电机伺服控制系统的研究与开发毕业论文

1、图书分类号: 密 级:毕业设计（论文）题目：电机伺服控制系统的研究与开发学生姓名 班 级 学院名称 专业名称 指导教师学位论文原创性声明本人郑重声明：所呈交的学位论文，是本人在导师的指导下，独立进行 研究工作所取得的成果。除文中已经注明引用或参考的内容外，本论文不含 任何其他个人或集体已经发表或撰写过的作品或成果。对本文的研究做出重 要贡献的个人和集体，均已在文中以明确方式标注。本人完全意识到本声明的法律结果由本人承担。论文作者签名： 日期：年月日学位论文版权协议书本人完全了解关于收集、保存、使用学位论文的规定，即：本校学生在 学习期间所完成的学位论文的知识产权归所拥有。有权保留并向国家有关部

2、 门或机构送交学位论文的纸本复印件和电子文档拷贝，允许论文被查阅和借 阅。可以公布学位论文的全部或部分内容，可以将本学位论文的全部或部分 内容提交至各类数据库进行发布和检索，可以采用影印、缩印或扫描等复制 手段保存和汇编本学位论文。论文作者签名： 导师签名：日期：年 月 日日期：年 月 日电机伺服控制系统的研究与开发1.总体设计思想该系统是针对直流电动机开发设计的智能控制器。包括人机交互界面（键盘跟 lcd显示器）、主mcu控制模块以及电机驱动三大部分。该系统的主耍功能是实现电 机的速度伺服控制。首先通过键盘输入标准速度，两个电机都将以此速度为标准进 行调速，电机在运行过程中将一直保持此速度匀

3、速前进，如果由于外界条件的变化 使得电机速度发生变化，该控制系统将自动进行调速，直到达到标准速度为止。电 机在运行过程中将运行状况实时显示在lcd上，直观清晰。整个系统采用的是闭环 控制，对数据的处理也是采用实时计算的方法，能够适应齐种不同的外界条件。电 路采用高速微处理器实现智能控制，内建pi运动控制数字模型，可控制电机的转速 转向以及行驶距离，功能齐全，集成度高，体积小，工作稳定可靠，能为电机运动 精密控制方面提供完整的解决方案。既可作为运动系统的智能驱动模块使用，也可 单独对运动系统的各种运动功能进行精确的控制。根据对控制系统的基木要求，做出如图1的系统设计方案。直流伺服电动机驱动模块

4、直流伺服电动机v键盘输入mc u速度检测v显示模块图1:系统结构图2.各模块方案选择与论证2. 1 mcu的选择方案一采用fpga （现场可编程门列阵）作为系统的控制器fpga可以实现各种复杂的逻辑功能，规模大，密度高，它将所有器件 集成在一块芯片上，减少了体积，提高了稳定性，并且可应用eda软件仿真、 调试，易于进行功能扩展。fpga采用并行的输入输出方式，提高了系统的 处理速度，适合作为大规模实时系统的控制核心。但是，fpga的成本札i对 较高，同时本系统用到各种延时程序，fpga的编程难度较大，同时由于芯 片的引脚教多，实现硬件电路板布线复杂，加重了电路设计和实际焊接的工 作。方案二采用

5、dsp控制器tms320lf247芯片作为dsp控制器24x 一族tms320lf24x系列的新成员, 是tms320c2000平台下的一种定点dsp芯片，几种先进的外设被集成到芯片 内，形成了真正的单芯片控制器，是一种低成本，低功耗，功能强大的电机 运动数字化控制升级产品。其cpu芯核为16位，运算速度是30mips之间。 6路脉宽调制pwm输出，可用于变频调速系统中对电机的控制。3路捕获单 元cap,可用于纪录脉冲的宽度，从而可以为fft算法提供时间基准以及与 转速测量用的光栅编码器接口，以测量电机转速。但是，dsp的成本较高， 同时由于芯片的引脚教多，配载芯片种类繁多，实现硬件电路板布线

6、复杂， 加重了电路设计和实际焊接的工作。而且编程较为负载，难度较大。方案三采用atmel公司的avr系列单片mcuavr单片机废除了机器周期，抛弃复杂指令计算机（cisc）追求指令完 备；采用精简指令集，以字作为指令长度单位，将内容丰富的操作数与操作 码安排在一字之中（指令集中占大多数的单周期指令都是如此），取指周期 短，又可预取指令，实现流水作业，可高速执行指令。avr单片机硬件结构采取8位机与16位机的折中策略，即釆用局部寄 存器存堆（32个寄存器文件）和单体高速输入/输出的方案（即输入捕获寄 存器、输出比较匹配寄存器及相应控制逻辑）。这样，既提高了指令执行速 度，克服了瓶颈现象，增强了功

7、能；乂减少了对外设管理的开销，相对简化 了硬件结构，降低了成本，同时内部ram>2kbit, r0m>8kbito故avr单片机 在软/硬件开销、速度、性能和成本诸多方面取得了优化平衡，是高性价比 的单片机。综上所述，考虑到性价比及编程易实现性，我们在mcu上选择at90s8535 单片机。2. 2直流电动机驱动模块的选择对直流电机的驱动可以选择如下几种方式方案一釆用大功率场效应管组成的h型全桥式电路采用四个大功率场效应管组成h型全桥式电路，可控制电机的双向运动以及变 速运动.该驱动电路是使用最广泛的一种电机驱动电路,成本小，可以很方便实现直 流电机的四象限运行，分别对应正转、正转

8、制动、反转、反转制动。它的基本原理 图如图1所示。全桥式驱动电路的4只开关管都工作在斩波状态，si、s2为一组，s3、s4为另一 组，两组的状态互补，一组导通则另一组必须关断。当si、s2导通时，s3、s4关 断，屯机两端加正向电压，可以实现电机的正转或反转制动；当s3、s4导通时， si、s2关断，电机两端为反向电压，电机反转或正转制动。因一方案二采用sgs公司的集成芯片l298n采用sgs公司的集成芯片l298no它是恒压恒流双ii桥电机芯片，可同时控制 两台直流电机，输出电流可达到2 a。l298内部集成桥式电路，每一组pwm波用来控 制一个电机的速度，另外有专用的方向口控制电机的正反转

9、，一个芯片内包含有8 个功率管，这样简化了电路的复杂性，控制比较简单，电路也很简单，但采用该种 驱动芯片驱动电流较小，不能驱动人功率的直流电机，而且该种驱动芯片散热量较 大。方案三采用ns公司的直流电机专用驱动芯片lmd18200tlmd18200是美国国家半导体公司(ns)推出的专用于直流电动机驱动的h桥 组件。同一芯片上集成有cmos控制电路和dmos功率器件，利用它可以与主处 理器、电机和增量型编码器构成一个完整的运动控制系统,其峰值输出电流高达6a , 连续输出电流达3a ,工作电压高达55v,还具有温度报警和过热与短路保护功能。因 此我们在选用该方案作为我们的电机驱动方案.其工作原理

10、如下：首先通过充电泵电路为上桥臂的2个开关管提供栅极控制电压，充电泵电路由 一个300khz左右的工作频率。可在引脚1、11外接电容形成第二个充电泵电路， 外接电容越大，向开关管栅极输入的电容充电速度越快，电压上升的时间越短，工 作频率可以更高。引脚2、10接直流电机电枢，正转时电流的方向应该从引脚2到 引脚10；反转时电流的方向应该从引脚10到引脚2。电流检测输出引脚8可以接一 个对地电阻，通过电阻来输出过流情况。内部保护电路设置的过电流阈值为10a, 当超过该值时会口动封锁输岀，并周期性的口动恢复输出。如果过电流持续时间较 长，过热保护将关闭整个输出。过热信号还可通过引脚9输出，当结温达到

11、145度 时引脚9有输出信号。lmd18200芯片原理图(如下图)：温度报誓输岀自举1输岀1 vs 输岀2自举2lmd18200工作电路原理图（如下图）:2. 3速度检测模块作为闭环控制系统来说速度值的检测在系统中是非常必要的，通常速度的检 测方式有以下儿种：方案一.采用光电编码器采用光电编码器作为速度检测元件，它可输出3路脉冲信号a、b和z。其中,a和 b是两个频率变化冃正交（即相位差为90° ）的脉冲，当它由电机轴上的光电编码器 产生时，电机的旋转方向可通过检测两个脉冲序列中的哪一列先到来确定，电机的转 速可由脉冲数和脉冲频率来决定。这样把光电编码器输出的数字脉冲送入mcu进行处

12、 理即可得到电机的转速和转向。该种方式的优点是精确度高，检测全面.方案一:采用霍尔传感器测速采用此方式对电动小车进行速度测量，在电动小车的轮子上安装霍尔传感器, 轮子每转过一圈，霍尔传感器给出一个脉冲信号,mci；进行计速,此种方式的缺点是精 度太差.在整个系统中我们采用光电编码器作为速度反馈，因为我们采用的是高精度 的伺服电机，内带光电编码器（12线），电机减速比为1:65,所以用口带的光电编码器 最小分辨精度可达1mm,对于运动控制系统来说已经足够.2. 4数据显示模块对于显示部分，我们有两套方案。方案一：使用数码管（led）显示。数码管显示简单方便，价格低廉，但是由于 本题口要求可以显示

13、多种数据，所以用数码管显示不够方便，人机界面不够良好。方案二：使用液晶（lcd）显示.液晶（lcd）显示数据多，不需占用太多的10 口，可以完整的显示整个系统的所有信息，并且控制方便、显示清晰直观。所以我们选择方案二，充分利用lcd的优势。2. 5数据输入模块由于系统要求用户能够任意输入速度值，这对输入方式有了更高的要求。方案一：拨码开关组合输入这是我们在常用的仪器上最常见的输入方式，其优点也很明显，但是由于数 据输入的量大，用拨码开关操作，过于繁琐和复杂。方案二：使用按键与专用的接口芯片构成键盘。现在市场上有很多专用键盘与led控制芯片，利用这种芯片可以方便的构成 键盘，并可以附带数码管显示

14、，但控制部分要另外附加资源，也需要对这种专用 接口芯片有充分了解，且代价较高，所以放弃这个方案。方案三：矩阵键盘输入矩阵键盘容易制作、使用方便，输入精确，且实现方便。我们自制了2*6 的矩阵键盘，外接电路简单，很方便使用。比较以上各个方案的优缺点，以及我们现有的条件，数据输入采用方案三。26机械构架方案方案一：使用舵机。机器人的后轮为驱动轮，前轮为舵机比例控制。 后轮使用齿轮差速器配合转向（消除转向时产生的轮差），这样的设计可极 大的提高机器人的稳定性。但是在这种方案中由于前轮由舵机控制，受其设 计所限旋转的角度只能小于60度，不可能实现90度的直角转弯，机器人在 转向时会存在转弯半径。这就限

15、制了机器人的实际活动能力，因此，在本设 计中机器人的机械构架放弃该方案。方案二：驱动转向功能合并。前轮即充当主动轮又肩负转向轮的功能。 两前轮相互独立，分别由两个电机驱动，有各自的减速系统，后轮采用万向 轮结构，起支撑作用随前轮运动。使用此种方案不仅不会降低机器人的稳定 性，而且大大的提高了它的灵活性以及适应性。从而满足了我们的设计初衷。方案三：采用菱形车架结构，驱动轮在屮间。前轮和后轮为辅助轮肩 负支撑的功能，前轮和后轮由一个杠杆连接可以自动调整高度，从而，提高 车体的灵活性，适应不同的工作环境；中间两个轮为驱动轮肩负驱动与转向 的功能，完成车体的所有动作。因此，我们选取方案二为实际操作方案

16、。如上所述，我们的运动控制系统采用at9os8535为mcu,通过3*8键 盘输入数据，整个系统的状况通过lcd液晶实时显示，通过lmd182o0集 成芯片驱动直流伺服电机。3.伺服电机的控制策略3. 1伺服电动机简介木系统所使用的是伺服电动机。下面主要以此为例介绍一下伺服电动机的基本 工作原理。伺服电动机又称执行电动机，分为直流伺服电动机和交流伺服电动机，直 流伺服电机的基本结构与普通直流电机和同，不同点只是它针对伺服控制系统而带 有速度或位置反馈装置，以便满足快速响应的要求。直流伺服电机的主要结构包括 定子和转子两部分。定子和转子之间由空气隙分开。定子的作用是产生主磁场和在 机械上支撑屯机

17、，它的组成部分由主磁极、换向极、机座、端盖和轴承等。转子的 作用是产生感应电动势或产生机械转矩以实现能量的转换，它的组成部分有电枢铁心、电枢绕组、换向器等。直流伺服电动机具有良好的线性调节特性及快速的时间响应，并且其精度更 高，可控性更强，一般通过改变伺服电动机的电枢电压ua来控制直流伺服电动机的 转速。3. 2伺服直流电机控制策略对直流伺服电机转炬的控制完全依赖于对定子电流的控制。所以控制逆变器输 入方波电压的幅值即可控制电动机的转速。在控制方波电压幅值，亦即调速中，我 们釆用了闭环控制的pwm (pulse width modulation)控制技术。所谓调速,是指在 某一具体负载情况下，

