一级倒立摆控制系统设计

基于双闭环pid控制的一阶倒立摆控制系统设计一、设计目的倒立摆是一个非线性、不稳定系统 ,经常作为研究比较不同控制方法的典型例子。设计一个倒立摆的控制系统， 使倒立摆这样一个不稳定的被控对象通过引入适当的控制策略使之成为一个能够满足各种性能指标的稳定系统。二、设计要求倒立摆的设计要求是使摆杆尽快地达到一个平衡位置，并且使之没有大的振荡和过大的角度和速度。当摆杆到达期望的位置后，系统能克服随机扰动而保持稳定的位置。实验参数自己选定，但要合理符合实际情况，控制方式为双 pid 控制，并利用matlab 进行仿真， 并用 simulink对相应的模块进行仿真。三、设计原理倒立摆控制系统的工作原理是：由轴角编码器测得小车的位置和摆杆相对 垂直方向的角度， 作为系统的两个输出量被反馈至控制计算机。计算机根据一定的控制算法， 计算出空置量， 并转化为相应的电压信号提供给驱动电路，以驱动直流力矩电机的运动，从而通过牵引机构带动小车的移动来控制摆杆和保持平衡。四、设计步骤首先画出一阶倒立摆控制系统的原理方框图一阶倒立摆控制系统示意图如图所示：精品资料分析工作原理，可以得出一阶倒立摆系统原理方框图：一阶倒立摆控制系统动态结构图下面的工作是根据结构框图，分析和解决各个环节的传递函数！1. 一阶倒立摆建模在忽略了空气流动阻力，以及各种摩擦之后，可将倒立摆系统抽象成小车和匀质杆组成的系统，如下图所示，其中：精品资料m： 小 车 质 量 m： 为 摆 杆 质 量 j： 为 摆 杆 惯 量 f：加在小车上的力x：小车位置：摆杆与垂直向上方向的夹角l ：摆杆转动轴心到杆质心的长度根据牛顿运动定律以及刚体运动规律，可知：（1） ） 摆杆绕其重心的转动方程为精品资料jf yl sinf xlcos(1)（2） ） 摆杆重心的运动方程为d 2f xm d 2 t ( xl sin).(2)d 2f ymgm得d 2 t(l cos).(3)（3） ）小车水平方向上的运动为ffxd 2 xm2(4)d t联列上述4 个方程，可以得出一阶倒立精确气模型：jml 2fmljml 2sin.2m2 l 2 g sincosx22 22jmlmmm lcosml cos.fm2l 2 sincos.2mmm lg sinm2 l 2cos2mmjml 2式中 j 为摆杆的转动惯量：jml 23若只考虑在其工作点附近0=0 附近（1010）的细微变化，则可以近似认为：20.( jxml 2 ) fm2l 2 g2sinj( mm)mml.(mm)m lgmlfcos1j( mm)mml 2若取小车质量m=2kg, 摆杆质量m=1kg, 摆杆长度2l =1m, 重力加速度取2g= 10m / s ,则可以得一阶倒立摆简化模型：(s)0.4.x0.44f3.33拉氏变换f (s)s2122.x( s)1.1s100.4 f12( s)s2即g1(s)=;g2(s)=一阶倒立摆环节问题解决！2. 电动机驱动器选用日本松下电工msma021型小惯量交流伺服电动机，其有关参数如下： 驱动电压： u=0100v额定功率： pn=200w额定转速： n=3000r/min转动惯量： j=3 10-6kg.m2 额定转矩： tn=0.64nm最大转矩： tm=1.91nm 电磁时间常数： tl=0.001s电机时间常数： tm=0.003s经传动机构变速后输出的拖动力为：f=016n ；与其配套的驱动器为：msda021a1a ，控制电压： uda=0 10v 。若忽略电动机的空载转矩和系统摩擦，就可以认为驱动器和机械传动装置均为纯比例环节，并假设这两个环节的增益分别为kd 和 km 。kvt t s2t s1m lmg(s)kd kv kmksskfmax u max161.610即 d3(s)=1.6电动机驱动器部分问题解决！3. 双闭环 pid 控制器设计剩下的问题就是如何确定控制器d1 (s)d1 和d2 (s)d2 (s) 的结构和参数。（一）内环控制器的设计其中， ks=1.6 为伺服电动机与减速机构的等效模型1. 控制器的选择内环系统未校正时的传递函数为(s)6.4f (s)s212对于内环反馈控制器 d2(s) 可有 pd ，pi，pid 三种可能的结构形式，怎么选取呢？这里，不妨采用绘制各种控制器结构下“系统根轨迹”的办法加以分析比较，从之选出一种比较适合的控制器结构。各种控制器的开环传函的传递函数分别为：6.4k pp :2pd :s126.4k d ss26.4k p12pi :6.4k p s s( s6.4k i212)6.4ks26.4ks6.4kpid :ppis(s212)