Updated motor joint position controller to accept an invert angle parameter