基于磁编码器的无刷直流电机控制系统设计与实现

摘要随着对高性能、智能化电机控制系统的需求不断提升，无刷直流电机（BLDC）因其高效率、低噪声和响应快等优点，被广泛应用于伺服控制、机器人与精密设备等领域。本文围绕基于磁编码器反馈的无刷电机控制系统展开研究，设计并实现了一套支持矢量控制（FOC）与三闭环结构（位置、速度、电流环）的高性能嵌入式控制平台。首先，论文建立了无刷电机的数学模型，明确了电角度、坐标变换及PI调节等关键控制原理。随后，基于STM32G4系列主控平台，构建了完整的软硬件系统，包括编码器角度采集、电流闭环采样、PWM调制驱动、按键交互与OLED显示模块，实现了三闭环FOC算法的嵌入式部署。在控制算法设计中，提出了基于电角度吸附的偏移校准机制与极对数自动识别方法，提升了系统适应性与移植性。在Simulink中构建了完整的控制仿真模型，验证了系统在目标角变化、扰动干扰、环路对比等场景下的稳定性与响应特性。最终通过实物平台进行测试，记录并分析了位置、速度、电流及PWM波形等关键指标，实测结果与仿真高度一致，验证了控制策略的有效性与工程可行性。本文研究成果为资源受限平台下的高精度电机控制提供了完整的参考设计，具有良好的教学与工程推广价值。关键词：无刷直流电机；磁编码器；矢量控制；三闭环控制；STM32；电角度校准

ABSTRACTBrushlessDCmotors(BLDC)arewidelyusedinrobotics,servodrives,andprecisionsystemsduetotheirhighefficiency,fastresponse,andlownoise.Thispaperpresentsthedesignandimplementationofahigh-performanceembeddedBLDCcontrolsystembasedonmagneticencoderfeedback.ThesystemadoptsField-OrientedControl(FOC)andathree-looparchitecture,includingposition,speed,andcurrentloops.AmathematicalmodelofthemotorisestablishedtosupportcoordinatetransformationsandPI-basedcontrol.ThehardwareplatformisbuiltontheSTM32G4microcontroller,integratingangleacquisition,currentsampling,PWMmodulation,andOLEDdisplay.Theembeddedsoftwareimplementsreal-timecontrolwithmodulardesignandefficientinterruptscheduling.Toensureaccuracy,thesystemincludesencoderoffsetcalibrationandautomaticpole-pairdetection.ASimulinkmodelisdevelopedforsimulationanalysisundervariousconditions,suchasstepchangesintargetangleandexternaldisturbances.Experimentalresultsonarealhardwareplatformconfirmthatthesystemachievesfastresponse,stableoperation,andstrongdisturbancerejection.Themeasureddatamatchthesimulationclosely,validatingtheproposedcontrolstrategy.Thisworkprovidesapracticalandlow-costsolutionforhigh-precisionBLDCcontrolonembeddedplatforms,offeringvalueforbothengineeringapplicationsandeducationaluse.Keywords:BrushlessDCMotor;MagneticEncoder;Field-OrientedControl;Three-LoopControl;STM32;ElectricalAngleCalibration目录TOC\o"1-3"\h\u第1章绪论 第1章绪论1.1研究背景与意义随着电力电子、嵌入式系统及控制理论的快速发展，电机控制系统正朝着高性能、高精度、智能化方向不断演进。在众多电机类型中，无刷直流电机（BLDC）因结构简洁、效率高、响应快、寿命长等优势，广泛应用于机器人、无人机、电动工具与自动化设备等领域，成为新一代驱动系统的重要选择[1]。图1.1无刷电机典型应用场景示意图与传统有刷电机相比，BLDC省去了机械换向器与碳刷，依赖电子换相实现对磁场与电流的控制，从而提升了运行可靠性与控制精度。在实际应用中，电机控制的关键在于转子位置的准确获取与电流的有效调制。霍尔传感器虽结构简单，但精度有限，尤其在低速场景下易出现死区与延迟。相比之下，磁编码器具备高分辨率、低延迟、抗干扰能力强等优势，逐渐成为高性能控制系统的优选方案。图1.2无刷电机典型结构剖面图为实现更优的电流调节与动态响应，矢量控制（FOC）技术应运而生，通过将三相电流解耦为磁通与转矩两个分量，实现对转矩的精准控制[2]。进一步地，三闭环控制架构在此基础上叠加了速度环与位置环，从而提升系统整体的响应速度、稳态精度与抗扰动能力。本课题围绕高性能无刷电机控制系统的设计与实现，构建了一套基于磁编码器反馈、支持三闭环FOC控制策略的嵌入式控制系统。该系统以STM32G4系列单片机为核心控制平台，结合三相驱动、电流采样与角度测量模块，配套完整的软件控制算法，支持目标角跟踪、扰动响应等运行模式，并通过MATLAB/Simulink建立仿真模型，验证控制性能与系统鲁棒性。该研究在工程实践中具备良好的推广前景，也为资源受限平台下的高精度伺服系统设计提供了参考路径。1.2国内外研究现状目前，无刷电机控制技术在学术界与工业界均受到广泛关注。传统的六步换相控制由于结构简单、实现容易，在早期小型驱动设备中广泛使用。但该方法存在换相过程中转矩波动较大、噪声明显、低速控制困难等缺陷，难以满足高性能应用需求。为了解决上述问题，越来越多研究开始采用磁场定向控制（FOC）技术，以实现电流解耦与磁场方向控制。国外在该领域起步较早，德国、日本、美国等国家企业与科研机构在电机建模、数字控制系统设计、高性能变频器开发等方面已形成成熟体系。如德国Infineon、日本Mitsubishi、美国TexasInstruments等公司均推出支持FOC控制的专用电机控制芯片和开发平台。近年来，基于磁编码器的高速精确位置控制系统在欧美高端制造设备中也得到了广泛应用[3]。国内高校与研究机构近年来也在无刷电机高性能控制方面取得显著进展，尤其是在嵌入式平台移植、低成本驱动系统开发、开源FOC算法优化等方向。部分高校尝试将模型预测控制、自适应控制、滑模控制等新型方法引入电机系统控制中，取得一定成效。然而在实际工程应用中，仍需考虑成本、复杂度与实时性之间的平衡问题。因此，结合磁编码器进行精确位置采样、实现嵌入式三闭环控制的实用型控制系统，仍具有广阔的研究与工程价值[4]。1.3课题研究内容与技术路线本课题以AE2207无刷电机和MT6701磁编码器为核心，构建了一套完整的电机控制系统，并以NUCLEO-G474RE单片机为控制平台，搭建起基于编码器反馈的三闭环控制系统。整个项目包括以下几个方面的研究与开发内容：（1）研究无刷电机的工作机理与数学模型，掌握FOC控制原理与坐标变换关系；（2）设计基于磁编码器的电角度识别与偏差校准方法；（3）搭建三相驱动电路与电流采样通道，完成电流环反馈闭环控制；（4）实现位置、速度、电流三环控制结构，编写C语言控制算法并在STM32平台上部署；（5）构建Simulink控制模型，完成目标跳变、扰动响应等仿真测试；（6）进行实物测试与系统响应分析，并与仿真结果进行对比验证。图1.3本课题系统总体结构框图1.4论文结构安排本文共分为七章，具体安排如下：第1章为绪论，介绍研究背景、国内外研究现状、课题研究内容与结构安排；第2章介绍无刷电机原理、数学模型、控制策略及编码器解算方法，为后续设计打下理论基础；第3章对系统控制结构与软件设计进行详细分析，明确三闭环控制逻辑与算法实现流程；第4章介绍整个系统的硬件构成、器件选型、接口配置及平台搭建过程；第5章基于MATLAB/Simulink完成控制系统仿真，并分析不同工况下的响应性能与鲁棒性；第6章展示实物测试过程与结果，对比分析系统的实际控制效果与仿真吻合度；第7章对全文进行总结，指出不足并展望后续优化方向。

