RethinkRobotics / sawyer_simulator

Gazebo Simulation interface for the Sawyer Robot
http://sdk.rethinkrobotics.com/intera/Gazebo_Tutorial
Apache License 2.0
50 stars 65 forks source link

Add collision checking to Inverse Kinematics Sim Service #19

Open IanTheEngineer opened 6 years ago

IanTheEngineer commented 6 years ago
if (jointsInCollision(kinematic_chain_map_[req.tip_names[i]], jnt_result))
        {
          res.result_type[i] = res.IK_IN_COLLISION;
        }  TODO(imcmahon) Utilize FCL for collision checking

We could use FCL, or some other library to check to see if the robot is in collision at any configuration.