运动控制课程设计

目 录

1设计任务与要求 ................................................. 1 2系统方案论证 ................................................... 1

2.1 PWM控制使用在直流电力拖动系统中的优势 .............................. 1 2.2单片机控制使用在直流电力拖动系统中的优势 ............................ 1

3系统总体设计 ................................................... 2

3.1单片机控制PWM直流双闭环调速系统原理 ................................ 2 3.2 PWM技术基本原理 .................................................... 3

4调节器参数设计 ................................................. 3

4.1电流环参数设计 ...................................................... 3 4.2转速环参数设计 ...................................................... 5

5系统电路设计 ................................................... 7

5.1主电路设计 .......................................................... 7 5.2驱动电路设计 ........................................................ 7 5.3检测电路设计 ........................................................ 8 5.4数字控制器设计 ...................................................... 8

6调速系统软件设计 ............................................... 9

6.1主程序 .............................................................. 9 6.2初始化子程序 ....................................................... 10 6.3中断服务子程序 ..................................................... 10 6.4 PI算法子程序 ...................................................... 11

设计体会 ........................................................ 12 参考文献 ........................................................ 12

1

单片机控制PWM直流双闭环

调速系统设计

1设计任务与要求

转速、电流双闭环控制直流调速系统是性能很好、应用最为广泛的直流调速系统。本次设计需要根据已知参数及性能指标，设计一个单片机控制PWM直流双闭环调速系统，使其具备基本的运行可能性和可操作性，具体包括主电路设计、触发电路设计、控制回路设计以及控制程序的编写。

2系统方案论证

2.1 PWM控制使用在直流电力拖动系统中的优势

直流电力拖动系统使用PWM控制方法，与晶闸管可控整流方法比较，性能上有以下特点。

1）由于开关频率高，所以系统频带宽，快速响应性能好，动态抗干扰性能强。新开发的MOSFET开关频率可达到几十kHz,IGBT开关频率也可达到30kHz。并且电枢电流仅依赖于电动机本身的电感就能连续，不需要增加饱和电抗器，减少了电动机损耗。

2）电动机低速时电流脉动小，即转矩脉动小，稳速精度高，调速范围大，特别是双极式PWM变换器，最大调速比可达1∶20 000。当直流电源采用不可控整流时，电网功率因数比相控整流器高。

3）主电路结构简单，MOSFET与IGBT都开发有多种驱动集成模块；并且由于功率器件工作在开关状态，而使功率电路功耗小，其功率可达到90%以上。

2.2单片机控制使用在直流电力拖动系统中的优势

基于单片机控制的数字直流调速数字控制系统与模拟控制系统相比较有很多优势，主要包括以下几方面。

1）数字控制系统硬件电路的标准化程度高、制作成本低、不受器件温度漂移的影响。且系统的稳定性好、可靠性高，可以提高控制能力。

2）数字控制系统的控制软件能够进行逻辑判断和复杂运算，可以实现不同于一般线性调节的最优化、自适应、非线性、智能化等控制规律。另外，数字控制系统拥有信息存储、数据通信和故障诊断等模拟控制系统无法实现的功能。

1

3系统总体设计

3.1单片机控制PWM直流双闭环调速系统原理

根据设计任务要求，设计的单片机控制PWM直流双闭环调速系统的原理图如图1所示。 AT89S52单片机 UR Uc ASR ACR UPW GD UPEW 3~

n﹡ Id* - n - Id A/D TA M FBS 图1 单片机控制PWM直流双闭环调速系统的原理图 图1中，UR：三相桥式整流器，ASR：转速调节环节，ACR：电流调节环节，UPW：PWM波生成电路，GD：驱动电路，UPEW：桥式可逆电力电子变换器，A/D：模/数转换器，TA：霍尔电流传感器，FBS：光电码盘测速器。

为了实现转速、电流的无静差以及转速的稳定，整个系统采用了转速、电流双闭环的控制结构，在系统中设置了两个调节器转速调节器、电流调节器，从而引入转速负反馈和电流负反馈。两者之间实行串级联接，把转速调节器的输出当作电流调节器的输入，再用电流调节器的输出作为PWM的控制电压，最后通过驱动电路驱动桥式可逆电力电子变换器UPEW。从闭环结构上看，电流环在内部，构成了内环，从稳态要求上看，希望电流无静差，以得到理想的堵转特性，而且电流环应以跟随性能为主，所以电流环按典Ⅰ型系统设计；转速环在外部，从成了外环，为了实现转速无静差以及获得良好的动、静态品质，所以转速环按典Ⅱ型系统设计。整个系统中，转速、电流调节环采用单片机实现，系统的给定，电流、转速的反馈量经过模/数转换后也送入单片机中进行处理，最终形成了单片机控制PWM直流双闭环调速系统。

2

3.2 PWM技术基本原理

PWM控制系统是通过改变直流电机电枢上脉动直流电的“占空比”来改变平均电压的大小，从而控制电机的转速。电枢电压的平均值为：Umg=ρVcc, ρ称为占空比，其值由固定频率调节脉冲宽度的方法来调节。

4调节器参数设计

本系统调节器参数的设计主要采用工程设计法。按照多环控制系统设计的一般原则，采取先内环后外环，从内环开始，逐步向外扩张。因此在双闭环控制系统中，首先设计电流调节器，然后把整个电流环看作是转速调节系统中的一个环节，再设计转速调节器。单片机控制PWM直流双闭环调速系统的实际动态结构框图如图2所示。 电流环 *Un(s) β Tois+1 1 Tons+1ASR 1 Tois+1ACR Ks Tss+11/Rs Tls+1α Tons+1E(s) n(s) 1 CeIdL(s) R Tms图2单片机控制PWM直流双闭环调速系统动态结构框图

4.1电流环参数设计

首先将电流环从整个系统的动态结构框图中取出，得到近似的电流环结构框图，如图3所示。

β T oi s+1 ACR *U(s) i

Ks Tss+1β Tois+11/R Tls+1Id(s) 图3电流环近似结构框图 由于电流环的控制对象是双惯性的，而且设计要求电流超调量i5%，因此可校正成典Ⅰ型系统，所以电流调节器ACR采用PI型的，其传递函数可以写成下式：

3

Ki(is1)

WACR(S)is式中 Ki----电流调节器比例

系数

i----电流调节器超前时间常数。

对电流环作近似处理，可得出电流环结构简化图，如图4所示。

*U(s)/β i KI s(T∑is+1) Id(s) 图4电流环结构简化图

电动机电枢电流的额定值In18.5A,所以电枢允许的最大电流Idm1.5*18.527.75A,所以电枢电流的范围为27.75~27.75A，而A/D转换为8位的二进制数码，因此得出电流反馈回路的反馈系数：

255/(27.75(27.75))255/55.54.6A1

因为整流电路采用的是三相桥式整流电路，所以整流装置滞后时间常数Ts为三相桥式整流电路的平均失控时间Ts0.0017s，而电流滤波时间常数Toi为：Toi0.002s，通过小时间常数近似处理得出电流环小时间常数之和TiTsToi0.0037s，因此可以计算出电流调节器各参数。

电流调节器各参数计算：

电流调节器超前时间常数：iTl0.03s。

电流环开环增益：要求i5%，应取KITi0.5，因此

KI0.50.5135s1于是，ACR的比例系数为 Ti0.0037sKiKIiR135*0.03*0.51.667Ks0.264*4.6

校验近似条件：

电流环截止频率：ciKI135s1

4

PWM变换器传递函数近似条件

ss1ci

满足近似条件。

忽略反电动势变化对电流环动态影响的条件

1/TmTls1ci

满足近似条件。

电流环小时间常数近似处理条件

1/TsToi180.8s1ci

满足近似条件。

按照上述参数，电流环可以达到的动态跟随性能指标为i5%，满足设计要求。

4.2转速环参数设计

前面已经计算出了电流调节环的参数，要对转速环进行参数设计，首先计算出电流环的等效闭环传递函数，通过近似条件的处理可以得出电流环的等效闭环传递函数为下式。

Id(s)1/Ui*(s)1s/KI

用电流环的等效环节代替图3中

的电流环后，整个系统的动态结构框图如图5所示。 ASR 1Tons+11/β 1+s/KIα R CeTmsn(s) Un*(s) 图5转速环动态结构框图 Tons+1由前面调速系统的原理可知，转速的控制是无静差的，而且设计要求空载启动转速超调量n10%，因此可校正成典Ⅱ型系统，所以转速调节器ASR也采用PI型的，其传递函数可以写成下式：