18、通过改变电动机或电源参数的方法，使机械特性线得以改变, 从而使电动机转速发生变化或保持不变。调速具有两个方面的含义:一是能在一定范 围内“变速”。如图3.5所示，电动机负载不变时，转速由化变到代或亿，这就是 “变速”调速二是“恒速”，当生产机械在某一速度下运行时，总要受到外界的干 扰(如负载的变化)，为了保证工作速度不受干扰的影响，也要进行调速。例如由于 负载的增加，电动机的转速就要降低，为维持转速恒定，就得调整电动机转速，使 其回升，并等于或接近原来的转速。如图3. 5中的®就属于“恒速”调速。图3. 5调速与机械特性的关系3. 2. 1脉宽调制调速基本原理u.so->>

19、; t4 一"t1a）原理图b）波形图3. 8脉宽调制调速系统原理图脉宽调制调速系统中的主电路采用脉宽调制式变换器，简称pwm （pulse width modulation）变换器。脉宽调制变换器就是采用脉冲宽度调制的一种直流斩波器。直 流斩波调速最早是以它显著的节能效果应用于直流电动机中，但是由于它的某些缺 点，未能在工业中推广。自从晶体管迅速发展之后才使得脉宽调速更容易实现，而 r性能更好。因此，将脉宽调速推广到一般工业屮取代晶闸管整流调速有着广阔的 前景。只是由于器件容量的限制，目前直流pwm调速还只限于中、小功率的系统。 随着器件的发展，它的应用领域必然会日益扩人。例如品闸

20、管的生产水平己经达到 4500v, 2500a,组成pwm变换器，可以用来驱动上千瓦的电动机。图3.8a）是脉宽调制调速系统原理示意图。虚线框内的开关s表示脉宽调制器， 调速系统的外加电源电压/为固定的直流电压，当开关s闭合时，直流电流经过s 给电动机m供电;开关s打开时,直流电源供给m的电流被切断,m经二极管.续流, 电枢两端电压接近为零。如果开关s按照某固定频率开闭而改变每周期内的接通时 间匚时，控制脉冲宽度相应改变，从而改变了电动机两端平均电压，达到调速口的。 脉冲波形见图3. 8b）,其平均电压为：1如tud=-jusdt = us=pus'ol式屮t为脉冲时钟；匚为接通时间；

21、p = 为pwm电压的占至比（0<p<l）;t us可见，在电源匕/与pwm波的周期t固定的条件下，可随p的改变而平滑调节, 从而实现电动机的平滑调速。3. 2. 2直流调速系统单闭坏直流调速系统单闭环直流调速系统是指只有一个转速负反馈构成的闭环控制系统。一般采用 的反馈有两种方式：-：在电动机轴上装一台测速发电机sf,引出与转速成正比的电压（/厂与给定 电压（/歸比较后的偏差电压",经过放大器fd,产生触发装置cf的控制电压 用以控制电动机的转速，如图3. 6所示。二：直接通过光电编码盘对轮子转数进行计数，然后将计数的速度值反馈回主 mcu,然后mcu在根据测得的速度值

22、进行相应控制，这两种方式都只有一个转速反馈 环，所以称为单闭环调速系统。图3. 6采用转速反债的单闭环调速系统由于采用测速发电机进行测速成本较高并且电路复杂，所以在本系统中，我们 釆用光电编码盘进行测速，光电编码盘的读数做为反馈对整个系统进行单闭环控制, 在电机具体的调速方式上，我们采用的方法是“恒速”控制，即在控制过程中，先 设定一个标准的速度值，这个标准速度值就是下一步电机的冃标值，控制系统的任 务就是不管外界条件的变化要保证两个电机都以我们设定的速度值运行，这样就实 现了电机的速度伺服控制。3. 2.3实现算法的选择方案一：采用最原始的查表操作。就是在控制系统里面建一个表，将外界各种情况

23、下电机的运行状况都预先存放 在表中，然后根据前端反馈回来的速度值跟单片机屮存放的表屮的情况比较，然后 输出对应的控制信号。对于大多数单片机控制系统来说，可能都采用这种方式，这 种方式编程简单，并且执行速度快，但其有一个致命弱点就是实时性差，只能用在 固定的场合，如果外界条件发生变化，这种控制方式也就失效。方案二：采用实时计算的方法控制电机。在这种方式中单片机采集速度信号，然后根据反馈的速度值进行相应计算，得 出不同的输出值控制电机，这种方式因为实时性好，适应性强，并且控制精确等优 点已被大量应用在工业生产中，技术已相当成熟。其中应用最为广泛的是pid算法 (比例积分微分)，该算法通过比例、积分

24、、微分调节控制系统，不仅能够快速调 节系统，使系统能够尽快进入稳态，而且还能够消除系统的稳态误差、预判断系统 的发展趋势，提前纠正系统误差，因此，pid算法能够实现非常精确的控制。并且 其结构简单、稳定性好、工作可靠、调整方便，不需要精确数学模型。但是如果想 完全实现这种算法，需进行大量的实时计算，包括乘加等浮点数运算，因此对处理 器要求较高，一般要求有大容量、速度高、并且硬件资源丰富的处理器，对于本文 的电机速度控制，一般pi控制即可达到满意的调节效果，因此我们采用积分分离的 pi增量式控制算法，在一个扫描周期内采集轮子的速度信号值，然后通过pi控制 算法实时算出下一阶段的pwm量，如此不断

25、刷新一处理，使轮子总是保持定速前进, 从而实现电机的速度伺服控制。pi算法计算公式如下：u(k) = u(k l)土 au(k)t7(k)二kp*(e(k)-e(k-l) +ki*ek-ek-1,在程序中我们采用如下公式 uk) = a *e(k) + b*e(k 1)其中t/(k)为本次pwm输出量，"(k-1)为上一周期pwm输出量，(/&)为本次计 算的pwm增量，kp为比例系数，ki为积分系数，e(k)为本次速度实际值与标准值 的差值，e(k-1)为上次速度实际值与标准值的差值。采用p控制算法中的重点是比例系数a,积分系数b的设定，我们在设计过 程中不断实验，不断测试

26、，最终测出了最合适的系数。4软件设计4.1软件思路在该系统中，mcu需要完成的工作主要有键盘扫描、液晶显示、速度计数、pi 控制计算、pwm量输出等。我们的处理方法是在主程序中完成键盘扫描和pwm量输 出，在定时器中断程序中完成速度输入值的刷新、pi控制量的计算、以及液晶显示 的刷新等操作，我们通过一个定时器定时，另外两个定时器分别对左右轮子计数， 如此可测岀左右电机的实际转速。在设计过程中我们使用c语言编程，采取模块化的设计方法。4. 2程序流程图主程序流程图开始定时器中断程序流程图入巾断中断初始化关闭两个计数 器，读两个电 机探底计数侑进行pi计算输出量滴晶兄示刷新两电机计数值清零中断返冋

27、pi算法流程图e=setpoint-countisj终设计5.1完成情况通过本系统可实现对直流电动机的速度闭环控制，控制电动小车基本实现匀速直线运动。并且键盘输入、液晶显示等模块都工作正常，对于 位置伺服控制，只能部分实现，控制电动小车无参照走正方形图形。5.2操作说明我们所做的电机伺服控制系统实现的主要功能是对电机通过闭环反馈，实现 电机的速度伺服控制，其操作流程如下：首先启动整个控制系统，通过键盘输入固定的速度值，按“确定”键后电动小车将按照输入的固定速度值前进，如果外界条 件的变化引起了轮子的速度发生变化，我们的控制系统将对轮子转速进行自动调整, 使两个轮子始终按照输入的固定速度前进，如

28、此在外观表现上则是电动小车始终以 匀速直线前进。小车前进一段距离后将自动停止，停儿秒钟之后将自动后退，按原 路以原速直线返回出发点。从而实现电机的速度伺服控制。5.3性能指标测试后基本功能实现，能够在短距离内以各种速度实现匀速直线运动，基本达 到速度的闭环伺服控制，但由于pi算法自身的局限性、单片机处理速度的限制性以 及我们自身机械加工精度不是太高等方面的因素，导致了电机的控制精度不是太高, 在短的距离内这种误差可以忽略，但运行距离较远时则误差较大，以下是该运动控 制器的性能指标因为我们在控制系统中测得的速度值以及输入的设定速度值都是以计得的脉冲数来 显示的，并没有转换成实际的标准单位显示，固

29、在此表中的所有数据都是以脉冲数 为单位的，实际转换距离为：1个脉冲=0.028cm控制工作电压5v动力工作电压12v最低速度1个脉冲/100ms最高速度99个脉冲/100ms调节性能比较速度值（个 脉冲/100ms）不经过调节的 误差（cm/m）经过调节后的误 差（cm/m）106.30.5307.50.7509.51.36011.61.88014.02由上表可见该控制器对屯机性能的调节效果是相当显著的，经过控制 器调节后电机性能明显改善。5.4误差分析：1:物理构架造成的课差。由于本系统采用止三角形构架，后面的从动轮起 到了舵轮的作用。因此会造成一些误差.2:电源供电误差.因为直流伺服电机在启动瞬间的电流要求很大。电源会 岀