stretch_ros/stretch_gazebo

Overview

stretch_gazebo is an implementation of simulating a Stretch robot with Gazebo simulator.

Details

The urdf directory contains a xacro file that extends the capabilities of the original xacro files living in stretch_description package to include Gazebo functionality.

The config directory contains rviz files and ros_control controller configuration files for various parts of the robot including:

• Base: diff_drive_controller/DiffDriveController
• Arm: position_controllers/JointTrajectoryController
• Gripper: position_controllers/JointTrajectoryController
• Head: position_controllers/JointTrajectoryController
• Joints: joint_state_controller/JointStateController

The launch directory includes two files:

• gazebo.launch: Opens up an empty Gazebo world and spawns the robot loading all the controllers, including all the sensors except Cliff sensors and respeaker.
• teleop_joy.launch: Spawns a joy and teleop_twist_joy instance and remaps cmd_vel topics to /stretch_diff_drive_controller/cmd_vel, which the robot is taking drive commands from. Note that the teleop_twist_joy package has a deadman switch by default which disables the drive commands to be published unless it is being pressed. For an Logitech F310 joystick this button is A.

The script directory contains a single python file that publishes ground truth odometry of the robot from Gazebo.

Setup

Use rosdep to install the required packages.

Running Demo

    # Terminal 1:
    roslaunch stretch_gazebo gazebo.launch rviz:=true
    # Terminal 2:
    roslaunch stretch_gazebo teleop_joy.launch

This will launch an Rviz instance that visualizes the sensors and an empty world in Gazebo with Stretch and load all the controllers. Although, the base will be able to move with the joystick comamnds, there joystick won't give joint commands to arm, head or gripper. To move these joints see the next section about Running Gazebo with MoveIt! and Stretch.

Running Gazebo with MoveIt! and Stretch

    # Terminal 1:
    roslaunch stretch_gazebo gazebo.launch
    # Terminal 2:
    roslaunch stretch_gazebo teleop_joy.launch
    # Terminal 3
    roslaunch stretch_moveit_config demo_gazebo.launch

This will launch an Rviz instance that visualizes the joints with markers and an empty world in Gazebo with Stretch and load all the controllers. There are pre-defined positions for each joint group for demonstration purposes. There are three joint groups that can be controlled individually via Motion Planning Rviz plugin. Start and goal positions for joints can be selected similar to this moveit tutorial. A few notes to be kept in mind:

• Planning group can be changed via Planning Group drop down in Planning tab of Motion Planning Rviz plugin.
• Pre-defined start and goal states can be speciified in Start State and Goal State drop downs in Planning tab of Motion Planning Rviz plugin.
• stretch_gripper group does not show markers, and is intended to be controlled via the joints tab that is located in the very right of Motion Planning Rviz plugin.
• When planning with stretch_head group make sure you select Approx IK Solutions in Planning tab of Motion Planning Rviz plugin.

License

For license information, please see the LICENSE files.