K(s1)WASR(S)nnns

式中 Kn----转速调节器比例系

数

n----转速调节器超前时间常数。

5

对转速环作近似处理，可得出转速环结构简化图，如图6所示。

*KN(τns+1) U(s)/α n s2(T∑ns+1) n(s) 图6转速环结构简化图

转速调节器各参数计算：

电流环等效时间常数：1/KI2Ti0.0074s。 转速滤波时间常数：Ton0.01s。

转速环小时间常数：Tn1/KITon0.0174s。

按照跟随和抗扰性能都较好的原则，取h5，则ASR的超前时间常数为

nhTn0.087s

从而求出转速开环增益

22N(h1)/(2h2Tn)396.4s

最后可求出ASR的比例系数为

nKNnCeTm/R7.424

检验近似条件：

转速环截止频率：cnKNn34.4868s1。 电流环传递函数简化条件为

KI/Ti3.37s1cn

满足近似条件。

转速环小时间常数近似处理条件为

KI/Ton38.73s1cn

满足近似条件。

当h5时，n37.6%，不能满足设计要求，由于以上是按线性处理的，而突加阶跃给定时，ASR饱和，不符合线性系统的前提，所以应该按ASR退饱和的情况重新计算超调量。所以超调量为

CnTn2(max)(z)*bn1.68%10%CbnTm

6

5系统电路设计

整个调速系统硬件电路主要包含有：以三相桥式整流器为主的主电路，PWM功率放大驱动电路，电流、速度检测电路以及以51单片机为核心的数字控制器等几个单元电路组成，各个单元电路的设计如下。

5.1主电路设计

主回路的设计主要是：三相交流电源经三相桥式整流变换为电压恒定的直流电源，然后经过直流PWM变换器得到可调的直流电压，最后供给直流电动机使用。整个主回路的构成如图所示。

其中，从图7中可以看出，采用的是电压源型逆变器，直流环节采用大电容C1来滤波，从而使得输出的直流电压波形比较平直，在理想的情况下可视为内阻为零的恒压源。由于电容C1的容量很大，当突加电源后，后造成短路，从而形成比较大的充电电流，会减少整流二极管的寿命，严重的可能烧毁，因此在电路中加入了限流电阻R1，加入电源以后为了避免限流电阻R1在运行中造成不必要的损耗，可在限流电阻R1两端并入延时开关K，将其短路即可。

图7主回路电路图

5.2驱动电路设计

从上述原理可知，产生高压侧焖鸡驱动电压的前提是低压侧必须要有开关的动作，因此本系统采用的是双极性脉宽调制功率放大器。PWM驱动原理图如图8所示。因为VT1~VT4是作为开关用的大功率晶体管，只工作在截止和饱和状态，当电机正转时VT1、VT4导通，反转则VT2、VT3导通。而D4、D5、D9、D10则为续流二极管，主要起到保

7

护作用，防止VT1~VT4被反向击穿。因为控制回路是弱电，而主回路却是强电，因此在两者之间加入了起隔离和抗干扰作用的光电耦合器。

图8 PWM驱动原理图

5.3检测电路设计

检测回路主要包括电流、电压、速度的检测，其中电流、电压的检测须由A/D转换通道转换为数字量再送入单片机中进行相应的处理，转速检测直接使用数字测速。电流检测电路的主要组成部分包括霍尔电流传感器（TA）CSM100LA，A/D转换器ADC0809。转速测量电路则由施密特整形电路以及装在电动机转子上的光电编码盘组成，因为电机的转速与电脉冲的频率成固定的比例关系，因此将光电编码盘输出的电脉冲经施密特整形电路整为标准的TTL电平，再送入单片机的两个外部中断，然后利用单片机内部的定时计数器作为计数器来不断重复的捕捉相邻两次速度脉冲，最后从两次触发的时间差算出转速。

5.4数字控制器设计

数字控制器是整个调速系统的核心，AT89S52单片机测试数字控制器的核心。前面已经计算出电流、转速调节器的参数，因此可以得到两者的传递函数，一次可以先按模拟系统设计方法设计调节器，然后采用离散化，就可以得到数字控制器的散发，也就是模拟调节器数字化。数字控制器采用PI调节算法，将测得的电流、转速的数字量送入单片机中，通过测得的转速与预置转速相比得到差值，然后单片机通过对差值进行PI运算得出控制量，再通过IO口输出四路PWM控制信号，最终达到控制电机转速的目的。数字控制器的设计主要是单片机最小系统的设计，单片机最小系统如图9所示。整个系统的总电路图见附录。

