计算机控制系统课程设计--直流伺服电机控制系统-精品(共30页)

1、直流伺服电机控制系统PAGE 目录(ml) TOC o 1-3 h z u HYPERLINK l _Toc406085629 1引言(ynyn) PAGEREF _Toc406085629 h 3 HYPERLINK l _Toc406085630 2单片机控制系统硬件(yn jin)组成 PAGEREF _Toc406085630 h 3 HYPERLINK l _Toc406085631 2.1微控制器 PAGEREF _Toc406085631 h 3 HYPERLINK l _Toc406085632 2.2电机驱动芯片 PAGEREF _Toc406085632 h 4 HYPER

2、LINK l _Toc406085633 2.3按键输入和显示模块 PAGEREF _Toc406085633 h 5 HYPERLINK l _Toc406085634 2.3.1按键输入 PAGEREF _Toc406085634 h 5 HYPERLINK l _Toc406085635 2.3.2显示模块 PAGEREF _Toc406085635 h 5 HYPERLINK l _Toc406085636 2.4直流伺服电动机 PAGEREF _Toc406085636 h 5 HYPERLINK l _Toc406085637 3.单片机控制系统软件设计 PAGEREF _Toc4

3、06085637 h 5 HYPERLINK l _Toc406085638 3.1主程序 PAGEREF _Toc406085638 h 6 HYPERLINK l _Toc406085639 3.2键盘处理子程序 PAGEREF _Toc406085639 h 7 HYPERLINK l _Toc406085640 4.控制系统原理图及仿真 PAGEREF _Toc406085640 h 7 HYPERLINK l _Toc406085641 4.1控制系统方框图 PAGEREF _Toc406085641 h 7 HYPERLINK l _Toc406085642 4.2控制系统电路原理

4、图 PAGEREF _Toc406085642 h 8 HYPERLINK l _Toc406085643 5.Simulink组件对直流伺服控制系统的仿真 PAGEREF _Toc406085643 h 8 HYPERLINK l _Toc406085644 5.1直流伺服电机数学模型 PAGEREF _Toc406085644 h 8 HYPERLINK l _Toc406085645 5.2系统Simulink模型及时域特性仿真 PAGEREF _Toc406085645 h 9 HYPERLINK l _Toc406085646 5.2.1 Simulink建模及仿真 PAGEREF

5、_Toc406085646 h 9 HYPERLINK l _Toc406085647 5.2.2单位负反馈系统Simulink建模及仿真 PAGEREF _Toc406085647 h 10 HYPERLINK l _Toc406085648 5.3 PID校正 PAGEREF _Toc406085648 h 11 HYPERLINK l _Toc406085649 5.3.1 PID参数的凑试法确定 PAGEREF _Toc406085649 h 11 HYPERLINK l _Toc406085650 5.3.2比例控制器校正 PAGEREF _Toc406085650 h 12 HYP

6、ERLINK l _Toc406085651 5.3.3比例积分控制器校正 PAGEREF _Toc406085651 h 14 HYPERLINK l _Toc406085652 5.3.4 PID控制器校正 PAGEREF _Toc406085652 h 16 HYPERLINK l _Toc406085653 5小结 PAGEREF _Toc406085653 h 19 HYPERLINK l _Toc406085654 引用文献 PAGEREF _Toc406085654 h 191引言(ynyn)本设计(shj)的直流伺服电机控制系统(kn zh x tn)是一个随动控制系统。以ST

7、M32核心板为控制器，通过按键将设定值输入到单片机，采用超声波传感器采集小车前方物体的距离，单片机对设定值与测量距离求差后输出控制信号，双BTN7971大电流H桥驱动伺服电机工作，进而控制电机向着减小差值的方向转动。同时单片机处理的数字信号通过LCD来显示，实时显示超声波传感器的测量值。另外本设计还利用了MATLAB软件，利用Simulink构造直流电机控制系统模型，通过对各个单元部件的参数进行设定，进而对直流伺服电机系统控制进行仿真，就其仿真结果对系统进行时域分析。2单片机控制系统硬件组成本系统是由一片单片机、矩阵式键盘、超声波模块HC-SR04、显示模块和一辆带有直流伺服电机的车模组成，另

8、外通过Altinum Designer软件进行电路设计。2.1微控制器STM32系列基于专为要求高性能、低成本、低功耗的嵌入式应用专门设计的ARMCortex-M3内核。按性能分成两个不同的系列：STM32F103“增强型”系列和STM32F101“基本型”系列。增强型系列时钟频率达到72MHz，是同类产品中性能最高的产品；基本型时钟频率为36MHz，以16位产品的价格得到比16位产品大幅提升的性能，是16位产品用户的最佳选择。两个系列都内置32K到128K的闪存，不同的是SRAM的最大容量和外设接口的组合。时钟频率72MHz时，从闪存执行代码，STM32功耗36mA，是32位市场上功耗最低的

9、产品。以下是STM32系列的内部结构图：2.2电机驱动(q dn)芯片模块(m kui)上的EN端为H桥的使能端，需要外接5V电压，EN不可悬空，当EN都为高电平时电机驱动模块(m kui)开始工作，EN端为低电平时，电机驱动停止工作。2.3按键输入(shr)和显示模块2.3.1按键(n jin)输入采用(ciyng)自己设计的形如44矩阵式按键，按键用于设定某一数值。通过程序设置延时环节来消除按钮的抖动问题，这样做使矩阵式按钮硬件连线简单，同时按钮的软件设计也变的简单。2.3.2显示模块系统采用传统点阵式1602显示器，显示传感器的测量值以及键盘的输入设定值。2.4直流伺服电动机直流伺服电动

10、机在伺服系统中控制机械元件转动.是一种补助马达间接变速装置。又称执行电动机，在自动控制系统中，用作执行元件，把所收到的电信号转换成电动机轴上的角位移或角速度输出。其主要特点是，当信号电压为零时无自转现象，转速随着转矩的增加而匀速下降。其作用可使控制速度、位置精度非常准确。直流伺服电动机的结构与直流电动机基本相同。只是为减小转动惯量，电机做得细长一些。所不同的是电枢电阻大，机械特性软、线性（电阻大，可弱磁起动、可直接起动）。供电方式是他励供电，即励磁绕组和电枢分别两个独立的电源供电。控制方式包括电枢控制和磁极控制，其中改变电枢电压U调速范围较大，直流伺服电机常用此方法调速。直流伺服电动机转速的计

11、算公式如下：式中：n为转速；为磁通；U为外加电压；I、R为电枢电流和电阻；Ke为电势系数。3.单片机控制系统(kn zh x tn)软件设计软件设计采用(ciyng)模块化设计，由主程序模块和功能实现模块两大部分组成。主程序通过读取键值与超声波传感器测量距离进行求差，结合(jih)PID控制算法输出至驱动模块以达到控制电机的目的；功能实现模块主要由主函数模块、键盘处理子程序和屏幕显示模块、PID控制算法子程序等组成。3.1主程序主程序首先对键盘和显示模块的程序进行初始化，通过读取键值处理后与超声波传感器测量距离进行求差以达到控制电机的目的。主程序流程图如图3-1所示。显示模块初始化键盘扫描程序

12、开始读取键值PID消除差值控制电机键盘模块程序初始化输入值是否有效？与传感器测距求差进行秋茶 N Y 图3-1主程序流程图3.2键盘(jinpn)处理子程序键盘采用程序扫描(somio)的工作方式，即在特定的程序位置段上安排键盘扫描程序读取键盘状态。键盘处理子程序的程序扫描法流程图如图3-2所示。是否有键按下？延时10ms调用按键扫描子程序开始是否有键按下？按键散转、处理程序返回 N N Y Y 图3-2键盘处理子程序(chngx)的程序扫描法流程图4.控制系统(kn zh x tn)原理图及仿真4.1控制系统(kn zh x tn)方框图控制系统是以单片机为控制器，通过键盘输入设定值，经单片

