added :z_free ik solution
added manually_pose_set mode