Tiva C系列PWM故障保护与QEI编码器接口实战配置详解

1. 项目概述：从寄存器到电机控制系统的桥梁

在嵌入式电机控制的世界里，我们常常谈论算法、模型和高级框架，但真正让电机精准、安全转起来的，是底层那一行行与硬件寄存器直接对话的代码。最近在调试一个基于TI Tiva™ TM4C123GH6ZRB的直流无刷电机（BLDC）驱动板时，我花了大量时间与两个核心硬件模块打交道：PWM（脉宽调制）模块的故障保护系统和QEI（正交编码器接口）模块。前者是系统的“安全卫士”，确保功率桥在过流、过压时能瞬间关断，保护昂贵的MOSFET和电机；后者则是系统的“眼睛”，实时反馈电机转子的精确位置和速度，形成闭环控制。官方数据手册提供了寄存器的位域定义，但如何将它们串联成一个稳定、可靠的控制系统，中间隔着大量的实践细节和“坑”。本文将结合我的实际调试经验，深入拆解PWM故障状态寄存器（特别是PWMnFLTSTAT1）的工作机制与编程要点，并详解QEI模块从引脚配置到速度计算的完整实战流程。无论你是正在学习电机控制的在校生，还是面临产品调试的工程师，希望这些“踩坑”换来的经验能让你少走弯路。

2. PWM故障保护机制深度解析与实战配置

PWM模块是电机驱动的执行单元，而故障保护则是其生命线。一个没有可靠故障保护的电机驱动器，就像没有刹车的汽车，随时可能“车毁人亡”。Tiva的PWM模块提供了灵活的故障输入机制，其中故障状态寄存器是我们诊断和响应故障的关键窗口。

2.1 故障状态寄存器：PWMnFLTSTAT0与PWMnFLTSTAT1的角色分工

根据数据手册，PWM模块有两组故障状态寄存器：PWMnFLTSTAT0和PWMnFLTSTAT1。初学者容易混淆，其实它们分工明确：

• PWMnFLTSTAT0：通常映射到芯片外部引脚输入的模拟故障信号（如通过比较器生成的过流信号）。这是最快速、最直接的硬件保护路径。
• PWMnFLTSTAT1：本文重点，专门用于监控数字比较器（Digital Comparator）触发产生的故障。数字比较器是芯片内部一个强大的外设，它可以实时比较ADC采样值（如相电流）与用户设定的阈值，一旦超限，立即生成一个数字故障信号送入PWM模块。这种方式比纯软件判断要快得多，实现了硬件级的实时保护。

关键点：这两个寄存器反映了所有故障源的状态，无论该PWM发生器当前是否使能了该故障源。这意味着，即使你没有配置某个故障引脚生效，如果该引脚被外部电路拉低（有效），寄存器状态位依然会置位。这在调试时非常重要，一个悬空或受干扰的故障引脚可能导致你永远无法正常输出PWM。

2.2PWMnFLTSTAT1寄存器详解与两种工作模式

PWMnFLTSTAT1寄存器的低8位（Bit 7-0）分别对应8个数字比较器触发（DCMP7-DCMP0）。它的行为完全由PWMnCTL寄存器中的LATCH位决定，这是理解其用法的核心。

模式一：即时模式（LATCH = 0）在此模式下，PWMnFLTSTAT1是只读的。它像一个透明的玻璃窗，直接显示数字比较器触发输入的当前实时状态。如果比较器触发有效（例如，电流超过阈值），对应位为1；故障条件消失，该位立刻清零为0。

• 应用场景：适用于需要持续监控故障状态，但故障信号可能瞬间出现又消失（如短时毛刺）的场景。你可以通过轮询该寄存器来统计故障发生频率。
• 实战注意：由于状态是瞬态的，在软件轮询的间隙，故障可能已经发生并恢复，导致软件漏检。因此，对于需要绝对可靠保护的关键系统，此模式风险较高。

模式二：锁存模式（LATCH = 1）这是我强烈推荐在电机控制中使用的模式。在此模式下，PWMnFLTSTAT1的位变为R/W1C（写1清零）。一旦数字比较器触发有效，对应的状态位将被锁存为1，即使外部故障条件已经消失，该位也保持为1，直到软件主动向其写入1进行清零。