13、机处理后送到电机驱动器，电机驱动器将收到的信号进行放大，最终电机按照减小设定值与测量值的方式转动。图4-1即为控制系统方框图电机转动，随动系统完成将信号输出给电机驱动器PID控制减小差值与实际测量值求差按键输入图4-1控制系统(kn zh x tn)方框图4.2控制系统(kn zh x tn)电路原理图图4-2控制系统(kn zh x tn)电路原理图5.Simulink组件对直流伺服控制系统的仿真5.1直流伺服电机数学模型直流伺服电机闭环系统结构图如图5-1所示 U(S) N(S) 图5-1直流伺服电机闭环系统结构图其中(qzhng)直流伺服电机的传递函数为5.2系统(xtng)Simuli

14、nk模型及时(jsh)域特性仿真对于单输入单输出系统，在经典控制理论中可用传递函数来描述系统，获得系统的动态响应。同样，Simulink仿真软件也有传递函数模块，可方便地描述系统的特性，且简化了仿真模型。从模块库窗口创建系统模型如图1所示，选信号源模块组中的阶跃信号模块为输入信号，以输出模块组中的示波器模块作为显示器来观察系统阶跃响应。在模型窗口设置传递函数模块的参数和特性，运行仿真模型，得系统阶跃响应曲线。5.2.1 Simulink建模及仿真图5-2直流伺服电机开环系统Simulink模型端口Step为直流伺服电机的输入电压,输出端口为驱动信号。图5-3是开环系统的仿真结果，即开环系统的阶

15、跃响应曲线，也即直流伺服电机输入1V单位阶跃电压时。电机的转轴输出呈线性变化。图5-3开环系统(xtng)仿真图由图5-3响应曲线可知，系统没有在可视范围(fnwi)内达到稳态值“1”，但从理论上分析知此系统属稳定系统，在足够时间内是能够达到稳定状态的。上述分析说明(shumng)：系统的响应速度较慢，系统性能较差，从而可能不具备使用价值。结果表明，该系统没有达到预期的设计要求。5.2.2单位负反馈系统Simulink建模及仿真图5-4是在图5-3的基础上加一个单位负反馈环节，构成直流伺服电机的单位负反馈系统，单位负反馈系统Simulink模型如图5-4所示图5-4直流伺服电机单位负反馈系统S

16、imulink模型图5-5是单位(dnwi)负反馈系统的仿真结果图5-5单位负反馈系统(xtng)仿真图系统超调：40%，调节(tioji)时间：2s。由图5-5和开环阶跃响应曲线相比较知：系统应经可以达到较快达到稳态值。说明闭环单位负反馈系统对系统性能有很大改善。5.3 PID校正为了使系统能够达到设计要求，我们可以在图5-4前向通道上设置一个控制器构成闭环系统来校正直流伺服电机。基于PID控制（闭环）的直流伺服电机系统框图如图5-6所示。输入信号 +速度输出 输出信号 信号偏差 直流电机PID + -距离负反馈图5-6基于PID控制（闭环）的直流伺服电机系统框图其控制过程为比较超声波传感器

17、的测量值与键盘设定值，即输入信号，通过反馈后与系统输入信号进行比较，得到偏差信号。偏差信号作为PID控制器的输入信号根据设定的PID控制规律计算后输出信号U，作为控制量输入给直流电机，从而实现整个直流电机调速系统的闭环负反馈PID控制。5.3.1 PID参数的凑试法(sh f)确定增大(zn d)比例系数Kp系统响应(xingyng)有利于减小静差，但是过大会增大超调，并产生震荡，使稳定性变坏。增大Ti可以减小超调，减小震荡，是系统更稳定，但静差消除变慢。增大微分Td有利于加快系统响应时间，使超调减小，稳定性增加，但对扰动的抑制能力减弱，对扰动有较敏感的响应。在凑试时，对参数实行下述先比例，后

