水下机器人的驱动系统仿真无刷直流电动机仿真.doc

1、水下机器人的驱动系统仿真-无刷直流电动机仿真摘 要因为导师还没有给我具体的方向，只是让我先了解水下机器人的相关知识。所以我只是对机器人的整体有个了解，还没有做深入的研究，望老师理解！因此本文首先就自治水下机器人（AUV）的数学模型和三维模型及工作原理等相关知识做了介绍，主要仿真部分是在水下机器人的动力系统。本文只是选里一个方向的动力推动，其他方向的推动系统没有仿真。本文把无刷直流电动机作为水下机器人的动力系统，并用simulink对其进行仿真。目 录1 绪论11.1 研究意义11.2 AUV的介绍11.3 国内外AUV研究动态22 水下机器人的总体设计及建模32.1 AUV 物理模型32.2

2、AUV的动力学分析52.2.1 坐标系62.2.2 定义运动参数62.2.3 受力分析73 水下驱动系统113.1 驱动方式的选用113.2 推力器的组成113.3 能源供给方式的选用124 AUV动力装置无刷直流电机驱动系统仿真134.1 无刷直流电机的基本结构134.2 无刷直流电机的工作原理134.3 控制策略选择3144.4 电动机本体的建模164.4.1 无刷直流电机的数学模型4164.4.2 无刷直流电机本体的建模184. 5 驱动系统建模244.5.1 速度控制模块264.5.2 参考电流模块274.5.3 电流滞环控制模块7294.5.4 电压逆变器模块305 仿真结果及分析3

3、25.1 建模仿真参数设定325.2 仿真环境输入值设定325.3 仿真结果及分析335.3.1 绕组电流仿真结果335.3.2 反电动势仿真结果345.3.3 转过角度及转子位置仿真结果355.3.4 电机转速仿真结果365.3.5 输出转矩仿真结果376 总结38参考文献39致谢40- 40 -1 绪论1.1 研究意义近年来国外水下机器人技术发展迅速，技术水平较高。其中，具有代表性的产品有：美国Video Ray 公司开发出的Scout、Explorer、Pro 等系列遥控式水下机器人，美国Seabotix公司研发的LBV-ROV 系列，英国AC-CESS 公司的AC-ROV系列。随着海洋

4、开发、探测的需求越来越强，水下机器人成为全世界研究的热门课题。小型自治水下机器人具有低成本、小型化、操作灵活等特点成为近年来国内外研究的热点。自治水下机器人（Autonomous Underwater Vehicles, AUV）,载体采用模块化设计思想, 可根据需要适当增减作业或传感器模块, 载体采用鱼雷状流线外形, 总长约2 m, 外径25 cm, 基本模块包括推进器模块、能源模块、电子舱模块、传感器模块以及GPS、无线电通讯模块, 基本传感器有姿态传感器、高度计、深度计和视觉传感器, 支持光纤通讯, 载体可外挂声学设备, 通过光纤系统进行遥控操作可实现其半自主作业, 也可在预编程指令下实

5、现自主作业。系统基本模块组成设计如图1-1 所示1。它具有开放式、模块化的体系结构和多种控制方式（自主/半自主/遥控），自带能源。这种小型水下机器人可在大范围、大深度和复杂海洋环境下进行海洋科学研究和深海资源调查，具有更广泛的应用前景。在控制系统的设计过程中充分考虑了系统的稳定性和操纵性。控制器具有足够的鲁棒性来克服建模误差，以及水动力参数变化。1.2 AUV的介绍当前水下机器人的种类很多，其中载人潜器、有缆潜器(ROVs)和自治水下机器人(AUVs)是三类最重要的潜器，自治水下机器人AUVs是英语“自治水下潜器”(Autonomous Underwater Vehicles)的缩写。AUVs

6、不配备主缆和系缆，因此它又称为无人无缆水下机器人(Unmanned Untethered Vechiles缩写UUVs)。这类水下机器人携带能源，依靠自身的自治能力来管理自己、控制自己，以完成赋予它的使命，自治水下机器人也就因此得名。由于微电子技术、计算机技术、人工智能技术、导航技术的飞速进展，再加上海洋工程和军事活动的需要，国外产业界和军方再次对无缆水下机器人发生了兴趣。许多研究表明，无缆水下机器人是一种非常适合于海底搜索、调查、识别和打捞作业的既经济又安全的工具。与载人潜水器相比较，它具有安全(无人)、结构简单、重量轻、尺寸小、造价低等优点。而与ROVs相比，它具有活动范围大、潜水深度深、

