1. PID控制的工程动因与物理本质

在嵌入式运动控制系统中，开环控制存在根本性缺陷：电机实际转速永远无法精确等于期望转速。这种偏差并非设计疏漏，而是由物理世界固有的非线性特性决定的。以直流减速电机为例，其转速由施加的PWM占空比直接驱动，但同一占空比在不同负载条件下产生的机械输出截然不同——空载时高速旋转，而在水泥地面、陶瓷地砖、木板甚至沙地表面运行时，摩擦阻力差异导致转速显著衰减；当小车从平地驶入坡道时，重力分量引入新的扰动力矩，同样占空比下转速必然下降。这种“输入-输出”关系的时变性与不确定性，使得单纯依赖查表法或固定PWM值的开环策略在实际工程中完全失效。

PID控制器的引入，本质上是为系统构建一个闭环反馈调节机制。其核心思想在于： 不直接控制执行器，而是持续观测被控量（实际速度）与目标量（期望速度）之间的误差，并依据误差的历史、当前与变化趋势动态修正控制量 。这一过程可形式化表达为：

控制量 u(t) = Kp·e(t) + Ki·∫e(τ)dτ + Kd·de(t)/dt

其中 e(t) = r(t) - y(t) 是时刻 t 的速度误差（期望值 r(t) 减去实际测量值 y(t) ）。Kp、Ki、Kd 分别为比例、积分、微分增益系数，三者共同构成对误差信号的加权组合。该公式并非数学游戏，而是对物理系统动态响应的工程近似：比例项提供即时响应，积分项消除稳态误差，微分项抑制超调与振荡。理解这一点至关重要——PID不是万能黑箱，而是工程师在模型精度、计算资源、实时性约束之间做出的务实折衷。

2. 闭环系统的核心组件：传感器、执行器与控制器

一个可用的PID速度控制系统，其硬件架构必须包含三个不可分割的子系统：测量装置、执行机构与计算单元。三者通过物理连接与数据流形成完整闭环，缺一不可。

2.1 测量装置：编码器的选型与原理

本项目采用增量式光电编码器作为速度传感器。其核心部件是一个带有等距透光狭缝的圆盘，安装于电机轴端。当电机旋转时，圆盘随轴转动，光线周期性穿过狭缝照射到光敏元件上，产生脉冲序列。关键在于，单路脉冲（A相）仅能反映转速大小，无法判别转向。因此，编码器必须提供正交双路信号（A相与B相），两路脉冲在相位上严格相差90度电角度。

转向判别的物理基础在于相位超前关系：当A相脉冲前沿领先B相时，判定为正向旋转；反之，B相前沿领先A相则为反向。这种设计将方向信息编码进脉冲的时序关系中，无需额外传感器即可实现双向测速。对于本项目所用的电机，其编码器分辨率为1024线（即每转产生1024个A相脉冲），结合正交解码技术，实际计数频率提升至4倍，即每转产生4096个计数值（1024×4）。这意味着系统能以更高分辨率捕捉细微速度变化，为PID调节提供更精准的反馈基础。

2.2 执行机构：直流减速电机与驱动电路

本系统选用额定电压11V–16V的直流减速电机。所谓“减速”，是在标准直流电机后级集成行星齿轮箱，其物理作用是将电机高转速、低扭矩的输出，转换为低转速、高扭矩的机械输出。这一变换遵循能量守恒定律：输出转速降低n倍，输出扭矩相应增大n倍（忽略传动效率损失）。减速比的选择直接决定了系统的动态响应能力与负载适应性——过高的减速比虽提升扭矩，却牺牲了响应速度；过低的减速比则可能导致带载启动困难。

