二阶倒立摆实验报告.pdf

《二阶倒立摆实验报告.pdf》由会员上传分享，免费在线阅读，更多相关内容在应用文档-天天文库。

1、研究生课程报告二阶倒立摆的控制二阶倒立摆的控制指导老师：屈桢深问题描述小车质量0.8kg，摆杆1质量0.3kg,摆杆长度1.0m；摆杆2质量0.1kg,摆杆长度0.5m。要求：设计NN控制器，满足指标要求：0.2Hz正弦信号幅值裕度<10%,相角裕度<15度。同时系统具备抗噪声和干扰性，控制输入合理步骤：1阶倒立摆->2阶倒立摆。一阶倒立摆建模小车由电机通过同步带驱动在滑杆上来回运动，保持摆杆平衡。电机编码器和角编码器向运动卡反馈小车和摆杆位置（线位移和角位移）。小车在轨道上可以自由滑动。单级倒立摆系统数学模型.N和P分别为小车与摆杆相互作用力的水平和垂直方

2、向的分量。分析小车水平方向所受的合力，可得到方程为：MxFbxN由摆杆水平方向的受力进行分析可以得到下面等式：2dNmxlsin2dt2Nmxmlcosmlsin把这个等式代入式中，得到系统的第一个运动方程：2MmxbxmlcosmlsinF为了推出系统的第二个运动方程，对摆杆垂直方向的合力进行分析，得到下面的方程：2dPmgmlcos2dt2Pmgmlsinmlcos力矩平衡方程如下：PlsinNlcosI方程中力矩的方向，coscos,sinsin，故等式前面有负号。合并这两个方程，约去P和N，得到第二个运动方程：..2Imlmglsinmlxcos假设

3、与1（单位是弧度）相比很小，即1，则可进行近似处理：2dcos1,sin,0dt用u代表被控对象的输入力，线性化后两个运动方程如下：2ImlmglmlxMmxbxmlu对方程（7）进行拉普拉斯变换，得到：222Iml(s)smgl(s)mlX(s)s22MmX(s)sbX(s)sml(s)sU(s)推导时假设初始条件为0则摆杆角度和小车位移的传递函数为：2(s)mls22X(s)(Iml)smgl摆杆角度和小车加速度之间的传递函数为：(s)ml22A(s)Imlsmgl摆杆角度和小车所受外界作用力的传递函数：..ml2s(s)q2F(s)4b(Iml)3(M

4、m)mgl2bmglssssqqq222q(Mm)(Iml)ml以外界作用力作为输入的系统状态空间表达式为：0100x&Iml2bm2gl2x()0022&x&I(Mm)MmlI(Mm)Mmlx&&0001&&&mlbmgl(Mm)0022I(Mm)MmlI(Mm)Mml02Iml2I(Mm)Mmlu0ml2I(Mm)Mmlxx1000x&0yu00100&以小车加速度作为输入的系统系统状态空间表达式：01000x&x00001x&&x&'00010u&3g&30004l4l..xx1000x&0'yu00100&2系统的可控性、可观测性分析对于连续时间系统

5、：XAXBuyCXDu系统状态完全可控的条件为：当且仅当向量组n1B,AB,...,AB是线性无关的，或n×n维矩阵n1BABAB的秩为n。系统的输出可控条件为：当且仅当矩阵2n1的秩等于输出向量y的维数。CBCABCABCABD应用以上原理对输入为加速度输出为摆杆与竖直方向的角度的夹角时的系统进行可控性分析即可。二阶倒立摆建模在忽略了空气流动，各种摩擦之后，可将倒立摆系统抽象成小车、匀质杆的系统，如图所示。..图1直线两级倒立摆物理模型下面利用拉格朗日方程推导运动学方程。拉格朗日方程为：Lq,q&Tq,q&Vq,q&dLLfidtq&qTTMTm1Tm2T

6、m3Tm1Tm1Tm1Tm2Tm2Tm212TMMx&2..221dxl1sin1dl1sin1Tm1m12dtdt1mx&2mlx&&cos1ml2&21111111122121122122Tm1Jp1m1l11m1l112236'''12222Tm1Tm1Tm1m1x&m1l1x&&1cos1m1l1&123同样可以求出22'1d(x2l1sin1l2sin21d(2l1cos1l2cos2)Tm2m2m22dt2dt1212m2x&2l1&1cos1l2&2cos2m22l1&1sin1l2&2sin222''12112212&2Tm2J22m2l22

7、m2l222236'''1&2&&&Tm2Tm2Tm2m2x2x2l11cos1l22cos221m4l2&24l2&24ll&&cos2112212122123因此，可以得到系统的总动能为：..TTMTm1Tm21Mx&21mx&2mlx&&cos2ml2&21111111122312m2x&2x&2l1&1cos1l2&2cos221m4l2&24l2&24ll&&cos2112212122123系统的总势能为：VVm1Vm2Vm3m1gl1cos1m2g2l1cos1l2cos2从而拉格朗日算子：LTV1Mx&21mx&2mlx&&cos2ml2&21

8、111111122312mx&2x&2l&cosl&