电机应用-直流有刷电机三环PID的嵌入式实现与调优

1. 直流有刷电机三环控制基础认知

第一次接触直流有刷电机的三环控制时，我被各种专业术语搞得晕头转向。后来在实际项目中摸爬滚打才发现，理解这个系统就像理解汽车的驾驶控制——位置环决定目的地，速度环控制油门深浅，电流环则像发动机的实时响应。这种串级控制结构让电机运行既精准又稳定。

三环控制的核心在于层级嵌套：最外层的位置环输出作为速度环的输入，速度环的输出又作为电流环的设定值。这种结构带来的优势非常明显——当电机负载突变时，电流环能快速响应，速度环维持转速稳定，位置环则确保最终停靠点准确。我在调试智能窗帘项目时就深有体会：窗帘布料的重量变化会影响电机电流，但三环控制让窗帘始终能精准停在预设位置。

硬件配置上需要三个关键传感器：编码器测量位置和速度，电流采样电阻配合ADC检测电流，PWM驱动电路控制电机功率。这就像给电机装上了"眼睛"和"触觉"，让控制器能实时感知电机状态。常见的问题往往出在传感器精度上，比如我用过的某款低成本编码器就因分辨率不足导致速度环震荡，换成1000线的工业级编码器后问题立刻解决。

2. 嵌入式硬件配置实战

2.1 STM32外设初始化技巧

在STM32CubeIDE中配置外设时，有几个关键点容易踩坑。定时器TIM1的PWM输出需要特别注意互补输出配置，特别是用MOS管驱动电机时。我曾因为没配置死区时间导致上下管直通，烧毁了三个MOS管。正确的配置应该是：

c复制TIM_BreakDeadTimeConfigTypeDef sBreakDeadTimeConfig = {0};
sBreakDeadTimeConfig.OffStateRunMode = TIM_OSSR_DISABLE;
sBreakDeadTimeConfig.OffStateIDLEMode = TIM_OSSI_DISABLE;
sBreakDeadTimeConfig.LockLevel = TIM_LOCKLEVEL_OFF;
sBreakDeadTimeConfig.DeadTime = 72;  // 1us死区@72MHz
sBreakDeadTimeConfig.BreakState = TIM_BREAK_DISABLE;
sBreakDeadTimeConfig.BreakPolarity = TIM_BREAKPOLARITY_HIGH;
sBreakDeadTimeConfig.AutomaticOutput = TIM_AUTOMATICOUTPUT_DISABLE;
HAL_TIMEx_ConfigBreakDeadTime(&htim1, &sBreakDeadTimeConfig);

编码器接口模式配置更是个技术活。TIM3的编码器模式需要设置TI1和TI2的极性，我曾经因为搞反了极性导致计数值递减。正确的配置应该是：

c复制TIM_Encoder_InitTypeDef sConfig = {0};
sConfig.EncoderMode = TIM_ENCODERMODE_TI12;
sConfig.IC1Polarity = TIM_ICPOLARITY_RISING;
sConfig.IC1Selection = TIM_ICSELECTION_DIRECTTI;
sConfig.IC1Prescaler = TIM_ICPSC_DIV1;
sConfig.IC1Filter = 6;
sConfig.IC2Polarity = TIM_ICPOLARITY_RISING;
sConfig.IC2Selection = TIM_ICSELECTION_DIRECTTI;
sConfig.IC2Prescaler = TIM_ICPSC_DIV1;
sConfig.IC2Filter = 6;
HAL_TIM_Encoder_Init(&htim3, &sConfig);

2.2 电流采样电路设计要点

电流采样是电流环的基础，但也是最容易出问题的地方。我推荐使用差分放大电路加二阶低通滤波的方案。某次项目中使用普通运放电路，电机启动时的干扰导致ADC值跳变严重。改进后的电路参数：

• 采样电阻：0.05Ω/5W
• 差分放大：INA240A1（增益50V/V）
• 滤波电路：截止频率1kHz
• 参考电压：3.3V

ADC配置要注意DMA循环模式，我习惯用1024点的滑动平均滤波：

