From b815ef597d1c236651eb4c1c3f5613645376e206 Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Bj=C3=B6rn=20Ellensohn?= <bjoern.ellensohn@gmail.com>
Date: Thu, 22 Jun 2023 10:41:34 +0200
Subject: [PATCH] update laser joint pos

---
 urdf/diffbot_description.urdf.xacro | 14 +++++++-------
 1 file changed, 7 insertions(+), 7 deletions(-)

diff --git a/urdf/diffbot_description.urdf.xacro b/urdf/diffbot_description.urdf.xacro
index 59cfff5..27a48d9 100644
--- a/urdf/diffbot_description.urdf.xacro
+++ b/urdf/diffbot_description.urdf.xacro
@@ -70,10 +70,10 @@
     <!-- right wheel joint -->
     <!-- fixed wheel joint for testing, type was continuous -->
     <joint name="${prefix}right_wheel_joint" type="continuous">
-      <origin xyz="0 -0.125 ${z_offset}" rpy="${PI / 2} 0 0" />
+      <origin xyz="0 {-0.125 - wheel_len /2} ${z_offset}" rpy="${PI / 2} 0 0" />
       <parent link="${prefix}base_link" />
       <child link="${prefix}right_wheel" />
-      <axis xyz="0 0 1"/>
+      <axis xyz="0 0 -1"/>
       <limit effort="1" velocity="20" />
       <joint_properties friction="0.0"/>
     </joint>
@@ -81,7 +81,7 @@
     <!-- right wheel Link -->
     <link name="${prefix}right_wheel">
       <visual>
-        <origin xyz="0 0 0" rpy="0 -0 0" />
+        <origin xyz="0 -{wheel_len /2} 0" rpy="0 -0 0" />
         <geometry>
           <mesh filename="package://bot_mini_description/mesh/wheel_link_visual.stl"/>
         </geometry>
@@ -105,10 +105,10 @@
     <!-- fixed wheel joint for testing, type was continuous -->
     <!-- left wheel joint -->
     <joint name="${prefix}left_wheel_joint" type="continuous">
-      <origin xyz="0 0.125 ${z_offset}" rpy="${PI / 2} 0 0" />
+      <origin xyz="0 {0.125 + wheel_len /2} ${z_offset}" rpy="${PI / 2} 0 0" />
       <parent link="${prefix}base_link" />
       <child link="${prefix}left_wheel" />
-      <axis xyz="0 0 -1" />
+      <axis xyz="0 0 1" />
       <limit effort="1" velocity="20" />
       <joint_properties friction="0.0" />
     </joint>
@@ -116,7 +116,7 @@
     <!-- left wheel Link -->
     <link name="${prefix}left_wheel">
       <visual>
-        <origin xyz="0 0 0" rpy="0 -0 0" />
+        <origin xyz="0 {wheel_len /2} 0" rpy="0 -0 0" />
         <geometry>
           <mesh filename="package://bot_mini_description/mesh/wheel_link_2_visual.stl"/>
         </geometry>
@@ -125,7 +125,7 @@
         </material>
       </visual>
       <collision>
-        <origin xyz="0 0 0" rpy="0 -0 0" />
+        <origin xyz="0 {wheel_len /2} 0" rpy="0 -0 0" />
         <geometry>
           <mesh filename="package://bot_mini_description/mesh/wheel_link_2_collision.stl"/>
         </geometry>