倒立摆试验书

本文格式为Word版，下载可任意编辑——倒立摆试验书

直线型一级倒立摆系统系列试验

试验九倒立摆模型建立与仿真

试验目的

1、通过对倒立摆模型理论分析，建立状态空间模型。

2、结合经典控制理论和现代控制理论分析倒立摆系统的稳定性。3、画出系统的状态、输出响应曲线。试验指导

1、倒立摆工作原理

倒立摆系统通过计算机、I/O卡、伺服系统、倒立摆本体和光电码盘反馈测量元件组成一个闭环系统，其工作原理框图如图下所示。

图一中光电码盘1由伺服电机自带，小车的位移可以根据该码盘的反馈通过换算获得，速度信号可以通过对位移的差分得到。各个摆杆的角度由光电码盘2测量并直接反馈到I/O卡，而角速度信号可以通过对角度的差分得到。计算机从I/O卡实时读取数据，确定控制决策（电机的输出力矩），并发给I/O卡。I/O卡经过电控箱内部电路产生相应的控制量，驱动电机转动，使小车按控制要求进行运动，以达到控制目的。

图一倒立摆系统工作原理框图

1

2、倒立摆系统建模

2

3

4

试验内容

1、根据推导的微分方程，以小车的加速度为输入量、摆杆的角度为输出量，写出传递函数。（提醒：对微分方程进行拉斯变换）

2、将得到的传递函数，转换为零极点模型和状态空间模型，并依据零极点模型极点以及状态空间模型A矩阵判定系统的稳定性。

3、绘制倒立摆系统的状态响应、输出响应曲线。（提醒：用lsim函数）

思考：对于传递函数的稳定性能，在经典控制理论中常用的分析方法有哪些？现在控制理论又是怎样判定系统的稳定性？以该系统为例，进行具体分析。

5

11

12

试验内容

1、将得到的状态方程转换为传递函数、零极点模型，判断系统的稳定性。

2、依据得到的转态空间模型，状态反馈的期望极点为-2,-3,-4+3i,-4-3i,绘制系统的阶跃响应曲线。（提醒：用[Y,X]=lsim(sys,U,T)U为单位阶跃输入。K=place(A,B1,op)op为设定极点）

3、搭建倒立摆系统的仿真框图如下图，通过示波器观测各个状态的曲线以及输出曲线与试验程序得到的曲线对比分析。

13

试验十二倒立摆LQR控制算法设计与仿真

试验目的

通过LQR算法的设计与仿真，对现代控制理论中的最优控制有更深的理解。为状态反馈系统中K的值得选取提供了理论方法。

试验内容

1、由理论分析知，可以设计基于最优控制的状态调理器，使系统闭环稳定。设状态反馈调理律的形式为u(k)??Krx(k)

通过使性能指标函数

1T1N?1TJ?X(N)PX(N)??[X(k)Qr(k)X(k)?uT(k)Rr(k)u(k)]22k?0

T?1T为最小，Kr?[Rr?HP(K?1)H]HP(k?1)G

其中P由以下黎卡提方程获得

P(k)?Qr?GTP(k?1)G?GTP(k?1)H[Rr?HTP(k?1)H]?1HTP(k?1)G

其中Qr，Rr分别用来对状态向量x(k)，控制向量u(k)引起的性能度量的相对重要性进行加权。在实际运算中我们运用Matlab控制系统工具箱中的“dlqr〞函数直接进行运算。

利用dlqr函数，我们需要提供两个权值矩阵：Q、R。寻常我们取R=1，而对于Q我们只能通过不断的凑取来得到。源程序如下：

A=[0100000000010029.70]B=[0；1；0；3];C=[1000010000100001];D=[0000]';R=1;

Q=[500000;03000;00500;00010];K=lqr(A,B,Q,R)Ak0=[(A-B*K)];Bk0=[B];Ck0=[C];Dk0=[D];

x=[0000]';

sys=ss(Ak0,Bk0,Ck0,Dk0);

14

T=0:0.1:20;U=1+0*T

[Y,X]=lsim(sys,U,T);

h=plot(T,-Y)gridon;

title('LQR控制');

legend('Cart','VCart','single','Vs');

通过仿真得到的K值代入到，试验十一中替换框图中K值，得到状态与输出曲线。Q2取为：Q=[100000;0000;00100;0000];Q3取为Q=[1000000;0000;001000;0000]重复上述的试验步骤，

通过比较找到Q值得选取对相应曲线的影响。

（取大的值时系统的响应速度加快，但是超调加大；反之则响应变慢但是超调减小。）

附录试验十一参考程序A=[0100

000000010029.70];B1=[0；1；0；3];C=[1000010000100001];D1=[0000]';

op=[-2；-3；-4+3i；-4-3i];%期望极点K=place(A,B1,op)Ak1=[(A-B1*K)];Bk1=[B1];Ck1=[C];Dk1=[D1];

sys=ss(Ak1,Bk1,Ck1,Dk1);T=0:0.1:20;U=1+0*T

[Y,X]=l