Servoing, capture, and motion planning simulation for the Altius Robotic Arm