闭环PID控制

闭环PID控制是一个常见的应用场景，尤其在电机控制、温度控制、位置伺服等系统中。以下是实现闭环PID控制的详细步骤和注意事项：

1. PID控制原理

PID（比例-积分-微分）控制器通过以下公式调节输出：

• 比例项（P）：快速响应误差，但可能导致稳态误差。
• 积分项（I）：消除稳态误差，但可能引起超调。
• 微分项（D）：预测未来误差变化，抑制振荡。

2. 硬件配置

2.1 外设需求

• ADC：用于采集传感器反馈（如温度、位置、速度）。
• PWM/TIMER：生成控制信号（如驱动电机或加热元件）。
• GPIO：连接传感器和执行器。
• 中断/DMA：实现实时数据采集。

2.2 配置步骤

1. 初始化ADC：配置为连续扫描模式或定时触发模式。
2. 配置PWM输出：使用定时器（如TIM1/TIM2）生成PWM信号。
3. 设置定时器中断：用于周期性执行PID计算（如1kHz频率）。

3. PID算法实现

3.1 位置式PID

typedef struct {
    float Kp, Ki, Kd;
    float integral;
    float prev_error;
} PID_Controller;

float PID_Update(PID_Controller *pid, float setpoint, float measurement) {
    float error = setpoint - measurement;
    pid->integral += error * dt;          // dt为采样时间
    float derivative = (error - pid->prev_error) / dt;
    pid->prev_error = error;
    
    float output = pid->Kp * error 
                 + pid->Ki * pid->integral 
                 + pid->Kd * derivative;
    
    // 输出限幅（防止执行器饱和）
    output = fmaxf(fminf(output, MAX_OUTPUT), MIN_OUTPUT);
    return output;
}

3.2 增量式PID

适用于执行器需要增量控制的场景：

float PID_Incremental(PID_Controller *pid, float error) {
    float delta = pid->Kp * (error - pid->prev_error)
                + pid->Ki * error * dt
                + pid->Kd * (error - 2 * pid->prev_error + pid->prev_prev_error) / dt;
    pid->prev_prev_error = pid->prev_error;
    pid->prev_error = error;
    return delta;
}

4. STM32代码示例

4.1 主循环或中断服务程序

// 全局变量
PID_Controller motor_pid = {.Kp=2.0, .Ki=0.5, .Kd=0.1};
float setpoint = 100.0;  // 目标值（如转速、温度）

void TIM3_IRQHandler(void) {  // 定时器中断，1kHz频率
    if (TIM_GetITStatus(TIM3, TIM_IT_Update) != RESET) {
        float measurement = ADC_ReadMotorSpeed();  // 读取传感器值
        float output = PID_Update(&motor_pid, setpoint, measurement);
        PWM_SetDutyCycle(TIM1, output);  // 更新PWM输出
        TIM_ClearITPendingBit(TIM3, TIM_IT_Update);
    }
}

4.2 ADC读取函数

float ADC_ReadMotorSpeed(void) {
    ADC_SoftwareStartConv(ADC1);
    while (!ADC_GetFlagStatus(ADC1, ADC_FLAG_EOC));
    uint16_t raw = ADC_GetConversionValue(ADC1);
    return (raw / 4095.0f) * 3.3f;  // 假设12位ADC，量程0-3.3V
}

5. 参数整定方法

1. 试凑法：

   • 先设 ( Ki=0, Kd=0 )，增大 ( Kp ) 至系统出现振荡，取当前值的50%作为最终 ( Kp )。
   • 逐渐增加 ( Ki ) 以消除稳态误差。
   • 增加 ( Kd ) 抑制超调。

2. Ziegler-Nichols法：

   • 找到临界增益 ( Ku ) 和振荡周期 ( Tu )。
   • 根据下表设置参数：

     控制器类型	( Kp )	( Ki )	( Kd )
     P	0.5( Ku )	-	-
     PI	0.45( Ku )	0.54( Ku/Tu )	-
     PID	0.6( Ku )	1.2( Ku/Tu )	0.075( Ku*Tu )

6. 常见问题与优化

1. 积分饱和（Integral Windup）

   • 在误差较大时暂停积分（如 if (output < MAX) pid->integral += error * dt）。

2. 噪声抑制

   • 对传感器信号进行低通滤波（如一阶RC滤波）。
   • 使用滑动平均滤波算法。

3. 实时性要求

   • 使用硬件定时器触发ADC和PID计算。
   • 优化代码，减少中断服务程序中的计算量。

4. 浮点运算优化

   • 对于低端STM32（无FPU），可使用定点数运算（Q格式）。

7. 调试工具

• STM32CubeMonitor：实时监控变量（如设定值、反馈值、输出）。
• 逻辑分析仪：观察PWM波形和传感器信号。
• 串口打印：输出调试信息（需注意实时性影响）。

---

通过以上步骤，可以在STM32上实现高效的闭环PID控制。实际应用中需根据具体硬件和动态特性调整参数。