Added look at groundspace point to inverse kinematics