Grasping Trajectory Optimization with Point Clouds
Yu Xiang Sai Haneesh Allu Rohith Peddi Tyler Summers Vibhav Gogate
We introduce a new trajectory optimization method for robotic grasping based
on a point-cloud representation of robots and task spaces. In our method,
robots are represented by 3D points on their link surfaces. The task space of a
robot is represented by a point cloud that can be obtained from depth sensors.
Using the point-cloud representation, goal reaching in grasping can be
formulated as point matching, while collision avoidance can be efficiently
achieved by querying the signed distance values of the robot points in the
signed distance field of the scene points. Consequently, a constrained
non-linear optimization problem is formulated to solve the joint motion and
grasp planning problem. The advantage of our method is that the point-cloud
representation is general to be used with any robot in any environment. We
demonstrate the effectiveness of our method by conducting experiments on a
tabletop scene and a shelf scene for grasping with a Fetch mobile manipulator
and a Franka Panda arm.