Currently, the motion profiler does not respect the brake status and will begin dispatching motion profile commands immediately. For long-duration brake disengagements, this can cause issues or even position tracking faults.
The logic should go something like:
while `servo_enabled` is false:
Command CS* command to current position to trigger brake disengagement
Now, the brake is disengaged since `servo_enabled` is true so start motion profile
Currently, the motion profiler does not respect the brake status and will begin dispatching motion profile commands immediately. For long-duration brake disengagements, this can cause issues or even position tracking faults.
The logic should go something like: