单级倒立摆的数学模型的建立-参考

1单级倒立摆的数学模型的建立:小车由电机通过同步带驱动在滑杆上来回运动，保持摆杆平衡。电机编码器和角编码器向运动卡反馈小车和摆杆位置(线位移和角位移)。导轨截面成H型,小车在轨道上可以自由滑动，其在轨道上的有效运行长度为1米。轨道两端装有电气限位开关，以防止因意外失控而撞坏机构。FF图1单级倒立摆系统数学模型倒立摆系统的模型参数如下□:M小车质量1.096Kg；m摆杆质量0.109Kgb小车摩擦系数0.1N/m/secI摆杆质量0.0034kg*m*mTOC\o"1-5"\h\zl摆杆转动轴心到杆质心的长度0.25mT采样频率0.005s下面N和P为小车与摆杆相互作用力的水平和垂直方向的分量分析小车水平方向所受的合力，可得到方程为：MxFbxN(1)由摆杆水平方向的受力进行分析可以得到下面等式:Nm--xlsindt2⑵2Nmxmlcosmlsin把这个等式代入(1)式中，得到系统的第一个运动方程：2MmxbxmlcosmlsinF(3)为了推出系统的第二个运动方程，对摆杆垂直方向的合力进行分析，得到下面的方程：Pmgm^lcos

dt2Pmgmlsinml2cos力矩平衡方程如下:PlsinNlcosIPmgm^lcos

dt2Pmgmlsinml2cos力矩平衡方程如下:PlsinNlcosI方程中力矩的方向，由于cos,sinsin,故等式前面有负号。合并这两个方程，约去P和N,得到第二个运动方程:2Imlmglsinmlxcos2Imlmglsinmlxcos(6)综上：单级倒立摆的运动方程为:MmxbxmlcosmlsinF（3）Imlmglsinmlxcos（6）由于这2个方程式非线性的近似线性化处理：考虑一类非线性系统泉=/（1，我）其镇定问题所研究的是设计一个状态反馈控制器，使得闭环系统为稳定系统。针对上述非线性系统的镇定问题，有一类方法是先将其进行线性化，然后利用线性系统稳定性理论来设计控制器。线性化的方法有2种，一是以泰勒展开为基础的近似线性化方法；二是以微分几何为基础的精确线性化方法。经典的近似线性化方法该方法通过求取方程z=F（工）+G（况）"右端对状态向量x在平衡点的偏导数可得，即"]口)dx23/2(1)

dx2■

■

■af3

3必丁晨郁）gz（曲"]口)dx23/2(1)

dx2■

■

■af3

3必丁晨郁）gz（曲）■.■此（々）即为平衡点z。处的近似线性化模型。2精确线性化方法该方法通过寻找微分同胚变换z"Q)3xn■■■"rt(h)a二J%Q=T（x）和状态反馈P—a（N，“），使得非线性系统“一F（W）+G（n）"可转换成Brunosky标准型的线性系统:-010001式中4=：:：000[oooB=[00…000■■101丁基于微分几何的非线性系统精确线性化理论已经证明：存在这样一个微分同胚变换和状态反馈，使得一个单输入仿射非线性可以化为一个线性系统。若h（x）是线性偏微分方程组（〈dA,g〉,《或,nd”户自〉，…，〈d力，口成二/g））=［（0,…，0"（工）［的解，其中y（R）为光滑函数，且，（°）工。则？=（之］z2…招）=［乂了）Lz/i（x）…L尸九（上）］=T（x）是一一个微分同胚变换；并且若则单输入仿射非线性v=Lyh(x)+LJ7T晨幻•«(x)则单输入仿射非线性系统工卜3（门式可转换为Brunovsky标准型，即N］=胃Z，之W"3♦,,,•?用-1大n—Z♦冬1即c对于由近似线性化方法得到的非线性系统的近似线性模型和由精确线性化方法得到的线性模型，都可以应用线性系统的极点配置方法来设计系统的反馈控制器；但不同的是前者设计的反馈控制器可以直接应用于非线性系统，并在小范围内可以将系统从不稳定的初始状态镇定至平衡状态；而后者设计的反馈控制器所得到的是控制量R而不是原系统的控制量u,因此该控制量还需要经过控制量的逆变换将其转化为控制量〃才能作用于原系统，即乙肛（土）,1LJ小（x）LJ/*S》对比这2种设计非线性系统反馈控制器的方法，经典近似线性化方法方法最明显的缺点是它有误差，而且误差随偏离平衡点距离的增大而扩大利用精确线性化模型得到的系统状态反馈控制器能在更大范围内将系统从不平衡状态镇定至平衡状态；因此精确线性化方法不但更适合于高精度的非线性系统的镇定控制，而且更适合于初始状态远离平衡点系统的镇定控制。根据相对阶的定义，可知倒立摆系统的相对阶r=2不能为n即倒立摆系统不能实现精确线性化。J20cos1,sin假设与1（单位是弧度）相比很小，即J20cos1,sindt用u代表被控对象的输入力，线性化后两个运动方程如下:2ImlmglmlxMmxbxml对方程(7)进行拉普拉斯变换，得到:Iml2(s)s2mgl(s)mlX(s)s222(8)MmX(s)s2bX(s)sml(s)s2U(s)(推到时假设初始条件为0)则，摆杆角度和小车位移的传递函数为：(s)mls2X(s)(Iml2)s2mgl将上述参数代入，摆杆角度和小车位移的传递函数为：2(s)0.02725s2X(s)0.0102125s20.26705摆杆角度和小车加速度之间的传递函数为：(s)mlA(s)Iml2s2mgl将上述参数代入，摆杆角度和小车加速度之间的传递函数为：(s)0.02725s2A(s)0.0102125s20.26705摆杆角度和小车所受外界作用力的传递函数：ml2

s(s)qTOC\o"1-5"\h\z-，、■，.■2、..F(s)4b(Iml)3(Mm)mgl2bmglsJs乙-s——sqqq222q(Mm)(Iml)ml将上述参数代入，摆杆角度和小车所受外界作用力的传递函数：(s)2.35655s-—32F(s)s0.0883167s27.9169s2.30942以外界作用力作为输入的系统状态空间表达式为:000-2.mgl20xIml2I(Mm)Mml2&I(Mm)Mml2u010mgl(Mm)0&mlI(Mm)Mml2I(Mm)Mml20120(Iml)b2I(Mm)Mml00mlbI(Mm)Mml2将上述参数代入，以外界作用力作为输入的系统