7、不怕电缆缠绕、可进入复杂结构中、不需要庞大水面支持、占用甲板面积小和成本低等优点。1.3 国内外AUV研究动态海洋机器人在过去几十年间为世界各国的海军、石油开发和救援打捞开辟了崭新的活动领域。用这种高度计算机化、有的已开始了不需要人进行控制的机器人进行探索海底，可提供关于海底的大量数据。当今世界各国的一些主要的海洋研究中心倾注很大的精力正在研制或使用数十种可深潜的海底机器人。在技术方面，美国的水平领先于世界，欧洲各国其次，而日本要落后于美国和欧洲。这些机器人的造价与载人潜水器相比，造价低得多，但更加安全，而且可长时间在压力很大的海底工作。从上世纪90年代中期以来，自主式水下航行器(AUV)在海

8、洋科学调查以及军事领域得到越来越广泛的应用。截止到2005年，世界上共研制了约70艘AUV，AUV已经多次成功地应用于海底石油与天然气、天然气水合物、大洋多金属结核和热液硫化物矿床等海洋矿产资源的探测。AUV的最新应用主要体现在水雷搜索，冰下探测以及水下作业中。目前，美国在开发工作方面正朝着无缆预编程式(即自主式)海底机器人的方向发展。在过去的20年里，全球各主要国家所研制的AUV，其中美国占了一半。就其性能而言，应数美国海军的水下搜索系统(AUSS)和新罕布什尔州大学的小型AUV，即试验性的自主式EAVEEAST，主要用于水下管道和平台的检查。美国AUV的研究和开发经费90%来自国防部的财政

9、支持，主要通过国防高技术研究项目局(DARPA)和海军有关部门给予拨款。早在1988年，国防高技术研究项目局提出了开发既像无人潜水器UUV那样自由浮游，又像登陆艇那样能离开水域进入内陆的两栖性自主式机器人。美国海军控制和海洋监测中心于1983年推出了先进的自主式无人搜索系统(AUSS)，本系统的外形尺寸为510cm75cm，有效负荷不定。系统用银锌电池作为动力源，系统配置了侧扫声纳、前视声纳、35mm静物照相机、CCD水下摄像机。导航系统由多普勒声纳、先进的精密陀螺仪和周期性更新的水声通道组成；水面母船借助LBL发射应答网执行跟踪任务。现在AUSS为第二代先进的作业型自主式海底机器人，潜航深度

10、6000m，用于评价深海海底搜索技术和执行深海海底搜索作业使命。我国在军用AUV的研究中也取得了很好的成绩，研制出三型军用智能水下航行器。其试验平台“智水II号”于1995年夏进行了湖试，在自主导航、自主避障和自主简单作业等方面取得了成功的试验验证和宝贵的试验数据。此外，北京航空航天大学目前正致力于仿生机器鱼的研究，已研制出多种形式的仿生机器鱼，为水下航行器新型推进器技术和新型结构的研究，奠定了良好的基础。2 水下机器人的总体设计及建模2.1 AUV 物理模型三维建模的基础就是二维图纸的设计，三维建模成功与否在很大程度上决定于零件和装配的设计精度，所以在完成设计工作时，应该在满足强度要求的前提

11、下，根据装配关系进行零件设计。完成整体分析后，先由AutoCAD完成了设计的装配图、零件图，确定各部分尺寸，然后开始用SolidWorks建模。所设计的三维图主要包括：（1）高压舱(如图2.1)主要由高压舱盖、舱体、高压球舱盖三部分组成，共有2个，每个高压舱由两个卡箍固定于框架之上。材料选用6063合金，该材料主要合金元素是镁和硅，具有极佳的加工性能，优良的可焊性、电镀性，良好的抗腐蚀性、韧性，阳极氧化效果优良。图2.1 高压舱（2）框架（如图2.2）支撑作用，上面固定有高压舱、推进器、声纳等，是由352的钢管焊接而成，上面有8处配焊，作用是固定卡箍。框架要先进行密封性试验，在海底工作时，钢管