第2章无刷直流电机原理与控制方法2.1无刷直流电机结构与工作机理无刷直流电机（BrushlessDCMotor,BLDC）是一种依靠电子换相代替机械碳刷与换向器的电机类型。其典型结构包括定子绕组、永磁转子、位置检测单元与驱动电路。其中，定子通常采用三相对称绕组，类似交流电机结构；转子则采用永磁体材料，具备高能量密度与低损耗特性[5]。图2.1无刷电机三相绕组分布图BLDC的基本运行原理是：当定子绕组按照特定的时序通电时，形成旋转磁场，与转子磁极之间的相互作用产生电磁转矩，从而驱动转子旋转。为了保证磁场方向与转子位置同步，系统需实时换相。传统做法借助霍尔传感器或反电动势实现转子位置检测，但其精度有限，不适用于高性能应用。现代BLDC控制中广泛采用磁编码器作为转子角度检测手段，能够提供更高精度与更低延迟的位置信息，是实现矢量控制（FOC）的前提。FOC通过将三相电流在坐标变换下解耦为d轴与q轴两个分量，分别控制磁通与转矩，从而获得平稳、高效的运行特性。此外，BLDC可按结构分为内转子型与外转子型：前者惯量小、响应快，适合高精度伺服系统；后者功率密度高，广泛用于无人机、电动模型等对输出力矩要求较高的场合[6]。多数采用表贴式永磁结构，其气隙磁场分布近似正弦，为采用正弦波驱动与FOC提供了条件基础。综上所述，BLDC的结构简化了传统电机的磨损问题，而其运行机理为后续坐标变换、电角度控制与闭环调节提供了清晰的建模依据。掌握其基本结构与原理，是构建高性能控制系统的基础。2.2数学建模与电气模型为了实现对无刷直流电机的高性能控制，需要对其运行过程进行数学建模，以便构建控制器的输入输出关系。由于BLDC电机的三相绕组对称分布，其电气建模可以从abc三相坐标系出发，经过坐标变换得到更适合控制器使用的静止两相（αβ）和旋转两相（dq）坐标系表达，从而完成电压、电流、磁链与转矩之间的精确建模与解耦控制。2.2.1abc三相模型在电机定子三相坐标系abc中，假设定子电感对称，忽略饱和与铁耗影响，则三相绕组电压方程可表示为[7]：uuu其中，ua、ub、uc为定子三相绕组电压；ia、ib、ic为相电流；Ra、Rb、Rc为定子绕组电阻；ψa、ψb、ψc为相应的磁链。若三相绕组电阻和电感对称，即Ra=Rb=Rc=R，且忽略中性点，则可以简化为：ui其中ei表示每相的反电动势（Back-EMF），其与转子磁通密度、转速及位置有关。由于abc三相模型具有强耦合性，不便于控制分析，因此需引入Clarke变换与Park变换将其解耦。2.2.2Clarke与Park变换Clarke变换是一种将三相电量（abc）转换为静止正交两相（αβ）坐标的过程，其本质是将三相对称系统投影到两个正交轴上。变换公式如下[8]：ii进一步地，Park变换用于将αβ坐标系下的量变换到与转子磁场同步旋转的dq坐标系，以实现磁链定向控制。其变换过程为：ii其中θ为电角度，id表示与磁场方向相同的电流分量，iq为垂直于磁场方向的电流分量。在FOC控制中，通过令id=0实现无磁通变化，仅由iq调节转矩输出，从而获得更优的动态性能。同样地，电压和磁链也可通过上述变换得到ud、uq和ψd、ψq。图2.2Clarke与Park变换示意图2.2.3反变换与SVPWM原理为了将控制器输出的dq坐标系下的电压指令再次转换为可用于驱动器的三相PWM信号，需要进行Park逆变换和Clarke逆变换。其逆过程如下[9]：ii然后再通过Clarke逆变换：iii最终得到的三相参考电压被输入到SVPWM模块中进行调制。SVPWM（SpaceVectorPWM）是一种空间矢量调制技术，其基本思想是将三相电压矢量在扇区中通过两相分量加权实现等效合成，进而用三相PWM波形表示。与传统正弦波PWM相比，SVPWM具有更高的电压利用率、更低的谐波含量和更优的电机控制性能，是现代FOC系统的常用调制方式。图2.3SVPWM六扇区电压矢量图通过上述建模与变换过程，原本耦合复杂的三相系统被转换为解耦的两相系统，并能在转子磁场坐标下实现电流的独立调节，从而为高性能控制器设计提供理论支持。2.3控制策略对比与分析无刷直流电机的控制策略直接决定其运行效率、响应性能和适应环境的能力。在工程实践中，主要控制方案可分为传统的六步换相控制与基于坐标变换的矢量控制（FOC）。本节对这两种方法进行原理简述和效果对比，明确本课题选择FOC的技术优势。2.3.1六步换相控制策略六步换相是一种早期常用的控制方法，依赖霍尔传感器或反电动势检测转子位置信号，并按照120°相位差切换通电状态，形成旋转磁场。每次通电仅激活两个绕组，第三绕组悬空。该方法控制逻辑简单、实现成本低，适合低速、低精度场景[10]。然而，该策略存在显著缺陷：（1）电流波形为梯形，导致转矩波动大；（2）换相过程中易产生噪声与电磁干扰；（3）低速性能差，精度受限于位置检测分辨率；（4）无法实现磁通与转矩解耦，难以满足高精度需求。2.3.2矢量控制（FOC）策略与优势磁场定向控制（FieldOrientedControl,FOC）基于对电机数学模型的解析，通过坐标变换将三相电流转换为与磁场方向对齐的d、q分量，分别用于磁通与转矩控制。此方法本质上将复杂的三相耦合系统转化为两个独立通道进行调节，实现电流闭环控制。FOC的主要优势包括：（1）转矩输出连续平稳，几乎无波动；（2）可在零速及低速状态下实现高精度控制；（3）具备良好的动态响应性能；（4）适合与磁编码器配合，实现精确位置反馈与伺服控制。尽管FOC在实现复杂度与计算负载方面高于六步控制，但随着高性能微控制器与高分辨率传感器的普及，其已成为现代高性能BLDC控制系统的主流方案。2.3.3控制结构选择与应用匹配考虑到本课题需在多目标跟踪、扰动抑制和低速稳定运行等方面满足高性能需求，采用基于磁编码器的FOC控制策略是合理选择。在具体实现中，控制结构进一步拓展为三闭环架构（位置-速度-电流），用于提升系统的响应速度与抗干扰能力，相关细节将在第3章中详细介绍。表2.1常见BLDC控制策略对比控制方式控制精度响应速度转矩波动低速性能实现难度应用场景六步换相低中明显差低风扇、电动工具等低端场合FOC（矢量控制）高快极小优高伺服系统、机器人、高性能设备2.4电角度解算与极对数校准在磁场定向控制（FOC）中，电角度（ElectricalAngle）是核心控制变量之一，其准确性直接决定了坐标变换的正确性与控制系统的有效性。由于无刷直流电机采用永磁转子结构，其电角度与实际机械转子角度存在极对数倍数的关系，因此需结合高精度位置传感器进行电角度解算，并在初始化阶段完成偏差校准与极对数设定。2.4.1磁编码器读取原理本课题选用MT6701磁编码器作为位置信号源，该器件为高精度绝对值角度编码器，可通过I²C、SPI或ABZ接口实时读取转子角度。MT6701内部集成了霍尔感应阵列，可检测外部磁环的旋转角度并输出12位甚至14位的数字角度值，角度分辨率高、响应速度快，适合高性能位置控制应用[11]。磁编码器输出的角度值表示的是转子的机械角度θmech，单位为度或弧度，范围一般为[0,360)。在控制系统中，主控单片机定时读取编码器角度并缓存当前值，用于参与电角度计算与位置环反馈。相较于传统霍尔元件，磁编码器具备无接触、低抖动、高分辨率、低延迟等优势，特别适合需要精细换相、低速高稳运行的控制系统。2.4.2机械角-电角转换关系电角度是电机定子电磁场的参考角度，用于完成Clarke与Park变换中的坐标旋转操作。其与机械角的关系为[12]：θ其中θelec为电角度，θmech为机械角度，P为电机的极对数。举例而言，若电机具有7对磁极，则转子每转过1圈（360°机械角），其电角度将转过7圈，即2520°，周期为360°。因此电角度实际是机械角度的非线性倍增，其值可能在系统运行中不断增加，不适合直接用于坐标变换，通常需取模至[0,360)范围内。在工程实现中，为避免长时间运行造成角度累计溢出或精度损失，通常采用：θ此外，为了实现转子磁极方向与坐标系角度对齐，还需在实际计算中引入偏置量进行补偿。2.4.3初始偏差识别与极对数设定由于电机初始安装位置、电缆接线方向、编码器零点等因素影响，电角度在系统上电时可能存在固定偏差，若不加以修正将导致FOC控制失效或效率下降。为此，在系统启动阶段需执行电角度偏差识别与极对数校准流程。本课题采用“电角度强制对准法”进行校准，即在上电后输出固定电角度信号（如0°），使电机静止吸附至某一稳定位置，然后读取此时的机械角度θmech₀。根据该角度与已设定极对数P，即可反推当前实际电角度：θ将该值作为初始偏移量θoffset记录下来，在后续电角度计算中进行修正：  θ通过上述过程，系统可实现电角度的精确对齐，确保坐标变换方向与实际磁场方向一致。对于极对数P的设定，若使用的电机型号明确，可手动配置P值；若存在差异或需通用化设计，也可通过反复旋转整圈并统计电角度周期数的方式进行自动识别。本课题在实物系统中支持极对数自动设定与偏差校准，提高了系统移植性与用户友好性。

