Compute grasping pose from angle_approach added.