标签：设计 平衡 3.2 isp 积分 介绍 反向 init 对比
本文针对一个倒立摆系统进行了系统的建模、求解、控制系统的设计，并且使用Simulink对控制算法进行了仿真。
倒立摆系统如图（1），设有一个倒立摆装在只能沿轴方向移动的小车上，图中为小车的质量，为摆球的质量，为重力加速度，为摆长，为摆的转动惯量。当小车受到外力的作用时，小车产生位移，且摆产生角位移。
下面针对该倒立摆系统进行建模求解。
当小车在外力作用下产生位移时，摆球受力情况如图（2）所示。图中为摆球所受重力，为方向的惯性力，为垂直于摆杆方向的重力分量。在方向上，小车的惯性力矩为，摆球产生的位移量为；在垂直于摆杆的方向上，摆球的转动惯性力为；的分力为。
图（1）装有倒立摆的小车 图（2）倒立摆受力图
根据牛顿运动定律，按照力的平衡原理，可以分别列出该系统在方向上和垂直于摆杆方向上的的运动方程
（1）
（2）
联立式（1）、（2），经过方程组的恒等变形得
（3）
（4）
由式（3）、（4）令，可建立如下的微分方程组进行求解
在该模型中，对该倒立摆系统实施角度环、速度换的控制，并假设小车在运行过程中受到空气阻力，阻力大小与小车的速度成正比。通过调整的大小，达到在维持倒立摆保持平衡的条件下，使小车维持在给定的目标速度下。即控制目标有
下面就角度环和速度环分别介绍控制过程。
（1）角度环
为了使倒立摆能够保持平衡，首先就需要对摆的角位移进行控制。由于控制目标是角位移为零，自然需要引入角度反馈。首先考虑引入P控制。当有角度的偏差（假设偏差为正），P控制将会产生一个向前的推力，使角度回复为零。但是为了避免角度的来回震荡，需要引入一个阻尼项，即微分控制。只要角度有变化，微分控制便产生作用以阻碍角度的变化。综上，角度环采用PD控制，采取的为
（5）
在Simulink模型中通过调整Pa、Da参数来调节角度的控制。
（2）速度环
倒立摆系统的速度控制是一个难点。其与通常的负反馈不同。因为系统首要的任务是要保持平衡，因此系统的回复力应占据主导地位。而倒立摆系统要想获得速度，首先得有加速度，即必须得打破自身的平衡。换句话说，倒立摆系统是以牺牲部分的平衡为代价来换取速度的稳定。因此，倒立摆系统速度控制的大致思路是：若小车想获得向前的速度，首先小车得受到一个向后的力。当角度平衡被打破后，占据主导地位的回复力将会使小车向前加速，以使角位移恢复为零。当小车再次平衡后，已经具有了向前的速度。通过这样不断地干扰系统的平衡，小车最终将会达到并稳定地保持在设定速度附近。若小车想获得向后的速度，反之即可。
通过上面的分析可以得出结论，速度控制对于角度控制来说是一个弱干扰，并且是反向的。为了更加逼近真实的系统，假设小车在前进的过程中会受到空气阻力，其大小与速度成正比，即。由于模型中引入了空气阻力，会使速度控制产生静差，为了消除静差，速度环加入积分控制。综上，速度环的控制策略为PI控制，采取的为
（6）
在Simulink模型中通过调整Psp、Isp参数来调节速度的控制。
综合（5）、（6）式，并考虑空气阻力，可得
（7）
将（7）式带入上述微分方程组，便可以用Simulink进行求解。
建立Simulink模型如图（3）所示：
图（3）
在建模过程中，使该模型文件（DaoLiBai.slx）与MATLAB的m文件（InitParam.m）建立连接，在该文件中完成倒立摆系统的参数初始化，该文件内容如下：
%本文件完成倒立摆系统的参数初始化
m1 = 3; %小车的质量（kg）
m2 = 10; %摆球的质量（kg）
l = 0.05; %摆长（m）
J = 3; %摆的转动惯量（kg*m^2）
setspeed = 100; %小车的设定速度（m/s）
theta0 = 30; %摆的初始角度（度）
st = 50; %速度换的起始时间（s）
et = 400; %仿真的结束时间（s）
以下是求解得到的一些曲线（图中红色为，黄色为，蓝色为）：
Pa = 150，Da = 15，Psp = 0.2，Isp = 0.002，Kf = 0.1（基准参数）
Pa = 150，Da = 15，Psp = 0.2，Isp = 0.01，Kf = 0.1
Pa = 200，Da = 15，Psp = 0.2，Isp = 0.002，Kf = 0.1
Pa = 150，Da = 25，Psp = 0.2，Isp = 0.002，Kf = 0.1
Pa = 150，Da = 15，Psp = 0.15，Isp = 0.002，Kf = 0.1
从以上参数的对比中可以发现，Pa增大可以减小角度的波动范围，但会使小车速度的波动变大；Da增大可以抑制角度的变化；Psp减小会导致速度波动变大，但角度的波动会减小；Isp增大会使速度出现震荡，也会使角度的波动变大。综上，Pa，Psp，Isp过大都会使系统不稳定，三者都会使一项性能（角度或速度）得到改善，而使另一项性能（速度或角度）变差，因此在实际应用中只能根据需要采取折中的策略。
Fcn2: m2^2 * l^2 * sin(u(2)) * cos(u(2)) * (u(3)^2) - (m1 + m2) * m2 * 10 * l * sin(u(2))
Fcn4: 2 * J * m2 * l * sin(u(2)) * u(2)^2 - m2^2 * l^2 * 10 * sin(2 * u(2))
Fcn5: 2 * ((m1 + m2) * J - m2^2 * l^2 * (cos(u(2)))^2)
Fcn11: m2^2 * l^2 * (cos(u(2)))^2 - (m1 + m2) * J
Fcn8: -(setspeed * (u(1) > st) - u(5))
Gain1: 2 * J
Gain4: m2 * l
标签：设计 平衡 3.2 isp 积分 介绍 反向 init 对比
原文地址：http://www.cnblogs.com/pursuiting/p/6116106.html
