X-Bar: Fixed angle update.

Angles2Joints now returns PosArray back to RobotMain