Tune a bit physics to avoid joint slippage, specially in TIAGo

Author: Victor Lopez

pmb2_description/urdf/wheels/caster.gazebo.xacro

@@ -16,31 +16,31 @@
 
     <gazebo reference="caster_${side}_1_link">
       <kp>100000000.0</kp>
-      <kd>10.0</kd>
+      <kd>100000.0</kd>
       <friction>
         <ode>
           <mu>1.0</mu>
           <mu2>1.0</mu2>
         </ode>
       </friction>
       <!--<fdir1>1 0 0</fdir1>-->
-      <max_vel>10.0</max_vel>
-      <min_depth>0.0005</min_depth>
+      <max_vel>1.0</max_vel>
+      <min_depth>0.005</min_depth>
       <material>Gazebo/DarkGrey</material>
     </gazebo>
 
     <gazebo reference="caster_${side}_2_link">
       <kp>100000000.0</kp>
-      <kd>10.0</kd>
+      <kd>100000.0</kd>
       <friction>
         <ode>
           <mu>1.0</mu>
           <mu2>1.0</mu2>
         </ode>
       </friction>
       <!--<fdir1>1 0 0</fdir1>-->
-      <max_vel>10.0</max_vel>
-      <min_depth>0.0005</min_depth>
+      <max_vel>1.0</max_vel>
+      <min_depth>0.005</min_depth>
       <material>Gazebo/DarkGrey</material>
     </gazebo>
 

pmb2_description/urdf/wheels/caster.urdf.xacro

@@ -64,14 +64,15 @@
       <child link="caster_${side}_1_link"/>
       <origin xyz="${offset_x + separation_x / 2} ${offset_y - separation_y / 2} ${offset_z}" rpy="0 0 0"/>
       <axis xyz="0 0 1"/>
-      <dynamics damping="0.005" friction="0.0"/>
+      <dynamics damping="0.015" friction="0.0"/>
     </joint>
 
     <joint name="caster_${side}_2_joint" type="continuous">
       <parent link="caster_${side}_1_link"/>
       <child link="caster_${side}_2_link"/>
       <origin xyz="-0.016 0.0000 -0.040" rpy="${-90.0 * deg_to_rad} 0 0"/>
       <axis xyz="0 0 1"/>
+      <dynamics damping="0.015" friction="0.0"/>
     </joint>
 
     <!-- Gazebo extensions -->

pmb2_description/urdf/wheels/wheel.urdf.xacro

@@ -72,6 +72,7 @@ Creative Commons, 444 Castro Street, Suite 900, Mountain View, California, 94041
           <origin xyz="0 ${-separation / 2 * reflect} 0.0" rpy="${-90.0 * deg_to_rad} 0 0"/>
           <axis xyz="0 0 1"/>
           <limit effort="${torque}" velocity="${velocity / radius}"/>
+        <dynamics damping="1.0" friction="0.0"/>
         </joint>
 
         <!-- Gazebo extensions -->