Better icub (mesh colors)

robots/icub/icub.urdf

@@ -5,12 +5,12 @@
 <!-- =================================================================================== -->
 <!-- icub URDF model -->
 <robot name="icub" xmlns:xacro="http://ros.org/wiki/xacro">
-  <link name="world"/>
+  <!-- <link name="world"/>
   <joint name="reference" type="floating">
     <parent link="world"/>
     <child link="waist"/>
     <origin rpy="0 0 0" xyz="0 0 0"/>
-  </joint>
+  </joint> -->
   <!-- INDEX -->
   <!-- just press ctrl+f to search -->
   <!-- LINKS -->

src/examples/icub.cpp

@@ -22,10 +22,14 @@ int main()
 #endif
     simu.add_checkerboard_floor();
     simu.add_robot(robot);
-
-    // Add some visualizations
-    //    robot->set_draw_axis(imu_config.body->getName());
-    //    robot->set_draw_axis("r_ankle_2");
+    auto ghost = robot->clone_ghost();
+    ghost->skeleton()->setPosition(4, -1.57);
+    ghost->skeleton()->setPosition(5, 1.1);
+    simu.add_robot(ghost);
+#if DART_VERSION_AT_MOST(6, 12, 99)
+    // fix a bug for older versions of DART
+    robot->set_color_mode("material");
+#endif
 
     simu.set_control_freq(100); // 100 Hz
     std::vector<std::string> dofs = {

src/robot_dart/robots/a1.cpp

@@ -9,10 +9,13 @@ namespace robot_dart {
             set_color_mode("material");
             set_self_collision(true);
             set_position_enforced(true);
+
+            // put above ground
             set_base_pose(robot_dart::make_vector({0., 0., 0., 0., 0., 0.5}));
+
+            // standing pose
             auto names = dof_names(true, true, true);
             names = std::vector<std::string>(names.begin() + 6, names.end());
-            // standing pose
             set_positions(robot_dart::make_vector({0.0, 0.67, -1.3, -0.0, 0.67, -1.3, 0.0, 0.67, -1.3, -0.0, 0.67, -1.3}), names);
         }
     } // namespace robots

src/robot_dart/robots/icub.cpp

@@ -10,11 +10,9 @@ namespace robot_dart {
               _ft_foot_right(std::make_shared<sensor::ForceTorque>(joint("r_ankle_roll"), frequency))
         {
             set_color_mode("material");
-            set_color_mode("aspect", "right_foot");
-            set_color_mode("aspect", "left_foot");
 
             set_position_enforced(true);
-            skeleton()->setPosition(5, 0.5);
+            skeleton()->setPosition(5, 0.46);
             skeleton()->setPosition(2, 1.57);
         }