自动控制原理课程设计报告-北京科技大学Word文档

《自动控制原理课程设计报告-北京科技大学Word文档》由会员分享，可在线阅读，更多相关《自动控制原理课程设计报告-北京科技大学Word文档（17页珍藏版）》请在装配图网上搜索。

1、北京科技大学自动控制原理课程设计学院： 班级：学号：指导教师：姓名：整理为word格式目录一引言3二系统模型的建立3三系统控制的优化63.1 PID调节参数的优化73.2 积分分离PID的应用10四，结语13整理为word格式双轮自平衡智能车行走伺服控制算法摘要：全国第八届“飞思卡尔”智能汽车大赛已经结束。光电组使用大赛提供的D车模，双轮站立前进，相对于以前的四轮车，双轮车的控制复杂度大大增加。行走过程中会遇到各种干扰，经过多次的实验，已经找到了一套能够控制双轮车的方法。双轮机器人已经广泛用于城市作战，排爆，反恐，消防以及空间消防等领域。实验使用单片机控制双电机的转速,达到了预期的效果。关 键

2、 词:自平衡;智能;控制算法Motion Servo Control Algorithm for Dual Wheel Intelligent CarAbstract: The 8th freescale cup national Intelligent Car competition of has been end.The led team must used D car which has only 2tires.It is more difficult to control prefer to control A car which has 4tires.There is much in

3、terference on the track. A two-wheeled robots have been widely used in urban warfare, eod, counter-terrorism, fire control and space fire control and other fields。We has searched a good ways to control it.We used MCU to control the speed of motors and get our gates.Key Words: balance by self; intell

4、igent; control algorithm整理为word格式一引言双轮自平衡车是智能汽车中一个重要的组成部分。由于其是两轮站立，在很多场合有比四轮车更灵活，更方便控制的特点。基于双轮车的机器人已经用于在城市作战，排爆，反恐，消防，空间探测等领域。双轮自平衡车的控制过程与倒立摆相似。本次研究主要是对双轮车直立的研究。由于车在前进过程中还可能遇到弯道和路障，所以本文还对整个系统的稳定性做了比较深入的研究。在理论证明正确的前提下，再次进行仿真验证，仿真验证的结果与实验结果相符合。二系统模型的建立智能汽车竞赛使用的是D车模。D车模是双电机，双轮的车模。单电机控制双轮时可以满足车身保持平衡和前进的

5、要求，而之所以使用双电机是为了前进过程中转弯的需要。本文只讨论跟直立和干扰有关的内容，鉴于此，本文余下内容默认是单电机控制的车模。自平衡车在没有电机控制的情况下属于不稳定系统，在极小的干扰下，就会偏离平衡位置而失去平衡。因此，控制系统必须使用反馈控制。图1是站立在赛道上的双轮车模。整理为word格式图1 站立在赛道上的自平衡双轮车 自平衡双轮车在只研究直立的情况下与倒立摆相似，因此这里将借助倒立摆的研究方式研究双轮车的平衡控制。 控制车模平衡的主观经验。一般的人通过简单练习就可以让一个直木棒在手指尖上保持直立。这需要两个条件：一个是托着木棒的手可以移动；另一个是眼睛可以观察到木棒的倾斜角度和倾

6、斜趋势（角速度）。通过手掌移动抵消木棒的倾斜角和趋势，从而保持直立。这两个条件缺一不可，实际上就是控制中的负反馈控制，见图2。图2 在手上不倒的木棍世界上没有一个天才杂技演员可以蒙着双眼使得木棒在自己指尖上直立，因为没了双眼就没了负反馈的环节。经过简单的分析可以得到图3所示的控制结构图。图3 不倒的木棍的控制结构图同样，双轮直立车的控制也是通过负反馈来实现的，与上面保持木棍直立则比较简单。因为车模有2个轮子着地，车体只会在轮子滚动的防线上发生倾斜。控制轮子转动，抵消在一个维度上倾斜的趋势便可以保持车体的平衡了。如图4，5, 6所示。图4 车体平衡，车轮静止整理为word格式图5 车体后倾，车轮