12、内部充满氮气，抵消部分海水压力，防止其在海底工作时发生变形。图2.2 AUV框架（3）推进器推进器作为整个AUV动力来源，共有两种，一种是水平推进器，共两个，另一种是竖直推进器，共三个，通过推进器固定架将其固定于框架之上，各个推进器独立工作，相互协作实现对整个AUV姿态的控制。推进器上固定有导流罩，主要作用就是在运动中对迎面而来的海水阻力进行分割化解，从而达到降低阻力的效果。（4）声纳声纳主要是利用水中声波对水下目标进行探测、定位和通信的电子设备，是水声学中应用最广泛、最重要的一种装置。它是该海底机器人主要的探测装备，包括大小声纳各一个，分别安装在AUV前端的上下部位。所设计的三维模型如图2.

13、3所示：图2.3 AUV 总装图大声纳；框架；竖直推进器；高压舱；小声纳；卡箍；水平推进器此AUV重208kg，总排水量206L，长1500mm，宽1240mm，高920mm，工作深度为800m，压强约为8MP，温度约为2，正常工作时的速度2m/s，主要用于深海探测。2.2 AUV的动力学分析对5自由度AUV的动力学与运动控制进行研究，应该考虑重力、浮力、推力以及水动力的影响，建立水下机器人的动力学模型，对机器人的复杂水下动力学行为进行描述。研究水动力的意义：一是从操纵性的角度研究水下机器人载体的稳定性和快速型，另一方面在设计控制系统时需要考虑水动力的影响，以便建立AUV的数学模型。2.2.1

14、 坐标系为便于研究AUV的运动、数学建模与控制，需建立两个正交坐标系。先建立地面坐标系E-作为静坐标系，E为海平面一点，以海平面出发点为原点，E、E为水平面如图2.4所示：ExGzy 图2.4 静坐标系、动坐标系另外为了便于分析AUV还要建立载体坐标系即动坐标系，它与海底机器人固定在一起，Gx与其轴向一致，Gy指向右舷方向。本课题所研究的对象在海底的运动是5自由度的空间运动，包括沿x、z轴的平动和绕x、y、z轴的转动，由5个推进器来实现。2.2.2 定义运动参数机器人重心G的空间速度矢量在水平面内的投影；机器人重心G的空间速度矢量在纵垂直面内的投影；u、v在水平面内沿Gx、Gy方向的分量；u、

15、w在Gx、Gz方向的分量；p、q、r沿Gx、Gy、Gz轴的角速度；横倾角，Gy轴和E轴间的夹角；纵倾角，Gx轴和E轴在纵垂直面的夹角；艏向角，Gx轴和E轴在水平面的夹角。2.2.3 受力分析为了设计AUV的控制系统，首先需要建立机器人的动力学模型。在水下运动的机器人系统是一个非线性的动力学系统，需要确定的参数较多。由于技术和测试条件的限制，有些参数无法准确测定或者无法测定。为了控制的需要，有必要对系统进行必要的简化，而只考虑对系统性能起主要作用的影响因素，这里主要考虑重力、浮力、推力和水动力对机器人的影响。1.AUV在水中所受的合外力可用下式表示：（注：该方程为矢量方程，为矢量和） （2-1）

16、其中：作用在AUV上的水动力；AUV的浮力；AUV的重力；所有推进器推力之和；第i个推进器的推力；n推力器的总数，该处为n=5。AUV所受的合外力矩方程：（注：方程为矢量方程） （2-2）、分别为水动力、浮力、重力以及推进器推力所产生的力矩。2. 力学分析(1)推力 （2-3）n转速D螺旋桨直径（113mm）推力系数（经验值）海水密度(1030)（2）轴向力方程： （2-4）等号左边描述了水下机器人合力作用下的运动规律，右边第一项和第三项分别是角速度和速度引起的非线性水动力，第二项是惯性水动力，第四项是推力，第五项是重力和浮力。（3）侧向力方程： （2-5）（4）垂向力方程：（2-6） （5）

17、摇力矩方程、纵力矩方程、偏航力矩方程 （2-7） （2-8） （2-9）式中为推力在坐标轴x、y、z上的投影；为x、y、z轴的推力矩。（6）根据运动学知识可以将水下机器人姿态角与运动坐标系中角速度的关系可以表示为： （2-10） （2-11） （2-12）（7）水下机器人重心与动坐标系原点重合，水下机器人的运动轨迹（2-13） （8）有海流（海流速度为U（）时则水下机器人相对于海流的速度为： （2-14） （2-15） （2-16）若考虑海流作用时，用相对海流的速度代替前面公式中的速度即可。本章为研究机器人总体的运动分别建立了地面坐标系和体坐标系，定义了各运动参数。对海底机器人的运动过程，给出

18、了其各方向的受到的合力及力矩方程，并给出了其轨迹方程，由于部分水动力参数需经过海试或湖试才可以得出，故此只给出计算公式。3 水下驱动系统3.1 驱动方式的选用几乎所有的水下机器人都采用螺旋桨式推进器。80% 以上采用电机推进器，其余采用油压电机推进器。水下机器人要实现水下空间的六维（六自由度）运动，即三个平移运动：推进（Surge，沿x 轴）、升沉（Heave，沿z 轴）、横移（Sway，沿y 轴）和三个回转运动：转首（Yaw，绕z 轴）、纵倾（Pitch，绕y 轴）、横摇（Roll，绕x 轴）。为使水下机器人在所有六维上的运动都是可控的，须适当选用推进器的数量和给予不同的布置。根据本水下机器

19、人的使用目的，不需要使用六维运动，只要三个自由度即可，即推进、升沉和转首。我们选用了五个直流电机推进器，分别布置在机器人本体的水平左右两侧和后部部垂直处，左右推进器完成推进和转首两个动作，垂推进器完成升沉动作。3.2 推力器的组成推力器是由电机和螺旋桨组成的，水下机器人用的电机需要密封。密封主要有两种方式，一种是机械密封，另一种采用磁耦合器。机械密封相对而言比较简单，但因密封处要承受海水的压力，其特性因摩擦力的增加而变坏。对电机来说，则表现为电机的空载电流增大（有时会增大1-3倍），这样的电机用于推力器，会使启动电压升高，从而加重推力器非线性。为了改善这种情况可以采用充油电机，由于电机内部充油

20、，因而耐水压的性能得到极大的改善，而且电机因密封而引起的摩擦力要小得多，其空载电流的增加也很小，故可以忽略不计。 采用磁耦合器就是利用电磁力传递扭矩，这样减速器和螺旋桨之间没有直接的机械联系。依据磁场传递扭矩，密封问题很容易解决，只要用非导磁材料将电机、减速器包围起来就解决了动密封难题。采用磁耦合器，推力器的效率略有下降，但性能基本上不受影响。电机的转速与螺旋桨的转速不一定完全匹配，为了得到较高的效率，需要采用减速器，有时为了减小尺寸，采用高速电机（例如采用10000转/分以上的高速电机），这时也需要减速器。这样组成的推力器如图3-1所示。图3-1 推力器组成图3-2 螺旋桨与推进器示意图考虑

21、带定子的导管桨在无限宽广的静止流体域中工作的情况。设流体为理想且不可压缩。如图3-2所示，建立固定于导管上的直角坐标系O-xyz，以螺旋桨桨叶参考线与桨轴交点为原点，x 轴与桨轴中心线重合，指向桨的下游，y 轴垂直向上，z 轴方向由右手法则确定。推进器工作时，导管、定子与桨共同沿x 轴负方向以匀速V0 前进，同时桨叶绕x 轴以等角速度旋转5。3.3 能源供给方式的选用其能源供给方式有两种选择：有缆方式或无缆方式，对于无缆水下机器人能源供给一般在机器人舱体安装蓄电池或是带燃油发电机组，这就造成水下机器人本体体积庞大、超重，此外蓄电池所储存的能力有限，且受电池质量、充电工艺等因素的影响。根据实际应

22、用环境，此机器人工作所要求的行走距离不是很大，故设计时采用了有缆远程遥控方式，这样既可减小本体尺寸、重量，又保证了控制操作的有效性和可靠性，当设备出现不可预料的故障时可通过缆线撤回安全区域，不至于丢失。4 AUV动力装置无刷直流电机驱动系统仿真4.1 无刷直流电机的基本结构有刷直流电机具有旋转电枢和固定的磁场，因此有刷直流电机必须有一个滑动的接触机构-电刷和换向器，通过它们把电流传给旋转着的电枢。无刷直流电机却与有刷直流电机相反，它具有旋转的磁场和固定的电枢。这样，电子换相线路中的功率开关器件可直接与电枢绕组连接。在电机中，装有一个转子位置传感器，用来检测转子在运行过程中的位置。它与电子换相线

