Updated setJointMovementStateNB() and test program