Log robot names and configurations in run.yml

[nkoenig]

Tested using:

ign launch cloudsim_sim.ign worldName:=simple_cave_01 circuit:=cave robotName1:=MY_X1 robotConfig1:=X1_SENSOR_CONFIG_1 robotName2:=TEST_X2 robotConfig2:=X2_SENSOR_CONFIG_3 robotName3:=X3_CHILD robotConfig3:=X3_SENSOR_CONFIG_1 marsupial1:=MY_X1:X3_CHILD

which produces the following in run.yml:

robots:
  MY_X1:
    platform: X1
    config: X1 CONFIG 1
  TEST_X2:
    platform: X2
    config: X2 CONFIG 3
  X3_CHILD:
    platform: X3
    config: X3 UAV CONFIG 1
marsupials:
  MY_X1: X3_CHILD

Signed-off-by: Nate Koenig nate@openrobotics.org