23、路一起，代替了有刷直流电机的机械换向装置。综上所述，无刷直流电机有电机本体、转子位置传感器和电子换相线路三部分组成，如图4-1所示。无刷直流电机电机本体转子位置传感器电子换相电路图4-1 无刷直流电动机结构4.2 无刷直流电机的工作原理总的来说，无刷直流电机的基本工作原理是借助转子位置传感器测得的位置信号，通过驱动电路，驱动逆变电路的功率开关元件，使电枢绕组依一定顺序馈电，从而在气隙中产生步进式旋转磁场，拖动永磁转子旋转。随着转子的转动，转子位置信号依一定规律变化，从而改变电枢绕组的通电状态，实现无刷直流电机的机电能量转换。图4-2 无刷直流电机工作原理框图无刷直流电机有多相结构，可分为半桥驱

24、动和全桥驱动，全桥驱动又分成星形和角形连接以及不同的通电方式。目前三相星形全桥驱动方式以绕组利用率高、转矩的波动较小和电路成本较低的优势而使用最多，在本文的设计中使用该种驱动方式，下面主要针对该种驱动方式加以介绍。图 4-3是三相无刷直流电机星形全桥驱动方式的电路原理图。 图4-3 三相星形连接全桥驱动电路图中VT1-VT6为六个MOSFET功率管，起绕组开关作用。多数情况下，无刷直流电机的转子位置信号通过传感器发送到控制器，控制器根据相关的位置信息采用一定的控制策略输出一定规律的控制信号。这个控制信号经驱动电路后实现对六只功率管的“开关”控制，从而完成“逆变”过程。4.3 控制策略选择3无刷

25、直流电动机具有有刷直流电动机那样优良的调速性能，其转速调节及输出性能在很大程度上取决于系统控制器的合理设计。就驱动用无刷直流电动机的速度控制而言，有开环和闭环两种控制方式。在开环控制中，转子位置传感器产生的转子位置信号被检出后，送至转子位置译码电路，经放大和逻辑变换形成正确的换相顺序信号，去触发、导通相应的功率开关元件，使之按一定的顺序接通或关断相绕组,从而电机可按一定的转速旋转。该类开环控制电机的转速受预定速度控制信号的影响，因此加载时转速会下降，其下降的幅度与电机本体的机械特性及控制器的设计有直接关系。在闭环控制中，一般是将反映电机的转速信号与预定转速控制信号相比较、放大后，用其差动量去校

26、正控制对象，直至控制转速在一定范围内达到平衡。为了进一步改善系统的稳态和动态性能，通常采用转速、电流双闭环调节器的控制策略。如图4-4所示，本系统采用速度环和电流环串联的双闭环控制结构，当电机处于自同步运行状态时，控制器根据测出的电机位置切换信息计算出当前转速，速度给定信号与当前转速在DSP中进行PID计算（速度环）得到电流的参考值，电机绕组电流反馈信号由采样电阻从A/D口送入DSP，A/D转换得到当前电流值，将当前电流值与电流参考值进行PID计算（电流环），最终通过电流环的PID调节算法计算PWM占空比的控制量，实现对电机驱动波形的脉宽调制，从而控制电机达到预定的转速。从闭环结构上看，电流调

27、节环在里面，叫做内环；转速调节环在外边，叫做外环。这样就形成了一个无刷直流电机转速、电流双闭环控制系统。图4-4速度环和电流环串联的双闭环控制结构图4.4 电动机本体的建模为了更好的理解无刷直流电机的工作原理和内在的数学模型，本文利用simulink搭建了基于无刷直流电机的仿真模型，并在整体的驱动系统中进行了验证，证明了电机数学模型和仿真模型的正确性。无刷直流电机的仿真模型的搭建是基于其准确的数学模型基础上的，其数学模型的准确性直接影响到仿真模型的仿真效果。下面就无刷直流电机的数学模型进行简要介绍。4.4.1 无刷直流电机的数学模型4预建立无刷直流电机的数学模型，需要在合理的范围内对其进行必要

