二阶倒立摆实验报告

研究生课程报告二阶倒立摆的控制二阶倒立摆的控制指导老师：屈桢深问题描述小车质量0.8kg，摆杆1质量0.3kg,摆杆长度1.0m；摆杆2质量0.1kg,摆杆长度0.5m。要求：设计NN控制器，满足指标要求：0.2Hz正弦信号幅值裕度10%,相角裕度15度。同时系统具备抗噪声和干扰性，控制输入合理步骤：1阶倒立摆-2阶倒立摆。一阶倒立摆建模小车由电机通过同步带驱动在滑杆上来回运动，保持摆杆平衡。电机编码器和角编码器向运动卡反馈小车和摆杆位置（线位移和角位移）。小车在轨道上可以自由滑动。单级倒立摆系统数学模型研究生课程报告二阶倒立摆的控制1N和P分别为小车与摆杆相互作用力的水平和垂直方向的分量。分析小车水平方向所受的合力，可得到方程为：NxbFxM由摆杆水平方向的受力进行分析可以得到下面等式：sincossin222mlmlxmNlxdtdmN把这个等式代入式中，得到系统的第一个运动方程：FmlmlxbxmMsincos2为了推出系统的第二个运动方程，对摆杆垂直方向的合力进行分析，得到下面的方程：cos22ldtdmmgPcossin2mlmlmgP力矩平衡方程如下：INlPlcossin方程中力矩的方向，sinsin,coscos，故等式前面有负号。合并这两个方程，约去P和N，得到第二个运动方程：研究生课程报告二阶倒立摆的控制2cossin2xmlmglmlI假设与1（单位是弧度）相比很小，即1，则可进行近似处理：0,sin,1cos2dtd用u代表被控对象的输入力，线性化后两个运动方程如下：umlxbxmMxmlmglmlI2对方程（7）进行拉普拉斯变换，得到：)()()()()()()(22222sUssmlssbXssXmMssmlXsmglssmlI推导时假设初始条件为0则摆杆角度和小车位移的传递函数为：mglsmlImlssXs222)()()(摆杆角度和小车加速度之间的传递函数为：mglsmlImlsAs22)()(摆杆角度和小车所受外界作用力的传递函数：研究生课程报告二阶倒立摆的控制322432222()()()()()()mlssqbImlMmmglbmglFsssssqqqqMmImlml以外界作用力作为输入的系统状态空间表达式为：22222222220100()00()()0001()00()()0()0()xxImlbmglxxIMmMmlIMmMmlmlbmglMmIMmMmlIMmMmlImlIMmMmlumlIMmMml1000000100xxxyu以小车加速度作为输入的系统系统状态空间表达式：'0100000001000103300044xxxxugll研究生课程报告二阶倒立摆的控制4'1000000100xxxyu2系统的可控性、可观测性分析对于连续时间系统：BuAXXDuCXy系统状态完全可控的条件为：当且仅当向量组BAABBn1,...,,是线性无关的，或n×n维矩阵BAABBn1的秩为n。系统的输出可控条件为：当且仅当矩阵DBCABCACABCBn12的秩等于输出向量y的维数。应用以上原理对输入为加速度输出为摆杆与竖直方向的角度的夹角时的系统进行可控性分析即可。二阶倒立摆建模在忽略了空气流动，各种摩擦之后，可将倒立摆系统抽象成小车、匀质杆的系统，如图所示。研究生课程报告二阶倒立摆的控制5图1直线两级倒立摆物理模型下面利用拉格朗日方程推导运动学方程。拉格朗日方程为：,,,LqqTqqVqqidLLfdtqq123MmmmTTTTT111mmmTTT222mmmTTT212MTMx研究生课程报告二阶倒立摆的控制62211111122211111111sinsin1211cos22mdxldlTmdtdtmxmlxml222221111111111112236mpTJmlml'''2221111111111112cos23mmmTTTmxmlxml同样可以求出22'112211222222221112222111222(2sinsin(2coscos)1122112coscos2sinsin22mdxlldllTmmdtdtmxllmll''2222222222222211112236mTJmlml'''22222111222222221122121221122coscos21444cos23mmmTTTmxxllmllll因此，可以得到系统的总动能为：研究生课程报告二阶倒立摆的控制71222221111111122111222222221122121221112cos223122coscos21444cos23MmmTTTTMxmxmlxmlmxxllmllll系统的总势能为：12311121122cos2coscosmmmVVVVmglmgll从而拉格朗日算子：2222111111112211122222222112212122111121122112cos223122coscos21444cos23cos2coscosLTVMxmxmlxmlmxxllmllllmglmgll由于因为在广义坐标21,上均无外力作用，有以下等式成立：110dLLdt220dLLdt对21,求解代数方程，得到以下两式研究生课程报告二阶倒立摆的控制8111213122122221121212212211213121222112321(3(2sin4sin4sin3cos()sin6cos()sin()4sin()2cos4cos4cos3cos()cos))/(2(412129cos(gmgmmgmgmlmlmxmxmxmxlmmmm2)))22221231221112222212122221212311222222212312212124((3())(3sin6sin()3cos)92cos()(6sin()33(2())(sincos)))/16((3())4cos())9mmmmllglxmllmlmmmgxmmmmllmll表示成以下形式：111212(,,,,,,)fxxx221212(,,,,,,)fxxx取平衡位置时各变量的初值为零，1212(,,,,,,)(0,0,0,0,0,0,0)0Axxx将（23）式在平衡位置进行泰勒级数展开，并线性化，令:11100AfKx1231120112313(244)2(4312)AgmgmgmfKmmml研究生课程报告二阶倒立摆的控制9121302123192(4312)AfmgKmmml11400AfKx115010AfK116020AfK12311701213(24)2(43)AmmmfKxmml带入式，得到线性化之后的公式112113217KKKx将式在平衡位置进行泰勒级数展开，并线性化，令22100AfKx2122201221222(2)164(3)9AfgmmKmlmml2122302221224(3)163(4(3))9AfgmmKmlmml22400AfKx研究生课程报告二阶倒立摆的控制10225010AfK226020AfK121222702212242(2)(3)3164(3)9AmmmmfKxmlmml带入（22）式，得到222123227KKKx即：112113217KKKx222123227KKKx现在得到了两个线性微分方程，由于我们采用加速度作为输入，因此还需加上一个方程ux取状态变量如下：1213245162xxxxxxxx研究生课程报告二阶倒立摆的控制11由（33），（41），（42）式得到状态空间方程如下：112233445121351762223627000100000001000000010000000100000000xxxxxxuxxxKKxKxKKxK其中直线两级倒立摆系统参数为：M小车质量2.32kg1m=0.3kg；2m=0.2kg；1为摆杆1与垂直向上方向的夹角2为摆杆2与垂直向上方向的夹角；1l=1m；2l=0.5m；F为作用在系统上的外力由以上方程，将以下参数代入即可。12120.80.30.29.810.5Mmmgll神经网络建模本文采用的神经网络采用4-5-3结构的三层前馈网。输入变量为研究生课程报告二阶倒立摆的控制12123123inoutxxxxxetxetdetxdtetxtyt(0-1)网络隐含层的局部诱导域和输出分别为1100011,2,3,...,MjjiiiijvnnOnOnvnjQ(0-2)其中，w为隐含神经元的突触权值，w0表示神经元的偏置，Q为隐含神经元的节点数，隐含神经元的激活函数取双曲正切函数tanhxxxxeexxee(0-3)网络输出层的诱导局部域和输出分别为2210QkkjjjvnwnOn(0-4)221,2,3kkOnfvnk(0-5)212223pidkOnkOnkOn(0-6)考虑到输出参数不能为负值，所以激活函数采用非负函数研究生课程报告二阶倒立摆的控制1311tanh2xxxefxxee(0-7)控制率为cpiddetMtketketkdt(0-8)采用BP学习算法，对网络的突触权值进行迭代修正，并附加一个使搜索快速收敛的全局极小的动量项。定义系统的代价函数为。212tet(0-9)22222