第3章控制系统总体设计与软件实现3.1控制系统总体结构为实现高精度的无刷电机控制，本课题设计并实现了一套基于FOC矢量控制策略与三闭环结构的嵌入式控制系统。系统以STM32G4系列主控芯片为核心，结合磁编码器、电流采样模块和三相驱动器构成完整的硬件闭环，通过软件控制算法实现目标角度跟踪、速度调节和电流精确控制。本节将介绍控制系统的总体架构与各功能模块的划分，重点说明软硬件之间的协同配合机制，为后续算法与实现细节打下基础。3.1.1系统结构概述系统整体架构由主控单元、传感器模块、执行驱动模块与人机交互单元组成。主控单元选用ST的NUCLEO-G474RE开发板，具备高性能浮点计算能力与丰富外设资源，能够满足高速电流采样、PWM波形生成与控制算法实时执行的需求。（1）传感器模块包括磁编码器MT6701，用于获取精确的转子角度，以及电流采样电路，采集三相绕组的瞬时电流，用作电流环反馈；（2）驱动模块采用EG2103三相驱动板，通过主控生成的三路PWM信号实现对BLDC的控制；（3）人机交互部分包括OLED显示与按键输入，用于展示控制状态和调节目标角度等参数。主控通过周期性中断机制，完成数据采集、坐标变换、PI控制、PWM更新等控制任务，确保系统具备实时性与响应性。具体系统结构如图1.2所示。3.1.2软件模块划分为了提升系统的可维护性与可移植性，软件部分采用模块化设计。各功能模块划分如下：（1）编码器读取模块：定时获取转子角度，参与电角度计算与位置环反馈；（2）电流采样模块：采集三相电流，作为电流环输入；（3）控制算法模块：实现三闭环结构中的PI控制逻辑，输出调制电压；（4）坐标变换模块：负责电流与电压在abc、αβ、dq坐标系之间的转换；（5）PWM输出模块：生成三相对称PWM波形，通过TIM1控制功率驱动；（6）交互显示模块：通过OLED显示控制状态，响应用户按键设置；（7）中断调度模块：配置定时中断与DMA采样触发，确保关键任务及时执行。上述模块通过共享数据结构与定时调度协同工作，实现完整的闭环控制流程。控制任务以中断为主，主循环则处理低频事务与用户操作，形成“中断主导、主循环辅助”的系统调度策略。本节所述架构以实际工程可行性为目标，结合性能与开发效率，搭建了一个功能完整、响应快速、结构清晰的控制系统平台。下一节将详细阐述该控制系统的软件执行流程与中断控制机制。3.2软件流程设计3.2.1主循环与中断逻辑在电机控制系统中，程序执行的实时性和逻辑结构对控制性能起着决定性作用。为确保系统能够在高速旋转、电流变化等动态条件下稳定运行，本课题采用“中断主导、主循环调度”模式，将时间敏感型任务交由中断处理，低优先级任务由主循环完成，以实现控制精度与资源利用的平衡。具体而言，系统运行后进入主循环框架，持续轮询用户输入、OLED显示更新、非关键变量管理等低频功能。而与电机运行实时性紧密相关的电流采样、编码器读取、坐标变换、PI调节与PWM更新等核心控制任务，则由定时中断周期性触发执行。系统主要使用以下几类中断源：（1）定时器中断（TIM1Update）：用于触发FOC主控制流程。其周期通常设置为10kHz~20kHz，在该中断中完成以下操作：读取编码器角度，计算机械角与电角度；采集三相电流并进行Clarke、Park变换；执行PI控制算法，生成dq轴电压指令；反变换后更新三相PWM占空比，完成SVPWM输出。（2）ADC采样中断或DMA回调：用于电流采样完成后自动转入下一阶段处理，确保采样值及时参与控制计算。（3）按键中断或轮询处理：用于检测用户设定目标角度、启停命令、方向切换等操作指令，并更新相关变量。（4）系统时基中断（SysTick）：用于OLED屏定时刷新、状态变量超时检测、动画帧控制等辅助任务。主循环部分结构简洁，主要包含以下功能：检查按键状态，解析用户输入；控制电机启停逻辑切换；实时刷新OLED显示内容；执行状态记录与限幅保护；控制目标角度变更、方向翻转等动态设定。主循环执行频率通常为几百Hz，远低于控制中断频率，从而避免占用处理器过多时间。通过上述中断与主循环配合的方式，系统既能实现高频率、高精度的FOC控制，也能保持良好的人机交互响应和系统运行稳定性。3.2.2位置/速度/电流控制流程图本系统采用三闭环控制结构，即位置环、速度环、电流环级联控制，以实现对目标位置的高精度跟踪。每一层闭环均采用PI调节器实现反馈控制，形成“外层给定、内层跟踪”的控制逻辑。三闭环控制流程如下：（1）最外层为位置环：以用户设定的目标角度为输入，减去当前位置（由磁编码器实时读取），得到位置误差。该误差通过位置PI控制器计算出目标速度值，作为速度环的参考输入。（2）中间层为速度环：以目标速度与实时估算的实际速度之间的差值为输入，经过速度PI控制器调节，输出目标q轴电流iqref，作为电流环的参考。（3）最内层为电流环：以采样获得的实际三相电流经Clarke与Park变换后的dq轴分量id、iq与参考值进行比较，分别使用两个PI控制器计算出ud与uq，作为逆变换的输入，最终生成三相PWM输出。每一个环节均引入了滤波、限幅与死区处理，以提高系统的抗扰动能力与稳定性。整个流程自外向内逐级传递控制目标，自内向外逐级闭环校正，有效抑制扰动影响，提高响应速度。图3.2三闭环FOC控制流程图为了估算实际速度，系统采用角度差分法。即每次中断中读取当前角度，与上一次角度相减后除以中断周期，得到角速度。该速度值用于速度环反馈。ω其中θcurrent为当前采样的机械角度，θlast为上一次保存的角度，Ts为控制周期。整个控制流程在定时器中断中以固定周期执行，确保数据一致性与实时性。在控制效果上，三闭环结构可实现平滑加速、快速响应、抗扰动强的目标角度跟踪能力。3.2.3PWM调制与输出实现在完成dq轴电压指令的计算后，控制系统需将该信息转化为具体的三相驱动信号，作用于三路功率管，从而控制电机转动。本系统采用基于空间矢量思想的正弦波PWM（SVPWM）调制方式，实现三相PWM波形输出。与传统梯形波调制或六步换相方式相比，SVPWM具有更高的电压利用率、更低的谐波含量以及更平滑的转矩输出。在SVPWM调制之前，系统先通过逆Park变换与逆Clarke变换将dq轴电压指令（ud,uq）转换为三相静止坐标下的参考电压（ua,ub,uc）。变换过程如下：uuuuu将得到的三相电压映射到PWM占空比范围内（通常为0~1），即完成占空比生成。系统使用定时器TIM1的三个输出通道，分别控制A、B、C三相PWM信号，配合外部驱动器实现对电机三相绕组的精确驱动。为简化计算，本系统并未使用完整的SVPWM六扇区算法，而是将三相正弦波幅值直接映射为占空比值，在三相对称正弦基础上乘以当前调制幅度，并加上0.5偏置，以适配定时器中心对称PWM输出方式。具体公式为：dutydutyduty其中，A(amplitude)为调制幅度，根据当前运行状态（静止或转动）设定；θelec为当前电角度。最终将duty值乘以PWM周期值并写入定时器通道比较寄存器，实现高频PWM输出。系统PWM频率设定为20kHz，兼顾电流响应速度与驱动器开关损耗。在输出过程中，为保证输出信号一致性，系统在更新三相PWM时开启定时器互补更新锁存机制，避免中断过程中输出数据失配。同时，为防止占空比过大导致驱动器导通重叠，系统设定了上下限阈值，将占空比限制在一定范围内（如5%~95%），提高系统可靠性。3.3核心算法与参数设定在本系统中，位置、速度、电流三个控制环节均采用比例-积分（PI）控制器进行误差调节与反馈修正。为保证系统响应速度与稳定性，PI参数需根据电机参数与控制周期合理设置。同时，编码器解算与极对数识别算法在初始阶段的精度也对整体控制效果有直接影响，需进行有效初始化与实时修正。3.3.1PI参数设置PI控制器是一种常见的线性调节器，其控制规律为[13]：u(t)=其中，e(t)为控制误差，Kp为比例系数，Ki为积分系数。在数字实现中，控制器通常采用增量式或位置式离散形式，每个控制周期计算一次调节值。本系统的PI控制器设置如下：（1）位置环PI控制器：根据目标角度与当前位置的差值计算目标速度，Kp值较小，防止角度微小变化引起速度突变，Ki值可设为较低或零，用于慢速调节。（2）速度环PI控制器：控制目标速度与估算速度之间的差值输出iq参考电流，是调节灵敏度的关键环节，Kp值中等偏大，Ki值适中以消除稳态误差。（3）电流环PI控制器：对dq轴电流进行直接控制，要求响应快、带宽高，Kp值偏大，Ki值设定需平衡响应速度与超调程度。为了防止积分饱和，本系统引入了积分限幅机制与输出限幅机制，避免PI输出超出PWM范围导致系统不稳定。控制参数可根据实际电机参数、控制周期以及所需响应特性进行调试，系统中留有调节接口支持手动微调。3.3.2极对数识别逻辑极对数P是将机械角度θmech转换为电角度θelec所必需的关键参数。在一些已知电机型号中，P可通过规格书直接设定；但在部分电机或不同接线方式下，极对数难以准确确认，或存在极性反接的问题，需进行识别与修正。本系统提供两种极对数设定方式：（1）手动配置：用户在程序中预设极对数P值，适用于固定电机型号的系统部署；（2）自动识别：在电机运行状态下，系统读取机械角变化量并检测电角度周期数，根据完整旋转圈数反推出P值。具体方法为：在无负载状态下转动电机一圈，同时记录机械角变化和电角度变化次数，最终计算：P=此方法适用于具备连续旋转能力和精确角度采样能力的系统，有助于提升通用性与初始化便捷性。3.3.3编码器零点偏差校准算法磁编码器由于安装误差、PCB偏移或磁环中心不一致，可能导致输出的零点位置与实际转子磁极方向不一致，进而影响电角度的换算精度。为此，系统在启动阶段进行零点偏差校准。校准流程如下：（1）在上电初始化时，强制输出固定电角度（如0°）到PWM，使电机转子吸附至特定磁场方向，此时位置可视为电角对准状态；（2）读取此时的机械角度θmech_zero，计算出偏差角度：θ将该偏差值存入系统变量中，后续每次计算电角度时均减去该偏差值：θ该过程仅需在初始化阶段执行一次，校准结果在系统运行期间持续有效。在系统重新上电或编码器重新安装后，需重新执行一次零点校准流程。为避免磁编码器值抖动或失准影响校准结果，校准期间系统会延迟一定时间（如500ms~1s），确保转子吸附稳定后再读取角度。

