diff --git a/ros_packages/mrs_uav_gazebo_simulation/models/mrs_robots_description/sdf/component_snippets.sdf.jinja b/ros_packages/mrs_uav_gazebo_simulation/models/mrs_robots_description/sdf/component_snippets.sdf.jinja index b5f591b..8d1ee50 100644 --- a/ros_packages/mrs_uav_gazebo_simulation/models/mrs_robots_description/sdf/component_snippets.sdf.jinja +++ b/ros_packages/mrs_uav_gazebo_simulation/models/mrs_robots_description/sdf/component_snippets.sdf.jinja @@ -2395,10 +2395,10 @@ limitations under the License. {{ generic.imu_sensor_macro( sensor_name = sensor_name + '_imu', - parent_link = parent_link, + parent_link = sensor_name + '_link', update_rate = spawner_args[spawner_keyword]['imu_rate'], topic_name = '/' + spawner_args['name'] + '/' + sensor_name + '/imu', - frame_name = spawner_args['name'] + '/' + sensor_name, + frame_name = spawner_args['name'] + '/' + sensor_name + '_imu', noise_mean = spawner_args[spawner_keyword]['imu_noise'], x = 0, y = 0, @@ -2409,6 +2409,14 @@ limitations under the License. }} + + {{ generic.tf_static_macro( + namespace = spawner_args['name'] + '/', + parent_link = sensor_name + "_link", + child_link = sensor_name + "_imu_link") + }} + {# #} + {{ mount if mount }} @@ -2476,7 +2484,7 @@ limitations under the License. {{ generic.imu_sensor_macro( sensor_name = sensor_name + '_imu', - parent_link = parent_link, + parent_link = sensor_name, update_rate = spawner_args[spawner_keyword]['imu_rate'], topic_name = '/' + spawner_args['name'] + '/' + sensor_name + '/imu', frame_name = spawner_args['name'] + '/' + sensor_name, @@ -2490,6 +2498,14 @@ limitations under the License. }} + + {{ generic.tf_static_macro( + namespace = spawner_args['name'] + '/', + parent_link = sensor_name + "_link", + child_link = sensor_name + "_imu_link") + }} + {# #} + {{ mount if mount }} diff --git a/ros_packages/mrs_uav_gazebo_simulation/models/mrs_robots_description/sdf/generic_components.sdf.jinja b/ros_packages/mrs_uav_gazebo_simulation/models/mrs_robots_description/sdf/generic_components.sdf.jinja index 0b4c2e7..63f8814 100644 --- a/ros_packages/mrs_uav_gazebo_simulation/models/mrs_robots_description/sdf/generic_components.sdf.jinja +++ b/ros_packages/mrs_uav_gazebo_simulation/models/mrs_robots_description/sdf/generic_components.sdf.jinja @@ -789,6 +789,16 @@ limitations under the License. {%- endmacro -%} {# #} +{%- macro tf_static_macro(namespace, parent_link, child_link) -%} + + {{ namespace }} + {{ parent_link }} + {{ child_link }} + +{%- endmacro -%} +{# #} + {# ========================== gazebo plugins ========================= #} {# gazebo_gps_macro {--> #}