feat: 下位机发车

This commit is contained in:
2024-05-23 15:53:21 +08:00
parent 6b1f345ead
commit 55cc6b31f3
8 changed files with 150 additions and 106 deletions

View File

@@ -122,10 +122,10 @@ void by_pwm_update_duty(uint32_t update_pwm_duty1, uint32_t update_pwm_duty2)
*/
void by_pwm_power_duty(int32_t bpwm_duty_ls, int32_t bpwm_duty_rs, int32_t bpwm_duty_lb, int32_t bpwm_duty_rb)
{
bpwm_duty_ls = clip_s32(bpwm_duty_ls, 0, 5000);
bpwm_duty_rs = clip_s32(bpwm_duty_rs, 0, 5000);
bpwm_duty_lb = clip_s32(bpwm_duty_lb, -3000, 8000);
bpwm_duty_rb = clip_s32(bpwm_duty_rb, -3000, 8000);
// bpwm_duty_ls = clip_s32(bpwm_duty_ls, 0, 5000);
// bpwm_duty_rs = clip_s32(bpwm_duty_rs, 0, 5000);
// bpwm_duty_lb = clip_s32(bpwm_duty_lb, -3000, 8000);
// bpwm_duty_rb = clip_s32(bpwm_duty_rb, -3000, 8000);
// pwm_duty_ls_g = pwm_duty_ls;
// pwm_duty_rs_g = pwm_duty_rs;
@@ -136,19 +136,19 @@ void by_pwm_power_duty(int32_t bpwm_duty_ls, int32_t bpwm_duty_rs, int32_t bpwm_
pwm_set_duty(FAN_LS_PWM_A_PIN, bpwm_duty_ls);
pwm_set_duty(FAN_LS_PWM_B_PIN, 0);
}
// else {
// pwm_set_duty(FAN_LS_PWM_A_PIN, 0);
// pwm_set_duty(FAN_LS_PWM_B_PIN, -1 * pwm_duty_ls);
// }
else {
pwm_set_duty(FAN_LS_PWM_A_PIN, 0);
pwm_set_duty(FAN_LS_PWM_B_PIN, -1 * pwm_duty_ls);
}
if (bpwm_duty_rs >= 0) {
pwm_set_duty(FAN_RS_PWM_A_PIN, bpwm_duty_rs);
pwm_set_duty(FAN_RS_PWM_B_PIN, 0);
}
// else {
// pwm_set_duty(FAN_RS_PWM_A_PIN, 0);
// pwm_set_duty(FAN_RS_PWM_B_PIN, -1 * pwm_duty_rs);
// }
else {
pwm_set_duty(FAN_RS_PWM_A_PIN, 0);
pwm_set_duty(FAN_RS_PWM_B_PIN, -1 * pwm_duty_rs);
}
if (bpwm_duty_lb >= 0) {
pwm_set_duty(FAN_LB_PWM_A_PIN, bpwm_duty_lb);