c复制HAL_ADC_Start_DMA(&hadc1, (uint32_t*)adcBuffer, 1024);

实际测试发现，这种配置下即使在电机PWM开关噪声干扰下，也能获得稳定的电流采样值。

3. 三环PID算法实现细节

3.1 位置式PID代码优化

教科书上的PID公式直接实现往往效果不佳，需要加入实用化改进。我的位置环PID实现加入了以下特性：

c复制typedef struct {
    float target;     // 目标值
    float actual;     // 实际值
    float err;        // 当前误差
    float err_last;   // 上次误差
    float Kp,Ki,Kd;   // PID参数
    float integral;   // 积分项
    float max_output; // 输出限幅
    float dead_zone;  // 死区范围
} PID_Controller;

float PID_Calculate(PID_Controller* pid, float feedback) {
    pid->err = pid->target - feedback;
    
    // 死区处理
    if(fabs(pid->err) < pid->dead_zone) {
        pid->err = 0;
        pid->integral = 0;
        return 0;
    }
    
    // 积分分离
    if(fabs(pid->err) < 1500) {
        pid->integral += pid->err;
        // 积分限幅
        pid->integral = constrain(pid->integral, -4000, 4000);
    }
    
    // 微分先行（只对反馈量微分）
    float dterm = pid->Kd * (pid->err_last - feedback);
    
    float output = pid->Kp * pid->err 
                 + pid->Ki * pid->integral 
                 + dterm;
    
    pid->err_last = pid->err;
    return constrain(output, -pid->max_output, pid->max_output);
}

3.2 多环协同控制策略

三环协同的关键在于控制周期的配合。我的经验是：

• 电流环：50-100μs（PWM周期同步）
• 速度环：5-10ms
• 位置环：15-30ms

在STM32中可以用不同定时器实现：

c复制// 电流环（PWM周期中断）
void HAL_TIM_PWM_PulseFinishedCallback(TIM_HandleTypeDef *htim) {
    if(htim == &htim1) {
        Current_PID_Update();
    }
}

// 速度环（基本定时器）
void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) {
    if(htim == &htim6) {
        static uint8_t count = 0;
        if(++count >= 5) {  // 10ms*5=50ms
            count = 0;
            Position_PID_Update();
        }
        Speed_PID_Update();
    }
}

4. 参数整定与调试技巧

4.1 从内到外的调参方法

三环PID调参必须从内环到外环逐步进行。我的标准流程是：

1. 电流环整定：

   • 先设Ki=0，Kd=0
   • 逐渐增大Kp直到出现等幅振荡
   • 取振荡时Kp的60%作为最终值
   • 然后加入Ki消除静差

2. 速度环整定：

   • 固定电流环参数
   • 用阶跃响应测试
   • 超调量控制在5%以内
   • 调节时间<100ms

3. 位置环整定：

   • 最后调节
   • 关注稳态精度
   • 适当加入前馈控制

实测参数示例（24V/200W电机）：

4.2 上位机调试实战

没有上位机观察曲线就像盲人摸象。我常用**VOFA+**工具，通过串口发送数据：

c复制typedef struct {
    float target;
    float actual;
    float output;
} DebugData;

void Send_Debug_Data(uint8_t ch, DebugData* data) {
    uint8_t buf[12];
    memcpy(buf, &data->target, 4);
    memcpy(buf+4, &data->actual, 4);
    memcpy(buf+8, &data->output, 4);
    HAL_UART_Transmit(&huart1, buf, 12, 10);
}

调试时重点关注三个指标：

1. 电流环：响应速度要快，通常要求<1ms
2. 速度环：抗扰动能力，加载/卸载时的转速波动
3. 位置环：稳态误差，通常要求<5个脉冲

遇到过的典型问题及解决方案：

• 低频振荡：增加微分项或降低P值
• 超调过大：增加阻尼（Kd）或减小积分时间
• 响应迟钝：检查控制周期是否过长

在调试AGV小车驱动时，发现位置环总是过冲。通过上位机曲线发现是速度环输出饱和，通过增加速度环输出限幅和加入加速度前馈，问题完美解决。