Fixed a bug where the position control was not working in the simulation. When I made changes to break positionvelcoitycontrol out I had it making the wrong call to JointPosition() instead of SetJointPosition()