一级倒立摆的建模与控制分析.doc

控制工程与仿真课程设计报告报告题目 直线一级倒立摆建模、分析及控制器的设计 组员1专业、班级 14自动化1 班 姓名 朱永远 学号 1405031009 组员1专业、班级 14自动化1 班 姓名 王宪孺 学号 1405031011 组员1专业、班级 14自动化1 班 姓名 孙金红 学号 1405031013 报告评分标准评分项目权重评价内容评价结果项目得分内容70设计方案较合理、正确，内容较完整70-50分设计方案基本合理、正确，内容基本完整50-30分设计方案基本不合理、正确，内容不完整0-30分语言组织15语言较流顺，标点符号较正确10-15分语言基本通顺，标点符号基本正确5-10分语言不通顺，有错别字，标点符号混乱5分以下格式15报告格式较正确，排版较规范美观10-15分报告格式基本正确，排版不规范5-10分报告格式不正确，排版混乱5分以下总 分 直线一级倒立摆建模、分析及控制器的设计一 状态空间模型的建立1.1直线一级倒立摆的数学模型 图1.1 直线一级倒立摆系统 本文中倒立摆系统描述中涉及的符号、物理意义及相关数值如表1.1所示。 图1.2是系统中小车的受力分析图。其中，N和P为小车与摆杆相互作用力的水平和垂直方向的分量。图1.2 系统中小车的受力分析图图1.3是系统中摆杆的受力分析图。Fs是摆杆受到的水平方向的干扰力, Fh是摆杆受到的垂直方向的干扰力，合力是垂直方向夹角为的干扰力Fg。图1.3 摆杆受力分析图 分析小车水平方向所受的合力，可以得到以下方程： 设摆杆受到与垂直方向夹角为 的干扰力Fg，可分解为水平方向、垂直方向的干扰力，所产生的力矩可以等效为在摆杆顶端的水平干扰力FS、垂直干扰力Fh产生的力矩。 对摆杆水平方向的受力进行分析可以得到下面等式： 即： 对图1.3摆杆垂直方向上的合力进行分析，可以得到下面方程： 即 力矩平衡方程如下： 代入P和N，得到方程： 设，（是摆杆杆与垂直向上方向之间的夹角，单位是弧度），代入上式。假设 A=0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0; B=0;1;0;3; T=ctrb(A,B); rank(T)ans = 4由于rank（Ic）=4，可见该系统是完全可控的。2.3 系统能观测性分析系统的可控性可根据秩判据进行可控性判断。线性定常连续系统完全可控的充分必要条件是：或其中n为系数矩阵A的阶次。matlab程序及运行结果如下： A=0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0; C=1 0 0 0;0 0 1 0; T0=obsv(A,C);rank(T0)ans = 4由于rank（T0）=4，故该系统是可观测的。 三 状态反馈与状态观测器设计3.1状态反馈原理设维线性定常系统： 其中x,u,y分别是n维、p维、q维向量；A、B、C分别是n*n维，n*p维，n*q维实数矩阵。状态反馈系统的控制量u取为状态x的线性函数：其中，v为p参考输入向量，K为p*n维实反馈增益矩阵。 加入状态反馈后系统的结构图如图3.1所示：图3.1 系统的全状态反馈结构图 则系统状态反馈的动态方程为： 3.2状态反馈观测器和simulink仿真状态反馈的的实现是利用状态反馈使系统的闭环极点位于所希望的极点位置。而状态反馈任意配置闭环极点的充分必要条件是被控系统可控。直线一级倒立摆系统是可控的。 设系统期望极点为=，则系统期望特征多项式为： 列写状态反馈系统的特征多项式： 令两个特征多项式各项系数对应相等，则可解出K阵。由matlab求出状态反馈矩阵K，编程如下： A=0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0; B=0;1;0;3; K=acker(A,B,-2 -3 -4+3i -4-3i)K = -5.1020 -5.8844 35.1673 6.2948系统加入0.1m/s2的阶跃输入，在构成的状态反馈调节器控制下，MATLAB中进行系统的阶跃响应仿真，编程如下：A=0 1 0 0 0 0 0 0 0 0 0 1 0 0 29.4 0;B1=0 1 0 3;C=1 0 0 0 0 1 0 0 0 0 1 0 0 0 0 1;D1=0 0 0 0;dt=0.005;ieof=801;for i=1:ieof; U(:,i)=0.1; T(i)=i*dt;end; %离散化op=-2 %期望极点 -3 -4+3i -4-3i;K=place(A,B1,op)Ak0=(A-B1*K);Bk0=B1;Ck0=C;Dk0=D1;lqrop=eig(Ak0);x=0 0 0 0;dt=0.005;%离散时dA,dB=c2d(Ak0,Bk0,dt);%经离散化得到离散状态方程Ak1=(A-B1*K);Bk1=B1;Ck1=C;Dk1=D1;sys=ss(Ak1,Bk1,Ck1,Dk1);Y,X=lsim(sys,U,T);plot(T,-Y),grid;legend(Cart,VCart,single,Vs);图3.2 极点配置为-2 -3 -4+3i -4-3i时的全状态反馈仿真图 横轴时间单位秒，从图中可以看出，系统稳定。四 总结 通过对一级倒立摆的分析可知，在开环情况下，倒立摆的平衡系统是不稳定的的；通过秩判据可知，其系统是可控可观测的；以上都是利用MATLAB对其进行分析和设计，对其系统进行了稳定性、可控性、可观测性分析，以及极点配置和最优控制设计，从中我们可以看出，MATLAB作为一种交互式计算分析软件，其强大的运算分析功能，集科学计算、程序设计和可视化于一体的高度集成化软件环境，为控制系统的分析设计，特别是高阶系统综合设计，提供了一种方便可靠的途径。参考文献1 李国勇，控制系统数字仿真与CADM，北京：电子工业出版社，2003，92 王丹力，MATLAB控制系统设计仿真应用M，北京：中国电力出版社，2007，93 薛定宇，控制系统仿真与计算机辅助设计M，北京：机械工业出版社，2005，14 金以慧，过程控制M，北京：清华大学出版社，2003，65 刘金琨. 先进PID控制及其MATLAB仿真M . 北京：电子工业出版社，2003，6 薛定宇. 控制系统计算机辅助设计MATLAB语言及应用M. 北京：清华大学出版社，19967 易继锴. 智能控制技术M. 北京：北京工业大学出版社，2003.8 李国勇. 控制系统数字仿真与CADM. 北京：电子工业出版社,2011.9 邵裕森.