A basic grasp generator for objects such as blocks or cylinders for use with the MoveIt! pick and place pipeline. Does not consider friction cones or other dynamics.
Its current implementation takes as input a pose vector (postition and orientation) and generates a large number of potential grasp approaches and directions. Also includes a grasp filter for removing kinematically infeasible grasps via threaded IK solvers.
This package includes:
- pose-based grasp generator for a block
- Separate grasp generators for custom objects such as rectanguar or cylindrical objects
- Grasp filter
- Test code and visualizations
Developed by Dave Coleman at the Correll Robotics Lab, University of Colorado Boulder with outside contributors.
A demo with Baxter:
Indigo:
sudo apt-get install ros-indigo-moveit-grasps
Clone this repository into a catkin workspace, then use the rosdep install tool to automatically download its dependencies. Depending on your current version of ROS, use:
Indigo:
rosdep install --from-paths src --ignore-src --rosdistro indigo
You will first need a configuration file that described your robot's end effector geometry. Currently an example format can be seen in this repository at config/baxter_grasp_data.yaml. See the comments within that file for explanations.
To load that file at launch, you copy the example in the file launch/grasp_test.launch where you should see the line <rosparam command="load" file="$(find moveit_grasps)/config/baxter_grasp_data.yaml"/>.
Within that file you can specify the following (example taken from jaco):
# ee group name as defined in the MoveIt! SRDF
end_effector_name: 'gripper'
# actuated joints in end effector
joints : ['jaco_joint_finger_1','jaco_joint_finger_2','jaco_joint_finger_3']
# open position (pre-grasp)
pregrasp_posture : [0.697, 0.697, 0.697]
# time to wait before grasping
pregrasp_time_from_start : 4.0
# close position (grasp)
grasp_posture : [0.0, 0.0, 0.0]
# time to wait after grasping
grasp_time_from_start : 4.0
# desired pose from end effector to grasp - [x,y,z]
grasp_pose_to_eef_translation : [-0.05, 0, 0]
# desired pose from end effector to grasp - [roll, pitch, yall], in standard 3,2,1 notation
grasp_pose_to_eef_rotation : [1.5707, 0, 0]
# max depth of fingers - distance from finger tip to inner palm
finger_to_palm_depth : 0.11
These values can be visualized by launching grasp_test_rviz.launch and grasp_pose_visualizer.launch.
The result should look like the following:
Poses Visualized: Object, Grasp, EE
Distances: finger_to_palm_depth, pre(post)grasp_distance, pre(post)grasp_min_distance
There are two tests scripts in this package. To view the tests, first start Rviz with:
roslaunch moveit_grasps rviz.launch
To test just grasp generation for randomly placed blocks:
roslaunch moveit_grasps test_grasp_generator.launch
To also test the grasp filtering:
roslaunch moveit_grasps test_filter.launch baxter:=true
roslaunch moveit_grasps rviz.launch
roslaunch moveit_grasps test_bounding_box.launch
Each mesh in the products folder will be displayed with the calculated bounding box. Hit enter to move to the next mesh.
A new (still in development) example tool is moveit_blocks.h located in the include folder. It gives you a complete pick and place pipeline using this package and MoveIt, and all you need is the appropriate config file and launch file. An example launch file can be found here.
There are currently example implementations:
Features we'd like to see added to this project:
- Better reasoning about support surfaces (table)
- Integrate collision checking to verify feasibility of grasp
- Make grasp quality metric better informed
- Make this project easier to setup for new robots
- Integrate into Setup Assistant GUI
- Dave Coleman, CU Boulder @davetcoleman
- Andy McEvoy, CU Boulder @mcevoyandy
- Bence Magyar, PAL Robotics @bmagyar