3D IK legs on the robot