$ cd /home/lzt/catkin_crl/src/flexiv_ros/flexiv_hardware/rdk/example_py $ python display_robot_states.py 192.168.2.100 192.168.2.104

$ roslaunch flexiv_bringup rizon_control.launch robot_ip:=192.168.2.100 local_ip:=192.168.2.104 rizon_type:=rizon4s

$ roslaunch flexiv_moveit_config moveit_control.launch robot_ip:=192.168.2.100 local_ip:=192.168.2.104 rizon_type:=rizon4s

$ roslaunch flexiv_example_controllers joint_impedance_example_controller.launch robot_ip:=192.168.2.100 local_ip:=192.168.2.104 rizon_type:=rizon4s

$ roslaunch flexiv_example_controllers joint_position_example_controller.launch robot_ip:=192.168.2.100 local_ip:=192.168.2.104 rizon_type:=rizon4s

Flexiv ROS

RDK APIs are wrapped into ROS packages in flexiv_ros. Key functionalities like real-time joint torque and position control, ros_control and MoveIt! integrations are implemented.

References

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

Compatibility

Supported OS	Supported ROS distribution
Ubuntu 20.04	Noetic Ninjemys

Building

# source ros noetic
$ source /opt/ros/noetic/setup.bash

# create a catkin workspace
$ mkdir -p flexiv_ros_ws/src && cd flexiv_ros_ws

# clone the packages
$ git clone https://github.com/flexivrobotics/flexiv_ros.git src/flexiv_ros

# install dependencies
$ sudo apt update -qq
$ rosdep update
$ rosdep install --from-paths src --ignore-src -y

# build the workspace
$ catkin_make

# source the workspace
$ source ~/flexiv_ros_ws/devel/setup.bash

Usage

Enable RDK on robot server

In order to use ROS driver to control the robot, you need to enable RDK on the robot server. See the RDK Getting Started guide for details.

Control the robot

Make sure that the ROS packages are built successfully and you have sourced the workspace. It is highly recommended to use a direct wired connection between the robot and the workstation PC for real-time access to the robot. The workstation PC must be in the same subnet with the robot in order to connect.

To start the robot driver run the following command in a terminal:

$ roslaunch flexiv_bringup rizon_control.launch robot_ip:=[robot_ip] local_ip:=[local_ip]

Note: Rizon 4 is the default robot type in the above launch command. If you want to control the Rizon 4s, add the launch argument rizon_type:=rizon4s.

In another terminal, start the following launch file to run the rqt:

$ rosrun rqt_joint_trajectory_controller rqt_joint_trajectory_controller

You can use the rqt GUI to control the robot in joint space.

Using MoveIt!

Launch the robot driver and the MoveIt! interface:

$ roslaunch flexiv_moveit_config moveit_control.launch robot_ip:=[robot_ip] local_ip:=[local_ip]

You should get a RViZ window with the robot in the planning scene. You can use the MotionPlanning plugin in RViZ to control the robot.

Robot States

The following ROS topics are published by the robot driver:

/external_force_in_tcp: Estimated external force applied on TCP in TCP frame $^{TCP}F_{ext}~[N][Nm]$ in force and moment. [flexiv_msgs/ExternalForce.msg]
/external_force_in_base: Estimated external force applied on TCP in the base frame $^{0}F_{ext}~[N][Nm]$ in force and moment. [flexiv_msgs/ExternalForce.msg]
/joint_states: Joint states of the robot. [sensor_msgs/JointState.msg]

ZhaotingLi/crl-flexiv-ros