• 工作原理：这相当于一个带保持功能的报警灯。故障事件被“记住”了。
• 巨大优势：确保软件绝不会错过任何一次故障事件。在中断服务程序或主循环中，只要检查该寄存器，就能知道历史是否发生过故障，这对于系统诊断和可靠性分析至关重要。
• 关键配置步骤：
  1. 必须先将PWMnCTL寄存器中的FLTSRC位置1，以使能故障源扩展。这是很多工程师容易遗漏的一步，如果不使能，你对PWMnFLTSTAT1的写操作是无效的。
  2. 再将PWMnCTL寄存器的LATCH位置1，启用锁存模式。
  3. 当检测到故障并处理完毕后，需要向PWMnFLTSTAT1中已置位的位写入1来清除锁存状态，为下一次故障检测做准备。

2.3 实战代码示例：配置与处理流程

以下代码片段展示了如何配置PWM0的故障1输入为锁存模式，并使用数字比较器0（DCMP0）作为触发源。

#include <stdint.h> #include <stdbool.h> #include "inc/hw_memmap.h" #include "inc/hw_types.h" #include "driverlib/pwm.h" #include "driverlib/sysctl.h" #include "driverlib/gpio.h" void PWM_Fault_Config(void) { // 1. 使能PWM0和GPIO模块时钟 SysCtlPeripheralEnable(SYSCTL_PERIPH_PWM0); SysCtlPeripheralEnable(SYSCTL_PERIPH_GPIOB); // 假设故障引脚在GPIOB // 等待外设就绪 while(!SysCtlPeripheralReady(SYSCTL_PERIPH_PWM0)); while(!SysCtlPeripheralReady(SYSCTL_PERIPH_GPIOB)); // 2. 配置GPIO引脚为PWM故障输入功能 (以PWM0的FAULT0引脚PB4为例) GPIOPinTypeGPIOInput(GPIO_PORTB_BASE, GPIO_PIN_4); GPIOPadConfigSet(GPIO_PORTB_BASE, GPIO_PIN_4, GPIO_STRENGTH_2MA, GPIO_PIN_TYPE_STD_WPU); // 配置引脚复用为PWM故障功能，具体数值查数据手册表 GPIOPinConfigure(GPIO_PB4_M0PWM0_FAULT0); // 3. 配置PWM发生器0 PWMGenConfigure(PWM0_BASE, PWM_GEN_0, PWM_GEN_MODE_UP_DOWN | PWM_GEN_MODE_NO_SYNC); // 设置周期和占空比... // PWMGenPeriodSet(PWM0_BASE, PWM_GEN_0, SysCtlClockGet() / 10000); // 10kHz PWM // PWMPulseWidthSet(PWM0_BASE, PWM_OUT_0, ...); // 4. ！！！关键步骤：配置故障为锁存模式并启用故障源扩展 uint32_t ui32PWM0CTL; ui32PWM0CTL = PWMGenIntTrigGet(PWM0_BASE, PWM_GEN_0, PWM_INT_CNT_ZERO); // 先读取，避免影响其他位 // 设置FLTSRC位和LATCH位 ui32PWM0CTL |= (PWM_CTL_FLTSRC | PWM_CTL_LATCH); // 注意：TI的驱动库可能没有直接提供设置CTL寄存器的完整函数，有时需要直接操作寄存器 HWREG(PWM0_BASE + PWM_O_0_CTL) = ui32PWM0CTL; // 直接写寄存器 // 5. 配置故障触发条件：故障输入低电平有效，并映射到PWM输出 PWMFaultLevelSet(PWM0_BASE, PWM_FAULT_0, true); // true表示低电平有效 PWMGenFaultConfigure(PWM0_BASE, PWM_GEN_0, PWM_FAULT_0, PWM_FAULT_UNLATCHED); // PWM_FAULT_UNLATCHED 指故障条件解除后PWM自动恢复，也可用PWM_FAULT_LATCHED // 6. 配置数字比较器模块（ADC采样比较）触发故障（此处为简化流程） // ... 需要配置ADC、比较器模块，并将其输出连接到PWM故障系统。 // 7. 使能PWM输出和发生器 PWMOutputState(PWM0_BASE, PWM_OUT_0_BIT, true); PWMGenEnable(PWM0_BASE, PWM_GEN_0); } // 故障状态检查与处理函数（应在主循环或中断中调用） void CheckAndClearFault(void) { uint32_t ui32FaultStatus; // 读取PWM0的故障状态寄存器1（锁存模式） // 注意：TI标准外设驱动库可能未封装此寄存器读函数，需直接访问 ui32FaultStatus = HWREG(PWM0_BASE + PWM_O_0_FLTSTAT1); // PWM_O_0_FLTSTAT1 是偏移量宏定义 if (ui32FaultStatus != 0) { // 有故障被锁存 if (ui32FaultStatus & PWM_FLTSTAT1_DCMP0) { // 检查是否是数字比较器0触发的故障 // 执行故障处理：记录日志、关闭电机、点亮报警灯等 SystemHalt(); // 自定义的系统安全停机函数 // 处理完毕后，清除锁存的故障位（写1清零） HWREG(PWM0_BASE + PWM_O_0_FLTSTAT1) = ui32FaultStatus; // 将读出的值（全1的位）写回，实现清零 // 或者更明确地：HWREG(PWM0_BASE + PWM_O_0_FLTSTAT1) = PWM_FLTSTAT1_DCMP0; } // 检查其他DCMP位... } }

