Refactored MoveToPose. AngleGripper moves in response to the optical sensors.