电机驱动采用L298N双H桥芯片。其核心功能是将MCU输出的低压逻辑电平（如STM32的GPIO）转换为可驱动大电流电机绕组的高压功率信号。L298N支持双路独立控制，本项目仅使用其中一路：IN1与IN2引脚接收来自STM32的互补PWM信号，ENA引脚接收使能信号。通过改变IN1/IN2的电平组合（00-停转，01-正转，10-反转，11-制动），配合ENA的PWM占空比调节，即可实现电机的启停、正反转及无级调速。值得注意的是，L298N的供电需严格分离：逻辑电源（5V）与电机电源（11V–16V）必须独立，避免大电流瞬态干扰MCU工作。

2.3 控制单元：STM32的硬件资源配置

本项目基于STM32F103C8T6（“蓝 pill”开发板）构建控制器。其核心外设配置如下：

• 定时器TIM3 ：配置为编码器接口模式（Encoder Interface Mode），通道1（CH1）连接编码器A相（PB4），通道2（CH2）连接编码器B相（PB5）。此模式下，TIM3硬件自动完成正交解码与计数，无需CPU干预，极大降低软件开销。计数器最大值设为65535（0xFFFF），覆盖绝大多数应用需求。当计数值溢出时，产生更新事件（UEV），可触发中断或DMA传输。

• 定时器TIM2 ：配置为PWM输出模式，通道1（CH1）输出PWM信号至L298N的ENA引脚（PA0）。预分频器（PSC）与自动重装载值（ARR）共同决定PWM频率。本项目设定PWM频率为20kHz，远高于人耳听觉上限，有效消除电机运行噪音，并减少电感电流纹波。

• 串口USART1 ：配置为异步通信，波特率115200bps，用于将实时速度、PID输出等数据上传至上位机（如FreeMODBUS或自定义上位机软件），实现可视化监控与参数在线调试。

上述资源配置并非随意指定，而是基于STM32的硬件架构深度优化的结果：TIM3的编码器接口模式直接映射至GPIOB的特定引脚（PB4/PB5），这是芯片硬件设计决定的；而TIM2的PWM输出引脚PA0则属于其默认复用功能，符合最小化引脚冲突的设计原则。

3. 编码器信号采集与速度解算

准确获取电机实际转速是PID闭环的起点。本节详细阐述从原始脉冲到物理速度的完整转换链路，重点解析硬件计数、软件采样与数学换算三个关键环节。

3.1 硬件计数：TIM3编码器接口配置

TIM3工作于编码器接口模式时，其计数器行为由A、B两相脉冲的边沿组合决定。具体逻辑如下：
- A相上升沿且B相为低电平时，计数器递增；
- A相下降沿且B相为高电平时，计数器递增；
- B相上升沿且A相为高电平时，计数器递减；
- B相下降沿且A相为低电平时，计数器递减。

此逻辑确保了计数器值 CNT 严格正比于电机轴的角位移，且符号反映旋转方向。在初始化代码中，关键配置包括：

// 使能TIM3时钟
RCC->APB1ENR |= RCC_APB1ENR_TIM3EN;
// 配置PB4(PB5)为复用推挽输出（实际为输入，但需配置复用功能）
GPIOB->CRH &= ~(GPIO_CRH_CNF4 | GPIO_CRH_MODE4 | GPIO_CRH_CNF5 | GPIO_CRH_MODE5);
GPIOB->CRH |= (GPIO_CRH_CNF4_1 | GPIO_CRH_CNF5_1); // 复用功能
// 配置TIM3为编码器模式：TI1FP1与TI2FP2均用于计数
TIM3->SMCR = TIM_SMCR_SMS_1 | TIM_SMCR_SMS_2; // 编码器模式3
TIM3->CCMR1 = TIM_CCMR1_CC1S_0 | TIM_CCMR1_CC2S_0; // CH1/CH2均配置为输入
TIM3->CCER = TIM_CCER_CC1E | TIM_CCER_CC2E; // 使能输入捕获
TIM3->ARR = 0xFFFF; // 自动重装载值设为最大
TIM3->CR1 = TIM_CR1_CEN; // 启动计数