18、积分，再微分的整定步骤。(1)首先只整定比例部分。即将比例部分由小变大，并观察相应的系统响应，直到得到反应快，超调小的响应曲线。如果系统没有静差或静差已小到允许范围内，那么只需用比例控制器即可，最优比例系数可由此确定。(2)如果在比例调节的基础下系统的静差不能满足设计要求，则须加入积分环节。整定时首先置积分时间Ti为一较大值，并将经第一步整定得到的比例系数略微缩小，然后减小积分时间，并在保持系统良好动态性能的情况下，静差得到消除。在此过程中，可根据响应曲线的好坏反复改变比例系数与积分时间，以期得到满意的控制过程与整定参数。(3)若使用比例积分控制器消除了静差，但动态过程经反复调整仍不能满意，则

19、可加入微分环节，构成比例积分微分控制器。在整定时，可先置微分时间Td为零。在第二步整定的基础上，增大Td，同时相应的改变比例系数和积分时间，逐步凑试，以获得满意的调节效果和控制参数。5.3.2比例控制器校正比例控制系统Simulink模型及仿真图5-7 比例(bl)控制系统Simulink模型(mxng)Kp=1时仿真(fn zhn)图Kp=3时Kp=5时仿真(fn zhn)图由以上三个比例控制的仿真(fn zhn)图可知，增大比例系数KP一般系统响应利于减小静差，但是过大会(dhu)增大超调，并产生震荡，使稳定性变坏。5.3.3比例(bl)积分控制器校正积分控制的作用是只要系统存在(cnzi

20、)误差，积分控制作用就不断地积累，输出控制量以消除误差，因而，只要有足够的时间，积分控制将能完全消除误差。在比例(bl)环节基础上加入积分环节，只要参数设置合适就能完全消除系统偏差。比例积分控制系统Simulink模型图5-8 比例积分控制系统Simulink模型Kp=1、Ki=1时仿真图Kp=1、Ki=3时仿真图Kp=5、Ki=3时仿真(fn zhn)图由以上三个比例积分控制的仿真(fn zhn)图可知，增大TI有减小超调，减小震荡，使系统更稳定，但静差消除变慢。PI控制(kngzh)参数设置适当可使系统静差为零。经多次试凑，选KI=1.5.3.4 PID控制器校正(jiozhng)比例积分

21、作用虽能是系统误差为零，但系统动态性能不能得到(d do)满足。积分作用太强可能会使系统出现震荡。微分控制具有超前控制能力，可抑制最大动态偏差，改善系统动态性能，提高系统的稳定性。为此，在PI作用基础上引入微分控制，构成PID控制器，以使系统满足(mnz)稳、准、快的要求。PID控制控制系统Simulink模型如图图5-9 PID控制系统Simulink模型Kp=1、Ki=1、Kd=0.1时仿真图和PI控制闭环响应曲线相比较可知：系统响应时间变短，超调变小，但仍不符合要求；Kp=5、Ki=1、Kd=0.1时仿真(fn zhn)图与KP=1、KI=1、KD=0.1时的仿真图相比，系统超调和调节(

22、tioji)时间都变小，仍然不符合要求，继续校正。需加大Kp及Ki。Kp=12、Ki=1、Kd=0.5时仿真(fn zhn)图由上曲线知此时系统有微量的超调，进一步加大Ki时超调为零。Kp=12、Ki=1、Kd=0.9时仿真图经过多次校正参数(cnsh)，此时当Kp=12、Ki=1、Kd=0.9时系统超调量为0，稳态误差(wch)为0，性能满足设计要求，稳定、准确、快速(kui s)得到了完满的统一。5小结控制系统特点是以单片机为控制器，通过键盘输入设定值，使得系统消除测量值与实际值的偏差方便快捷。但在proteus中没能实现闭环系统的PID控制。此缺点通过软件弥补，在MATLAB软件中的SI

23、MULINK中进行了直流伺服电机的开环控制系统仿真，单位闭环控制系统仿真，闭环PI控制系统仿真,闭环PD控制仿真,闭环PID控制仿真能够更好的测试和控制系统的性能，从而为系统设计提供了更准确的性能指标。参考文献1李正军.计算机控制系统(kn zh x tn).北京：机械(jxi)工业出版社，2010.62周荷琴等.微型(wixng)计算机原理及接口技术M.合肥：中国科技大学出版社,2008.63张毅刚等.单片机原理与应用设计M.北京：电子工业出版社4计算机控制技术实验指导书部分程序如下：#include stm32f10 x.h #include user_Config.h #include

