Fixed a lot of grasping code, plus removed unnecessary, old dependencies

Oh you actually got rid of arm_navigaion_msgs and kinematics_msgs, nice!