Flexiv ROS2

For ROS2 users to easily work with RDK, the APIs of RDK are wrapped into ROS packages in flexiv_ros2. Key functionalities like real-time joint torque and position control are supported, and the integration with ros2_control framework and MoveIt 2 is also implemented.

License

Flexiv RDK is licensed under the Apache 2.0 license.

References

Flexiv RDK main webpage contains important information like RDK user manual and network setup.

OS and distribution support

Supported OS:

• Linux: Ubuntu 20.04

Supported ROS2 distribution:

• Foxy Fitzroy

Getting Started

This project was developed for ROS2 Foxy on Ubuntu 20.04. Other versions of Ubuntu and ROS2 may work, but are not officially supported.

1. Install ROS2 Foxy via Debian Packages

2. Install colcon and additional ROS packages:

   sudo apt install -y \
       python3-colcon-common-extensions \
       python3-rosdep2
       libeigen3-dev \
       ros-foxy-xacro \
       ros-foxy-tinyxml2-vendor \
       ros-foxy-ros2-control \
       ros-foxy-realtime-tools \
       ros-foxy-control-toolbox \
       ros-foxy-moveit \
       ros-foxy-ros2-controllers \
       ros-foxy-test-msgs \
       ros-foxy-joint-state-publisher \
       ros-foxy-joint-state-publisher-gui \
       ros-foxy-robot-state-publisher \
       ros-foxy-rviz2

3. Setup workspace:

   mkdir -p ~/flexiv_ros2_ws/src
   cd ~/flexiv_ros2_ws/src
   git clone https://github.com/flexivrobotics/flexiv_ros2.git
   cd flexiv_ros2/
   git submodule update --init --recursive

4. Install dependencies:

   cd ~/flexiv_ros2_ws
   rosdep update
   rosdep install --from-paths src --ignore-src --rosdistro foxy -r -y

5. Build and source the workspace:

   cd ~/flexiv_ros2_ws
   source /opt/ros/foxy/setup.bash
   colcon build --symlink-install
   source install/setup.bash

NOTE1: Remember to source the setup file and the workspace whenever a new terminal is opened:

source /opt/ros/foxy/setup.bash
source ~/flexiv_ros2_ws/install/setup.bash

NOTE2:We can also add these two commands to the bashrc file by：

sudo gedit ~/.bashrc

Open the bashrc file and add the:

source /opt/ros/foxy/setup.bash
source ~/flexiv_ros2_ws/install/setup.bash

into the bottom of the bashrc file content like below picture line 119 and 120.

Then we don't need run these two command everytime when open a new terminal for source purpose.

Usage

NOTE: the instruction below is only a quick reference, see the Flexiv ROS2 Documentation for more information.

(Details about the launch file can be found in flexiv_bringup)

1. Start robot, simulator or fake hardware:

   • Test with real robot:

     ros2 launch flexiv_bringup rizon.launch.py robot_ip:=<RobotIP> local_ip:=<LocalIP>

     The launch file loads and starts the robot hardware, controllers and opens RViZ. Stop RViZ from auto-start use start_rviz:=false launch file argument.

     NOTE: Getting the following output in terminal is OK: Warning: Invalid frame ID "link1" passed to canTransform argument source_frame - frame does not exist. This happens because joint_state_broadcaster node need some time to start.

   • Test with fake hardware (ros2_control capability):

     ros2 launch flexiv_bringup rizon.launch.py robot_ip:=dont-care local_ip:=dont-care use_fake_hardware:=true

     use_fake_hardware argument starts FakeSystem instead of real hardware. This is a simple simulation that mimics joint command to their states.

2. Publish commands to controllers

   • The default controller in the launch file is rizon_arm_controller. To send the goal position to the controller by using the node from flexiv_test_nodes, start the following command in a new terminal:

     ros2 launch flexiv_bringup test_joint_trajectory_controller.launch.py

     You can change the joint position goals in flexiv_bringup/config/joint_trajectory_position_publisher.yaml. The robot will move like below picture：

NOTE: Press Ctrol+c for stop the robot Moving,Ctrol+z may break the robot for Start configuration checked.

• To test another controller, define it using the robot_controller launch argument, for example the joint_impedance_controller:

  ros2 launch flexiv_bringup rizon.launch.py robot_ip:=<RobotIP> local_ip:=<LocalIP> robot_controller:=joint_impedance_controller

  NOTE: The command starts the robot in the joint torque mode. In this mode, gravity and friction are compensated only for the robot without any attached objects (e.g. the gripper, camera).

  Open a new terminal and run the launch file:

  ros2 launch flexiv_bringup sine_sweep_impedance.launch.py

  The robot should run a sine-sweep motion with joint impedance control.

  NOTE: joint impedance control is not supported in fake/simulated hardware.

Using MoveIt

You can also run the MoveIt example and use the MotionPlanning plugin in RViZ to start planning:

ros2 launch flexiv_bringup rizon_moveit.launch.py robot_ip:=<RobotIP> local_ip:=<LocalIP>

Test with fake hardware:

ros2 launch flexiv_bringup rizon_moveit.launch.py robot_ip:=dont-care local_ip:=dont-care use_fake_hardware:=true