此处 ARR=0xFFFF 的设定意味着计数器范围为0–65535。当电机高速旋转时，计数器可能在极短时间内发生多次溢出。若仅读取当前 CNT 值，将丢失溢出次数，导致位移计算严重失真。因此，必须在每次读取 CNT 前，先读取并清除更新事件标志（ TIM3->SR & TIM_SR_UIF ），并将溢出次数累计计入一个32位变量中，从而获得真实的、无溢出丢失的绝对计数值。

3.2 软件采样：定时中断下的速度计算

速度是位移对时间的导数，工程实践中无法实现真正的微分，只能采用离散差分近似。本项目采用“定时采样法”：在固定时间间隔 Δt （如10ms）内，读取两次计数值 CNT1 与 CNT2 ，则平均速度 v 计算为：

v = (CNT2 - CNT1) / (Δt × CPR)

其中 CPR （Counts Per Revolution）为每转脉冲数，本项目为4096。

该算法的实现依赖于一个高精度的定时中断源。本项目使用TIM4配置为10ms周期中断：

// TIM4初始化：10ms中断
RCC->APB1ENR |= RCC_APB1ENR_TIM4EN;
TIM4->PSC = 7199; // 假设系统时钟72MHz，PSC+1=7200分频
TIM4->ARR = 999;  // ARR+1=1000，总周期=7200×1000/72MHz=10ms
TIM4->DIER |= TIM_DIER_UIE;
TIM4->CR1 = TIM_CR1_CEN;

在TIM4中断服务函数（ISR）中，执行以下操作：
1. 读取TIM3的当前计数值 CNT_now ；
2. 计算本次与上次采样间的净脉冲数 delta_cnt = CNT_now - CNT_last ；
3. 根据 delta_cnt 的符号判断转向（正为正转，负为反转）；
4. 计算绝对速度 |v| = |delta_cnt| / (0.01 × 4096) （单位：转/秒）；
5. 更新 CNT_last = CNT_now ，为下次采样做准备。

此方法的关键优势在于：采样周期 Δt 由硬件定时器严格保证，不受主循环执行时间波动影响，确保了速度计算的时间基准绝对稳定。若在主循环中轮询计数器，则 Δt 将随其他任务执行时间而漂移，引入系统性误差。

3.3 数据校准：零点漂移与线性度补偿

原始编码器信号不可避免地存在硬件偏差。最常见的是“零点漂移”：当电机静止时，由于电磁干扰或编码器安装偏心，计数器可能缓慢爬升或下降。若不处理，静止状态将被误判为低速旋转，导致PID控制器持续输出无效控制量，引发系统振荡。

解决方案是在系统启动时执行一次零点校准：让电机保持静止，连续采集N次（如100次）计数值，计算其均值 CNT_offset ，后续所有速度计算均以 CNT_now - CNT_offset 为有效计数值。此偏移量应存储于EEPROM或Flash中，避免每次上电重复校准。

此外，编码器的线性度亦需关注。理想情况下，脉冲间隔应绝对均匀。但受制造工艺限制，实际脉冲可能存在微小不等距。对于高精度控制，可在电机全速范围内采集多组数据，拟合出实际脉冲间隔与理论值的误差曲线，再在软件中进行查表补偿。本项目因面向教学，暂未实施此高级补偿，但工程师在工业现场必须将其纳入考量。

4. PWM驱动与电机控制接口

PWM（脉宽调制）是连接数字控制器与模拟执行器的桥梁。其物理本质是通过快速开关（通常为MOSFET）控制施加在电机两端的平均电压。占空比 D 定义为高电平时间 Ton 与周期 T 的比值（ D = Ton/T ），电机两端的平均电压 V_avg = D × Vcc 。因此，调节PWM占空比即等效于调节电机的供电电压，进而控制其转速。

4.1 STM32 TIM2 PWM输出配置

本项目使用TIM2通道1（CH1）输出PWM信号，引脚为PA0。关键配置步骤如下：

