Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Fix the position of the imu in the waist #267

Merged
merged 4 commits into from
Oct 9, 2024
Merged
Show file tree
Hide file tree
Changes from all commits
Commits
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
6 changes: 3 additions & 3 deletions urdf/creo2urdf/data/ergocub1_0/base_1_0.yaml
Original file line number Diff line number Diff line change
Expand Up @@ -1194,7 +1194,7 @@ XMLBlobs:
<link name="waist_imu_0"/>
- |
<joint name="waist_imu_0_fixed_joint" type="fixed">
<origin xyz="0.0354497 0.00639688 0.060600" rpy="1.5708 0 -1.5708"/>
<origin xyz="0.0606 -0.00639428 0.01745" rpy="1.5708 -0.000105208 -1.5708"/>
<parent link="torso_1"/>
<child link="waist_imu_0"/>
<dynamics damping="0.1"/>
Expand All @@ -1216,7 +1216,7 @@ XMLBlobs:
<sensor name="waist_imu_0" type="imu">
<always_on>1</always_on>
<update_rate>100</update_rate>
<pose>0.0354497 0.00639688 0.060600 1.5708 0 -1.5708</pose>
<pose>0.0606 -0.00639428 0.01745 1.5708 -0.000105208 -1.5708</pose>
<plugin name="ergocub_yarp_gazebo_plugin_IMU" filename="libgazebo_yarp_imu.so">
<yarpConfigurationFile>model://ergoCub/conf/gazebo_ergocub_waist_inertial.ini</yarpConfigurationFile>
</plugin>
Expand All @@ -1225,7 +1225,7 @@ XMLBlobs:
- |
<sensor name="waist_imu_0" type="accelerometer">
<parent link="torso_1"/>
<origin rpy="1.5708 0 -1.5708" xyz="0.0354497 0.00639688 0.060600"/>
<origin xyz="0.0606 -0.00639428 0.01745" rpy="1.5708 -0.000105208 -1.5708"/>
</sensor>
# upperbody
- |
Expand Down
6 changes: 3 additions & 3 deletions urdf/creo2urdf/data/ergocub1_1/base_1_1.yaml
Original file line number Diff line number Diff line change
Expand Up @@ -1143,7 +1143,7 @@ XMLBlobs:
<link name="waist_imu_0"/>
- |
<joint name="waist_imu_0_fixed_joint" type="fixed">
<origin xyz="0.0354497 0.00639688 0.060600" rpy="1.5708 0 -1.5708"/>
<origin xyz="0.0606 -0.00639428 0.01745" rpy="1.5708 -0.000105208 -1.5708"/>
<parent link="torso_1"/>
<child link="waist_imu_0"/>
<dynamics damping="0.1"/>
Expand All @@ -1159,7 +1159,7 @@ XMLBlobs:
<sensor name="waist_imu_0" type="imu">
<always_on>1</always_on>
<update_rate>100</update_rate>
<pose>0.0354497 0.00639688 0.060600 1.5708 0 -1.5708</pose>
<pose>0.0606 -0.00639428 0.01745 1.5708 -0.000105208 -1.5708</pose>
<plugin name="ergocub_yarp_gazebo_plugin_IMU" filename="libgazebo_yarp_imu.so">
<yarpConfigurationFile>model://ergoCub/conf/gazebo_ergocub_waist_inertial.ini</yarpConfigurationFile>
</plugin>
Expand All @@ -1174,7 +1174,7 @@ XMLBlobs:
- |
<sensor name="waist_imu_0" type="accelerometer">
<parent link="torso_1"/>
<origin rpy="1.5708 0 -1.5708" xyz="0.0354497 0.00639688 0.060600"/>
<origin xyz="0.0606 -0.00639428 0.01745" rpy="1.5708 -0.000105208 -1.5708"/>
</sensor>
# upperbody
- |
Expand Down
42 changes: 21 additions & 21 deletions urdf/ergoCub/robots/ergoCubGazeboV1/model.urdf
Original file line number Diff line number Diff line change
Expand Up @@ -3007,30 +3007,30 @@
</sensor>
<link name="waist_imu_0"/>
<joint name="waist_imu_0_fixed_joint" type="fixed">
<origin xyz="0.0354497 0.00639688 0.060600" rpy="1.5708 0 -1.5708"/>
<parent link="torso_1"/>
<child link="waist_imu_0"/>
<dynamics damping="0.1"/>
</joint>
<origin xyz="0.0606 -0.00639428 0.01745" rpy="1.5708 -0.000105208 -1.5708"/>
<parent link="torso_1"/>
<child link="waist_imu_0"/>
<dynamics damping="0.1"/>
</joint>
<gazebo>
<plugin name="ergocub_yarp_gazebo_plugin_IMU" filename="libgazebo_yarp_imu.so">
<yarpConfigurationFile>model://ergoCub/conf/gazebo_ergocub_waist_inertial.ini</yarpConfigurationFile>
</plugin>
</gazebo>
<plugin name="ergocub_yarp_gazebo_plugin_IMU" filename="libgazebo_yarp_imu.so">
<yarpConfigurationFile>model://ergoCub/conf/gazebo_ergocub_waist_inertial.ini</yarpConfigurationFile>
</plugin>
</gazebo>
<gazebo reference="torso_1">
<sensor name="waist_imu_0" type="imu">
<always_on>1</always_on>
<update_rate>100</update_rate>
<pose>0.0354497 0.00639688 0.060600 1.5708 0 -1.5708</pose>
<plugin name="ergocub_yarp_gazebo_plugin_IMU" filename="libgazebo_yarp_imu.so">
<yarpConfigurationFile>model://ergoCub/conf/gazebo_ergocub_waist_inertial.ini</yarpConfigurationFile>
</plugin>
</sensor>
</gazebo>
<sensor name="waist_imu_0" type="imu">
<always_on>1</always_on>
<update_rate>100</update_rate>
<pose>0.0606 -0.00639428 0.01745 1.5708 -0.000105208 -1.5708</pose>
<plugin name="ergocub_yarp_gazebo_plugin_IMU" filename="libgazebo_yarp_imu.so">
<yarpConfigurationFile>model://ergoCub/conf/gazebo_ergocub_waist_inertial.ini</yarpConfigurationFile>
</plugin>
</sensor>
</gazebo>
<sensor name="waist_imu_0" type="accelerometer">
<parent link="torso_1"/>
<origin rpy="1.5708 0 -1.5708" xyz="0.0354497 0.00639688 0.060600"/>
</sensor>
<parent link="torso_1"/>
<origin xyz="0.0606 -0.00639428 0.01745" rpy="1.5708 -0.000105208 -1.5708"/>
</sensor>
<link name="base_link"/>
<joint name="base_link_fixed_joint" type="fixed">
<origin xyz="0 0 0" rpy="0 -0 0"/>
Expand Down
6 changes: 3 additions & 3 deletions urdf/ergoCub/robots/ergoCubGazeboV1_1/model.urdf
Original file line number Diff line number Diff line change
Expand Up @@ -2952,7 +2952,7 @@
</joint>
<link name="waist_imu_0"/>
<joint name="waist_imu_0_fixed_joint" type="fixed">
<origin xyz="0.0354497 0.00639688 0.060600" rpy="1.5708 0 -1.5708"/>
<origin xyz="0.0606 -0.00639428 0.01745" rpy="1.5708 -0.000105208 -1.5708"/>
<parent link="torso_1"/>
<child link="waist_imu_0"/>
<dynamics damping="0.1"/>
Expand All @@ -2966,7 +2966,7 @@
<sensor name="waist_imu_0" type="imu">
<always_on>1</always_on>
<update_rate>100</update_rate>
<pose>0.0354497 0.00639688 0.060600 1.5708 0 -1.5708</pose>
<pose>0.0606 -0.00639428 0.01745 1.5708 -0.000105208 -1.5708</pose>
<plugin name="ergocub_yarp_gazebo_plugin_IMU" filename="libgazebo_yarp_imu.so">
<yarpConfigurationFile>model://ergoCub/conf/gazebo_ergocub_waist_inertial.ini</yarpConfigurationFile>
</plugin>
Expand All @@ -2979,7 +2979,7 @@
</gazebo>
<sensor name="waist_imu_0" type="accelerometer">
<parent link="torso_1"/>
<origin rpy="1.5708 0 -1.5708" xyz="0.0354497 0.00639688 0.060600"/>
<origin xyz="0.0606 -0.00639428 0.01745" rpy="1.5708 -0.000105208 -1.5708"/>
</sensor>
<link name="base_link"/>
<joint name="base_link_fixed_joint" type="fixed">
Expand Down
6 changes: 3 additions & 3 deletions urdf/ergoCub/robots/ergoCubGazeboV1_1_minContacts/model.urdf
Original file line number Diff line number Diff line change
Expand Up @@ -2766,7 +2766,7 @@
</joint>
<link name="waist_imu_0"/>
<joint name="waist_imu_0_fixed_joint" type="fixed">
<origin xyz="0.0354497 0.00639688 0.060600" rpy="1.5708 0 -1.5708"/>
<origin xyz="0.0606 -0.00639428 0.01745" rpy="1.5708 -0.000105208 -1.5708"/>
<parent link="torso_1"/>
<child link="waist_imu_0"/>
<dynamics damping="0.1"/>
Expand All @@ -2780,7 +2780,7 @@
<sensor name="waist_imu_0" type="imu">
<always_on>1</always_on>
<update_rate>100</update_rate>
<pose>0.0354497 0.00639688 0.060600 1.5708 0 -1.5708</pose>
<pose>0.0606 -0.00639428 0.01745 1.5708 -0.000105208 -1.5708</pose>
<plugin name="ergocub_yarp_gazebo_plugin_IMU" filename="libgazebo_yarp_imu.so">
<yarpConfigurationFile>model://ergoCub/conf/gazebo_ergocub_waist_inertial.ini</yarpConfigurationFile>
</plugin>
Expand All @@ -2793,7 +2793,7 @@
</gazebo>
<sensor name="waist_imu_0" type="accelerometer">
<parent link="torso_1"/>
<origin rpy="1.5708 0 -1.5708" xyz="0.0354497 0.00639688 0.060600"/>
<origin xyz="0.0606 -0.00639428 0.01745" rpy="1.5708 -0.000105208 -1.5708"/>
</sensor>
<link name="base_link"/>
<joint name="base_link_fixed_joint" type="fixed">
Expand Down
6 changes: 3 additions & 3 deletions urdf/ergoCub/robots/ergoCubGazeboV1_2/model.urdf
Original file line number Diff line number Diff line change
Expand Up @@ -2952,7 +2952,7 @@
</joint>
<link name="waist_imu_0"/>
<joint name="waist_imu_0_fixed_joint" type="fixed">
<origin xyz="0.0354497 0.00639688 0.060600" rpy="1.5708 0 -1.5708"/>
<origin xyz="0.0606 -0.00639428 0.01745" rpy="1.5708 -0.000105208 -1.5708"/>
<parent link="torso_1"/>
<child link="waist_imu_0"/>
<dynamics damping="0.1"/>
Expand All @@ -2966,7 +2966,7 @@
<sensor name="waist_imu_0" type="imu">
<always_on>1</always_on>
<update_rate>100</update_rate>
<pose>0.0354497 0.00639688 0.060600 1.5708 0 -1.5708</pose>
<pose>0.0606 -0.00639428 0.01745 1.5708 -0.000105208 -1.5708</pose>
<plugin name="ergocub_yarp_gazebo_plugin_IMU" filename="libgazebo_yarp_imu.so">
<yarpConfigurationFile>model://ergoCub/conf/gazebo_ergocub_waist_inertial.ini</yarpConfigurationFile>
</plugin>
Expand All @@ -2979,7 +2979,7 @@
</gazebo>
<sensor name="waist_imu_0" type="accelerometer">
<parent link="torso_1"/>
<origin rpy="1.5708 0 -1.5708" xyz="0.0354497 0.00639688 0.060600"/>
<origin xyz="0.0606 -0.00639428 0.01745" rpy="1.5708 -0.000105208 -1.5708"/>
</sensor>
<link name="base_link"/>
<joint name="base_link_fixed_joint" type="fixed">
Expand Down
6 changes: 3 additions & 3 deletions urdf/ergoCub/robots/ergoCubGazeboV1_2_minContacts/model.urdf
Original file line number Diff line number Diff line change
Expand Up @@ -2766,7 +2766,7 @@
</joint>
<link name="waist_imu_0"/>
<joint name="waist_imu_0_fixed_joint" type="fixed">
<origin xyz="0.0354497 0.00639688 0.060600" rpy="1.5708 0 -1.5708"/>
<origin xyz="0.0606 -0.00639428 0.01745" rpy="1.5708 -0.000105208 -1.5708"/>
<parent link="torso_1"/>
<child link="waist_imu_0"/>
<dynamics damping="0.1"/>
Expand All @@ -2780,7 +2780,7 @@
<sensor name="waist_imu_0" type="imu">
<always_on>1</always_on>
<update_rate>100</update_rate>
<pose>0.0354497 0.00639688 0.060600 1.5708 0 -1.5708</pose>
<pose>0.0606 -0.00639428 0.01745 1.5708 -0.000105208 -1.5708</pose>
<plugin name="ergocub_yarp_gazebo_plugin_IMU" filename="libgazebo_yarp_imu.so">
<yarpConfigurationFile>model://ergoCub/conf/gazebo_ergocub_waist_inertial.ini</yarpConfigurationFile>
</plugin>
Expand All @@ -2793,7 +2793,7 @@
</gazebo>
<sensor name="waist_imu_0" type="accelerometer">
<parent link="torso_1"/>
<origin rpy="1.5708 0 -1.5708" xyz="0.0354497 0.00639688 0.060600"/>
<origin xyz="0.0606 -0.00639428 0.01745" rpy="1.5708 -0.000105208 -1.5708"/>
</sensor>
<link name="base_link"/>
<joint name="base_link_fixed_joint" type="fixed">
Expand Down
42 changes: 21 additions & 21 deletions urdf/ergoCub/robots/ergoCubGazeboV1_minContacts/model.urdf
Original file line number Diff line number Diff line change
Expand Up @@ -3007,30 +3007,30 @@
</sensor>
<link name="waist_imu_0"/>
<joint name="waist_imu_0_fixed_joint" type="fixed">
<origin xyz="0.0354497 0.00639688 0.060600" rpy="1.5708 0 -1.5708"/>
<parent link="torso_1"/>
<child link="waist_imu_0"/>
<dynamics damping="0.1"/>
</joint>
<origin xyz="0.0606 -0.00639428 0.01745" rpy="1.5708 -0.000105208 -1.5708"/>
<parent link="torso_1"/>
<child link="waist_imu_0"/>
<dynamics damping="0.1"/>
</joint>
<gazebo>
<plugin name="ergocub_yarp_gazebo_plugin_IMU" filename="libgazebo_yarp_imu.so">
<yarpConfigurationFile>model://ergoCub/conf/gazebo_ergocub_waist_inertial.ini</yarpConfigurationFile>
</plugin>
</gazebo>
<plugin name="ergocub_yarp_gazebo_plugin_IMU" filename="libgazebo_yarp_imu.so">
<yarpConfigurationFile>model://ergoCub/conf/gazebo_ergocub_waist_inertial.ini</yarpConfigurationFile>
</plugin>
</gazebo>
<gazebo reference="torso_1">
<sensor name="waist_imu_0" type="imu">
<always_on>1</always_on>
<update_rate>100</update_rate>
<pose>0.0354497 0.00639688 0.060600 1.5708 0 -1.5708</pose>
<plugin name="ergocub_yarp_gazebo_plugin_IMU" filename="libgazebo_yarp_imu.so">
<yarpConfigurationFile>model://ergoCub/conf/gazebo_ergocub_waist_inertial.ini</yarpConfigurationFile>
</plugin>
</sensor>
</gazebo>
<sensor name="waist_imu_0" type="imu">
<always_on>1</always_on>
<update_rate>100</update_rate>
<pose>0.0606 -0.00639428 0.01745 1.5708 -0.000105208 -1.5708</pose>
<plugin name="ergocub_yarp_gazebo_plugin_IMU" filename="libgazebo_yarp_imu.so">
<yarpConfigurationFile>model://ergoCub/conf/gazebo_ergocub_waist_inertial.ini</yarpConfigurationFile>
</plugin>
</sensor>
</gazebo>
<sensor name="waist_imu_0" type="accelerometer">
<parent link="torso_1"/>
<origin rpy="1.5708 0 -1.5708" xyz="0.0354497 0.00639688 0.060600"/>
</sensor>
<parent link="torso_1"/>
<origin xyz="0.0606 -0.00639428 0.01745" rpy="1.5708 -0.000105208 -1.5708"/>
</sensor>
<link name="base_link"/>
<joint name="base_link_fixed_joint" type="fixed">
<origin xyz="0 0 0" rpy="0 -0 0"/>
Expand Down
42 changes: 21 additions & 21 deletions urdf/ergoCub/robots/ergoCubSN000/model.urdf
Original file line number Diff line number Diff line change
Expand Up @@ -3007,30 +3007,30 @@
</sensor>
<link name="waist_imu_0"/>
<joint name="waist_imu_0_fixed_joint" type="fixed">
<origin xyz="0.0354497 0.00639688 0.060600" rpy="1.5708 0 -1.5708"/>
<parent link="torso_1"/>
<child link="waist_imu_0"/>
<dynamics damping="0.1"/>
</joint>
<origin xyz="0.0606 -0.00639428 0.01745" rpy="1.5708 -0.000105208 -1.5708"/>
<parent link="torso_1"/>
<child link="waist_imu_0"/>
<dynamics damping="0.1"/>
</joint>
<gazebo>
<plugin name="ergocub_yarp_gazebo_plugin_IMU" filename="libgazebo_yarp_imu.so">
<yarpConfigurationFile>model://ergoCub/conf/gazebo_ergocub_waist_inertial.ini</yarpConfigurationFile>
</plugin>
</gazebo>
<plugin name="ergocub_yarp_gazebo_plugin_IMU" filename="libgazebo_yarp_imu.so">
<yarpConfigurationFile>model://ergoCub/conf/gazebo_ergocub_waist_inertial.ini</yarpConfigurationFile>
</plugin>
</gazebo>
<gazebo reference="torso_1">
<sensor name="waist_imu_0" type="imu">
<always_on>1</always_on>
<update_rate>100</update_rate>
<pose>0.0354497 0.00639688 0.060600 1.5708 0 -1.5708</pose>
<plugin name="ergocub_yarp_gazebo_plugin_IMU" filename="libgazebo_yarp_imu.so">
<yarpConfigurationFile>model://ergoCub/conf/gazebo_ergocub_waist_inertial.ini</yarpConfigurationFile>
</plugin>
</sensor>
</gazebo>
<sensor name="waist_imu_0" type="imu">
<always_on>1</always_on>
<update_rate>100</update_rate>
<pose>0.0606 -0.00639428 0.01745 1.5708 -0.000105208 -1.5708</pose>
<plugin name="ergocub_yarp_gazebo_plugin_IMU" filename="libgazebo_yarp_imu.so">
<yarpConfigurationFile>model://ergoCub/conf/gazebo_ergocub_waist_inertial.ini</yarpConfigurationFile>
</plugin>
</sensor>
</gazebo>
<sensor name="waist_imu_0" type="accelerometer">
<parent link="torso_1"/>
<origin rpy="1.5708 0 -1.5708" xyz="0.0354497 0.00639688 0.060600"/>
</sensor>
<parent link="torso_1"/>
<origin xyz="0.0606 -0.00639428 0.01745" rpy="1.5708 -0.000105208 -1.5708"/>
</sensor>
<link name="base_link"/>
<joint name="base_link_fixed_joint" type="fixed">
<origin xyz="0 0 0" rpy="0 -0 0"/>
Expand Down
6 changes: 3 additions & 3 deletions urdf/ergoCub/robots/ergoCubSN001/model.urdf
Original file line number Diff line number Diff line change
Expand Up @@ -2952,7 +2952,7 @@
</joint>
<link name="waist_imu_0"/>
<joint name="waist_imu_0_fixed_joint" type="fixed">
<origin xyz="0.0354497 0.00639688 0.060600" rpy="1.5708 0 -1.5708"/>
<origin xyz="0.0606 -0.00639428 0.01745" rpy="1.5708 -0.000105208 -1.5708"/>
<parent link="torso_1"/>
<child link="waist_imu_0"/>
<dynamics damping="0.1"/>
Expand All @@ -2966,7 +2966,7 @@
<sensor name="waist_imu_0" type="imu">
<always_on>1</always_on>
<update_rate>100</update_rate>
<pose>0.0354497 0.00639688 0.060600 1.5708 0 -1.5708</pose>
<pose>0.0606 -0.00639428 0.01745 1.5708 -0.000105208 -1.5708</pose>
<plugin name="ergocub_yarp_gazebo_plugin_IMU" filename="libgazebo_yarp_imu.so">
<yarpConfigurationFile>model://ergoCub/conf/gazebo_ergocub_waist_inertial.ini</yarpConfigurationFile>
</plugin>
Expand All @@ -2979,7 +2979,7 @@
</gazebo>
<sensor name="waist_imu_0" type="accelerometer">
<parent link="torso_1"/>
<origin rpy="1.5708 0 -1.5708" xyz="0.0354497 0.00639688 0.060600"/>
<origin xyz="0.0606 -0.00639428 0.01745" rpy="1.5708 -0.000105208 -1.5708"/>
</sensor>
<link name="base_link"/>
<joint name="base_link_fixed_joint" type="fixed">
Expand Down
6 changes: 3 additions & 3 deletions urdf/ergoCub/robots/ergoCubSN002/model.urdf
Original file line number Diff line number Diff line change
Expand Up @@ -2952,7 +2952,7 @@
</joint>
<link name="waist_imu_0"/>
<joint name="waist_imu_0_fixed_joint" type="fixed">
<origin xyz="0.0354497 0.00639688 0.060600" rpy="1.5708 0 -1.5708"/>
<origin xyz="0.0606 -0.00639428 0.01745" rpy="1.5708 -0.000105208 -1.5708"/>
<parent link="torso_1"/>
<child link="waist_imu_0"/>
<dynamics damping="0.1"/>
Expand All @@ -2966,7 +2966,7 @@
<sensor name="waist_imu_0" type="imu">
<always_on>1</always_on>
<update_rate>100</update_rate>
<pose>0.0354497 0.00639688 0.060600 1.5708 0 -1.5708</pose>
<pose>0.0606 -0.00639428 0.01745 1.5708 -0.000105208 -1.5708</pose>
<plugin name="ergocub_yarp_gazebo_plugin_IMU" filename="libgazebo_yarp_imu.so">
<yarpConfigurationFile>model://ergoCub/conf/gazebo_ergocub_waist_inertial.ini</yarpConfigurationFile>
</plugin>
Expand All @@ -2979,7 +2979,7 @@
</gazebo>
<sensor name="waist_imu_0" type="accelerometer">
<parent link="torso_1"/>
<origin rpy="1.5708 0 -1.5708" xyz="0.0354497 0.00639688 0.060600"/>
<origin xyz="0.0606 -0.00639428 0.01745" rpy="1.5708 -0.000105208 -1.5708"/>
</sensor>
<link name="base_link"/>
<joint name="base_link_fixed_joint" type="fixed">
Expand Down
Loading