1. 硬件准备与引脚配置
要构建一个完整的电机PID双环控制系统,首先需要准备好硬件环境。我这里使用的是STM32F4系列开发板,搭配一个带编码器的直流有刷电机。编码器采用AB相输出,通过定时器的编码器接口模式进行脉冲计数。
在CubeMX中配置引脚时,需要注意几个关键点:
- 电机驱动部分需要配置两个GPIO引脚控制方向(AIN1和AIN2),一个PWM输出引脚控制速度(通常使用定时器的PWM输出通道)
- 编码器接口需要使用定时器的编码器模式,配置两个输入引脚(通常是TIMx_CH1和TIMx_CH2)
- 建议再配置一个基础定时器用于产生控制周期中断,我习惯用TIM6或TIM7这种基本定时器
具体到代码实现,方向控制的函数可以这样写:
c复制void Motor_SetDirection(DirectionType dir)
{
switch(dir) {
case DIR_FORWARD:
HAL_GPIO_WritePin(AIN1_GPIO_Port, AIN1_Pin, GPIO_PIN_RESET);
HAL_GPIO_WritePin(AIN2_GPIO_Port, AIN2_Pin, GPIO_PIN_SET);
break;
case DIR_BACKWARD:
HAL_GPIO_WritePin(AIN1_GPIO_Port, AIN1_Pin, GPIO_PIN_SET);
HAL_GPIO_WritePin(AIN2_GPIO_Port, AIN2_Pin, GPIO_PIN_RESET);
break;
case DIR_STOP:
default:
HAL_GPIO_WritePin(AIN1_GPIO_Port, AIN1_Pin, GPIO_PIN_SET);
HAL_GPIO_WritePin(AIN2_GPIO_Port, AIN2_Pin, GPIO_PIN_SET);
}
}
需要模型API调用? 免费领10W Token,多模型网关一键接入 Claude、DeepSeek 等主流模型。
2. 编码器数据采集与处理
编码器数据采集是整