第4章硬件系统设计与搭建4.1主控器与执行单元选型电机控制系统的硬件平台是实现高性能控制策略的基础，其选择需兼顾处理性能、外设资源、开发便利性与可靠性。为实现位置、速度、电流三闭环控制策略，本课题选用功能强大、资源丰富的STM32G4系列主控芯片，同时匹配一颗高KV值无刷直流电机AE2207和一块三相驱动器EG2103，构建完整的执行通道。以下对核心单元的选型及其功能进行说明。4.1.1NUCLEO-G474RE主控与资源分析本项目使用的主控平台为ST公司推出的NUCLEO-G474RE开发板，该板搭载STM32G474RETx系列主控芯片，具有如下特点[14]：（1）主频高：主频达170MHz，内核为ARMCortex-M4，具备DSP指令集与浮点运算单元，可满足FOC控制中大量实时计算需求；（2）PWM资源丰富：TIM1为高级定时器，支持三相互补PWM输出、死区时间控制、并带有PWM同步更新机制，适合电机控制应用；（3）ADC采样速度快：具有3路独立ADC模块，每路支持多通道并行采样，满足三相电流的快速采样要求；（4）通信接口齐全：板载I²C、SPI、USART等多种接口，可实现与编码器、OLED显示、上位机等设备的互联互通；（5）开发环境成熟：支持STM32CubeMX、Keil、IAR等开发工具，配套HAL库便于快速搭建电机控制工程。此外，NUCLEO板具备ST-LINK调试器，可直接通过USB连接下载与调试程序，降低了开发门槛与系统调试复杂度。4.1.2AE2207无刷电机参数与连接AE2207是一款常见的航模无刷直流电机，具备高转速、大功率密度的特性，适合本课题中对快速响应与负载扰动能力的验证实验。其关键参数如下：型号：AE2207V2KV值：1960KV（表示无负载每伏产生1960rpm）极对数：7对（14极）电机尺寸：直径27.9mm，高13.5mm工作电压范围：7.4V~14.8V额定电流：小于30A安装孔距标准，配合磁环与编码器易于搭建。AE2207为外转子结构，转动惯量相对较大，转矩变化更平稳。在接线方式上，电机的U/V/W三相线分别接入驱动器输出端口，由主控生成PWM信号间接控制电流输出方向与幅度。电机轴上安装磁环，与编码器相对固定，用于获取高精度角度反馈。4.1.3EG2103驱动板说明EG2103是集成式三相无刷电机驱动模块，内部采用MOSFET全桥结构，可直接驱动外部无刷电机。该驱动板具备以下特性：（1）三通道驱动输入（PWM_A、PWM_B、PWM_C），直接与主控定时器PWM通道对应；（2）支持高频PWM驱动，适配SVPWM调制频率（20kHz左右）；（3）集成三路电流采样输出（ISA/ISB/ISC），通过低阻分流电阻检测U/V/W相电流，输出模拟电压信号供主控采样；（4）板载逻辑供电与功率供电分离，具备基本保护电路，适合教学与研究使用；（5）接口标准化，便于与NUCLEO主控连接，连接方式为3根PWM控制线、3根电流采样线、3根电机相线、VCC/GND供电线。通过EG2103驱动器，系统可根据主控输出的PWM占空比控制电流方向和幅度，实现FOC控制算法与电机物理驱动的闭环连接。4.2编码器与电流采样电路设计高性能的无刷电机控制系统需要对转子位置与三相电流进行实时、高精度的反馈采样。为此，系统分别采用磁编码器MT6701用于角度检测，利用EG2103驱动板内置的电流检测电路输出三相采样信号，主控通过ADC进行同步采集。本节将详细介绍两部分采样电路的设计与接线配置。4.2.1MT6701磁编码器通信方式与接线MT6701是一款高精度非接触式旋转磁编码器，支持SPI、I²C、ABZ脉冲输出和模拟输出多种接口方式。其内置霍尔阵列可感应磁场方向并实时输出绝对角度，分辨率最高可达14位，适用于高速、高分辨率的位置检测[15]。本课题采用I²C通信模式连接MT6701磁编码器，主控STM32G474RE通过I2C1接口周期性读取角度值。编码器输出角度为数字格式，分辨率为14位，测量范围为[0,360°)，主控中断周期内更新该值参与电角度计算。相比模拟采样方式，I²C模式可减少噪声干扰并提高读取精度。MT6701模块接线方式如下：（1）VCC：连接3.3V（2）GND：接地（3）SDA/SCL：接主控I2C1的PB9/PB8引脚该模块体积小巧，响应快速，安装时需注意磁环与芯片中心对准，以保证角度精度。在系统初始化阶段，主控通过读取该值用于电角度计算与零点偏差校准。4.2.2三路电流采样通道设计系统电流采样基于EG2103驱动板提供的三路模拟电压输出：ISA、ISB、ISC，分别代表U、V、W三相的电流采样信号。驱动板内部通过电流检测电阻（一般为低阻值0.01Ω~0.05Ω）转换出对应的电流电压值，主控只需采集模拟信号并换算即可。电流采样采用STM32片上ADC模块采集，每相对应一个ADC输入通道，建议配置如下：（1）ISA→PA0（ADC_IN5）（2）ISB→PA1（ADC_IN6）（3）ISC→PA4（ADC_IN9）三个通道通过多通道扫描方式在控制周期内同时完成采样，结合DMA实现数据传输，确保采样值的时效性与一致性。电流采样频率与PWM频率同步，为20kHz。电流换算公式为[16]：I其中，Vsample为ADC采样值转换后的电压，Vref为零电流时输出基准电压（一般为中间电压2.5V），Rsense为电阻值，Gain为运放增益。为简化处理，系统可近似认为电流采样为线性映射，并在电流环中使用单位化归一值作为PI控制输入。为避免噪声影响，电流采样线上增加滤波电容，并使用外部接地屏蔽，同时通过多次采样平均或中位值滤波提高精度。在ADC配置中启用硬件触发（如由定时器更新事件触发）可进一步提高采样同步性。4.3接口分配与系统集成结构为实现控制系统中各模块的高效协同与稳定运行，必须合理规划主控芯片的GPIO、通信、PWM和ADC资源。结合STM32G474RE的片上外设配置与本课题的具体控制需求，本节将详细说明各接口的具体分配方式以及系统集成方案，确保软硬件联调顺畅、运行稳定。4.3.1I²C/PWM/ADC接口配置（1）ADC通道配置：系统使用ADC1模块的三个通道采集电流信息和编码器模拟输出，配置如下：PA0（ADC_IN5）：接收ISA，相当于U相电流PA1（ADC_IN6）：接收ISB，相当于V相电流PA4（ADC_IN9）：接收ISC或编码器模拟角度输出这些通道可通过DMA方式配合定时器触发实现高频高精度的连续采样。（2）PWM输出配置：使用TIM1高级定时器提供三通道中心对称PWM波形，控制三相无刷电机：CH1（PA8）：对应PWM_ACH2（PA9）：对应PWM_BCH3（PA10）：对应PWM_C定时器设置为20kHz频率，启用互补输出与死区时间功能，提高驱动可靠性。（3）通信接口配置：OLED显示模块使用SSD1306显示驱动库，主要用于实时显示目标角度、当前位置、电角度偏移等控制状态信息，便于用户交互与调试，接口采用I²C通信方式，连接至主控的I2C4接口，对应引脚为：SDA：PC7SCL：PC6磁编码器MT6701同样采用I²C数字通信方式连接，主控通过I2C1接口读取角度数据，接口引脚为：SCL：PB8SDA：PB9编码器每轮输出14位角度信息，测量范围为0~360°，精度高、响应快，适用于FOC控制中电角度解算。相较于模拟输出方式，I²C通信模式能有效避免噪声干扰，提升系统测量稳定性。除I²C外，为满足未来扩展调试需求，系统预留了其他通信接口：（1）SPI编码器或传感器接口：可使用PA5（SCK）、PA6（MISO）、PA7（MOSI）、PB6（CS）；（2）上位机串口调试接口：保留USART2，接PA2（TX）/PA3（RX）或USB虚拟串口通道；当前系统默认采用MT6701的I²C输出方式和OLED的I²C4通道，其他通信接口作为调试和扩展用途保留。4.3.2按键功能设置与硬件映射系统设置五个按键，实现用户对控制流程的交互干预和运行状态调节，具体功能如下：（1）目标角度+（PB14）：每次按下目标角度增加一定幅度；（2）目标角度−（PB13）：每次按下目标角度减少一定幅度；（3）清零按键（PB15）：将当前位置或电角度偏移值复位；（4）启动/停止（PB1）：控制电机是否运行；（5）方向切换（PB2）：控制电机正转或反转；所有按键采用上拉输入方式连接至GPIO，状态通过主循环轮询读取。按键检测逻辑中加入软件消抖机制，确保避免因电平抖动造成误触发。按键状态与控制结果均在OLED显示屏中实时反馈，提升系统的交互友好性与操作直观性。在系统布线过程中，接口设计充分考虑了抗干扰性和信号完整性要求。PWM控制线、模拟采样信号线与I²C通信线分开布线，所有模块共地处理，并通过排线连接规避交叉干扰，保障系统运行稳定。