8

图9单片机最小系统

6调速系统软件设计

调速系统的控制规律是利用软件实现的，所有的硬件须由软件来实施管理，通过软硬件的相互结合来实现电机的调速。整个调速系统的软件有主程序、初始化子程序、中断服务子程序和PI算法子程序组成。

6.1主程序

主程序设计成循环形式，将预置的转速与实际测得的转速相比较，得到一个差值，然后将差值进行PI运算得到电流调节器的输入值，再将输入值与实际测得的电流值相比较，又得到一个差值，最后将差值进行PI运算得到控制值，最后利用控制值改变输出的PWM信号的占空比，最终达到控制电机转速的目的。主程序框图如图10所示。

9

开始系统初始化N按键是否按下PI运算NY键处理电流差值PI运算开外部中断控制速度速度差值

图10主程序框图

6.2初始化子程序

初始化子程序的功能主要是完成器件工作方式的设定、系统运行参数和变量的初始化等。初始化子程序框图如图11所示。

6.3中断服务子程序

中断服务子程序的设计是整个系统软件设计的关键部分，用来完成实时性强的功能。例如PWM控制信号的生成、状态检测以及数字PI调节等。中断服务子程序主要包括了转速调节中断服务子程序、电流调节中断服务子程序。

10

系统初始化保护现场设定定时器、PWM、数字测速工作方式设定I/O、按键工作方式参数及变量初始化读入转速给定允许测量速度计算转速恢复现场转速调节中断返回

图11初始化子程序框图 图12转速调节中断服务子程序框图

进入转速调节中断服务子程序后，首先保护现场，再计算实际转速，完成转速PI调节，最后启动转速检测，为下一步调节做准备。中断服务完成以后须恢复现场，从而使得被中断的上一级程序正确可靠的运行，转速调节中断服务子程序框图如图12所示。

电流调节中断服务子程序主要完成电流PI调节和PWM控制信号的生成功能，然后启动A/D转换，为下一步调节做准备。中断服务完成以后须恢复现场，从而使得被中断的上一级程序正确可靠的运行，电流调节中断服务子程序框图如图13所示。

保护现场启动A/D转换读入电流反馈电流调节恢复现场YPWM生成中断返回

图13电流调节中断服务子程序框图

6.4 PI算法子程序

本系统采用的是比例积分调节器，使系统在扰动的干扰下，通过PI调节器的调节作用使电机的转速达到无静差，同时使电流紧紧跟随给定值的变化，从而加快启动过程。PI算

11

法子程序框图如图14所示。

数字PI调节计算偏差e(k)uI(k)KITsame(k)uI(k1)uI(k)um?NYYuI(k)um?NuI(k)umuI(k)umYuk()kPek()uI(k)u(k)um?NYu(k)umuk()um?u(k)umN结束 图14 PI算法子程序框图

设计体会

通过本次运动控制系统课程设计的实践训练，我巩固了自己在理论课程中学习的基础知识，同时还进一步熟悉了许多设计软件的应用，了解了一些以前没有涉及到得新知识。这具体包括，通过这次设计，我进一步学习、掌握了ProtelDXP、VISO这几款画图设计软件的使用，同时我在原来学习电力电子整流、滤波、斩波的基础上进一步熟悉了其中相关的原理以及设计单片机控制PWM直流双闭环调速系统所要采用的方法。另外，这次设计也加强了我们动手、思考和解决实际问题的能力，凡事都要具体问题要具体分析，才能找出最优的解决办法，从而达到设计的目的。

参考文献

[1]陈伯时.电力拖动自动控制系统-运动控制系统. 北京：机械工业出版社，2003

12

[2]王兆安，黄俊.电力电子技术. 北京：机械工业出版社，2005 [3]于海生.微型计算机控制技术. 北京：清华大学出版社，1999

[4]戴仙金.51单片机及其C语言程序开发实例. 北京：清华出版社，2008 [5]王晓明.电动机的单片机控制. 北京：北京航天航空大学出版社，2004

13