adjust katana_simple_grasp_planner to new ikfast IK