This repository provides several contollers for the Ridgeback mobile-robot with Ur5 robotic-arm.
- admittance_control: This package implements an admittance controller on the ridgeback+UR5 platform (see below for the control architecture).
- ur5_cartesian_velocity_control: This package provides a cartesian velocity controller (ros control) for the UR5 arm.
- obstacle_avoidance: This package provides a simple obstacle-avoidance for the platform. It looks for the nearest obstacle using the laser sensors and remove the velocity components in that direction.
- cpr_bringup: This package provides a series of launch files and ROS settings in order to start-up the real-robot as well as the simulator.
- cpr_mocap_tracking: This package enables the robot to track an object (using mocap system) in its own frame of references (automatic calibration is included).
- cartesian_state_msgs: It contains the defintion of message type "PoseTwist" (combination of the standard ros/geometry_msgs pose and twist).
Clone the repository intor your catkin source directory
$ cd ~/catkin_ws/src
$ git clone git@github.com:epfl-lasa/ridgeback_ur5_controller.gitGet the source dependencies using wstool
$ wstool init
$ wstool merge ridgeback_ur5_controller/dependencies.rosinstall
$ wstool upGet the package dependencies using rosdep
$ rosdep install -y --from-paths src --ignore-src --rosdistro indigoYou also need the following ros packages
$ sudo apt-get install ros-indigo-ridgeback-*
$ sudo apt-get install ros-indigo-universal-robotif you are getting error for broken packages (most probably due to a wrong version of gazebo), you can use 'aptitude' instead of 'apt-get' which propose a solution and resolve the conflict.
Finally complie
$ cd ~/catkin_ws
$ catkin_make
$ source devel/setup.bash
$ catkin_make- you might need the source the bash file and compie again if the first compliation could not find some of in house dependencies.
For simulator, you can use gazebo7
$ sudo apt-get install ros-indigo-gazebo7-*You might need to follow these instructions.
To bring up the robot in simulation run
roslaunch cpr_bringup cpr_bringup.launch
roslaunch admittance_control admittance_controller.launch
For the real robot launch on the CPR main PC run
roslaunch cpr_bringup cpr_bringup.launch sim:=false
roslaunch admittance_control admittance_controller_real.launch
The behavior of different components are demonstrated here:
- admittance control and its rviz
- obstacle avoidance and its rviz.
- object tracking and its rviz.
Here is a short list of important frames and their usage.
| frame id | Usage |
|---|---|
| world | Odometry and navigation |
| ur5_arm_base_link | Arm pose and twist |
| base_link | Platform pose and twist |
| robotiq_force_torque_frame_id | External force applied to the end-effector |
The following figure shows the controller architecture for the admittance control on the robot.
The two equations in the center describe the admittance dynamics which compute the desired accelaration for the arm and the platform. These accelerations are integrated in time to acheive the desired velocities for the robot. The low-level velocity controller fullfills these velocities. In the case of platform, the computed velocities can be modified accroding to obstacle avoidance node.
The admittance parameters (shown in purple) are as follows:
| Variable | Parameter |
|---|---|
| Ma | Desired mass of the arm |
| Da | Desired damping of the arm |
| Dc | Desired damping of the coupling |
| Kc | Desired Stiffness of the coupling |
| Mp | Desired mass of the platform |
| Dp | Desired damping of the platform |
These parameters are load from a yaml through the launch file.
The external is initially measured by the force/torque sensor in its own frame reference. In admittance controller this force is transformed to "ur5_arm_base_link" where the control of arm takes place. To avoid reacting to small forces a deadzone is considered. Moreover, a low-pass filter is used to smooth the measurements. The parameters of the deadzone and the filter can be set from the launch file.
Through a higher level controller, the position of the equilibrium can be can be changed to acheive a desired behavior. Also, Fc can be used for control purposes; e.g., to compensate for the mass of an object carried by the arm.