// 使能TIM2与GPIOA时钟
RCC->APB1ENR |= RCC_APB1ENR_TIM2EN;
RCC->APB2ENR |= RCC_APB2ENR_IOPAEN;
// 配置PA0为复用推挽输出
GPIOA->CRL &= ~GPIO_CRL_CNF0;
GPIOA->CRL |= GPIO_CRL_MODE0_1 | GPIO_CRL_CNF0_1; // 复用推挽
// 配置TIM2：20kHz PWM
TIM2->PSC = 3599; // 72MHz/(3599+1)=20kHz基频
TIM2->ARR = 999;  // 最终频率=20kHz/(999+1)=20Hz? 错！需重新计算
// 正确计算：设目标频率f=20kHz，则T=50μs。若PSC=0，则ARR=72MHz×50μs-1=3599。
TIM2->ARR = 3599;
TIM2->CCMR1 |= TIM_CCMR1_OC1M_2 | TIM_CCMR1_OC1M_1; // PWM模式1
TIM2->CCER |= TIM_CCER_CC1E; // 使能CH1输出
TIM2->CR1 = TIM_CR1_CEN; // 启动TIM2

此处需特别注意： ARR 值的计算必须基于目标PWM频率与系统时钟。若系统时钟为72MHz，要生成20kHz PWM，则计数周期 T = 1/20000 = 50μs ，所需计数值为 72MHz × 50μs = 3600 ，故 ARR = 3599 （因计数从0开始）。错误的 ARR 设置将导致PWM频率偏离预期，直接影响电机响应特性与噪声水平。

4.2 L298N驱动电路接口设计

L298N的输入逻辑与电机动作关系如下表所示：

IN1	IN2	ENA	电机状态
0	0	0/1	制动（短接）
0	1	1	正转
1	0	1	反转
1	1	0	停转（高阻）

本项目仅实现单向调速，故固定IN1=0、IN2=1，仅通过调节ENA引脚的PWM占空比控制正转速度。硬件连接时，必须注意：
- L298N的VS（电机电源）与VSS（逻辑电源）引脚必须分别接入12V电池与单片机5V电源，二者地线（GND）必须共地，否则逻辑电平无法正确识别；
- 在VS与GND之间并联大容量电解电容（如1000μF）与高频陶瓷电容（0.1μF），以吸收电机换向时产生的反电动势尖峰，保护L298N不被击穿；
- 电机引线应尽量短且粗，减少线路压降与电磁辐射。

4.3 占空比-转速映射的非线性特性

理论上，电机转速应与PWM占空比呈线性关系。但实际测试表明，该关系存在显著非线性：
- 死区效应 ：当占空比低于某一阈值（如5%）时，电机因静摩擦力过大而无法启动，转速为零；
- 饱和效应 ：当占空比超过95%后，转速增长趋于平缓，接近电机空载极限；
- 负载依赖性 ：同一占空比下，轻载转速远高于重载转速。

这一非线性是PID控制器必须克服的核心挑战。比例增益Kp若设置过大，系统在低速段将过于敏感，易引发振荡；若过小，则在高速段响应迟钝。因此，在实际控制中，常采用“分段线性化”或“前馈补偿”策略：预先标定不同负载下的占空比-转速曲线，将PID输出的控制量经查表或插值后，再送入PWM模块。本项目为简化教学，暂采用全局PID调节，但在真实产品开发中，此补偿环节不可或缺。

5. 上位机监控与数据可视化

实时监控系统状态是调试PID参数、验证控制效果的基础。本项目采用串口协议将关键数据上传至上位机，通过图形化界面直观展示速度响应曲线。

5.1 串口通信协议设计

为平衡传输效率与解析简易性，本项目定义精简二进制协议：
- 帧头 ：2字节，固定为 0xAA 0x55 ；
- 数据长度 ：1字节，表示后续数据字节数；
- 数据域 ：包含多个16位整数，按顺序为：当前速度（rpm）、期望速度（rpm）、PID输出（占空比%）、误差（rpm）；
- 校验和 ：1字节，为数据域所有字节的异或和；
- 帧尾 ：1字节，固定为 0xCC 。