第5章控制系统仿真与性能分析5.1仿真平台与建模概述在控制系统实际部署前，进行充分的仿真建模是评估控制策略可行性、分析系统响应特性和优化控制参数的重要手段。为验证本文提出的基于磁编码器的无刷直流电机三闭环控制系统的有效性与稳定性，构建了完整的Simulink仿真模型，并在不同目标角度、扰动条件、控制策略下进行了多组对比测试。本仿真平台基于MATLAB/Simulink环境，结合Simscape电机模块、控制逻辑模块和信号源，搭建了包含电机、电流采样、PI控制器、坐标变换、PWM驱动器等在内的完整控制环路。仿真模型结构与实物系统高度一致，确保测试数据可用于实物对照分析。所采用的电机模型为表贴式永磁无刷电机，按照AE2207实际参数设定，包括以下关键信息：（1）极对数：7对（2）定子相电阻、电感：根据样本估算值设定（3）反电动势波形：正弦型或梯形可选，默认正弦型以匹配FOC控制特性（4）编码器分辨率：设定为12位模拟角度信号（5）电源电压：设定为12V稳定直流源（6）负载模型：默认带惯量负载，并支持扰动注入仿真系统中，控制周期设置为50μs，对应20kHz采样频率，与实物系统一致。所有PI控制器参数均根据实物设置匹配设定，保证仿真结果可用于分析控制性能趋势与动态过程响应。仿真系统如图5.1，包括以下主要模块：（1）目标角生成模块：设置固定目标角、跳变角或周期函数；（2）编码器角度模块：模拟磁编码器输出角度，用于位置反馈；（3）速度估算模块：使用角度微分方式模拟实际速度估算；（4）三闭环控制器：包括位置PI、速度PI、电流PI三层级联控制；（5）dq变换模块：完成Clarke与Park变换及其逆变换；（6）SVPWM模块：模拟PWM调制并作用于电机模型；（7）电流采样模块：提取ABC三相电流，用于反馈；（8）负载模块：可设置负载突变时间点与扰动大小。图5.1完整仿真系统图仿真过程中，记录了电机转子位置、速度、三相电流、电角度等关键变量，并以图形形式输出用于对比分析。不同控制场景下的响应特性对照表与图形展示，有助于验证控制系统的动态稳定性、调节精度与抗扰性能。5.2多目标角响应仿真为验证控制系统在不同目标角度输入下的响应能力与稳态控制性能，本节设定三组典型目标角度输入，分别为1rad、2rad与3rad，并在恒定负载条件下进行仿真测试。每组实验均记录电机的位置响应曲线、速度变化曲线与三相电流波形，用于分析系统的跟踪能力与输出调节过程。此外，为进一步评估系统在突变目标指令下的动态调节能力，设计阶跃跳变仿真，设置在仿真运行1秒时将目标角从2rad跳变为1rad，观察系统响应过程的稳定性与收敛速度。5.2.1目标角仿真结果仿真中目标角设定为1rad、2rad与3rad三组场景，初始位置为0，控制系统根据设定角度自动调整输出，实现目标位置的闭环跟踪。系统整体运行良好，响应过程平稳，具体分析如下：位置响应方面，如图5.2所示，目标角设为1rad时，电机位置在短时间内快速上升，约1秒内稳定至目标值，过程中无明显超调或振荡，说明位置环调节精度高、动态响应良好；图5.2目标角度为1rad时位置变化曲线速度响应方面，对应的速度曲线见图5.3，系统在初始阶段加速明显，接近目标角度时速度自动减小，呈现出理想的“先加速后减速”变化趋势，避免了快速跟踪过程中的超调和抖动；图5.3目标角度为1rad时速度变化曲线电流响应方面，图5.4展示了三相电流的调节过程，可见电流波形呈周期性正弦形态，幅值随目标角度变化略有上升，输出平稳且无尖峰脉冲，说明电流环响应迅速，能有效适应不同位置设定下的驱动需求。图5.4目标角度为1rad时三相电流变化曲线总体来看，三组目标角输入下系统均能快速稳定跟踪，三闭环结构实现了从位置目标到电流调节的连续闭环控制，体现出良好的协调性与动态适应能力。。5.2.2目标角跳变仿真为测试系统在突变输入下的响应能力与稳定性，设置在仿真运行1秒时将目标角从2rad跳变至1rad，模拟典型的路径切换场景。仿真结果表明：位置响应方面，如图5.5所示，跳变发生后电机位置快速向新目标调整，过渡过程平滑，约0.4秒内稳定在1rad附近，无明显超调或迟滞，系统具备良好的跳变调节能力；图5.5目标角度跳变位置变化曲线速度响应方面，图5.6所示速度曲线在跳变瞬间出现反向波动，随后逐步趋近于零，速度响应过程连续且收敛快，说明速度环能及时缓冲位置误差并协调电流输出变化；图5.6目标角度跳变速度变化曲线电流响应方面，如图5.7所示，跳变时电流出现短暂负向脉冲，随后恢复为新稳态下的稳定波形，整体无高频震荡，反映出电流环具备良好的快响应与抗干扰能力，能有效支撑跳变过程中的能量调节。图5.7目标角度跳变三相电流变化曲线该组仿真验证了控制系统在面对动态位置变更时的响应速度与输出稳定性，说明三闭环结构具备良好的综合调节性能和突发情况应对能力，适用于路径变化频繁或目标实时切换的实际场景。5.3轨迹跟踪与扰动响应仿真为进一步验证三闭环控制系统在复杂工况下的性能表现，本节设置三组典型测试场景，包括周期目标角轨迹跟踪（正弦输入）、负载突变扰动测试、去除电流环/速度环的对比实验。通过分析各场景下的位置、速度、电流变化趋势，评估控制系统的动态响应能力、稳态精度与抗扰动性能，并明确各控制环节在整体系统中的作用与价值。5.3.1周期目标轨迹跟踪设定目标角为正弦函数输入，模拟实际中复杂路径随动控制需求。系统需平滑连续地跟踪输入目标。位置响应方面，如图5.8所示，电机位置变化曲线与目标正弦轨迹高度重合，基本无明显相位延迟或跟踪误差，说明位置环具备良好的同步调节能力；图5.8周期目标跟踪位置变化曲线速度响应方面，图5.9中可见速度曲线随目标角动态变化连续变化，无跳变、突升现象，在角度变化较快的波峰波谷处呈现平滑过渡，系统具有良好的速度跟随能力；图5.9周期目标跟踪速度变化曲线电流响应方面，如图5.10所示，三相电流随角速度变化同步波动，波形规则，幅值适中，无异常尖峰或失调，说明电流环调节灵敏，整体系统稳定。图5.10周期目标跟踪三相电流变化曲线该组仿真结果说明系统能实现动态目标角的连续跟踪，适用于路径规划执行、柔性控制等对响应连续性要求较高的场景。5.3.2负载扰动仿真在仿真运行1秒时，系统负载从0突变至较大值，模拟外部负载扰动注入，用于评估控制系统的鲁棒性与扰动抑制能力。位置响应方面，图5.11显示，在扰动注入瞬间，位置曲线仅产生微小偏移，随后迅速恢复至原目标轨迹，说明系统具备良好的扰动抑制能力；图5.11负载扰动位置变化曲线速度响应方面，如图5.12所示，速度在扰动发生时略有下降，之后在0.2秒内迅速回稳，说明速度环快速介入，有效补偿了扰动带来的动态偏差；图5.12负载扰动速度变化曲线电流响应方面，图5.13显示电流在扰动瞬间出现幅值快速上升，表明电流环第一时间对负载变化做出响应，随后输出重新趋稳，系统输出能力良好。图5.13负载扰动三相电流变化曲线整体来看，该仿真验证了电流环在对突变负载的响应中发挥了关键作用，而位置与速度环则维持系统总体稳定，有效协同应对外界扰动。5.3.3去除电流环对比仿真为评估电流环在三闭环控制系统中的关键作用，本节设计对比实验：在保留位置环与速度环的情况下，屏蔽最内层的电流环，即使速度控制器直接输出控制量给PWM驱动器，绕过电流反馈通道。其余控制结构与仿真参数保持一致，负载扰动依然在1秒处注入。位置响应方面，如图5.14所示，位置响应虽然仍能最终趋近目标值，但整体波形略有波动，尤其在响应初期存在超调现象，说明系统在无电流精细调节下失去了输出稳定性；图5.14去除电流环位置变化曲线速度响应方面，图5.15显示，速度在扰动前后均存在高频震荡，表现出调节过程的迟缓与抖动特征，说明速度环无法独立稳定电机响应，缺乏足够的能量控制基础；图5.15去除电流环速度变化曲线电流响应方面，图5.16中三相电流波形明显失稳，波动剧烈，存在过冲、尖峰等现象，难以维持正弦波形。说明系统在缺乏电流闭环调节后，电流输出完全依赖于速度控制的间接调节，难以应对快速动态或扰动。图5.16去除电流环三相电流变化曲线该实验充分说明电流环在系统中起到了输出稳定与快速响应的关键作用。电流调节的缺失将直接导致能量驱动层失控，进而影响速度和位置控制效果，即使外层环节保持，也无法弥补低层能量调节失效带来的系统震荡。5.3.4去除速度环对比仿真为进一步验证三闭环中各控制环节的重要性，本节对控制结构进行极限简化，仅保留最外层的位置环控制器，完全去除速度环与电流环，即位置误差直接输出目标控制值参与PWM调制，形成“单闭环”控制结构。由于该结构稳定性极差，实验中未引入外部负载扰动，仅在无干扰条件下测试系统对固定目标角度的响应行为。位置响应方面，如图5.17所示，系统初始阶段可推动电机向目标角度移动，但在接近目标位置后未能有效稳定，曲线出现显著的周期性振荡。这说明误差未被合理缓冲和削减，系统处于持续过调与反调之间，无法收敛；5.17进一步去除速度环位置变化曲线（2）速度响应方面，图5.18中速度曲线变化剧烈，方向频繁反转，表明由于缺乏速度调节层的平滑作用，电机直接受位置误差驱动，调节过度、响应冲动，导致速度控制完全失效；5.18进一步去除速度环速度变化曲线（3）电流响应方面，图5.19显示电流波形剧烈震荡，周期性大幅波动，存在明显过冲和高频切换，表明系统完全无法维持稳定电流输出，电机驱动严重紊乱。5.19进一步去除速度环三相电流变化曲线该实验结果表明：若控制系统仅依赖位置误差直接驱动输出，未经过速度与电流的逐级调节，系统将极易陷入高频震荡、周期性冲突与控制失控状态。速度环和电流环在调节速率、抑制误差冲动、稳定能量输出方面缺一不可，三闭环的分层控制策略是保障系统性能的基础。5.4仿真性能分析总结为系统验证所设计三闭环控制策略的性能表现，本文设置目标角度分别为1rad、2rad和3rad三组工况，分析其在不同目标输入下的位置响应、速度变化及电流调节过程。图像结果显示：系统在三种输入幅值下均能实现快速、稳定的调节过程，具有良好的鲁棒性与自适应能力，现总结如下：（1）位置跟踪性能一致，响应速度快三组目标角均从0rad启动，最终稳定在各自设定值；电机在所有工况下均能在约1秒内完成响应并进入稳态区间，收敛时间差异极小；曲线呈典型一阶响应特性，无明显超调或滞后，说明系统位置环调节效果良好、动态性能一致性强；目标角幅值的增大并未对系统响应速度产生显著影响，体现出控制器具备一定程度的幅值无关特性。（2）速度响应稳定，变化趋势合理三组速度曲线均在初期快速上升，随后下降至零；虽然目标角度不同，初始加速度略有差异，但总体趋势一致，均无抖动、无突变；说明速度环可根据不同误差大小自动调节输出，动态缓冲效果显著，提升系统整体平滑性。（3）电流调节快速，功率响应良好电流波形在各组测试中均出现短时过渡，随后迅速趋于稳定；随着目标角度增大，电流的峰值略有提高，反映出系统能根据负载需求自动增加输出；无论是±100A还是±200A范围内波动，均在1秒内收敛为稳态正弦，说明电流环调节能力强、系统能量输出稳定可靠。（4）综合评价综上所述，本文控制系统在面对1～3rad不同目标角输入时，均表现出以下特性：调节速度快：所有工况均在1秒左右完成；稳定性高：无明显超调、振荡或迟滞；响应一致：系统对不同输入幅值具有高度适应性；能量调节及时：电流环能在负载变化下快速收敛；各控制环分工明确，三闭环结构协同稳定、高效。本节仿真验证表明，三闭环控制系统具备优秀的动态性能与稳态性能统一特性，为后续实物系统移植和复杂任务扩展提供可靠控制基础。

