[jedy_bringup] support mecanum drive using ridgeback_control

jedy/jedy_bringup/config/jedy_mecanum_drive_controller.yaml

@@ -0,0 +1,42 @@
+ridgeback_control:
+  type: "mecanum_drive_controller/MecanumDriveController"
+  front_left_wheel_joint: "front_left_wheel_joint"
+  back_left_wheel_joint: "rear_left_wheel_joint"
+  front_right_wheel_joint: "front_right_wheel_joint"
+  back_right_wheel_joint: "rear_right_wheel_joint"
+  publish_rate: 50
+  pose_covariance_diagonal: [0.001, 0.001, 1000000.0, 1000000.0, 1000000.0, 0.03]
+  twist_covariance_diagonal: [0.001, 0.001, 0.001, 1000000.0, 1000000.0, 0.03]
+  cmd_vel_timeout: 0.25
+
+  # Override URDF look-up for wheel separation since the parent link is not the base_link.
+  wheel_separation_x: 0.638
+  wheel_separation_y: 0.551
+
+  # Odometry fused with IMU is published by robot_localization, so  # no need to publish a TF based on encoders alone.
+  enable_odom_tf: true
+  base_frame_id: bodyset94855827795112
+
+  # Wheel separation and radius multipliers
+  wheel_separation_multiplier: 1.5 # default: 1.0
+  wheel_radius_multiplier    : 1.0 # default: 1.0
+
+  # Velocity and acceleration limits
+  # Whenever a min_* is unspecified, default to -max_*
+  linear:
+    x:
+      has_velocity_limits    : true
+      max_velocity           : 0.1   # m/s
+      has_acceleration_limits: true
+      max_acceleration       : 20.0   # m/s^2
+    y:
+      has_velocity_limits    : true
+      max_velocity           : 0.1   # m/s
+      has_acceleration_limits: true
+      max_acceleration       : 20.0   # m/s^2
+  angular:
+    z:
+      has_velocity_limits    : true
+      max_velocity           : 4.0   # rad/s
+      has_acceleration_limits: true
+      max_acceleration       : 25.0   # rad/s^2

jedy/jedy_bringup/launch/mecanum_drive_controller.launch

@@ -0,0 +1,12 @@
+<?xml version="1.0" encoding="utf-8"?>
+<launch>
+
+  <rosparam command="load" file="$(find jedy_bringup)/config/jedy_mecanum_drive_controller.yaml" />
+
+  <node name="mecanum_drive_controller_spawner"
+        pkg="controller_manager" type="spawner"
+        respawn="true" respawn_delay="5" output="screen"
+        args="ridgeback_control" >
+  </node>
+
+</launch>

jedy/jedy_bringup/launch/minimal.launch

@@ -40,11 +40,11 @@
   </include>
 
   <group if="$(eval len(arg('namespace')) > 0)" ns="$(arg namespace)" >
-    <include file="$(find jedy_bringup)/launch/diff_drive_controller.launch" />
+    <include file="$(find jedy_bringup)/launch/mecanum_drive_controller.launch" />
   </group>
 
   <group unless="$(eval len(arg('namespace')) > 0)">
-    <include file="$(find jedy_bringup)/launch/diff_drive_controller.launch" />
+    <include file="$(find jedy_bringup)/launch/mecanum_drive_controller.launch" />
   </group>
 
 </launch>

jedy/jedy_bringup/package.xml

@@ -30,6 +30,7 @@
     <exec_depend>slam_karto</exec_depend>
     <exec_depend>map_server</exec_depend>
     <exec_depend>ldlidar_stl_ros</exec_depend>
+    <exec_depend>ridgeback_control</exec_depend>
 
     <export>
         <gazebo_ros gazebo_model_path="${prefix}/worlds/model" />