28、的简化，因此假定：l 定子星形连接，三相绕组完全对称，工作在二相导通，三相六状态下；l 反电势波形是平顶宽度为120电角度的梯形波；l 电机在工作过程中磁路不饱和,不计涡流和磁滞损耗,；l 气隙均匀，磁场为方波,定子电流、转子磁场分布皆对称,电枢绕组在定子内表面均匀连续分布；l 忽略电枢效应、齿槽效应。在以上假设条件下，可以得到无刷直流电机的数学模型如下：（一）、绕组电压方程（基尔霍夫电压定律）利用基尔霍夫电压定律（KVL）可以得到三相绕组的电压平衡方程：其中：、为定子相绕组电压（V）；、为定子相绕组电流（）；、为定子相绕组电动势（V）；为电机相电阻；为每相绕组的自感（）；为每两相绕组间的互感

29、（）。为微分算子，p=d/dt. 由绕组电压方程可知，无刷直流电机的等效电路如图4-5所示：图4-5无刷直流电机的等效电路图（二）、电磁转矩方程无刷直流电机的定子绕组输入功率与产生的电磁转矩关系为：故无刷直流电机的电磁转矩为：其中，为电机的机械角速度（rad/s）。无刷直流电机的电磁转矩是由定子绕组中的电流与转子磁钢产生的磁场相互作用而产生的，由上式可见，电机电磁转矩与磁场和相电流成正比，与转动角速度成反比。（三）、电机运动方程无刷直流电机的运动方程为：式中，TL为负载转矩，J为电机转动惯量。4.4.2 无刷直流电机本体的建模基于以上介绍的无刷直流电机的数学模型，本文进行了电机本体的仿真模型建

30、模，其主要包括电压方程模块、电机反电动势模块、电机转矩计算模块等模块组成。（一） 电压方程模块根据无刷直流电机的绕组电压方程可以建立无刷直流电机的电压方程模块，并将其封装成为子系统如下图所示：图4-6 电压方程模块及其封装（二） 电机反电动势模块从绕组电压方程和由电压方程建立的电压方程模块我们可以看出，无刷直流电机的建模需要知道绕组反电动势。在无刷直流电机本体的建模过程中，反电动势的建模是关键问题之一。反电动势波形不理想会造成转矩脉动增大、相电流不理想等问题。对于反电动势的求取一般有以下几种方法： 1.有限元法5 它是以变分原理为基础，将电磁场理论与磁路等效模型相结合，根据微分方程及边界条件，

31、求解有限元方程组，得到节点上的位函数，建立反电动势的波形。应用有限元法求得的反电动势脉动小，精度高，但方法复杂，专业性强，不宜推广。 2.FFT法傅里叶变换（FFT）法是通过将理想反电动势波形中包含的各次谐波分量谐波叠加来得到近似的反电动势。FFT法应用简单，但其计算量较大，利用它进行仿真时效率较低。 3.分段线性法6 分段线性法是将无刷直流电机的绕组反电动势的一个运行周期分为6个阶段，如图4-7所示，对于每一相绕组，每60为一个运行阶段，每个阶段用一条直线表示，并且各相绕组相位相差120。根据某时刻转子位置和转速信号就可以确定该时刻各相绕组的反电动势波形。图4-7 反电动势波形分段线性法具有

32、简单易用，精度较高等优点，本文选择分段线性法用于求取绕组反电动势，其中分段线性法有三种方法： s函数 embedded function 查表法本文选择查表法，其仿真结构及其封装如图：图4-8 反电动势模块及其封装如上图所示，反馈回来的转子位置信号position（范围为02）经过Lookup Tablet模块，与转速信号增益后分别相乘，得到三相绕组的反电动势。其中Lookup Tablet模块是完成查表法的关键环节，它通过设置输入位置信号范围内的几个值及其对应的输出值，就可以插值完成输出波形。（三） 电机转矩计算模块依据电机电磁转矩方程和电机运动方程设计电机的转矩计算模块如下图所示：图4-9

