Fix ackermann demo (backport #582) (#583)

Signed-off-by: Alejandro Hernandez Cordero <ahcorde@gmail.com>
Co-authored-by: Narukara <narukara17@gmail.com>
Co-authored-by: Alejandro Hernández Cordero <ahcorde@gmail.com>

Author: 3 people

gz_ros2_control_demos/config/ackermann_drive_controller.yaml

@@ -14,8 +14,8 @@ ackermann_steering_controller:
     traction_wheels_radius: 0.3
     steering_wheels_radius: 0.3
     reference_timeout: 2.0 # In s. Timeout to stop if no cmd_vel is received
-    traction_joints_names: ['rear_left_wheel_joint', 'rear_right_wheel_joint']
-    steering_joints_names: ['left_wheel_steering_joint', 'right_wheel_steering_joint']
+    traction_joints_names: ['rear_right_wheel_joint', 'rear_left_wheel_joint']
+    steering_joints_names: ['right_wheel_steering_joint', 'left_wheel_steering_joint']
     open_loop: false
     velocity_rolling_window_size: 10
     base_frame_id: base_link

gz_ros2_control_demos/urdf/test_ackermann_drive.xacro.urdf

@@ -109,10 +109,10 @@
   </link>
 
   <joint name="left_wheel_steering_joint" type="revolute">
-    <origin xyz="0.9 -0.5 -0.2" rpy="1.57 0 0" />
+    <origin xyz="0.9 0.5 -0.2" rpy="0 0 0" />
     <parent link="chassis" />
     <child link="left_wheel_steering" />
-    <axis xyz="0 1 0" />
+    <axis xyz="0 0 1" />
     <dynamics damping="0.2" />
     <limit effort="1000.0" lower="-1.57" upper="1.57" velocity="30"/>
   </joint>
@@ -126,10 +126,10 @@
   </link>
 
   <joint name="right_wheel_steering_joint" type="revolute">
-    <origin xyz="0.9 0.5 -0.2" rpy="1.57 0 0" />
+    <origin xyz="0.9 -0.5 -0.2" rpy="0 0 0" />
     <parent link="chassis" />
     <child link="right_wheel_steering" />
-    <axis xyz="0 1 0" />
+    <axis xyz="0 0 1" />
     <dynamics damping="0.2" />
     <limit effort="1000.0" lower="-1.57" upper="1.57" velocity="30"/>
   </joint>
@@ -154,7 +154,7 @@
   </link>
 
   <joint name="front_left_wheel_joint" type="continuous">
-    <origin xyz="0 0 0" rpy="0 0 0" />
+    <origin xyz="0 0 0" rpy="-1.57 0 0" />
     <parent link="left_wheel_steering" />
     <child link="front_left_wheel" />
     <axis xyz="0 0 1" />
@@ -181,7 +181,7 @@
   </link>
 
   <joint name="front_right_wheel_joint" type="continuous">
-    <origin xyz="0 0 0" rpy="0 0 0" />
+    <origin xyz="0 0 0" rpy="-1.57 0 0" />
     <parent link="right_wheel_steering" />
     <child link="front_right_wheel" />
     <axis xyz="0 0 1" />