例如，发送当前速度120rpm、期望速度100rpm、PID输出45%、误差20rpm的帧为：

AA 55 08 00 78 00 64 00 2D 00 14 78 CC

其中 00 78 是120的十六进制（小端序）， 78 是校验和（0x00^0x78^0x00^0x64^0x00^0x2D^0x00^0x14）。

此协议摒弃了ASCII文本格式，大幅降低串口带宽占用（单帧仅12字节），确保在115200bps波特率下仍能支撑20Hz以上的高速数据流，满足实时性要求。

5.2 FreeMODBUS上位机配置

FreeMODBUS是一款开源的Modbus RTU/ASCII协议栈，其配套上位机软件（如QModMaster）可作为通用数据监控工具。配置步骤如下：
1. 在软件中选择对应COM端口，设置波特率115200、数据位8、停止位1、无校验；
2. 选择“RTU”模式；
3. 在寄存器地址窗口中，将起始地址设为 40001 （对应保持寄存器），数量设为4；
4. 将四个寄存器分别映射为：40001-当前速度，40002-期望速度，40003-PID输出，40004-误差；
5. 启用“自动刷新”，设置刷新周期为50ms。

软件将自动解析串口数据，以数字仪表与实时曲线形式显示各参数。工程师可通过调整期望速度设定值，观察实际速度的跟踪响应，直观评估PID参数的效果。曲线图的横轴为时间，纵轴为转速，超调量、调节时间、稳态误差等关键性能指标一目了然。

5.3 数据采集的工程实践要点

在实际部署中，需警惕几个常见陷阱：
- 缓冲区溢出 ：若上位机处理速度慢于数据发送速度，串口接收缓冲区会溢出，导致数据丢失。应在MCU端添加流量控制（如XON/XOFF）或采用硬件流控（RTS/CTS）；
- 时间戳同步 ：上位机显示的时间轴基于自身时钟，与MCU的采样时钟存在微小偏差。长期运行后，曲线可能出现“漂移”。解决方法是在每帧数据中加入32位毫秒时间戳，上位机据此重绘时间轴；
- 数据平滑 ：原始速度数据因编码器量化误差与机械振动而存在高频噪声。直接绘制将导致曲线毛刺严重。应在上位机或MCU端实施简单移动平均滤波（如5点滑动平均），提升视觉可读性。

6. PID参数整定的工程方法论

PID参数（Kp, Ki, Kd）的整定是控制系统调试的核心环节，绝非试错游戏。其目标是找到一组能在稳定性、响应速度与抗扰性之间取得最佳平衡的系数。本节介绍两种经过工业验证的系统化方法。

6.1 经验试凑法（Ziegler-Nichols临界比例度法）

此方法适用于无法获取精确数学模型的场合，步骤严谨：
1. 关闭I、D作用 ：将Ki=0, Kd=0，仅保留Kp；
2. 增大Kp直至临界振荡 ：缓慢增大Kp，观察系统响应。当输出出现等幅持续振荡时，记录此时的临界增益 Ku 与振荡周期 Tu ；
3. 按经验公式计算初始参数 ：
- P控制： Kp = 0.5Ku
- PI控制： Kp = 0.45Ku , Ki = 0.54Ku/Tu
- PID控制： Kp = 0.6Ku , Ki = 1.2Ku/Tu , Kd = 0.075Ku·Tu

此方法的物理意义在于： Ku 代表系统在纯比例控制下的最大稳定增益， Tu 反映了系统固有的惯性时间尺度。公式本质是将控制器的动态特性与被控对象的动态特性进行匹配。在本项目中，通过观察FreeMODBUS曲线上的振荡形态，可精确判定 Ku 与 Tu ，避免主观误判。

6.2 响应曲线法（Cohen-Coon法）