避坑指南：

1. 顺序很重要：一定要先配置FLTSRC和LATCH位，再配置故障引脚和使能PWM输出。顺序错乱可能导致故障机制不生效。
2. 直接寄存器操作：TI的TivaWare驱动库对高级故障功能（如FLTSTAT1）的支持可能不完整。很多时候，你需要像上面示例一样，使用HWREG()宏直接读写寄存器地址。务必查阅头文件（如hw_pwm.h）中的寄存器偏移量定义。
3. 故障恢复策略：PWMGenFaultConfigure中配置的PWM_FAULT_UNLATCHED或PWM_FAULT_LATCHED决定了硬件是否在故障条件消失后自动恢复PWM输出。在安全要求极高的场合，建议使用PWM_FAULT_LATCHED（故障锁存），然后由软件在彻底排查问题后手动复位故障并重启PWM，避免故障反复冲击系统。
4. 滤波与防抖：故障输入引脚极易受到噪声干扰。除了在硬件上增加RC滤波电路，还可以考虑在软件中引入简单的延时确认逻辑，避免误触发。

3. QEI模块全流程配置与高精度速度位置获取

如果说PWM是控制电机的“手”，那么QEI就是感知电机状态的“眼”。正交编码器能提供高精度的位置和速度反馈，是实现伺服控制、FOC（磁场定向控制）的基础。

3.1 QEI模块工作模式选择：正交相位 vs 时钟/方向

Tiva的QEI模块支持两种编码器信号模式，由QEICTL寄存器的SIGMODE位选择：

• 正交相位模式（SIGMODE = 0）：最常见。编码器输出两路相位差90度的方波（PhA, PhB）。根据两路信号的相位关系判断转向（正转：PhA超前PhB；反转：PhB超前PhA）。在此模式下，还可以通过CAPMODE位选择计数边沿：
  • CAPMODE = 0：仅在PhA的上升和下降沿计数。每转计数脉冲数 = 编码器线数 * 2。
  • CAPMODE = 1：在PhA和PhB的上升和下降沿都计数。这是最常用的模式，精度最高，每转计数脉冲数 = 编码器线数 * 4（这就是常说的4倍频）。
• 时钟/方向模式（SIGMODE = 1）：编码器输出一路时钟脉冲（CLK）和一路方向信号（DIR）。时钟脉冲每个上升沿计数一次，方向信号的电平决定计数方向（高电平加，低电平减）。这种模式接口更简单，但精度和抗噪性通常不如正交模式。

选型建议：绝大多数增量式编码器都是正交输出，因此首选正交相位模式，并开启4倍频（CAPMODE=1）以获取最高分辨率。

3.2 位置积分器：绝对位置与相对位置

位置积分器（QEIPOS寄存器）是记录编码器累计脉冲数的核心。

• 复位模式（RESMODE位）：
  • RESMODE = 0：相对位置模式。QEIPOS在达到QEIMAXPOS寄存器设置的最大值后归零，然后重新计数。它忽略索引（INDEX）信号。适用于只需要知道相对位移（如走了多少步）的应用。
  • RESMODE = 1：绝对位置模式。QEIPOS在每次检测到索引脉冲时复位到0。QEIMAXPOS应设置为（编码器每转总边沿数 - 1）。这样，QEIPOS的值始终代表在当前旋转周期内，距离索引点的绝对位置。这是实现多圈绝对位置记忆（需结合软件计数）或单圈绝对定位的基础。
• QEIMAXPOS设置：如果RESMODE=1，且编码器是1000线，采用4倍频，则每转产生4000个边沿。QEIMAXPOS应设置为3999（0xF9F）。这样，位置计数器将在0~3999之间循环，索引信号到来时归零。

3.3 速度捕获：原理、配置与计算优化

速度捕获是QEI模块另一个强大功能。它通过一个内置定时器，在固定时间窗口内对编码器边沿进行计数，从而计算出速度。

1. 原理：速度定时器从QEILOAD值开始递减计数，减到0时，产生“速度定时器计满返回”中断。同时，硬件将QEICOUNT寄存器（当前周期计数值）自动复制到QEISPEED寄存器（只读，获取上一个完整周期的速度值），然后将QEICOUNT清零，开始下一个周期的计数。

2. 配置步骤：

   • 使能QEI模块时钟（RCGCQEI）。
   • 配置GPIO引脚复用为QEI功能（GPIOAFSEL,GPIOPCTL）。
   • 配置QEICTL寄存器（模式、边沿、复位模式、使能滤波器等）。
   • 设置QEIMAXPOS（如果需要）。
   • 设置QEILOAD值：这是决定速度采样周期的关键。定时器周期 = (QEILOAD + 1) / 系统时钟频率。例如，系统时钟80MHz，希望速度采样频率为1kHz，则QEILOAD = (80,000,000 / 1000) - 1 = 79999。
   • 使能速度捕获（QEICTL中的VELEN位）和速度捕获中断（如果需要）。
   • 最后使能QEI模块（QEICTL中的ENABLE位）。

3. 速度计算与优化： 数据手册给出的速度计算公式为：rpm = (clock * (2 ^ VELDIV) * SPEED * 60) / (LOAD * ppr * edges)其中：

   • clock：系统时钟频率（Hz）。
   • VELDIV：速度预分频因子（QEICTL中的VELDIV位域），用于扩展低速测量范围。
   • SPEED：从QEISPEED寄存器读出的值（上一个周期的边沿数）。
   • LOAD：QEILOAD寄存器的值。
   • ppr：编码器每转的物理脉冲数（线数）。
   • edges：每个物理脉冲计数的边沿数（CAPMODE=0时为2，CAPMODE=1时为4）。

   实战优化技巧：

   • 避免浮点运算：在中断或实时性要求高的场合，使用浮点数计算rpm会消耗大量CPU时间。应尽可能使用整数运算。
   • 预计算常数：将公式中的常数部分(clock * 60) / (ppr * edges)预先计算好。如果LOAD值也是固定的，可以进一步将整个分母(LOAD * ppr * edges)预计算出来。
   • 利用移位代替除法：精心选择LOAD值，使得分母(LOAD * ppr * edges)接近2的整数次幂。例如，编码器ppr=500，edges=4，则ppr*edges=2000。如果我们选择LOAD=819，那么分母约为1,638,000，接近2^21 = 2,097,152。这样，除法可以近似为(分子 >> 21)，在MCU上这是一条指令的事，速度极快。虽然略有误差，但在许多场合可以接受。
   • 处理溢出：SPEED是32位数，与一些大常数相乘后可能溢出。在预计算时，可以考虑使用64位整数（int64_t）进行中间运算。

3.4 完整初始化代码与速度计算示例

#include <stdint.h> #include "inc/hw_memmap.h" #include "driverlib/qei.h" #include "driverlib/sysctl.h" #include "driverlib/gpio.h" #include "driverlib/interrupt.h" // 预计算常数 (假设: 系统时钟80MHz, 编码器1000线, 4倍频, LOAD=79999) #define SYS_CLOCK_HZ 80000000ul #define ENCODER_PPR 1000 #define EDGES_PER_REV 4 // CAPMODE=1 #define QEI_LOAD_VAL 79999 // 对应1kHz速度采样 // 预计算： (clock * 60) / (LOAD * ppr * edges) // 注意：直接计算可能溢出，分步进行 #define CALC_CONST_NUMERATOR (SYS_CLOCK_HZ * 60) // 4,800,000,000 #define CALC_CONST_DENOMINATOR (QEI_LOAD_VAL * ENCODER_PPR * EDGES_PER_REV) // 3,199,960,000 // 由于分母不是2的幂，我们保留除法。在实际产品中，应优化LOAD值使其接近2的幂。 // 为简化演示，我们使用浮点常数，实际应用应优化为定点数或整数查表。 const float g_fSpeedScaleFactor = (float)CALC_CONST_NUMERATOR / CALC_CONST_DENOMINATOR; void QEI_Init(void) { // 1. 使能外设时钟 SysCtlPeripheralEnable(SYSCTL_PERIPH_QEI0); SysCtlPeripheralEnable(SYSCTL_PERIPH_GPIOD); // 假设编码器接在PD6, PD7, PD3 // 等待就绪 while(!SysCtlPeripheralReady(SYSCTL_PERIPH_QEI0)); while(!SysCtlPeripheralReady(SYSCTL_PERIPH_GPIOD)); // 2. 配置GPIO引脚为QEI功能 // PhA0 -> PD6, PhB0 -> PD7, IDX0 -> PD3 GPIOPinTypeQEI(GPIO_PORTD_BASE, GPIO_PIN_6 | GPIO_PIN_7); // PhA, PhB GPIOPinTypeQEI(GPIO_PORTD_BASE, GPIO_PIN_3); // IDX // 配置引脚复用，具体数值查数据手册表23-5 GPIOPinConfigure(GPIO_PD6_PHA0); GPIOPinConfigure(GPIO_PD7_PHB0); GPIOPinConfigure(GPIO_PD3_IDX0); // 3. 配置QEI模块 // 正交模式(0), 4倍频(PHA和PHB边沿都计数), 索引复位模式(绝对位置), 使能滤波器 QEIConfigure(QEI0_BASE, (QEI_CONFIG_CAPTURE_A_B | QEI_CONFIG_RESET_IDX | QEI_CONFIG_QUADRATURE | QEI_CONFIG_FILTER), 0); // 4. 设置最大位置值 (1000线 * 4 - 1) QEIPositionSet(QEI0_BASE, 0); // 可选：初始位置清零 QEIMaximumPositionSet(QEI0_BASE, (ENCODER_PPR * 4 - 1)); // 5. 配置速度捕获 QEIVelocityConfigure(QEI0_BASE, QEI_VELDIV_1, QEI_LOAD_VAL); // 预分频1分频，加载值79999 QEIVelocityEnable(QEI0_BASE); // 使能速度捕获 // 6. 使能QEI模块 QEIEnable(QEI0_BASE); // 7. (可选) 配置并启用中断 QEIIntRegister(QEI0_BASE, QEI0_IntHandler); // 注册中断处理函数 // 使能索引脉冲中断和速度定时器中断 QEIIntEnable(QEI0_BASE, QEI_INTTIMER | QEI_INTINDEX); IntEnable(INT_QEI0); } // 获取速度 (RPM) - 在主循环或定时任务中调用 float GetMotorSpeedRPM(void) { uint32_t ui32RawSpeed; float fRPM; // 读取上一个完整速度周期的计数值 ui32RawSpeed = QEIVelocityGet(QEI0_BASE); // 应用预计算的换算公式 fRPM = ui32RawSpeed * g_fSpeedScaleFactor; // 注意：如果VELDIV不为0，需要乘以 (2 ^ VELDIV) // 例如，如果VELDIV=1（2分频），则 fRPM *= 2; return fRPM; } // 获取当前位置 (脉冲数) int32_t GetMotorPosition(void) { return QEIPositionGet(QEI0_BASE); } // QEI中断服务函数 void QEI0_IntHandler(void) { uint32_t ui32Status; ui32Status = QEIIntStatus(QEI0_BASE, true); // 获取中断状态 if (ui32Status & QEI_INTINDEX) { // 索引脉冲中断：一圈的起点 // 可以在这里进行圈数计数，实现多圈绝对位置记录 // g_i32RevolutionCount++; // 全局圈数计数器 QEIIntClear(QEI0_BASE, QEI_INTINDEX); // 清除中断标志 } if (ui32Status & QEI_INTTIMER) { // 速度定时器中断：一个新的速度采样周期开始 // 可以在这里读取QEISPEED（但QEIVelocityGet函数通常已处理），或进行其他周期任务 QEIIntClear(QEI0_BASE, QEI_INTTIMER); } // 还可以处理方向改变中断(QEI_INTDIR)和正交错误中断(QEI_INTERROR) }

4. 系统集成与调试实战中的常见问题

将PWM故障保护和QEI反馈集成到一个完整的电机控制系统中，会遇到许多数据手册上没有的挑战。

4.1 PWM与QEI的同步与时序问题

在FOC等高级算法中，需要严格同步PWM开关时刻、ADC电流采样时刻和QEI位置读取时刻。

• 问题：如果ADC采样时刻太靠近PWM开关的边沿，会因开关噪声导致电流采样不准。如果位置读取与PWM周期不同步，计算出的角度会有滞后。
• 解决方案：
  1. 利用PWM触发ADC：配置PWM发生器在计数器为0（或峰值）时产生一个触发信号（PWMGenTrigger()），用这个硬件触发信号去启动ADC采样，确保每次采样都在PWM周期的固定点（如中点），避开开关噪声。
  2. 在PWM中断中读取QEI：将QEI位置/速度的读取放在PWM周期中断服务程序（ISR）中。例如，配置PWM在计数器下溢（为0）时产生中断，在中断里读取QEIPOS。这样可以保证控制算法使用的反馈信息是与当前PWM周期严格对齐的“快照”。

4.2 噪声抑制与信号调理

编码器信号和故障输入信号极易受电机、电源的噪声干扰。

• QEI信号：
  • 硬件：使用双绞屏蔽线连接编码器。在PhA、PhB、IDX信号线上对地接100pF~1nF的电容（位置靠近MCU引脚），并串联一个22-100欧姆的电阻，构成低通滤波。
  • 软件：务必使能QEI模块内部的数字滤波器（QEICTL中的FILTEN位）。FILTCNT位域需要根据你的系统时钟和预期噪声频率来设置。例如，系统时钟80MHz，希望滤除宽度小于5个时钟周期的毛刺，可以设置FILTCNT=5。
• 故障输入信号：同样需要硬件RC滤波。对于数字比较器触发的故障，其源头是ADC采样值，因此ADC采样的抗干扰（如使用硬件平均、软件滤波）同样关键。

4.3 位置溢出与多圈计数

QEIPOS是一个32位寄存器，在高速高分辨率下，长时间运行也可能溢出。对于绝对位置记忆，需要处理多圈计数。

• 单圈绝对位置：使用索引复位模式（RESMODE=1），QEIPOS在每圈索引脉冲处归零，范围是[0, QEIMAXPOS]。这提供了单圈内的绝对位置。
• 多圈绝对位置：需要软件辅助。在索引脉冲中断（QEI_INTINDEX）中，对一个全局的int64_t类型圈数计数器进行加减（根据方向）。总绝对位置 =圈数 * (QEIMAXPOS + 1) + 当前QEIPOS值。注意处理方向改变时的圈数加减逻辑。

4.4 故障诊断与寄存器调试技巧

当电机不转或控制异常时，如何快速定位是PWM问题还是QEI问题？

1. 示波器是第一工具：首先用示波器查看PWM输出引脚是否有波形，波形频率、占空比是否正确。查看编码器PhA、PhB引脚是否有正常的正交波形。
2. 寄存器状态检查：
   • PWM：检查PWMnENABLE寄存器确认输出已使能。检查PWMnFLTSTAT0/1寄存器是否有故障位被锁存。检查PWMnCTL的LATCH和FLTSRC位配置是否正确。
   • QEI：在电机缓慢手动旋转时，通过调试器实时观察QEIPOS寄存器的值是否连续变化。观察QEISTAT寄存器中的方向位（DIR）是否与转动方向一致。检查QEISPEED寄存器在电机转动时是否有非零值。
3. 使用调试中断：初始化时先使能所有可能的中断（故障中断、QEI各种中断），在中断服务函数里设置断点或点亮不同的LED。这样当中断触发时，你能立刻知道系统进入了哪种状态，是故障保护了，还是收到了索引脉冲，或是速度定时器到期了。这是非常高效的动态调试手段。

调试是一个反复迭代的过程。我的经验是，先确保PWM能输出干净的波形，再接入QEI确保位置反馈正确，然后才逐步构建闭环控制算法。每次只增加一个功能，并充分测试，能极大降低系统复杂度，快速定位问题根源。