7、向后加速图6 车体前倾，车体向前加速将双轮车简化成高度为L，质量为m的简单倒立摆，它可以放置在左右移动的车轮上。与空气中的单摆类似，车身偏离平衡位置后要想能迅速的回到平衡位置，车身应该受到与位移方向相反的的回复力。在平衡点附近，角度很小，即有sin 。假设车身偏离平衡角度后，将受到电机产生的与角度成比例的力:f = mk1(1) 由于重力原因，车身偏离平衡位置后受到的回复力为：F = mg mk1 (2)从上式中可以看出回复力要想与位移相反，必须有k1 g。假设外力干扰引起车模产生角速度x(t)。沿着垂直于车模底盘的方向进行受力分析，可以得到车模倾角与车轮加速度a(t)以及外力干扰加速度x(t

8、)之间的的运动方程。受力分析如图7所示。图7 车模受力分析Ld2dt2=gt-at+Lxt-k1 (4)车模静止不向前运动时，a(t) = 0,即：Ld2dt2=gt+ Lxt-k1(t) (5)对应车模静止时，系统输入输出的传递函数为：Hs= (s)X(s)= 1s2+k1L- gL (6)此时系统具有2个极sp = -g+k1L。一个极点位于s平面的右半平面，车模不稳定。在此处假设L=0.1，k1 = 20用matlab仿真此系统：Matlab代码如下：%程序目的：在没有微分量的情况下仿%真系统的阶跃响应%author:程顺均%时间：2013.8.28sys = tf(1, 1 0 100

9、);t = 0:0.01:3;figure(1)step(sys,t);grid on仿真截图如图8所示：整理为word格式图8 比例控制系统的阶跃响应从图来看，与分析结果一样，系统的阶跃响应为等幅振荡，不稳定。原因是在阶跃响应中没有阻尼，也就是说实际中的车不会倒向一边，而是在平衡位置附近来回震荡。这显然不是我们需要得到的效果。因此在系统中我们加入为微分量，也就是阻尼。在实际中变现为阻碍车模转动的力，类似于摩擦阻力，大小方向与车身角速度有关。即阻力Ff= k2ddt (7)经过拉式变换，得到带阻尼的系统的控制结构图，如图9所示：图9 加入比例微分反馈控制的系统系统传递函数为：Hs= (s)X(

10、s)= 1s2+k2Ls+k1-gL (8)此时系统的极点为：sp= -k2k2 2-4L(k1-g)2L (9)根据自动控制原理稳定性分析知识知道，只有系统的2个极点都在s平面的左半平面时系统才是稳定的。因此系统必须满足k1g,k20 。 假设k2 = 0.5，k1 = 20。利用matlab仿真。仿真代码如下：%程序目的：在比例微分控制的情况下仿%真系统的阶跃响应%author:程顺均%时间：2013.8.28sys = tf(1,1,5,100);t = 0:0.01:3;figure(1)step(sys,t);grid on;title(比例微分控制时的阶跃响应);阶跃响应曲线如下：

11、图10 比例微分控制的阶跃响应曲线从响应的曲线来看比例微分控制曲线能够比较收敛下来。在宏观看来，就是车身能够很快到我们需要的角度，而不是一直在设定角度的前后震荡。研究到此也智能算是解决了直立控制的问题。在实际中往往有很多干扰因素，例如飞思卡尔竞赛中赛道上就设有比赛道高的路障。如果稳定性较差的直立车在通过路障的时候，会直接倒下。假设干扰信号为D(s)，D(s)与s的关系为：s=(Ls2-gLs2+k2s+k1-g)D(s) (10) 这里我们把路障一类的干扰看成是脉冲干扰，D(s) = 1。仿真参数不变，对干扰进行一次仿真。仿真代码如下：%程序目的：仅在干扰下的输出响应%author:程顺均整理

12、为word格式%时间：2013.8.28sys = tf(0.1 0 -10,0.1 0.2 10);t = 0:0.2:10;figure(1);impulse(sys,t);gird on;仿真截图如图11所示：图11 系统对脉冲干扰的响应 从仿真的图来看，脉冲干扰会让本来已经稳定的系统来回的震荡，在多次震荡后才回到比较稳定的状态。因此比例-微分控制的方式能够满足我们的要求。对于一个系统来讲，能够稳定下来并不是我们追求的最终目标。接下来将详细研究系统的优化和稳定性。三系统控制的优化飞思卡尔智能汽车竞赛中评比成绩是以在赛道上跑一圈的时间为唯一依据的。这要求车在保持稳定的前提下以最大的速度前进

