别再手动调参了！用C语言实现一个简易PID自整定库（附Arduino移植指南）-开发者社区

嵌入式开发者的PID自整定实战指南：从算法原理到跨平台移植

在温控系统、电机调速等嵌入式应用中，PID控制器的参数整定一直是工程师的痛点。传统手动调参不仅耗时耗力，还难以适应动态环境变化。本文将带你用C语言构建一个轻量级PID自整定库，解决以下实际问题：如何封装可复用的算法核心？如何平衡计算精度与内存占用？如何实现Arduino、STM32等平台的快速移植？

1. PID自整定库的架构设计

1.1 核心算法选型：增量式 vs 位置式

增量式PID因其计算量小、无积分饱和的特点，更适合资源受限的MCU。以下是两种算法的关键对比：

特性	增量式PID	位置式PID
内存占用	较少（不累积误差）	较多（需存储积分项）
抗积分饱和	天然避免	需额外处理
代码复杂度	较低	较高
适用场景	执行机构带记忆功能（如步进电机）	需精确位置控制（如伺服电机）

// 增量式PID计算示例 typedef struct { float Kp, Ki, Kd; float last_error, prev_error; } IncPID; float incPID_compute(IncPID *pid, float setpoint, float input) { float error = setpoint - input; float delta = pid->Kp * (error - pid->last_error) + pid->Ki * error + pid->Kd * (error - 2*pid->last_error + pid->prev_error); pid->prev_error = pid->last_error; pid->last_error = error; return delta; }

1.2 内存优化策略

嵌入式环境下需特别注意内存管理：

固定点数运算：对于8位MCU，可用int16_t替代float减少70%内存占用
环形缓冲区：自整定过程的历史数据采用固定长度存储
参数压缩：将Kp/Ki/Kd三个参数打包为32位数据（如Kp用16位，Ki/Kd各用8位）

注意：在STM32F103等Cortex-M3芯片上，使用硬件FPU时保留float类型可获得更好性能

2. 自整定算法实现关键

2.1 基于继电振荡的自动整定

Ziegler-Nichols方法的嵌入式实现要点：

从初始KP开始逐步增加，直到出现持续振荡
记录临界增益Ku和振荡周期Tu
按以下规则计算参数：
- Kp = 0.6 * Ku
- Ki = 2 * Kp / Tu
- Kd = Kp * Tu / 8

void autotune_relay(PID *pid, float (*get_input)(void), void (*set_output)(float)) { float output = 0.5f; // 初始输出50% float hysteresis = 0.1f; bool rising = true; while(/* 超时检测 */) { float input = get_input(); if (input > (pid->setpoint + hysteresis)) { output = 0.0f; rising = false; } else if (input < (pid->setpoint - hysteresis)) { output = 1.0f; rising = true; } set_output(output); // 记录振荡周期和幅度 if (rising && input > pid->setpoint) { // 计算Ku和Tu... } } }

2.2 抗干扰处理技巧

移动平均滤波：对输入信号进行5~10点平滑
死区设置：忽略±1%范围内的小幅波动
变步长调整：接近稳态时减小参数调整幅度

3. 跨平台移植实战

3.1 Arduino平台适配

主要修改点：

替换printf为Serial.print
提供微秒级时间获取函数
示例PWM输出接口：

// 在pid_port.h中定义平台相关接口 #define GET_TIME() micros() / 1e6f #define PRINTF(...) Serial.printf(__VA_ARGS__) // PWM输出封装 void set_pwm(uint8_t pin, float duty) { analogWrite(pin, (int)(duty * 255)); }

3.2 STM32 HAL库集成

针对STM32CubeMX项目的移植步骤：

在CubeMX中启用TIM定时器（用于采样周期）
添加PID库文件到Core/Src目录
实现ADC读取回调：

// 在main.c中覆盖弱定义 void HAL_ADC_ConvCpltCallback(ADC_HandleTypeDef* hadc) { float input = HAL_ADC_GetValue(&hadc1) * 3.3f / 4096; float output = PID_Compute(&pid, setpoint, input); __HAL_TIM_SET_COMPARE(&htim2, TIM_CHANNEL_1, output * 1000); }

4. 典型应用场景优化

4.1 温控系统实现

特殊处理要求：

采样周期较长（通常1~5秒）
强非线性（加热冷却不对称）
参数整定建议：
- 初始Kp：1.0 / (最大功率/温度变化率)
- 初始Ki：Kp / 加热时间常数
- 初始Kd：Kp * 时间常数 / 4

4.2 直流电机控制

高速响应场景的调整：

使用1kHz以上采样频率
增加速度前馈补偿
代码优化技巧：

// 快速整数运算版本 int32_t pid_compute_fast(PID_Fast *pid, int32_t setpoint, int32_t input) { int32_t error = setpoint - input; pid->integral += error; if (pid->integral > INTEGRAL_LIMIT) pid->integral = INTEGRAL_LIMIT; int32_t derivative = error - pid->last_error; return (pid->Kp * error + pid->Ki * pid->integral + pid->Kd * derivative) >> 8; }