33、 电机转矩计算模块及其封装转矩计算模块用于计算给定条件下电机所能产生的电磁转矩，并且在负载TL情况下计算电机转速（角速度）以及位置信号position，用于上面所述电机反电动势模块的输入信号。其中：图4-10所示为转子位置检测模块，它利用MATLAB的rem()函数实现转子位置的检测，从而作为反电动势模块的输入信号。输出的转子位置信号(position)的范围是02。图4-10 转子位置检测模块综上，对上述环节的建模完成后，就可以通过适当的链接完成电机本体总模型的建模，各环节的链接及电机本体的总模型如图4-11所示。图4-11 电机本体的总模型及其封装4. 5 驱动系统建模利用MATLAB7.

34、0 的simulink模块对无刷直流电机驱动系统进行建模，建立的整体驱动系统如图4-12所示。BLDC的驱动仿真模型采用双闭环控制：其转速环采用PID控制器构成，电流环采用电流滞环调节器构成。图4-12 无刷直流电机驱动系统模型无刷直流电机驱动仿真系统的工作原理可简要介绍为：预定的转速信号（n-ref）与实际转速信号n进行比较，求其偏差e,经PID控制器计算得电流幅值信号Is，参考电流模块（reference current）利用PID控制器输出的电流幅值信号Is和反馈的转子位置信号（position）计算三相绕组各自的参考电流iar、ibr、icr，然后经电流滞环控制模块（Current C

35、ontroller）实现各相实际电流ia、ib、ic对参考电流iar、ibr、icr的滞环跟踪，输出PWM逆变器控制信号(Pulse)，用于控制逆变器模块（MOSFET Diode）的导通和关断，从而产生驱动电机的输入相电压ua、ub、uc，同时在给定时间对电机施加给定的负载转矩tl，利用示波器观察各相电流（i_abc）、各相反电动势（emf）、电磁转矩（Te）、转过角度及转子位置（theta）和转速（n），并反馈给前面的模块作为反馈信号，实现闭环控制。BLDC的驱动仿真模型按照功能模块划分主要由下列几部分模块构成：速度控制模块、参考电流模块、电流滞环控制模块、电压逆变器模块和电机本体模块几部

36、分组成。其中电机本体模块的建模在上一节已经进行了详细的介绍，这里不再赘言。下面对其余几个模块进行详细的说明。4.5.1 速度控制模块BLDC驱动系统的速度环控制由速度控制模块实现，其结构如图4-13所示，图4-13 速度控制模块速度控制采用PID控制器实现，转速预设值（n_ref）与反馈回来的实际转速信号（n）求其差值e，输入PID控制器作为其输入，经PID算法计算后输出电流幅值信号Is，作为参考电流模块的输入信号。离散PID控制器的内部结构如图4-14所示，其中Kp为控制器的比例系数，Ki为控制器的积分系数，Kd为控制器的微分系数，限幅模块用于使输出的电流幅值信号Is限定在要求的范围内。图4

37、-14 离散PID控制器的内部结构PID控制器的三个控制参数Kp 、Ki、Kd分别具有不同的作用，(1) 比例系数Kp的作用： 比例系数加大，使系统的动作灵敏，速度加快，稳态误差减小。Kp偏大，振荡次数加多，调节时间加长。Kp太大时，系统会趋于不稳定。Kp太小，又会使系统的动作缓慢。(2) 积分控制Ki的作用： 积分环节使系统的稳定性下降，Ki小（积分作用强）会使系统不稳定，但能消除稳态误差，提高系统的控制精度。 (3) 微分控制Kd的作用： 微分环节可以改善动态特性，Kd偏大时，超调量较大，调节时间较短。Kd偏小时，超调量也较大，调节时间也较长。只有Kd合适，才能使超调量较小，减短调节时间。

38、PID控制器的参数设定如图4-15所示：图4-15 PID控制器的参数设定4.5.2 参考电流模块参考电流模块如图4-16所示，其作用是根据PID控制器输出的电流幅值信号（Is）和反馈回来的转子位置信号（position）确定三相绕组各自的参考电流，用于下一级电流滞环控制模块的电流滞环控制。图4-16参考电流模块参考电流模块的功能是利用转子位置信号确定三相各自的参考电流，其对应关系可以用表4-1来表示。表4-1 转子位置和三相参考电流之间的对应关系表转子位置I_arI_brI_cr0/3Is-Is0/32*/3Is0-Is2*/30Is-Is4*/3IsIs04*/35*/3-Is0Is5*/