当系统可安全施加阶跃扰动时，此法更为精准。步骤如下：
1. 施加阶跃输入 ：在开环状态下，给电机施加一个固定占空比（如30%），待其转速稳定；
2. 记录飞升曲线 ：用上位机记录从施加阶跃到转速达到新稳态的全过程，得到典型的S形响应曲线；
3. 提取特征参数 ：在曲线上确定延迟时间 L （曲线拐点切线与时间轴交点）与时间常数 T （拐点处斜率倒数）；
4. 计算PID参数 ：
- Kp = 0.9(T/L) / (1 + 0.05(T/L))
- Ki = 0.27(L/T) / (1 + 0.05(T/L))
- Kd = 0.27(L²/T) / (1 + 0.05(T/L))

此方法的优势在于，它直接利用了被控对象的实际动态特性，而非依赖于临界振荡这一可能损害设备的危险工况。对于贵重电机或高精度定位系统，响应曲线法是首选。

6.3 参数整定中的典型现象与对策

在实际调试中，观察到的现象与参数的关系具有高度规律性：
- 系统响应缓慢，超调小，但存在较大稳态误差 ：Kp过小，或Ki=0。对策：适度增大Kp，或引入Ki；
- 系统响应快，但出现剧烈振荡，难以稳定 ：Kp过大，或Kd=0。对策：减小Kp，或增大Kd；
- 系统稳定，但调节时间过长，有小幅持续振荡 ：Ki过大。对策：减小Ki；
- 系统在设定值附近高频抖动 ：Kd过大。对策：减小Kd。

这些现象的本质，是PID三项对误差信号的不同加权方式在时域上的直观体现。工程师需将示波器般的观察能力与对PID数学本质的深刻理解相结合，方能高效完成整定。

7. 实验平台搭建与故障排查

一个可靠的实验平台是验证理论、积累经验的前提。本节详述从元器件选型到最终联调的全流程，并总结高频故障的根源与解决方案。

7.1 电源系统设计

本项目采用双电源架构：
- 电机电源 ：3S锂聚合物电池（标称11.1V，满电12.6V）。选择3S而非4S，是出于安全冗余考虑——12.6V略低于电机16V上限，避免长期满压运行加速绝缘老化。电池需配备专用平衡充电器，严禁过充（>4.2V/节）或过放（<3.0V/节）。
- 逻辑电源 ：由LM2596 DC-DC降压模块将12V稳压至5V，供给编码器与STM32。选择开关电源而非线性稳压器（如7805），是因其效率高、发热量小，适合长时间运行。模块输出端必须并联100μF电解电容与0.1μF陶瓷电容，以滤除高频开关噪声。

电源布线的关键是“星型接地”：电机电源地、逻辑电源地、STM32地、L298N地，所有地线最终汇聚于一点（通常选在STM32的GND引脚附近）。此举可最大限度避免大电流回路的地线压降耦合到敏感的模拟/数字电路中，消除因共地阻抗引起的干扰。

7.2 硬件连接核查清单

在首次通电前，务必逐项核对：
- ✅ 编码器A相（PB4）、B相（PB5）是否正确接入STM32，且无虚焊；
- ✅ L298N的IN1（GND）、IN2（VCC）、ENA（PA0）逻辑电平是否与设计一致；
- ✅ 电机正负极是否与L298N输出端（OUT1/OUT2）极性匹配，反接将导致电机反转；
- ✅ 所有电源正负极是否无短路，用电阻档测量VS-GND间电阻应大于10kΩ；
- ✅ STM32的BOOT0引脚是否接地（正常运行模式），BOOT1悬空。

一个常被忽视的细节是：编码器的5V供电必须来自LM2596输出，而非STM32的5V引脚。后者电流能力有限（通常<100mA），而编码器LED驱动电流可能达50mA，叠加其他外设极易导致STM32复位。

7.3 典型故障现象与根因分析

