寒假学习（14）（HAL库5）
搞了搞小车PWM驱动#include PWM.h // Ignore PWM dead band 忽略PWM信号死区 static int16_t Motor_Ignore_Dead_Zone(int16_t pulse) { if (pulse 0) return pulse MOTOR_IGNORE_PULSE; if (pulse 0) return pulse - MOTOR_IGNORE_PULSE; return 0; } // All motors stopped 所有电机停止 void Motor_Stop(uint8_t brake) { if (brake ! 0) brake 1; PWM_M1_A brake * MOTOR_MAX_PULSE; PWM_M1_B brake * MOTOR_MAX_PULSE; PWM_M2_A brake * MOTOR_MAX_PULSE; PWM_M2_B brake * MOTOR_MAX_PULSE; PWM_M3_A brake * MOTOR_MAX_PULSE; PWM_M3_B brake * MOTOR_MAX_PULSE; PWM_M4_A brake * MOTOR_MAX_PULSE; PWM_M4_B brake * MOTOR_MAX_PULSE; } // 设置电机速度speed:±3600-MOTOR_IGNORE_PULSE, 0为停止 // Set motor speed, speed:± (3600-MOTOR_IGNORE_PULSE), 0 indicates stop void Motor_Set_Pwm(uint8_t id, int16_t speed) { int16_t pulse Motor_Ignore_Dead_Zone(speed); // Limit input 限制输入 if (pulse MOTOR_MAX_PULSE) pulse MOTOR_MAX_PULSE; if (pulse -MOTOR_MAX_PULSE) pulse -MOTOR_MAX_PULSE; switch (id) { case L_F: { pulse -pulse; if (pulse 0) { PWM_M1_A pulse; PWM_M1_B 0; } else { PWM_M1_A 0; PWM_M1_B -pulse; } break; } case L_R: { pulse -pulse; if (pulse 0) { PWM_M2_A pulse; PWM_M2_B 0; } else { PWM_M2_A 0; PWM_M2_B -pulse; } break; } case R_F: { if (pulse 0) { PWM_M3_A pulse; PWM_M3_B 0; } else { PWM_M3_A 0; PWM_M3_B -pulse; } break; } case R_R: { if (pulse 0) { PWM_M4_A pulse; PWM_M4_B 0; } else { PWM_M4_A 0; PWM_M4_B -pulse; } break; } default: break; } } void Motion_Set_Pwm(int16_t Motor_1, int16_t Motor_2, int16_t Motor_3, int16_t Motor_4) { if (Motor_1 -MOTOR_MAX_PULSE Motor_1 MOTOR_MAX_PULSE) { Motor_Set_Pwm(L_F, Motor_1); } if (Motor_2 -MOTOR_MAX_PULSE Motor_2 MOTOR_MAX_PULSE) { Motor_Set_Pwm(L_R, Motor_2); } if (Motor_3 -MOTOR_MAX_PULSE Motor_3 MOTOR_MAX_PULSE) { Motor_Set_Pwm(R_F, Motor_3); } if (Motor_4 -MOTOR_MAX_PULSE Motor_4 MOTOR_MAX_PULSE) { Motor_Set_Pwm(R_R, Motor_4); } }#ifndef __PWM_H #define __PWM_H #include main.h enum motor { L_F0,//左前 L_R,//左后 R_F, R_R, }; #define PWM_M1_A TIM8-CCR1 #define PWM_M1_B TIM8-CCR2 #define PWM_M2_A TIM8-CCR3 #define PWM_M2_B TIM8-CCR4 #define PWM_M3_A TIM1-CCR1 #define PWM_M3_B TIM1-CCR2 #define PWM_M4_A TIM1-CCR3 #define PWM_M4_B TIM1-CCR4 #define MOTOR_MAX_PULSE 3600 #define MOTOR_IGNORE_PULSE 2000 void Motor_Set_Pwm(uint8_t id, int16_t speed); void Motion_Set_Pwm(int16_t Motor_1, int16_t Motor_2, int16_t Motor_3, int16_t Motor_4); #endif#include RedRay.h void car_irtrack(void) { if((IN_X1 0 IN_X3 0) IN_X2 1 IN_X4 1) //直走 go straight { Motion_Set_Pwm(600,600,600,600); } if(IN_X1 0 IN_X3 1 IN_X4 1 IN_X2 1)//小幅度调整 small adjustment { Motion_Set_Pwm(0,0,500,500); } else if(IN_X1 1 IN_X3 0 IN_X4 1 IN_X2 1) { Motion_Set_Pwm(500,500,0,0); } if(IN_X2 0 IN_X3 1 ) //大幅度左右转 Turn left and right sharply { Motion_Set_Pwm(-500,-500,500,500); } else if(IN_X4 0 IN_X1 1 ) { Motion_Set_Pwm(500,500,-500,-500); } //其它情况保持不变 Other things remain unchanged }#ifndef __REDRAY_H #define __REDRAY_H #include main.h #include PWM.h #define IN_X1 HAL_GPIO_ReadPin(X1_GPIO_Port,X1_Pin)//读取X1引脚的状态 Read the status of X1 pin #define IN_X2 HAL_GPIO_ReadPin(X2_GPIO_Port,X2_Pin)//读取X2引脚的状态 Read the status of X2 pin #define IN_X3 HAL_GPIO_ReadPin(X3_GPIO_Port,X3_Pin)//读取X3引脚的状态 Read the status of X3 pin #define IN_X4 HAL_GPIO_ReadPin(X4_GPIO_Port,X4_Pin)//读取X4引脚的状态 Read the status of X4 pin void car_irtrack(void); #endif
)
