自动控制原理课程设计(倒立摆)

自动控制原理课程设计倒立摆控制系统研究/XX航空航天大学课程名称：自动化控制原理课程设计专业：探测制导与控制技术时间：2016.6.20-2016.6.25一、实验目的1、 学会用SIMULINK软件分析复杂的控制系统。2、 会用状态反馈进行控制系统设计。3、 了解状态观测器的实现。二、实验设备1、 计算机和打印机。2、 实际倒立摆系统。三、实验原理假设原系统的状态空间模型为,若系统是完全能控的,则引入状态反馈调节器这时,闭环系统的状态空间模型为设计任务是要计算反馈K,使A-BK的特征值和期望的极点P相同。通过将倒立摆线性数学模型输入到MATLAB中,使用K=place<A,B,P>函数算出反馈矩阵反馈增,K和期望极点向量P应与状态变量X具有相同的维数。。本系统可令输入R=0,即只讨论初始值对系统的作用。倒立摆系统模型如下：1、倒立摆线性模型：2、倒立摆非线性模型:其中：四、实验内容1、根据给出的倒立摆的线性数学模型,讨论系统的稳定性,可控性和可观性。A=[0010;0001;65.8751-16.8751-3.70620.2760;-82.212282.21224.6254-1.3444];B=[0;0;5.2184;-6.5125];C=[1000;0100];D=[0;0];r1=rank<ctrb<A,B>> ；计算可控性矩阵的秩,判断可控性r2=rank<obsv<A,C>> ；计算可观性矩阵的秩,判断可观性eig<A> ；计算系统的极点,通过极点的实部来判断稳定性运算结果：r1=4 ；可控性矩阵的秩为4=n,系统可控r2=4 ；可观性矩阵的秩为4=n,系统可观ans=-12.6466 ；系统存在正实部极点,系统不稳定-6.70279.04425.2546得出结论如下：〔1特征方程的根为：-12.6466,-6.7027,9.0442,5.2546由此可知有两个极点在虚轴的左半平面,故系统不稳定。〔2系统的可控性分析：因为：nc=4与系统的维数相等,可得到系统可控。〔3系统的可观测性分析：因为：no=4与系统维数相等,可知系统可测。2.根据给出的倒立摆的非线性数学模型用SIMULLINK图形库实现倒立摆系统的结构图,并给出初始角度θ1为0.1左右<弧度>时系统的状态响应<给出4个响应曲线,此时令控制u=0>。SIMULINK图如下,〔1原系统SIMULINK仿真封装系统图originsystem〔2原系统SIMULINK仿真子系统图Subsystem〔3A0模块〔4B0模块令控制u=0,初始角度θ1为0.1左右<弧度>时系统的状态响应曲线分别如下：<按顺序依次为θ1.θ2..的图像>3、为使系统稳定,根据线性模型设计系统的状态反馈阵K,即使A-BK的特征值具有负实部。A=[0010;0001;65.8751-16.8751-3.70620.2760;-82.212282.21224.6254-1.3444]B=[0;0;5.2184;-6.5125]C=[1000;0100]D=[0;0]P=[-20;-15;-3+4i;-3-4i]K=place<A,B,P>配置极点为：-20;-15;-3+4i;-3-4i得到反馈矩阵为：K=-10.8771-120.6299-9.4770-13.11394、在2的基础上,用SIMULINK实现状态反馈,仍给出初始角度θ1为0.1左右<弧度>时系统的状态响应<4个响应曲线,此时令控制u=0>,并确定能使系统稳定的最大初始角度θ1。根据要求得到SIMULINK图如下：得到的响应曲线如下图所示：加入反馈后,系统可以在0度稳定,反馈系数是由我们设定的极点决定,由于我们选的极点离虚轴较远,所以响应很快。通过对初始角度θ1尝试性地代入系统,运行仿真图,看示波器的运行结果来判断系统是否稳定,最终得到θ1max=0.655。5、将所设计的反馈阵实施到实际的倒立摆装置上看是否稳定,若不稳定再通过仿真修正K值以最终达到系统稳定的目的。试验过程：在旋臂和摆杆自然下垂,用手将摆杆扶到中间位置附近,按下开关,倒立摆保持平衡运动状态。打开系统提供的PC程序〔需在Win98的环境中设置为"控制模式"后开始运行程序。在参数设置中,按设计好的反馈参数,设置Ka,Ko,Kva,Kvo。点击"OK"并进行联机控制。在试验中设置K=[-10.8771-120.6299-9.4770-13.1139],。在实际验证中,倒立摆的恢复速度比较理想,可以以较快速的速度恢复到平衡状态。所以选择最终的K参数仍然是仿真试验中的K=[-10.8771-120.6299-9.4770-13.1139],。A=[0010;0001;65.8751-16.8751-3.70620.2760;-82.212282.21224.6254-1.3444];B=[0;0;5.2184;-6.5125];C=[1000;0100];A=[0010;0001;65.8751-16.8751-3.70620.2760;-82.212282.21224.6254-1.3444];B=[0;0;5.2184;-6.5125];C=[1000;0100];D=[0;0];Q=[0010;0001;1000;0100];Qn=inv<Q>;A1=Q*A*QnB1=Q*BC1=C*QnA1=-3.70620.276065.8751-16.87514.6254-1.3444-82.212282.21221.000000001.000000B1=5.2184-6.512500C1=00100001〔1降维观测器的设计过程：A11=[-3.70620.2760;4.6254-1.3444];A11=[-3.70620.2760;4.6254-1.3444];A12=[65.8751-16.8751;-82.212282.2122];A21=[10;01];A22=[00;00];B1=[5.2184;-6.5125];B2=[0;0];C1=[00;00];C2=[10;01];p=[-12-8j,-12+8j];H=place<A11’,A21’,p’>’T=A11-H*A21F=B1-H*B2L=<A11-H*A21>*H+A12-H*A22H=8.2938-7.724012.625410.6556T=-12.00008.0000-8.0000-12.0000F=5.2184-6.5125L=67.3527161.0577-300.067416.1370〔2Simulink仿真图及结果：由上图可知,用降维观测器实现反馈得到的系统响应曲线与直接状态反馈曲线基本相同,充分验证了状态观测器的作用。同时降维观测器状态反馈比直接的状态反馈性能好许多。五、实验分析1.系统可控、可观性与稳定性验证。由MATLAB可以判断倒立摆为可控可观,但系统不稳定。设计状态反馈要求系统是完全可控的,设计状态观测器要求系统具有完全可观性,正是由于该系统不稳定,我们才设计了观测和反馈阵,使其具有在一定干扰下的稳定性。经分析可知,该系统完全满足上述要求,故此种设计方法是可行的。配置K阵极点原则：〔1要使系统稳定则极点应配置在左半平面〔24个极点中选取其中2个作为主导极点,以达到近似于二阶系统,要使其能成为主导极点则其他2个极点必须设计为大于主导极点实部的5倍已上,这样才能消除其对系统的影响。在选取极点过程中要不断地进行尝试,最终使系统稳定。值得注意的是,在仿真中系统稳定,而加至实际的倒立摆装置,不一定能使其稳定,原因主要是纯粹的物理模型和工程上模型有一定的出入。3.由不加状态反馈时系统的响应曲线分析可知：不加入状态反馈的原系统不稳定,即倒立摆在初始角度为0.1时无法最终到达平衡状态4.由加上状态反馈时系统的响应曲线分析可知：加入状态反馈的系统可以在较短时间内达到稳定状态,并且在0.73弧度范围内都可以稳定。5.由带状态观测器的状态反馈系统的响应曲线分析可知：带状态观测器的状态反馈系统和仅加上状态反馈的系统进行对比,带状态观测器的系统的性能明显比仅有状态反馈的系统稳定性能差。并且动态响应性能不好,恢复到平衡状态的时间相对较长。六、实验体会通过该课程设计收获良多,首先更加熟悉MATLAB的使用方法,MATLAB是一款强大的学习工具,在控制、数学等多个领域发挥了巨大的作用,此次课设,让我又掌握了MATLAB的一些功能,比如封装、求系统的状态反馈阵等。对于一个学控制的学生,MATLAB是以后学习必需的工具软件,此次课设给了我一个很好的锻炼机会,为以后的进一步学习打下了基础。其次再次让我重温刚学过的知识,加深了对刚学知识的理解；再次切身感受到了将理论运用于实践的成就感：将状态反馈的加至系统,看到系统能控制实际的倒立摆装置,心里特别兴奋。该课程设计总体思路比较清晰：〔1判断系统稳定性、可控性、可观性〔2设计状态反馈〔3设计状态观测器。难点主要在于系统是非线性的以及我们对降维观测器并不了解两方面。我花了很长一段时间,去了解该观测器的原理,作用,以及设计步骤,目标和理论结果,然后再模拟出系统,不过幸好极点配置的要求不是很高,也就降低了一定难度,在经过数十次的试验对比分析之后,确定了较为合适的极点。通过本次课程设计我深刻地体会到了理论与实际的差别