UWSim multi robots with sensors
Hi,
I am having issues setting up a scene with 2 robots, each equipped with an IMU. My scene XML looks like:
...
<vehicle>
<name>AZOR</name>
<file>data/scenes/g500ARM5.urdf</file>
<position>
<x> 5</x>
<y> 7 </y>
<z> -3 </z>
</position>
<orientation>
<r>0</r>
<p>0 </p>
<y>0 </y>
</orientation>
<imu>
<name>IMU_AZOR</name>
<relativeTo>base_link</relativeTo>
<position>
<x>0</x>
<y>0</y>
<z>0</z>
</position>
<orientation>
<r>0</r>
<p>0</p>
<y>0</y>
</orientation>
<std>0.00000001</std>
</imu>
</vehicle>
<vehicle>
<name>TOM</name>
<file>data/scenes/g500ARM5.urdf</file>
<position>
<x> 10</x>
<y> 8 </y>
<z> -3 </z>
</position>
<orientation>
<r>0</r>
<p>0 </p>
<y>0 </y>
</orientation>
<imu>
<name>IMU_TOM</name>
<relativeTo>base_link</relativeTo>
<position>
<x>0</x>
<y>0</y>
<z>0</z>
</position>
<orientation>
<r>0</r>
<p>0</p>
<y>0</y>
</orientation>
<std>0.00000001</std>
</imu>
</vehicle>
<rosInterfaces>
<ROSOdomToPAT>
<topic> /dataNavigator_AZOR </topic>
<vehicleName> AZOR </vehicleName>
</ROSOdomToPAT>
<ROSOdomToPAT>
<topic> /dataNavigator_TOM </topic>
<vehicleName> TOM </vehicleName>
</ROSOdomToPAT>
<PATToROSOdom>
<topic> /uwsim/odom_AZOR </topic>
<vehicleName> AZOR </vehicleName>
</PATToROSOdom>
<PATToROSOdom>
<topic> /uwsim/odom_TOM </topic>
<vehicleName> TOM </vehicleName>
</PATToROSOdom>
<WorldToROSTF>
<rootName> world </rootName>
<enableObjects> 0 </enableObjects>
<rate>10</rate>
</WorldToROSTF>
<ImuToROSImu>
<name>IMU_AZOR</name>
<topic>g500/IMU_AZOR</topic>
<rate>20</rate>
</ImuToROSImu>
<ImuToROSImu>
<name>IMU_TOM</name>
<topic>g500/IMU_TOM</topic>
<rate>20</rate>
</ImuToROSImu>
</rosInterfaces>
When I try to run this scene, UWSim gives me Segmentation Fault. However, If I remove the second IMU sensor, the simulation is working OK. How can I have two vehicles with 2 IMU sensors? Thanks