2、质心的转动惯量I0.0034kgm备注:可忽略了空气阻力以及小车与摆杆之间铰接点上的摩擦力矩。表1.实验装置参数现基于现代控制理论,按照如下步骤实现对研究直线一级倒立摆的控制方法:1)建立直线一级倒立摆的运动方程;2)推导状态空间方程;3)分析能控及能观性;4)计算状态反馈矩阵及状态观测矩阵;5)通过离线仿真分析验证上述控1直线一级倒立摆控制方法制算法的有效性;6)通过上机实验观察其实际控制效果。1.建立直线一级倒立摆的运动方程对小车和摆杆进行受力分析如图2,其中,N和P为小车与摆杆相互作用力的水平和垂直两个方向的分量。P N
3、 MF g a.小车的受力分析b.摆杆的受力分析图2.小车与摆杆的受力分析小车在水平方向运动,则通过对小车的水平受力分析,可以得到以下方程: th h (1)摆杆作平面运动,可以分解为质心的平动和绕质心转动,由水平方向的受力分析,可以得到下式: ݈ 即, t h ݈ (2)带入方程(1)得: t h ݈ t(3)再由摆杆的垂直方向的受力分析,得到下式: h g t 即, h g h θ ݈ h
4、 t (4)又由摆杆对质心的力矩平衡方程有:h ݈ h t (5)由于 ,所以等式左边有负号。最后,整理方程(4),(5),可得: g ݈ h t (6) 由于φ≪1,则有 t h1 ݈ h .用u代表输入,也就是作用 在小车上的作用力,整理方程(3),(6)可以得到一级倒立摆的运动方程2直线一级倒立摆控制方法 h g h (7) h 2.系统的状态空间方程为求系统的状态空间方程,对方程(7)进行拉氏变换,得到:
5、 h g h ܷ 则摆杆角度和小车位移的传递函数为: h g将表1中参数带入上式,则得到摆杆角度和小车位移的传递函数为: . . 1 1 h . 摆杆角度和小车加速度之间的传递函数为: h g将表1中参数带入上式,则得: . . 1 1 h . 摆杆角度和小车所受外界作用力的传递函数:
6、 t h h 洠 h 将表1中参数带入上式,则得: . t . 1 h . 1 h . 以外界作用力作为输入的系统的状态空间表达式为: 1 h h 1 h 3直线一级倒立