13、。系统的响应时间，抗干扰能力都是需要反复调整的。快的调整时间，小的超调量，高的稳定性都是我们期望的结果。3.1 PID调节参数的优化一般的系统我们都需要短的调节时间，小的超调量。往往我们是不能两方面做到极限，但是通过PID参数的调节，我们可以得到一个满意的调节过程。为了研究每个参数的意义，先进行单参数的研究。P一般是作为比例项，决定了系统的部分响应速度。在这里我们使用一个仿真代码完成这个仿真。仿真代码见附件1：Kp的研究通过改变系统的Kp，可以得到一系列的仿真图。这里选取4组做研究。分别为100,400，1000，2000。仿真图如图12,13,14,15所示。图12 Kp = 100时的阶跃

14、响应图13 Kp = 400时的阶跃响应整理为word格式图14 Kp = 1000时的阶跃响应图15 Kp = 2000时的阶跃响应为了方便对比出他们的不同，这里将他们的响应特征列表出来，如表1所示。表1 Kp对系统性能的影响Kp10040010002000调节时间1.50.8351.1851.37超调量5.8%未超调11.8%26.4%从表的的数据和调整图像来看，Kp的值很小的时候，系统的第一次上升达不到我们需要的值，需要积分项才能弥补。这不是我们需要的结果。而当Kp值很大的时候，上升时间缩短，超调量也会增大。因此Kp值得选择主要影响了系统的响应能力。Ki的研究PID中的I是积分项，主要是

15、消除稳态误差。下面通过4组不同的参数的测试研究其作用。Ki的值为100,400，1000,2000的时候的值仿真图如图15,16,17,18所示。图16 Ki=100的稳态误差图17 Ki=400的稳态误差图18 Ki=1000的稳态误差整理为word格式图19 Ki=2000的稳态误差从图像可以看出来，其上升速度和超调量并无太大的差异。他们的差异主要体现在稳态误差上了。将四组仿真的稳态误差在1.5S时取值列表得表2。表2 Ki对系统性能的影响Ki10040010003000稳态误差5.70%4.31%2.44%0.03%从表的数据很明显的可以看出，增大Ki值可以减小稳态误差。但是由于系统会受

16、到一些小的干扰，所以Ki的值也并不是越大越好！Kd的研究在PID调节中微分项起预见作用，在系统靠近预期值时可以减小控制输入量，进而减小超调量，增强系统的性能。下面同样通过4组数据研究Kd值对系统的影响。Ki分别为10,20,40,60时的仿真图如图20,21,22,23所示。图20 Kd=10的稳态误差图21 Kd=20的稳态误差图22 Kd=40的稳态误差图23 Kd=60的稳态误差从图上我们已经可以清晰地看出，Kd值的增大可以减小超调量，减少进入稳态前的振荡次数。下表列出了超调量和进入稳态前的振荡次数表，如表3所示。Kd10204060超调量61.6%43.8%25.2%15.9%进入稳态

17、前的11522整理为word格式穿越次数从表的数据可以看出，kd的值过小的时候，系统的超调量很大，振荡加剧。Kd的值越大，系统的超调量越小。但是由于微分量的对高频噪声具有放大作用。所以，Kp的值也不是越大越好！优化的结果前面研究了每个参数对系统的影响，下面进行一个综合仿真实验，从各方面综合考虑得到一个好的参数组合。经过反复实验，得到一组参数Kp = 1500,Ki = 4000.Kd = 100。仿真截图如图24所示。图24 经过优化的系统的阶跃响应从图24可以看出，系统的响应速度很快，超调量小，稳态误差基本为0。3.2 积分分离PID的应用在普通的PID控制中引入积分环节的目的，主要是为了消

18、除静态误差，提高控制精度。但是在过程的启动，结束或大幅度增减设定时，短时间内系统输出有很大的偏差，会造成PID运算的积分积累，致使控制量超时执行机构可能允许的最大动作范围内对应的极限控制量，引起系统较大的超调，甚至引起系统较大的震荡，这在实际控制中是不允许的。在车模实际运行过程中，单片机控制系统需要不停地的改变输入量，以满足对循迹和调速的要求。在车模启动和遇到障碍时，积分量都会饱和，这给车模的控制带来了麻烦。为此，将要研究优化后的PID调节器。为了防止积分量对系统控制的影响，有积分分离PID调节，抗积分饱和PID调节等。积分分离PID调节的基本思路是：当被控量与设定量值偏差较大时，取消积分作用

