|
|
@@ -1528,7 +1528,11 @@ static bool mc_process_force_running(void) {
|
|
|
if (motor.force_open_wait > 0) {
|
|
|
--motor.force_open_wait;
|
|
|
}else {
|
|
|
- motor.force_open_angle += 1.5f;
|
|
|
+ float positive = 1.0f;
|
|
|
+ if (line_ramp_get_target(&motor.controller.ramp_target_vd) < 0) {
|
|
|
+ positive = -1.0f;
|
|
|
+ }
|
|
|
+ motor.force_open_angle += 1.5f * positive;
|
|
|
norm_angle_deg(motor.force_open_angle);
|
|
|
mot_contrl_set_angle(&motor.controller, motor.force_open_angle);
|
|
|
}
|