fix ramp
This commit is contained in:
@@ -225,7 +225,9 @@ void calcTorque(uint8_t joy_pos) {
|
||||
if(joy_pos >= 0) {
|
||||
calcTorque = rampTorque[joy_pos];
|
||||
} else {
|
||||
calcTorque = -rampTorque[-joy_pos];
|
||||
joy_pos *= -1;
|
||||
calcTorque = rampTorque[joy_pos];
|
||||
calcTorque *= -1;
|
||||
}
|
||||
calcTorque *= KART_CST.CONTROL_POWER_FACTOR; // convert by power factor
|
||||
calcTorque /= 1000; // torque define by joystick
|
||||
@@ -239,7 +241,9 @@ void calcPosition(uint8_t joy_pos){
|
||||
if(joy_pos >= 0) {
|
||||
calcPosition = rampPosition[joy_pos];
|
||||
} else {
|
||||
calcPosition = -rampPosition[-joy_pos];
|
||||
joy_pos *= -1;
|
||||
calcPosition = rampPosition[joy_pos];
|
||||
rampPosition *= -1;
|
||||
}
|
||||
calcPosition *= (int32_t) KART_CST.CONTROL_STEERING_FACTOR;
|
||||
calcPosition /= 1000;
|
||||
|
||||
Reference in New Issue
Block a user