现象	可能根因	排查步骤
电机不转，但串口有数据	L298N未上电、IN1/IN2电平错误、ENA无PWM	用万用表测L298N的VS、VSS电压；测IN1/IN2电平；用示波器测PA0是否有PWM波形
电机狂转不止	Kp设置过大、编码器信号丢失、PID输出饱和	检查FreeMODBUS曲线，若PID输出恒为100%，则编码器未反馈；用示波器查A/B相信号
速度显示为0或乱跳	编码器接线错误（A/B反接）、TIM3未使能、中断未开启	用手转动电机轴，用示波器观察A/B相是否产生规则脉冲；检查TIM3->CR1的CEN位
上位机无数据显示	串口线接反（TX/RX交叉）、波特率不匹配、帧格式错误	用串口助手发送任意字符，看STM32是否回传；检查协议帧头/校验和计算逻辑

我在实际项目中曾遇到一个隐蔽故障：电机在低速段（<20rpm）运行异常抖动。反复检查硬件无果，最终发现是编码器固定螺丝松动，导致码盘与轴间存在微小间隙，旋转时产生周期性晃动，使A/B相信号出现毛刺。重新紧固后问题消失。这提醒我们：机械装配的精度，有时比代码逻辑更能决定系统成败。

8. 从速度环到角度环的扩展路径

本项目聚焦于速度闭环控制，但其核心思想可无缝迁移至更复杂的姿态控制领域。以小车直行控制为例，其本质是角度闭环——维持航向角为0°。实现路径清晰而直接：

8.1 传感器升级：MPU6050的姿态感知

MPU6050集成了3轴陀螺仪与3轴加速度计，通过传感器融合算法（如Mahony或Madgwick滤波器）可实时解算出俯仰角（Pitch）、横滚角（Roll）与偏航角（Yaw）。其中，Yaw角即小车相对于初始方向的旋转角度，是角度环的直接反馈量。

硬件接口上，MPU6050通过I²C总线与STM32通信。需配置：
- I²C引脚 ：PB6（SCL）、PB7（SDA），上拉电阻4.7kΩ；
- 供电 ：VDD接3.3V（非5V，否则损坏）；
- 参考时钟 ：外部2MHz晶振或内部RC振荡器。

软件层面，需移植成熟的MPU6050驱动库（如Jeff Rowberg的I2Cdevlib），并集成姿态解算算法。解算出的Yaw角需进行零点校准（静止时读取初始值并作为基准），再与期望角度（通常为0）相减，得到角度误差。

8.2 控制策略：差速转向的实现

小车实现转向，依赖于左右轮的差速运动。设左轮速度为 vl ，右轮速度为 vr ，车身宽度为 L ，则瞬时转向半径 R = L × (vl + vr) / (2 × (vr - vl)) 。当 vl = vr 时， R → ∞ ，即直线行驶；当 vr > vl 时， R > 0 ，向左转向。

角度环的PID输出，应作为左右轮速度的“修正量”：

vl = v_base - Δω
vr = v_base + Δω

其中 v_base 是基础前进速度（由上层速度环设定）， Δω 是PID根据角度误差计算出的转向修正量。此结构实现了速度环与角度环的解耦：上层负责维持整体速度，下层负责修正航向。

8.3 系统层级：双环串级控制

更高级的应用是构建串级PID：外环为角度环，内环为速度环。外环PID的输出作为内环的速度设定值，内环则负责精确跟踪该设定值。这种结构的优势在于：
- 外环专注于宏观姿态调整，响应可稍慢以保证稳定；
- 内环专注于微观动力学响应，可设置更高带宽以快速抑制扰动；
- 两环职责分明，调试相互独立。

实现此架构，需在STM32中为两个PID控制器分配独立的定时器中断（如TIM4用于角度环，TIM5用于速度环），并确保中断优先级合理（通常速度环优先级高于角度环），以保障内环的实时性。

至此，一个从单一电机速度控制，到自主移动机器人姿态控制的技术演进路径已清晰呈现。其底层逻辑始终如一： 精确感知、快速计算、可靠执行、闭环反馈 。这正是嵌入式控制工程的永恒主题。