第6章实物测试与系统验证6.1实验平台搭建与功能测试为验证控制系统在真实环境中的可行性与稳定性，本文基于STM32微控制器构建了完整的实物测试平台，搭建了由主控单元、驱动电路、无刷电机、磁编码器、OLED显示模块等组成的硬件系统，并通过软件设计实现了对各模块的调度与数据交互。首先，选用意法半导体推出的NUCLEO-G474RE开发板作为主控芯片。该芯片基于STM32G4系列Cortex-M4内核，支持高性能定时器与多通道PWM输出，具备丰富的ADC采样与I2C通信能力，适用于电机控制类应用。硬件电路连接如图6.1所示，完成了主控芯片与各功能模块的物理连接。图6.1NUCLEO-G474RE主控接口引脚分布图执行单元选用AE2207型号无刷直流电机，其为2207规格航模无刷电机，额定电压约12V，转速较高、惯量小，适合用于台式实验平台的响应性能测试。为配合该电机的三相驱动控制，本文使用EG2103无刷电调电路板，其支持PWM控制方式，内部集成驱动芯片IR2101与功率MOS，具备过流保护与死区控制能力。电角度检测部分，使用MT6701磁编码器模块对转轴进行角度采集。该模块采用I2C通信方式连接主控I2C1口（PB8、PB9），采样角度精度达到0.1°，可稳定反馈转轴当前机械角度，用于反馈FOC算法的闭环控制。在程序启动后，系统首先通过foc_init方法初始化控制器结构体，并通过foc_calibrate_encoder_offset方法完成初始电角度的吸附与偏移校准，随后启动TIM1三通道PWM输出实现空间矢量调制。在TIM6定时中断中执行foc_update方法实现控制主逻辑，并根据运行状态实时调节目标角度与PWM输出。在主循环中，程序持续读取磁编码器反馈角度，并在识别到稳定静止时自动执行foc_set_zero_offset函数完成零点校准。同时将当前目标角度、电流估算值、偏移角度等信息通过OLED显示屏动态展示，便于观察系统运行状态。图6.2整机运行实拍图整体系统在通电后可快速完成电角度吸附并进入闭环控制状态，具备较好的稳定性与响应性能。在后续章节中将详细展开实测结果与各场景测试数据。6.2电角度识别与极对数校准验证电角度是FOC控制算法中核心的参考变量，其准确性直接影响Clarke与Park变换的方向，进而影响整个系统的输出效果与稳定性。在实物系统中，电角度由磁编码器MT6701提供的机械角度与电机极对数共同计算得出：θ然而由于电机初始安装方向、接线极性、磁环相位等因素不同，实际运行中存在一个固定的角度偏移，若不进行校准，将导致电角度偏离转子真实磁极方向，从而使FOC控制失效或转矩输出异常。为此，系统在上电启动时执行电角度吸附校准流程。具体步骤如下：（1）强制输出电角度为0°在主控程序启动阶段，通过foc_control_elec(state,0.0f,amplitude)强制输出0°电角度，并保持一定PWM幅值（如0.03），使电机定子磁场稳定地吸附住转子某一磁极位置。（2）延时等待转子吸附稳定调用HAL_Delay(1000)延迟1秒，确保电机稳定静止在吸附位置。（3）读取当前机械角度使用函数指针get_angle_cb函数回调磁编码器角度读取函数，记录吸附时的机械角度θmech0。（4）计算实际电角度根据设定的极对数（默认为7）计算出当前吸附状态下的实际电角度θelec0=P×θmech0，并将该值作为电角度偏移量存储到state->zero_electric_offset。在后续控制流程中，每次计算电角度时，均减去该偏移量[17]：θ从而保证坐标变换与真实转子磁极方向一致，实现精准磁场定向。6.3电角度校准过程流程图该校准流程只需在上电时执行一次，且对磁编码器方向、安装偏移具有较强的适应性。在系统运行过程中，若检测到当前位置稳定不动，用户还可通过按键手动触发foc_set_zero_offset函数重新校准，实现在线精度提升。实际验证中，系统在吸附后读取的机械角度大致稳定在固定值（如52.3°），对应电角度为366.1°，自动偏移后输出磁场方向与转子方向保持一致，电流响应平稳，说明校准逻辑运行正确，电角度精度满足控制系统要求。6.3目标角跟踪与响应验证为验证所设计三闭环控制系统在实物电机中的运行效果，本节基于NUCLEO-G474RE与无刷电机构建实物控制平台，采用按键设定目标角度、OLED实时显示状态的方式，测试系统在不同控制逻辑下的响应情况。重点考察系统对目标角的跟踪能力、追踪精度与稳态保持效果。6.3.1目标角追踪响应实验系统上电后默认将电机旋转至180°作为初始目标位置，同时自动完成电角度偏移校准过程。此后可通过按键手动调整目标角度，分别以±10°步长增加或减少目标值。OLED实时显示当前目标角度（Target）与电机实际角度（Pos），用于观察闭环控制精度与响应速度。实际测试过程中，电机可在目标角度变化后迅速进行调整，平均约0.3～0.5秒内完成对位。位置响应过程平稳，无振荡现象；目标角调整后，电机能够快速逼近并稳定在设定值附近，最终误差控制在0.01°级别。该结果说明系统具备高精度的角度跟踪能力，位置环与速度环调节效果良好。6.3.2目标跳变响应测试在持续旋转状态下（按下“开始旋转”按键），可通过手动修改目标角度实现角度突变跳变测试。实测中，目标角度突变后，系统能立刻完成加减速过程并调整方向，电机迅速响应目标变化。整个过程连续、平滑，无机械卡顿或中断，验证了系统在运行状态下的动态响应能力。6.3.3电角度校准验证系统通电初始阶段，将目标角固定输出为180°，电机在磁场作用下吸附至最近稳定位置，通过读取当前机械角度并与极对数计算对应电角度偏移值，完成初始零点校准。此后系统运行中能保持电角与机械角同步。实测中观察到：初始校准完成后，实际角度与目标角一致性良好，无累计偏差现象，说明电角度自动校准机制有效。6.4扰动响应测试为验证三闭环控制系统对外部扰动的抑制能力，本节在电机稳定运行至目标角度后，通过人工扰动方式引入外力干扰，观察实际角度变化与系统恢复过程。该实验旨在评估控制系统在静止状态下的抗干扰性能与位置保持能力。（1）实验设置在系统运行稳定后，电机保持静止，目标角度与当前角度一致。此时人为施加扰动力矩，即用手轻微扭转电机转子，模拟外界机械干扰。通过OLED屏幕观察电机“实际角度”与“目标角度”的偏差情况，同时评估系统响应过程。（2）实验现象与分析实验结果显示：电机在稳定状态下具有明显的保持力矩，转子难以被手动旋转；受扰动影响时，OLED上显示的实际角度产生短时偏移，偏差最大约为2～3度；当外力释放后，系统能在极短时间内（约0.2～0.3秒）快速将转子恢复至原目标位置；整个恢复过程平稳，无震荡或超调现象，说明电流环对转矩调节迅速、位置环调节精确。上述现象表明，系统具备良好的抗扰动能力。三闭环控制结构在扰动发生后能及时检测位置偏差，快速生成补偿电流，驱动电机对抗扰动并恢复至原位，有效实现位置保持功能。（3）工程意义相比传统开环驱动，本文所用闭环控制结构能在静止状态下提供稳固的保持能力，适用于对“抗扰、稳位”有高要求的应用场景，如精密定位设备、伺服执行器等。6.5三相PWM与等效电压波形分析为验证控制系统输出的三相电压波形是否符合预期，进一步确认电角度与PWM调制的匹配关系，本节选取了两组典型运行状态：电角度固定为60°的稳态输出，以及连续旋转过程中的动态输出，分别记录其三相PWM波形与平均等效电压变化，并进行分析。（1）固定电角度下的PWM波形分析图6.4展示了系统在电角度固定为60°时，三相A/B/C的PWM占空比波形。在这一状态下，虽然三相波形在时域上等周期分布，但由于PWM频率较高，肉眼无法清晰辨识电角度相位差。但通过观察波形的顶部与底部形状可见：A相（红色）为典型“T形”：顶部较宽、底部尖锐，表示占空比高；B相（绿色）呈现“倒T形”：顶部尖锐、底部宽，表示占空比低；C相（蓝色）上下宽度接近，接近于50%占空比。图6.4固定电角度60°下三相PWM波形图此三相PWM分布特征虽然无法直观展示120°相位差，但已具备调制形态的对称性和相对幅值关系，说明系统内部的dq变换与SVPWM调制逻辑执行正常。（2）固定电角度下的等效电压分析图6.5为在相同固定电角度（60°）下的三相平均等效电压结果（通过PWM占空比求平均后绘制）：A相电压最高，B相最低，C相居中；三相电压呈现合理的分布梯度，满足电角度60°下的正弦分布要求。图6.5固定电角度60°下三相等效电压曲线该图比原始PWM更直观地呈现了相对幅值关系，清晰地反映了当前电角度下三相电压输出幅值之间的对称与差异，验证了电角度计算、逆Park变换及Clarke变换后的调制结果准确。（3）连续旋转过程下的PWM波形图6.6展示了系统在旋转状态下的三相PWM波形变化。由于电角度持续变化，三相PWM信号随之连续调节，占空比呈周期性波动：三相PWM之间存在明显错位关系，但难以通过肉眼直接判断相位差是否为120°；观察上可见三相“密集—稀疏”的交替规律，符合周期性调制趋势；整体波形平稳，无抖动、缺相或突变现象，系统连续性良好。图6.6旋转过程中三相PWM波形图说明控制系统在运行中能够根据