19、，以避免由于积分作用使使系统稳定性降低，超调量增大；当被控量与设定量接近设定值时，引入积分控制，以便消除静态误差，提供控制精度。其具体实现步骤如下：（1） 根据实际情况，认为设定阈值；（2） 当|error(k) |时，采用PD控制，可避免产生过大的超调，又使系统有较快的响应；（3） 当|error(k) (12)为了清晰的对比出普通PID调节和积分分离PID调节的不同，下面用m语言进行仿真,仿真代码见附件1。为了得到两者之间的区别，在程序加了一个变量M，这个变量M 为0的时候使用积分分离，变量M为1的时候整理为word格式使用积分分离。在这里，为了得到好的效果，当误差大于或等于6的时候取消积

20、分项，即beta = 0;只有当误差值小于1的时候才使用完全的积分项，即beta = 1; 积分分离法主要在有干扰的时候起作用，在无干扰的时候，作用并不明显。为此，在程序里添加了一个干扰项： if k 100 yd(k) = 200; %输出期望值 else yd(k) = 40;end此干扰项是一个脉冲形式的干扰，在时间运行到100到120的时候，期望输出值突然变得很大yd(k)。这个干扰是为了模仿一些路障而设置的。在小车突然撞到一个路障上时小车的倾角发生明显的变化。由于电机等驱动都有极限，所以为了保护器件，我们在控制程序里面一般会加上保护。为了接近真实的仿真，在这里我们也加入了保护程序，也

21、就是限制控制输入。限制保护程序如下： if u(k) = 20000 u(k) = 20000; end if u(k) = 20000 u(k) = 20000; end if u(k) = -20000 u(k) = -20000; end u2 = u1;u1 = u(k);%记录上次的值 y2 = y1;y1 = y(k); error1 = error(k);endfigure(1);plot(time,yd,r,time,y,b);grid on;legend(理想输出,位置跟踪);附件2：路障干扰仿真m程序：%程序目的：对比积分分离PID和普通PID%的不同%author:程顺均

22、%时间：2013.8.31%积分分离式PID仿真clear all;clear all;ts = 0.005; %控制周期为5mssys = tf(1,1 5 100);%建立系统dsys = c2d(sys,ts,z); %添加v可以让输出的值由元胞数组改为数组直接输出整理为word格式num, den = tfdata(dsys,v); u1 = 0;u2 = 0; %控制器的输出y1 = 0;y2 = 0; %实际的输出值error1 = 0; %上次上次误差ei = 0; %误差积累M = 1; %选择是否使用积分分离Kp = 1000;Ki = 3000;Kd = 50;for k=

23、1:1:500 time(k) = k * ts; if k 100 yd(k) = 200; %输出期望值 else yd(k) = 40; end y(k) = - den(2)*y1 - den(3)*y2 + num(2)*u1 + num(3)*u2; error(k) = yd(k) - y(k); %变化率的计算 ei = ei + error(k)*ts; %误差累积计算 if 1 = M %使用积分分离 if abs(error(k) = 6 beta = 0; %积分分离 elseif abs(error(k) = 2 & abs(error(k) = 20000 u(k)

24、 = 20000; end if u(k) vi_Ref) - ( int)(pp-vi_FeedBack) ;/ 偏差计算 d_error = error - (int)(pp-vi_PreError);整理为word格式 dd_error = d_error - (int)pp-vi_PreDerror; pp-vi_PreError = error;/存储当前偏差 pp-vi_PreDerror = d_error; if( ( error -VV_DEADLINE ) );/设置调节死区 else/速度PID计算 pp-motor_PreU += (int)(pp - v_Kp * d_error+ pp - v_Ki * error+ pp-v_Kd*dd_error)/10; if( pp-motor_PreU = VV_MAX ) /速度PID，防止调节最高溢出 pp-motor_PreU = VV_MAX; else if( pp-motor_PreU motor_PreU =VV_MIN; return (pp-motor_PreU);/ 返回预调节占空比 友情提示：本资料代表个人观点，如有帮助请下载，谢谢您的浏览！ 整理为word格式