btl143/QD4C-firmware
4
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

无刷完赛

Browse Source
This commit is contained in:
井明江
2024-07-05 03:29:56 +08:00
parent e842452ec6
commit 34aae6602a
4 changed files with 123 additions and 110 deletions
Download Patch File Download Diff File Expand all files Collapse all files

97
app/by_fan_control.c
View File

@@ -6,18 +6,21 @@
#define FAN_LL_PWM_PIN TIM8_PWM_MAP1_CH1_B6 // 左升力风扇
#define FAN_RL_PWM_PIN TIM8_PWM_MAP1_CH2_B7 // 右升力风扇
// M4
#define FAN_RB_PWM_A_PIN TIM10_PWM_MAP3_CH4_D7 // 后
#define FAN_RB_PWM_B_PIN TIM10_PWM_MAP3_CH2_D3 // you后
#define FAN_RB_PWM_A_PIN TIM10_PWM_MAP3_CH2_D3 // 后
#define FAN_RB_PWM_B_PIN TIM10_PWM_MAP3_CH4_D7 // you后
// M1
#define FAN_LB_PWM_A_PIN TIM4_PWM_MAP1_CH3_D14 // zuo后
#define FAN_LB_PWM_B_PIN TIM4_PWM_MAP1_CH1_D12 // 后
#define FAN_LB_PWM_A_PIN TIM4_PWM_MAP1_CH1_D12 // zuo后
#define FAN_LB_PWM_B_PIN TIM4_PWM_MAP1_CH3_D14// 后
// M3
#define FAN_RS_PWM_B_PIN TIM10_PWM_MAP3_CH1_D1 // 右侧
#define FAN_RS_PWM_A_PIN TIM10_PWM_MAP3_CH3_D5 // you侧
// M2
#define FAN_LS_PWM_B_PIN TIM4_PWM_MAP1_CH4_D15 // 左侧
#define FAN_LS_PWM_A_PIN TIM4_PWM_MAP1_CH2_D13 // 左侧
// #define FAN_RS_PWM_B_PIN TIM10_PWM_MAP3_CH1_D1 // 右侧
// #define FAN_RS_PWM_A_PIN TIM10_PWM_MAP3_CH3_D5 // you侧
// // M2
// #define FAN_LS_PWM_B_PIN TIM4_PWM_MAP1_CH4_D15 // 左侧
// #define FAN_LS_PWM_A_PIN TIM4_PWM_MAP1_CH2_D13 // 左侧
//
#define FAN_LS_PWM_PIN TIM1_PWM_MAP0_CH4_A11
#define FAN_RS_PWM_PIN TIM1_PWM_MAP0_CH1_A8
int32_t pwm_duty_ls_g;
int32_t pwm_duty_rs_g;
int32_t pwm_duty_lb_g;
@@ -48,7 +51,8 @@ void by_pwm_init(void)
gpio_init(C8, GPO, 1, GPO_PUSH_PULL);
pwm_init(FAN_LL_PWM_PIN, 50, 500);
pwm_init(FAN_RL_PWM_PIN, 50, 500);
pwm_init(FAN_LS_PWM_PIN, 50, 500);
pwm_init(FAN_RS_PWM_PIN, 50, 500);
#if FIX_DRIVE == 1
pwm_init(FAN_LS_PWM_A_PIN, 20000, 7000);
pwm_init(FAN_LS_PWM_B_PIN, 20000, 7000);
@@ -60,24 +64,24 @@ void by_pwm_init(void)
pwm_init(FAN_RB_PWM_B_PIN, 20000, 7000);
while (1);
#elif FIX_DRIVE == 2
pwm_init(FAN_LS_PWM_A_PIN, 20000, 1000);
pwm_init(FAN_LS_PWM_B_PIN, 20000, 0);
pwm_init(FAN_RS_PWM_A_PIN, 20000, 1000);
pwm_init(FAN_RS_PWM_B_PIN, 20000, 0);
pwm_init(FAN_LB_PWM_A_PIN, 20000,1000);
pwm_init(FAN_LB_PWM_B_PIN, 20000, 0);
pwm_init(FAN_RB_PWM_A_PIN, 20000, 1000);
pwm_init(FAN_RB_PWM_B_PIN, 20000, 0);
// pwm_init(FAN_LS_PWM_A_PIN, 30000, 1000);
// pwm_init(FAN_LS_PWM_B_PIN, 30000, 0);
// pwm_init(FAN_RS_PWM_A_PIN, 30000, 1000);
// pwm_init(FAN_RS_PWM_B_PIN, 30000, 0);
pwm_init(FAN_LB_PWM_A_PIN, 30000, 1000);
pwm_init(FAN_LB_PWM_B_PIN, 30000, 0);
pwm_init(FAN_RB_PWM_A_PIN, 30000, 1000);
pwm_init(FAN_RB_PWM_B_PIN, 30000, 0);
while (1);
#endif
pwm_init(FAN_LS_PWM_A_PIN, 20000, 0);
pwm_init(FAN_LS_PWM_B_PIN, 20000, 0);
pwm_init(FAN_RS_PWM_A_PIN, 20000, 0);
pwm_init(FAN_RS_PWM_B_PIN, 20000, 0);
pwm_init(FAN_LB_PWM_A_PIN, 20000, 0);
pwm_init(FAN_LB_PWM_B_PIN, 20000, 0);
pwm_init(FAN_RB_PWM_A_PIN, 20000, 0);
pwm_init(FAN_RB_PWM_B_PIN, 20000, 0);
// pwm_init(FAN_LS_PWM_A_PIN, 40000, 0);
// pwm_init(FAN_LS_PWM_B_PIN, 40000, 0);
// pwm_init(FAN_RS_PWM_A_PIN, 40000, 0);
// pwm_init(FAN_RS_PWM_B_PIN, 40000, 0);
pwm_init(FAN_LB_PWM_A_PIN, 30000, 0);
pwm_init(FAN_LB_PWM_B_PIN, 30000, 0);
pwm_init(FAN_RB_PWM_A_PIN, 30000, 0);
pwm_init(FAN_RB_PWM_B_PIN, 30000, 0);
}
/**
@@ -104,31 +108,34 @@ 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, 7000);
bpwm_duty_rs = clip_s32(bpwm_duty_rs, -0, 7000);
bpwm_duty_lb = clip_s32(bpwm_duty_lb, -0, 7000);
bpwm_duty_rb = clip_s32(bpwm_duty_rb, -0, 7000);
bpwm_duty_ls = clip_s32(bpwm_duty_ls, 500, 1000);
bpwm_duty_rs = clip_s32(bpwm_duty_rs, 500, 1000);
// if(1000==bpwm_duty_ls)bpwm_duty_rs=600;
// if(1000==bpwm_duty_rs)bpwm_duty_ls=600;
bpwm_duty_lb = clip_s32(bpwm_duty_lb, 0, 7000);
bpwm_duty_rb = clip_s32(bpwm_duty_rb, 0, 7000);
pwm_set_duty(FAN_LS_PWM_PIN, bpwm_duty_ls);
pwm_set_duty(FAN_RS_PWM_PIN, bpwm_duty_rs);
// pwm_duty_ls_g = pwm_duty_ls;
// pwm_duty_rs_g = pwm_duty_rs;
// pwm_duty_lb_g = pwm_duty_lb;
// pwm_duty_rb_g = pwm_duty_rb;
if (bpwm_duty_ls >= 0) {
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);
}
// if (bpwm_duty_ls >= 0) {
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);
}
// 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);
// }
// if (bpwm_duty_rs >= 0) {
// 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);
// }
if (bpwm_duty_lb >= 0) {
pwm_set_duty(FAN_LB_PWM_A_PIN, bpwm_duty_lb);