|
@@ -578,7 +578,7 @@ static void crosszero_step_towards(float *value, float target) {
|
|
|
bool cross_zero = false;
|
|
bool cross_zero = false;
|
|
|
float high_ramp_torque = CONFIG_RAMP_SECOND_TARGET;
|
|
float high_ramp_torque = CONFIG_RAMP_SECOND_TARGET;
|
|
|
if (target > 0) {
|
|
if (target > 0) {
|
|
|
- if (v_now <= -RAMPE_1) {
|
|
|
|
|
|
|
+ if (v_now < -RAMPE_1) {
|
|
|
step_towards(value, -RAMPE_1, 2.0f);
|
|
step_towards(value, -RAMPE_1, 2.0f);
|
|
|
cross_zero = true;
|
|
cross_zero = true;
|
|
|
}else if (v_now >= -RAMPE_1 && v_now <= high_ramp_torque) {
|
|
}else if (v_now >= -RAMPE_1 && v_now <= high_ramp_torque) {
|