39、320IsIs参考电流模块的功能是通过simulink的Embedded MATLAB Function模块来实现的，其具体的代码为：function iar,ibr,icr = current(is,pos)% This block supports an embeddable subset of the MATLAB language.% See the help menu for details. iar=is;ibr=-is;icr=0;if(pos=0&pos=pi/3&pos=2*pi/3&pos=pi&pos=4*pi/3&pos=5*pi/3&pos=2*pi) iar=0;

40、ibr=-is; icr=is;end4.5.3 电流滞环控制模块7电流滞环控制模块用于实现电机双闭环控制中的电流环控制，实现实际电流跟随参考电流变化的目的。其原理是如图4-17示，给定一固定的滞环宽度HB，当反馈的实际电流瞬时值i达到参考电流i*的滞环宽度上边沿时，输出的PWM波变为低电平，开关器件关闭，从而使绕组电流逐渐下降；当反馈的实际电流瞬时值i下降到参考电流i*的下边沿时，输出的PWM波变为高电平，驱动开关器件导通，从而使绕组电流上升。如此反复，从而实现实际电流跟随参考电流变化的目的。图4-17电流滞环控制原理电流滞环控制模块结构及封装如图4-18所示：图4-18 电流滞环控制模块结

41、构及封装4.5.4 电压逆变器模块电压逆变器模块的功能是实现电池电压到电机供电电压的DC/DC变换，在电流滞环控制模块输出的PWM波形的控制下调节电机输入绕组电压，从而控制电机的转速。电压逆变器模块如图4-19所示，它采用SimPowerSystems工具箱的直流电源模块（DC Voltage Source）和全桥模块（Universal Bridge），其中全桥模块选择桥臂数为3个，功率器件为MOSFET，电流滞环控制模块输出的PWM波形（Pulse）控制MOSFET的导通与关断，从而实现对无刷直流电机的三相全桥控制。在MATLAB 7.0中，SimPowerSystems工具箱里的模块与S

42、imulink工具箱里的模块不能直接相连，因此，全桥模块（Universal Bridge）与电机本体模块之间加上了三个受控电压源，实现两者的连接。图4-19 电压逆变器模块5 仿真结果及分析在MATLAB/SIMULINK环境下，根据上面建立的电机本体模型和BLDC驱动系统模型进行电机双闭环控制系统的仿真。5.1 建模仿真参数设定在系统的建模过程中选定的建模和仿真参数分别为：BLDC电机参数设置为：电机定子相绕组电阻R2.8750，定子相绕组自感与自感之差L-M0.02，转动惯量J0.005kgm2，阻尼系数B=0.0002Nms/rad，额定转速n1000r/min，极对数p4，直流电源供

43、电电压为220V。离散PID控制器三个参数：比例系数Kp=3，积分系数Ki=0.02，微分系数Kd=0（无微分环节），电流幅值信号Is限幅范围为-35+35，采样周期T=0.0001s。5.2 仿真环境输入值设定为了验证所设计的无刷直流电机驱动控制系统仿真模型的静、动态性能，我们设定电机空载起动，待进入稳态后，在t0.5s时加上负载TL3Nm。5.3 仿真结果及分析5.3.1 绕组电流仿真结果图5-1所示为在给定参数和环境下绕组电流的仿真波形图：图5-1 绕组电流仿真波形图由图示可以看出，在n=1000r/min的参考转速下，电流经过短暂时间的波动之后，绕组电流值趋近平稳，由于有电流限幅环节的作用，相电流波动时冲击不大。由于初始阶段输入转矩为0，电机不对外做功，所以电流值几乎为零（由于电机中阻尼系数B的存在，电流稍大于零）；从t=0.5s开始，对电机施加转矩为TL=3Nm的负载，电机绕组中产生周期性的电流，三相电流电角度相差120，此时电流产生的电磁转矩与负载转矩及阻尼力之和相平衡。5.3.2 反电动势仿真结果图5-2所示为在给定参数和环境下绕组反电动势的仿真波形图：图5-2 绕组反电动势仿真波形图从上图可以看出，由分段线性法得到的电机三相绕组的反电动势仿真波形呈周期性的梯形，且三相绕组的反电动势电角度相差120