24、TFT28.h #include GUI.h#include #include key.h#include int overflow=0; #define module_interval 25 #define object_distance 100.0 void NVIC_Configuration(void);void TIM_Configuration(void);void GPIO_Configuration(void);void RCC_Configuration(void);float Sensor_using(void);void delay(void);unsigned long

25、 lastTime;double Input, Output, Setpoint,dErr;double errSum, lastErr;unsigned int Device_code; GPIO_InitTypeDef GPIO_InitStructure;/定义(dngy)一个结构(jigu)变量，用于初始化GPIOErrorStatus HSEStartUpStatus;void Delay(vu32 nCount) for(; nCount != 0; nCount-);void delay_ms(unsigned int nCount) int i,j; for(i=0;inCou

26、nt;i+) for(j=0;jCNT=0; while(GPIO_ReadInputDataBit(GPIOC,GPIO_Pin_11) & overflow=0); TIM_Cmd(TIM3, DISABLE); if(overflow!=0) overflow=0;return 0.0; TIM=TIM_GetCounter(TIM2);distance=(float)sqrt(TIM/20.0*17)*(TIM/20.0*17)-module_interval*module_interval/4.0)+12.0; return(distance);void TIM3_PWM_Init(

27、u16 arr,u16 psc)/PWM output GPIO_InitTypeDef GPIO_InitStructure; TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure; TIM_OCInitTypeDef TIM_OCInitStructure; RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE); RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC | RCC_APB2Periph_AFIO, ENABLE); GPIO_PinRemapConfig(

28、GPIO_FullRemap_TIM3, ENABLE); /启用(qyng)定时器三 GPIO_InitStructure.GPIO_Pin =GPIO_Pin_6 | GPIO_Pin_7 | GPIO_Pin_8 | GPIO_Pin_9; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP; GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; GPIO_Init(GPIOC, &GPIO_InitStructure); GPIO_ResetBits(GPIOC,GPIO_Pin_6 | GPIO_

29、Pin_7 | GPIO_Pin_8 | GPIO_Pin_9); TIM_TimeBaseStructure.TIM_Period = arr; TIM_TimeBaseStructure.TIM_Prescaler =psc; TIM_TimeBaseStructure.TIM_ClockDivision = 0; TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; TIM_TimeBaseInit(TIM3, &TIM_TimeBaseStructure); TIM_OCInitStructure.TIM_OCMode

30、= TIM_OCMode_PWM1; TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable; TIM_OCInitStructure.TIM_Pulse = 0; TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High; TIM_OC1Init(TIM3, &TIM_OCInitStructure); TIM_OC1PreloadConfig(TIM3, TIM_OCPreload_Enable); TIM_OC2Init(TIM3, &TIM_OCInitStruct

31、ure); TIM_OC2PreloadConfig(TIM3, TIM_OCPreload_Enable); TIM_OC3Init(TIM3, &TIM_OCInitStructure); TIM_OC3PreloadConfig(TIM3, TIM_OCPreload_Enable); TIM_OC4Init(TIM3, &TIM_OCInitStructure); TIM_OC4PreloadConfig(TIM3, TIM_OCPreload_Enable); TIM_ARRPreloadConfig(TIM3, ENABLE); TIM_Cmd(TIM3, ENABLE); Com

32、pute(double kp,double ki,double kd)/PID control double dErr; unsigned long now; double timeChange = (double)(now - lastTime); double error = Setpoint - Input; errSum += (error * timeChange);dErr = (error - lastErr)/timeChange; Output = kp * error + ki * errSum + kd * dErr; lastErr = error; lastTime = now;int main(void)float result=0;int x; RCC_Configuration;/系统(xtng)时钟(shzhng)初始化 NVIC_Configuration();/中断(zhngdun)初始化TIM_Co