运动控制课程设计

目录TOC\o"1-2"\h\z\u1设计任务与要求 12系统方案论证 12.1PWM控制使用在直流电力拖动系统中的优势 1单片机控制使用在直流电力拖动系统中的优势 13系统总体设计 2单片机控制PWM直流双闭环调速系统原理 23.2PWM技术基本原理 34调节器参数设计 3电流环参数设计 3转速环参数设计 55系统电路设计 7主电路设计 7驱动电路设计 8检测电路设计 8数字控制器设计 96调速系统软件设计 9主程序 10初始化子程序 10中断服务子程序 106.4PI算法子程序 11设计体会 13参考文献 14单片机控制PWM直流双闭环调速系统设计1设计任务与要求转速、电流双闭环控制直流调速系统是性能很好、应用最为广泛的直流调速系统。本次设计需要根据已知参数及性能指标，设计一个单片机控制PWM直流双闭环调速系统，使其具备基本的运行可能性和可操作性，具体包括主电路设计、触发电路设计、控制回路设计以及控制程序的编写。2系统方案论证PWM控制使用在直流电力拖动系统中的优势直流电力拖动系统使用PWM控制方法，与晶闸管可控整流方法比较，性能上有以下特点。

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

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

3〕主电路结构简单，MOSFET与IGBT都开发有多种驱动集成模块；并且由于功率器件工作在开关状态，而使功率电路功耗小，其功率可到达90%以上。单片机控制使用在直流电力拖动系统中的优势基于单片机控制的数字直流调速数字控制系统与模拟控制系统相比较有很多优势，主要包括以下几方面。1〕数字控制系统硬件电路的标准化程度高、制作成本低、不受器件温度漂移的影响。且系统的稳定性好、可靠性高，可以提高控制能力。2〕数字控制系统的控制软件能够进行逻辑判断和复杂运算，可以实现不同于一般线性调节的最优化、自适应、非线性、智能化等控制规律。另外，数字控制系统拥有信息存储、数据通信和故障诊断等模拟控制系统无法实现的功能。3系统总体设计根据设计任务要求，设计的单片机控制PWM直流双闭环调速系统的原理图如图1所示。 3~AT89S52单片机URId*UcId*Ucn﹡ASRACRUPWGDUPEW-Id-n-Id-nA/DTAMFBS图1单片机控制PWM直流双闭环调速系统的原理图图1中，UR：三相桥式整流器，ASR：转速调节环节，ACR：电流调节环节，UPW：PWM波生成电路，GD：驱动电路，UPEW：桥式可逆电力电子变换器，A/D：模/数转换器，TA：霍尔电流传感器，FBS：光电码盘测速器。为了实现转速、电流的无静差以及转速的稳定，整个系统采用了转速、电流双闭环的控制结构，在系统中设置了两个调节器转速调节器、电流调节器，从而引入转速负反馈和电流负反馈。两者之间实行串级联接，把转速调节器的输出当作电流调节器的输入，再用电流调节器的输出作为PWM的控制电压，最后通过驱动电路驱动桥式可逆电力电子变换器UPEW。从闭环结构上看，电流环在内部，构成了内环，从稳态要求上看，希望电流无静差，以得到理想的堵转特性，而且电流环应以跟随性能为主，所以电流环按典Ⅰ型系统设计；转速环在外部，从成了外环，为了实现转速无静差以及获得良好的动、静态品质，所以转速环按典Ⅱ型系统设计。整个系统中，转速、电流调节环采用单片机实现，系统的给定，电流、转速的反馈量经过模/数转换后也送入单片机中进行处理，最终形成了单片机控制PWM直流双闭环调速系统。PWM技术基本原理PWM控制系统是通过改变直流电机电枢上脉动直流电的“占空比”来改变平均电压的大小，从而控制电机的转速。电枢电压的平均值为：Umg=ρVcc,ρ称为占空比，其值由固定频率调节脉冲宽度的方法来调节。4调节器参数设计本系统调节器参数的设计主要采用工程设计法。按照多环控制系统设计的一般原则，采取先内环后外环，从内环开始，逐步向外扩张。因此在双闭环控制系统中，首先设计电流调节器，然后把整个电流环看作是转速调节系统中的一个环节，再设计转速调节器。单片机控制PWM直流双闭环调速系统的实际动态结构框图如图2所示。eq\f(β,eq\f(β,Tois+1)电流环UUn*(s)eq\f(Keq\f(Ks,Tss+1)eq\f(1/Rs,Tls+1)eq\f(1,Tois+1)eq\f(1,Tons+1) ASR ACReq\f(1,Tons+1)E(s)IdL(s)E(s)IdL(s)eq\f(α,Tons+1)eq\f(R,eq\f(R,Tms)eq\f(1,Ce)图2单片机控制PWM直流双闭环调速系统动态结构框图环参数设计首先将电流环从整个系统的动态结构框图中取出，得到近似的电流环结构框图，如图3所示。eq\f(Kseq\f(Ks,Tss+1)eq\f(β,Tois+1)eq\f(1/R,Tls+1)Ui*(s)Id(s)ACRUi*(s)Id(s)eq\f(βeq\f(β,Tois+1)图3电流环近似结构框图由于电流环的控制对象是双惯性的，而且设计要求电流超调量，因此可校正成典Ⅰ型系统，所以电流调节器ACR采用PI型的，其传递函数可以写成下式：式中电流调节器比例系数电流调节器超前时间常数。对电流环作近似处理，可得出电流环结构简化图，如图4所示。IId(s)UiUi*(s)/βeq\f(KI,s(T∑is+1))图4电流环结构简化图电动机电枢电流的额定值,所以电枢允许的最大电流,所以电枢电流的范围为，而A/D转换为8位的二进制数码，因此得出电流反馈回路的反馈系数：因为整流电路采用的是三相桥式整流电路，所以整流装置滞后时间常数为三相桥式整流电路的平均失控时间，而电流滤波时间常数为：，通过小时间常数近似处理得出电流环小时间常数之和，因此可以计算出电流调节器各参数。电流调节器各参数计算：电流调节器超前时间常数：。电流环开环增益：要求，应取，因此于是，ACR的比例系数为校验近似条件：电流环截止频率：PWM变换器传递函数近似条件满足近似条件。忽略反电动势变化对电流环动态影响的条件满足近似条件。电流环小时间常数近似处理条件满足近似条件。按照上述参数，电流环可以到达的动态跟随性能指标为，满足设计要求。前面已经计算出了电流调节环的参数，要对转速环进行参数设计，首先计算出电流环的等效闭环传递函数，通过近似条件的处理可以得出电流环的等效闭环传递函数为下式。用电流环的等效环节代替图3中的电流环后，整个系统的动态结构框图如图5所示。n(s)eq\f(R,n(s)eq\f(R,CeTms)eq\f(1/β,1+s/KI)eq\f(1,Tons+1)ASRUnUn*(s)eq\f(αeq\f(α,Tons+1)图5转速环动态结构框图由前面调速系统的原理可知，转速的控制是无静差的，而且设计要求空载启动转速超调量，因此可校正成典Ⅱ型系统，所以转速调节器ASR也采用PI型的，其传递函数可以写成下式：式中转速调节器比例系数转速调节器超前时间常数。对转速环作近似处理，可得出转速环结构简化图，如图6所示。n(s)Unn(s)Un*(s)/αeq\f(KN(τns+1),s2(T∑ns+1))图6转速环结构简化图转速调节器各参数计算：电流环等效时间常数：。转速滤波时间常数：。转速环小时间常数：。按照跟随和抗扰性能都较好的原则，取，则ASR的超前时间常数为从而求出转速开环增益最后可求出ASR的比例系数为检验近似条件：转速环截止频率：。电流环传递函数简化条件为满足近似条件。转速环小时间常数近似处理条件为满足近似条件。当时，，不能满足设计要求，由于以上是按线性处理的，而突加阶跃给定时，ASR饱和，不符合线性系统的前提，所以应该按ASR退饱和的情况重新计算超调量。所以超调量为5系统电路设计整个调速系统硬件电路主要包含有：以三相桥式整流器为主的主电路，PWM功率放大驱动电路，电流、速度检测电路以及以51单片机为核心的数字控制器等几个单元电路组成，各个单元电路的设计如下。主回路的设计主要是：三相交流电源经三相桥式整流变换为电压恒定的直流电源，然后经过直流PWM变换器得到可调的直流电压，最后供应直流电动机使用。整个主回路的构成如下图。其中，从图7中可以看出，采用的是电压源型逆变器，直流环节采用大电容C1来滤波，从而使得输出的直流电压波形比较平直，在理想的情况下可视为内阻为零的恒压源。由于电容C1的容量很大，当突加电源后，后造成短路，从而形成比较大的充电电流，会减少整流二极管的寿命，严重的可能烧毁，因此在电路中加入了限流电阻R1，加入电源以后为了防止限流电阻R1在运行中造成不必要的损耗，可在限流电阻R1两端并入延时开关K，将其短路即可。图7主回路电路图从上述原理可知，产生高压侧焖鸡驱动电压的前提是低压侧必须要有开关的动作，因此本系统采用的是双极性脉宽调制功率放大器。PWM驱动原理图如图8所示。因为VT1~VT4是作为开关用的大功率晶体管，只工作在截止和饱和状态，当电机正转时VT1、VT4导通，反转则VT2、VT3导通。而D4、D5、D9、D10则为续流二极管，主要起到保护作用，防止VT1~VT4被反向击穿。因为控制回路是弱电，而主回路却是强电，因此在两者之间加入了起隔离和抗干扰作用的光电耦合器。图8PWM驱动原理图检测回路主要包括电流、电压、速度的检测，其中电流、电压的检测须由A/D转换通道转换为数字量再送入单片机中进行相应的处理，转速检测直接使用数字测速。电流检测电路的主要组成部分包括霍尔电流传感器〔TA〕CSM100LA，A/D转换器ADC0809。转速测量电路则由施密特整形电路以及装在电动机转子上的光电编码盘组成，因为电机的转速与电脉冲的频率成固定的比例关系，因此将光电编码盘输出的电脉冲经施密特整形电路整为标准的TTL电平，再送入单片机的两个外部中断，然后利用单片机内部的定时计数器作为计数器来不断重复的捕捉相邻两次速度脉冲，最后从两次触发的时间差算出转速。数字控制器设计数字控制器是整个调速系统的核心，AT89S52单片机测试数字控制器的核心。前面已经计算出电流、转速调节器的参数，因此可以得到两者的传递函数，一次可以先按模拟系统设计方法设计调节器，然后采用离散化，就可以得到数字控制器的散发，也就是模拟调节器数字化。数字控制器采用PI调节算法，将测得的电流、转速的数字量送入单片机中，通过测得的转速与预置转速相比得到差值，然后单片机通过对差值进行PI运算得出控制量，再通过IO口输出四路PWM控制信号，最终到达控制电机转速的目的。数字控制器的设计主要是单片机最小系统的设计，单片机最小系统如图9所示。整个系统的总电路图见附录。图9单片机最小系统6调速系统软件设计调速系统的控制规律是利用软件实现的，所有的硬件须由软件来实施管理，通过软硬件的相互结合来实现电机的调速。整个调速系统的软件有主程序、初始化子程序、中断服务子程序和PI算法子程序组成。主程序设计成循环形式，将预置的转速与实际测得的转速相比较，得到一个差值，然后将差值进行PI运算得到电流调节器的输入值，再将输入值与实际测得的电流值相比较，又得到一个差值，最后将差值进行PI运算得到控制值，最后利用控制值改变输出的PWM信号的占空比，最终到达控制电机转速的目的。主程序框图如图10所示。图10主程序框图初始化子程序的功能主要是完成器件工作方式的设定、系统运行参数和变量的初始化等。初始化子程序框图如图11所示。中断服务子程序的设计是整个系统软件设计的关键部分，用来完成实时性强的功能。例如PWM控制信号的生成、状态检测以及数字PI调节等。中断服务子程序主要包括了转速调节中断服务子程序、电流调节中断服务子程序。图11初始化子程序框图图12转速调节