Now motor joint position controller will only set to preempted once the motor state changes to preempted