Added pedestal, for reference.

kineticsystem · kineticsystem · commit 231dd25a8380 · 2025-09-09T16:16:47.000+02:00
diff --git a/src/moveit_pro_franka_configs/franka_arm_sim/config/config.yaml b/src/moveit_pro_franka_configs/franka_arm_sim/config/config.yaml
@@ -34,7 +34,7 @@ hardware:
     # [Optional]
     urdf_params:
       - mujoco_model: "description/mujoco/scene.xml"
-      - mujoco_viewer: true
+      - mujoco_viewer: false
     simulated_hardware_launch_file:
       package: "moveit_studio_agent"
       path: "launch/blank.launch.py"
diff --git a/src/moveit_pro_franka_configs/franka_arm_sim/description/franka.urdf.xacro b/src/moveit_pro_franka_configs/franka_arm_sim/description/franka.urdf.xacro
@@ -26,6 +26,45 @@
                       xyz="0 0 0.9">
   </xacro:franka_robot>
   
+  <!-- Pedestal the robot stands on -->
+  <link name="pedestal">
+    <!-- simple mass/inertia for a solid cylinder -->
+    <inertial>
+      <mass value="30.0"/> <!-- adjust as needed -->
+      <!-- Inertia for solid cylinder: Ixx=Iyy=(1/12)m(3r^2+h^2), Izz=(1/2)m r^2 -->
+      <!-- For r=0.2 m, h=0.9 m, m=30 kg: Ixx=Iyy≈2.325, Izz≈0.6 -->
+      <origin xyz="0 0 0.45"/> <!-- center of mass at half height -->
+      <inertia ixx="2.325" ixy="0.0" ixz="0.0"
+               iyy="2.325" iyz="0.0"
+               izz="0.6"/>
+    </inertial>
+
+    <visual>
+      <!-- place the cylinder so its base sits at z=0 and top at z=0.9 -->
+      <origin xyz="0 0 0.45"/>
+      <geometry>
+        <cylinder radius="0.2" length="0.9"/>
+      </geometry>
+      <material name="pedestal_grey">
+        <color rgba="0.7 0.7 0.7 1.0"/>
+      </material>
+    </visual>
+
+    <collision>
+      <origin xyz="0 0 0.45"/>
+      <geometry>
+        <cylinder radius="0.2" length="0.9"/>
+      </geometry>
+    </collision>
+  </link>
+
+  <!-- Fix pedestal to the world at the origin -->
+  <joint name="pedestal_to_world" type="fixed">
+    <parent link="world"/>
+    <child link="pedestal"/>
+    <origin xyz="0 0 0" rpy="0 0 0"/>
+  </joint>
+
     <!-- This link aligns the axes of the grasp frame to our required convention for motion planning tasks. -->
    <link name="grasp_link" />
    <joint name="grasp_link_joint" type="fixed">
diff --git a/src/moveit_pro_franka_configs/franka_arm_sim/description/mujoco/scene.xml b/src/moveit_pro_franka_configs/franka_arm_sim/description/mujoco/scene.xml
@@ -67,6 +67,18 @@
       xyaxes="0.510 -0.860 0.000 0.666 0.395 0.633"
     />
 
+    <!-- Cylindrical pedestal: radius=0.2, length=0.9 (size takes half-length=0.45) -->
+    <body name="pedestal" pos="0 0 0">
+      <!-- place geom so the cylinder stands from z=0 to z=0.9 -->
+      <geom name="pedestal_geom"
+            type="cylinder"
+            size="0.2 0.45"
+            pos="0 0 0.45"
+            rgba="0.7 0.7 0.7 1"/>
+      <!-- useful marker at the top of the pedestal -->
+      <site name="pedestal_top" pos="0 0 0.9" size="0.01" type="sphere" rgba="0.1 0.8 0.1 1"/>
+    </body>
+
     <body name="desk" pos="0.8 0.1 0" euler="0 0 -1.5708">
       <body name="counters1" pos="0 0 0">
         <include file="assets/kitchen_assets/item_assets/counters_chain.xml" />
@@ -120,8 +132,7 @@
          fr3_joint5,
          fr3_joint6,
          fr3_joint7,
-         fr3_finger1,
-         fr3_finger2
+         fr3_finger1 - We control only one finger.
     -->
     <key
       name="home"
diff --git a/src/moveit_pro_franka_configs/franka_arm_sim/waypoints/waypoints.yaml b/src/moveit_pro_franka_configs/franka_arm_sim/waypoints/waypoints.yaml
@@ -60,14 +60,14 @@
     - fr3_joint7
     - fr3_finger_joint1
     position:
-    - -2.2161396085498604
-    - 1.5466183464436773
-    - -0.22145440706027172
-    - -1.6205947051727179
-    - -0.004699868288038443
-    - 1.581359852803185
-    - 0.7845073181465004
-    - 0.034967833251422394
+    - -2.2283963696816342
+    - 1.563234326437979
+    - -0.21066213082094074
+    - -1.4035234551463138
+    - -0.0034359985486580383
+    - 1.6199226560931328
+    - 0.7839630999178752
+    - 0.035000000000000066
     velocity: []
   multi_dof_joint_state:
     header:
