电机控制方案说明本电机控制方案基于FOC磁场定向控制原理通过ADC采样、EQEP测速测角、EPWM驱动MOS管三大核心操作配合速度-电流双环控制或位置-速度-电流三环控制实现电机的速度调节与精准定位。一、核心控制流程三大关键步骤电机正常运行的核心依赖于“采样-计算-驱动”的闭环循环三步协同工作确保电机稳定响应控制指令具体流程如下1. 信号采样获取电机运行实时数据为精准控制电机运行状态需实时采集两类关键信号为后续控制计算提供数据支撑l电流与电压采样采用“电流转电压”的采样方式将电机三相绕组电流通过采样电阻转换为可采集的电压信号再由ADC模数转换器对该电压信号及母线电压进行实时采集、量化最终换算为电机实际运行电流Ia、Ib、Ic和母线电压为电流环控制提供反馈依据。l转速与角度采样通过EQEP增强型正交编码器接口连接电机编码器实时采集编码器输出的正交脉冲信号通过计数、差分计算等方式精准解析出电机当前的转速RPM和转子电气角度、机械角度为速度环、位置环控制提供反馈数据确保电机转速和位置可测、可控。2. 数据计算解析运行状态并生成控制指令ADC和EQEP采集到的原始数据经控制算法处理后转化为驱动电机的控制指令l转速计算EQEP通过统计单位时间内的编码器脉冲数结合电机极对数、编码器线数换算出电机实际转速与预设目标转速进行对比计算转速误差。l角度计算EQEP通过解析正交脉冲的相位和计数确定转子当前的机械角度再结合极对数转换为电气角度为SVPWM空间矢量脉宽调制和位置控制提供角度基准。l控制算法运算根据双环或三环控制逻辑将转速、电流、角度误差输入对应的PI控制器计算出所需的控制电压Vd、Vq再通过SVPWM算法将Vd、Vq转换为三相PWM占空比为EPWM输出提供指令。3. 驱动输出控制电机运转EPWM增强型脉冲宽度调制模块根据上述计算得到的三相PWM占空比输出6路PWM信号驱动功率模块中的MOS管上下桥臂按设定规律导通与关断lMOS管开关逻辑每相绕组对应上下两个MOS管EPWM输出的高电平控制MOS管导通低电平控制MOS管关断通过调节上下桥臂MOS管的导通时间比例占空比改变电机线圈两端的平均电压。l电机运转控制线圈平均电压的变化会改变绕组电流大小依据电感电流公式VL·di/dt电流产生转矩转矩与Iq电流成正比进而驱动电机转子转动同时实时采样的数据会持续反馈到控制算法动态调整PWM占空比确保电机稳定运行。二、控制模式说明本方案支持两种核心控制模式速度-电流双环、位置-速度-电流三环一速度-电流双环控制双环控制以“转速稳定”为核心目标采用“外环速度环 内环电流环”的层级控制结构内环响应速度快外环控制精度高完整控制链路如下控制链路目标速度如600RPM→ 速度PI控制器 → 输出目标转矩电流Iq→ 电流PI控制器 → 输出控制电压Vq→ SVPWM算法 → 三相PWM占空比 → EPWM输出 → MOS管开关 → 线圈平均电压 → 产生绕组电流 → 产生电磁转矩 → 电机转动 → EQEP编码器测速 → 转速反馈至速度环 → 反复对比调整实现转速恒定。双环控制核心特点l速度环作为外环响应速度中等主要负责对比目标转速与实际转速的偏差通过PI调节输出合适的目标Iq电流确保转速稳定抑制负载扰动如负载增大时自动增大Iq电流提升转矩维持转速不变。l电流环作为内环响应速度最快负责对比目标Iq电流与实际采样电流的偏差通过PI调节输出Vq电压控制MOS管开关时间精准控制绕组电流大小避免电流过大烧毁电机同时快速响应速度环的指令。二位置-速度-电流三环控制三环控制在双环控制的基础上增加了位置环以“精准定位”为核心目标适用于需要电机停在指定角度或旋转指定圈数的场景如设定旋转0.2圈层级关系为位置环指挥速度环速度环指挥电流环具体控制逻辑如下1. 指令输入设定目标位置如0.2圈系统将目标位置转换为对应的角度值结合电机极对数、编码器线数2. 位置环调节通过EQEP采集电机当前实际位置对比目标位置与实际位置的偏差根据配置转速接近目标3. 速度环与电流环调节沿用双环控制逻辑速度环根据位置环输出的目标转速调节目标Iq电流电流环精准控制电流产生转矩驱动电机转动4. 精准定位当电机接近目标位置时位置环输出负的目标转速速度环输出负的Iq电流反向转矩实现刹车抵消电机惯性最终让电机停在指定位置且通过微小保持电流锁住位置避免偏移。三、电机运行完整动态过程以三环控制为例电机从启动到精准停稳整个过程分为5个阶段具体如下1.加速段电机启动后位置偏差较大位置环输出较大的目标转速速度环输出正向Iq电流正向转矩Iq电流处于较高水平驱动电机快速加速角度快速上升转速持续提升。2.匀速段当转速接近位置环设定的目标转速时速度环调节Iq电流至较小水平转矩与负载阻力达到平衡电机以恒定转速运行角度平稳上升转速保持不变Iq电流维持稳定。3.接近目标段电机角度逐渐接近目标位置位置偏差不断减小位置环逐步降低目标转速速度环同步减小Iq电流电机开始缓慢减速角度上升斜率变小。4.减速刹车段当角度接近目标位置偏差极小位置环输出负的目标转速速度环输出负的Iq电流反向转矩相当于“刹车”抵消电机转子的惯性转速快速下降至0角度停止上升避免冲过目标位置。5.稳停段电机角度精准到达目标位置转速降至0位置偏差为0此时Iq电流变为微小的保持电流产生微小转矩对抗重力、齿槽转矩等外力将电机死死“钉”在目标位置不抖动、不偏移实现精准定位。