Pose estimation for feedback control in a snake robot.