倒立摆系统实验设计报告

1、word.学生实验报告课课程名称程名称: 倒立倒立摆摆系系统课统课程程设计设计 组组号：号： 7 姓名：姓名： 学号：学号： 邮邮箱：箱： 2022 年年 11 月月 11 1 日日word.目录倒立摆系统的构成.3单级倒立摆数学模型的建立.3传递函数 .6状态空间方程 .6系统 MATLAB 仿真和开环响应.7稳定性与可控性分析.11控制器设计.12基于状态反应的控制算法设计与仿真 LQR .12极点配置法 .16PID 控制算法 .19实验结果及与仿真结果的比照分析.29感想和建议.30word.倒立摆系统的构成倒立摆系统的构成图图 1 倒立摆系统的组成框图倒立摆系统的组成框图如图 1 所

2、示为倒立摆的结构图。系统包括计算机、运动控制卡、伺服机构、倒立摆本体和光电码盘几大局部，组成了一个闭环系统。光电码盘 1 将小车的位移、速度信号反应给伺服驱动器和运动控制卡，摆杆的位置、速度信号由光电码盘 2 反应回控制卡。计算机从运动控制卡中读取实时数据，确定控制决策小车向哪个方向移动、移动速度、加速度等 ，并由运动控制卡来实现该控制决策，产生相应的控制量，使电机转动，带动小车运动，保持摆杆平衡。单级倒立摆数学模型的建立单级倒立摆数学模型的建立在忽略了空气流动，各种摩擦之后，可将倒立摆系统抽象成小车和匀质杆组成的系统，如以下图 2 所示word.图图 2 单级倒立摆模型示意图单级倒立摆模型示

3、意图那我们在本实验中定义如下变量：M 小车质量 本实验系统 0.5 Kgm 摆杆质量 本实验系统 0.2 Kgb 小车摩擦系数 本实验系统 0.1 N/m/secl 摆杆转动轴心到杆质心的长度0.3 mI 摆杆惯量 0.006 kg*m*mF 加在小车上的力 x 小车位置 摆杆与垂直向上方向的夹角 摆杆与垂直向下方向的夹角考虑到摆杆初始位置为竖直向下下面我们对这个系统作一下受力分析。以下图 3 是系统中小车和摆杆的受力分析图。其中，和为小车与摆杆相互作用力的水平和垂直方向的分量。NP注意：在实际倒立摆系统中检测和执行装置的正负方向已经完全确定，因而矢量方向定义如图，图示方向为矢量正方向。图图

4、3 倒立摆模型受力分析倒立摆模型受力分析分析小车水平方向所受的合力，可以得到等式：应用 Newton 方法来建立系统的动力学方程过程如下：分析小车水平方向所受的合力，可以得到以下方程：word.NxbFxM 由摆杆水平方向的受力进行分析可以得到下面等式：)sin(22lxdtdmN即 sincos2 mlmlxmN把这个等式代入上式中，就得到系统的第一个运动方程： 1FmlmlxbxmMsincos)(2 为了推出系统的第二个运动方程，我们对摆杆垂直方向上的合力进行分析，可以得到下面方程：cossin)cos(222 mlmlmgPldtdmmgP即：力矩平衡方程如下： INlPlcossin

5、注意：此方程中力矩的方向，由于，故等式sinsin,coscos,前面有负号。合并这两个方程，约去和，由得到第二个运动方程：PN231mlI 2cossin234xmlmglml 设是摆杆与垂直向上方向之间的夹角 ，假设与 1单位是弧度相比很小，即 1，那么可以进行近似处理：，。用1cossin0)(2dtd来代表被控对象的输入力，线性化后两个运动方程如下：uF 3umlxbxmMxgl )(34传递函数传递函数对方程组(3)进行拉普拉斯变换，得到word. 4)()()()()()()()(342222sUssmlssbXssXmMssXsgssl注意：推导传递函数时假设初始条件为 0。由于

6、输出为角度，求解方程组4的第一个方程，可以得到)(34)(2ssglsX把上式代入方程组4的第二个方程，得到)()()()()()()(22222sUssmlsssgmlmlIbsssgmlmlImM整理后得到传递函数：sqbmglsqmglmMsqbmlssqmlsUs2323442)()()(其中 )()(22mlmlImMq状态空间方程状态空间方程系统状态空间方程为DuCXyBuAXX方程组3对解代数方程，得到解如下： , xulmMlmMmMgxlmMbumMmMmgxmMbxxx)4(3)4()(3)4(3)4(4)4(3)4(4 整理后得到系统状态空间方程：word.ulmMmMx

7、xlmMmMglmMbmMmgmMbxx)4(30)4(400)4()(3)4(3010000)4(3)4(400010 uxxxy0001000001系统系统 MatlabMatlab 仿真和开环响应仿真和开环响应实际系统参数如下，求系统的传递函数、状态空间方程，并进行脉冲响应和阶跃响应的 Matlab 仿真。M 小车质量 1.096 Kgm 摆杆质量 0.109 Kgb 小车摩擦系数 0 .1N/m/secl 摆杆转动轴心到杆质心的长度 0.2 5mI 摆杆惯量 0.0034 kg*m*mF 加在小车上的力 x 小车位置 摆杆与垂直方向的夹角T 采样频率0.005 秒注意：在进行实际系统的

8、 Matlab 仿真时，请将采样频率改为实际系统的采样频率。传递函数：在 Matlab 中，拉普拉斯变换后得到的传递函数可以通过计算并输入分子和分母矩阵来实现。求系统传递函数的 m-文件内容如下：M = 1.096;m = 0.109;b = 0.1;I= 0.0034;g = 9.8;l = 0.25;word. q = (M+m)*(I+m*l2)-(m*l)2; %simplifies inputnum = m*l/q 0den = 1 b*(I+m*l2)/q -(M+m)*m*g*l/q -b*m*g*l/qt = 0 : 0.01 : 5;impulse ( num , den ,

9、 t )axis ( 0 1.1 0 70 )执行上面的文件，就可以求出系统传递函数的分子与分母多项式的 Matlab 表示：num = 2.3566 0den = 1.0000 0.0883 -27.8285 -2.3094可以得到系统开环脉冲响应的曲线如下：00.20.40.60.81010203040506070Impulse ResponseTime (sec)Amplitude 图图 4 4 系统开环脉冲响应曲线系统开环脉冲响应曲线状态空间法：状态空间法可以进行单输入多输出系统设计，(从实验二开始，我们将尝试同时对摆杆角度和小车位置进行控制)。为了更具挑战性，给小车一个阶跃输入信号，

10、设计指标如下：小车位置 x 和摆杆角度 的稳定时间小于 5 秒；word.位置 x 的上升时间小于 0.5 秒；摆杆角度的超调量小于 20 度0.35 弧度 。下面，我们用 Matlab 求出系统的状态空间方程各矩阵，并仿真系统的开环阶跃响应。在这里同样给出了一个 m-文件，执行这个文件，Matlab 将会给出系统状态空间方程的A，B，C 和 D 矩阵，并可以绘出在给定输入为一个 0.2 m 的阶跃信号时系统的响应曲线。M = 1.096;m = 0.109;b = 0.1;I= 0.0034;g = 9.8;l = 0.25; p = I*(M+m)+M*m*l2; %denominator

11、 for the A and B matriciesA = 0 1 0 0; 0 -(I+m*l2)*b/p (m2*g*l2)/p 0; 0 0 0 1; 0 -(m*l*b)/p m*g*l*(M+m)/p 0B = 0; (I+m*l2)/p; 0; m*l/pC = 1 0 0 0; 0 0 1 0D = 0; 0T=0:0.005:10;U=0.2*ones(size(T);Y,X=lsim(A,B,C,D,U,T);plot(T,Y)axis(0 2.5 0 100)执行该 m 文件，可以求出系统的状态空间 A、B、C、D 矩阵,得到开环系统阶跃响应的曲线。A = 0 1.0000

12、 0 0 0 -0.0883 0.6293 0 0 0 0 1.0000word. 0 -0.2357 27.8285 0B = 0 0.8832 0 2.3566C = 1 0 0 0 0 0 1 0D = 00100.511.522.50102030405060708090100图图 5 5 倒立摆状态空间开环系统阶跃响应曲线倒立摆状态空间开环系统阶跃响应曲线图中，实线是摆杆角度响应曲线，虚线是小车位置响应曲线。word.稳定性与可控性分析稳定性与可控性分析我们先看一看系统的稳定性，将数据代入状态方程中，利用 matlab 程序可以求出系统的零极点。源代码如下：M = 1.096;m =

13、0.109;b = 0.1;I= 0.0034;l = 0.25; a b c d=wer_ss(M,m,b,l);%自己编写的函数，建立模型之用，具体程序见下面sysc=ss(a,b,c,d); sysd=c2d(sysc,0.005);da db dc dd=ssdata(sysd);z p gain=ss2zp(da,db,dc,dd,1)z = -0.9999 -0.9999 1.0275 1.0000 + 0.0000i 0.9733 1.0000 - 0.0000ip = 1.0000 0.9996 1.0285 0.9723gain = 1.0e-004 * 0.1113 0.3

14、338wer_ss 源程序：function a b c d=wer_ss(M,m,b,l)a=0 1 0 0;0 -4*b/(4*M+m) 3*m*9.8/(4*M+m) 0;0 0 0 1;0 -3*b/(4*M+m)*l) 3*9.8*(M+m)/(4*M+m)*l) 0;b=0;4/(4*M+m);0;3/(4*M+m)*l);c=1 0 0 0;0 0 1 0;d=0;0由得到的 p极点可知，有的极点在单位圆外，所以可知原系统是不稳定的。同样，我们可以利用 matlab 来得到系统的能控性，源代码如下：ud=ctrb(da,db);rank(ud)ans = 4由得到的 rankud

15、的值可知，原系统的能控性矩阵为 4，所以我们可知原系统是能控的。word.控制器设计控制器设计 基于状态反应的控制算法设计与仿真基于状态反应的控制算法设计与仿真 LQR由理论分析知，可以设计基于最优控制的状态调节器，使系统闭环稳定。设状态反应调节律的形式为)()(kxKkur通过使性能指标函数)()()()()()(21)()(2110kukRkukXkQkXNPXNXJrTNkrTT为最小，根据在附录 1 中我们所介绍的求得GkPHHKPHRKTTrr) 1() 1(1其中 P 由以下黎卡提方程获得GkPHHkPHRHkPGGkPGQkPTTrTTr) 1() 1() 1() 1()(1其中

16、，分别用来对状态向量 x(k)，控制向量 u(k)引起的性能度量的相对重要性rQrR进行加权。在实际运算中我们运用 Matlab 控制系统工具箱中的“dlqr函数直接进行运算。利用 dlqr 函数，我们需要提供两个权值矩阵：Q、R。通常我们取 R=1，而对于 Q 我们只能通过不断的凑取来得到。源代码如下： R=1; Q=10 0 0 0;0 0 0 0;0 0 1 0;0 0 0 0Q = 10 0 0 0 0 0 0 0 0 0 1 0 0 0 0 0 T=0.005; syse k=wer_lqr(da,db,dc,dd,Q,R,T);%wer_lqr 是自己定义的函数，具体见下面程序 x

17、0=0.05;0;0.0175;0; t=0:0.005:10; y x1=initial(syse,x0,t);plot(t,y(:,1),red,t,y(:,2),blue)wer_lqr 源程序：function sysresult k=wer_lqr(da,db,dc,dd,Q,R,T);%sysresult k=wer_lqr(da,db,dc,dd,Q,R,T);k S e=dlqr(da,db,Q,R);word.G=da-db*k;sysresult=ss(G,db,dc,dd,T);我们已开始的 Q 为：Q1=10 0 0 0;0 0 0 0;0 0 1 0;0 0 0 0；

18、结果得到的图为图 6；Q2 取为：Q=100 0 0 0;0 0 0 0;0 0 10 0;0 0 0 0;结果得到的图为图 7；通过比拟，我们发现当 Q11、Q33 比值一定时，取大的值时系统的响应速度加快，但是超调加大；反之那么响应变慢但是超调减小。012345678910-0.0100.010.020.030.040.05位 位 位 位位 位图图 6 Q1 响应图响应图word.012345678910-0.0100.010.020.030.040.05位 位 位 位位 位图图 7 Q2 响应图响应图在左右权衡之间，我们最终选取了：Q=300 0 0 0;0 0 0 0;0 0 30 0

19、;0 0 0 0此时的响应曲线如图 8，而 k 值为：k = -16.6147 -12.4226 56.5909 10.2444012345678910-0.0100.010.020.030.040.05位 位 位 位位 位图图 8 最优的响应曲线最优的响应曲线word.此时的单位阶跃响应曲线为图 9：012345678910-0.07-0.06-0.05-0.04-0.03-0.02-0.0100.010.02位 位位 位 位 位图图 9 单位阶跃响应曲线单位阶跃响应曲线从仿真效果来看，零状态响应和单位阶跃响应都符合要求。 极点配置法极点配置法采用极点配置法设计多输出的倒立摆系统的控制方案。

20、可以用完全状态反应来解决，控制摆杆和小车的位置。 图 10 是控制系统的示意图。图图 10 控制系统框图控制系统框图 假定所有的状态变量都可以测量和反应，可以证明：假设所研究的系统是状态完全可控的，那么，利用状态反应的方法，经过适当的状态反应增益矩阵，就可以把闭环系统的极点配置到任何期望的位置。 设开环控制系统的离散状态方程为： x(k+1) = Gx(k) + Hu(k)其中，假设系统是状态完全可控的x(k) 为在第 k 次采样时刻的状态矢量n 维矢量u(k) 为在第 k 次采样时刻的控制信号标量G = nn 矩阵H = n1 矩阵设极点配置的控制律形式为word.)()(kxKkup式中是

21、状态反应增益矩阵矩阵 ，于是该系统就成为一个闭环控制系统。其pKn1闭环状态方程为 )()() 1(kxHKGkxp注意，的特征值就是所要求的闭环极点。 pHKG n,21我们希望利用状态反应把闭环极点布置在，)()(kxKkup1z2z。即要求特征方程为：nz)()(21npzzzHKGzI 012211 nnnnnazazazaz根据 Cayley_hamiton 定理, 经过推导 (此略) 可以得到 )(100011GHGGHHKnp其中IaGaGaGaGGnnnnn12211)(上式给出所要求的状态反应增益矩阵。矩阵的这种特殊表达式就是常说的阿克pKpK曼公式。状态反应增益矩阵按这样的

22、方法确定，即可使误差由扰动所引起的以足够快的速度降到零。注意，对于一个给定的系统，矩阵并不是唯一的，而是取决于所期望的闭pK环极点位置它决定响应速度的选择。选择期望的闭环极点或期望的特征方程是在误差矢量响应的快速性与对扰动和测量噪声敏感型之间的一个折衷方案。也就是说，如果我们使误差响应的速度提高，那么扰动和测量噪声的有害影响往往也会增强。在确定给定系统的状态反应增益矩阵时，通常是通过比拟按不同的期望闭环极点或期望特征方程得到pK的矩阵，并从中选出使整个系统到达的特性最好的那个矩阵。在实际设计时, 我们pKpK运用 Matlab 控制系统工具箱中的“place函数直接进行仿真和运算。先在连续域中

23、进行计算，然后再转到离散域。根据系统的性能要求，我们可取，这时完全满足题中的性能要求。那么我们就可以进行离散域设计了：=0.707w3n z1=exp(-3*20.5)/2+(-3*20.5)*j/2)*0.005)z1 = 0.9894 - 0.0105i z2=exp(-3*20.5)/2-(-3*20.5)*j/2)*0.005)z2 =word. 0.9894 + 0.0105i z3=exp(-10*0.005)z3 = 0.9512 z4=exp(-12*0.005)z4 = 0.9418 p=z1 z2 z3 z4;K=place(da,db,p)K = -38.6579 -25

24、.5096 103.3247 17.9041 G=da-db*K; syse=ss(G,db,dc,dd,0.005); t=0:0.005:10; x0=0.05; 0; 0.0175; 0; y1,x=initial(syse,x0,t); plot(t,y1(:,1),red,t,y1(:,2),blue)012345678910-0.0100.010.020.030.040.050.06位 位 位 位位 位图图 11 极点配置图零输入响应极点配置图零输入响应而它的单位阶跃响应是：u=ones(1,length(t); y,x=lsim(syse,u,t)word.01234567891

25、0-0.03-0.025-0.02-0.015-0.01-0.00500.0050.010.015位 位位 位 位 位图图 12 极点配置单位阶跃响应极点配置单位阶跃响应从仿真效果来看，也是根本上到达了系统的要求。PIDPID 控制算法控制算法目的：目的：设计 PID 控制器，使得当在小车上施加 1N 的脉冲信号时，闭环系统的响应指标为：1、稳定时间小于 5 秒2、稳态时摆杆与垂直方向的夹角变化小于 0.1 弧度分析：分析：系统输出量为摆杆的位置，它的初始位置为垂直向上，我们给系统施加一个扰动，观察摆杆的响应。系统框图如下：图图 13 PID 系统框图系统框图word.图中是控制器传递函数，是

26、被控对象传递函数。)(sKD)(sG考虑到输入，结构图可以很容易的变换成0)(sr图图 14 PID 系统反应控制框图系统反应控制框图该系统的输出为)()()()()()()(1)()()(1)()(sFnumnumPIDdendenPIDdenPIDnumsFdendenPIDnumnumPIDdennumsFsGsKDsGsy其中， 被控对象传递函数的分子项num被控对象传递函数的分母项denPID 控制器传递函数的分子项numPIDPID 控制器传递函数的分母项denPID被控对象的传递函数是dennumqbmglsqmglmMsqbmlssqmlsUs)()()(22343其中 )()

27、(22mlmlImMqPID 控制器的传递函数为denPIDnumPIDsKsKsKsKKsKsKDIPDIPD2)(调节 PID 控制器的各个参数，以得到满意的控制效果。word.前面讨论的输出量只考虑了摆杆角度，那么，在我们施加扰动的过程中，小车位置如何变化？考虑小车位置，得到改良的系统框图如下：图图 15 改良的改良的 PID 系统控制框图系统控制框图其中，是摆杆传递函数，是小车传递函数。)(1sG)(2sG由于输入信号，所以可以把结构图转换成：0)(sr图图 16 等价等价 PID 系统控制框图系统控制框图其中，反应环代表我们前面设计的摆杆的控制器。注注：从此框图我们可以看出此处只对摆

28、杆角度进行了控制，并没有对小车位置进行控制。小车位置输出为：)()()()()()()()()()(1)()()(1)()(212112112212sFdennumnumPIDdendendenPIDdendenPIDnumsFdendenPIDnumnumPIDdennumsFsGsKDsGsX其中，分别代表被控对象 1 和被控对象 2 传递函数的分子和1num1den2num2den分母。和代表 PID 控制器传递函数的分子和分母。下面我们来求，numPIDdenPID)(2sGword.根据前面实验二的推导，有)(34)(2ssglsX可以推出小车位置的传递函数为qbmglsqmglmM

29、sqbmlsqmglsqmlsUsXsG)()()()(2234322342其中 )()(22mlmlImMq可以看出， =，小车的算式可以简化成： 1den2denden)()()()()(12sFnumnumPIDkdendenPIDdenPIDnumsXMatlab 仿真仿真实际系统参数如下：M 小车质量 1.096 Kgm 摆杆质量 0.109 Kgb 小车摩擦系数 0 .1N/m/secl 摆杆转动轴心到杆质心的长度 0.2 5mI 摆杆惯量 0.0034 kg*m*mF 加在小车上的力 x 小车位置 摆杆与垂直方向的夹角T 采样频率 0.005 秒注意：在进行实际系统的 Matla

30、b 仿真时，请将采样频率改为实际系统的采样频率。1参照上例的处理方法，把实际系统参数代入，进行 PID 控制仿真，并找到适宜的参数；2将小车推到导轨正中间位置，并且使摆杆处于自由下垂的静止状态；3给计算机和电控箱通电；4翻开计算机，在 DOS 操作系统下，键入“Pend 启动程序，并按“s使系统处于准word.备状态；5按 “键起摆，等摆杆立起来并稳定下来之后此时为 LQR 控制 ，选择控制器菜单中的“PID，输入参数，观察小车和摆杆的运动；注意由于控制器只对摆杆进行了控制，所以在 PID 中输入参数后小车可能向一个方向运动，此时需用手轻轻扶一下摆杆6按“T停止摆杆，当摆杆处于自由下垂的静止状

31、态，并在控制器菜单中选择“PID，并参照仿真结果，输入 PID 控制器参数, 观察小车和摆杆的运动；通过调整参数可以控制摆杆摆起并能够竖直向上，此时可能需用手轻轻扶一下摆杆，以防止小车“撞墙 。7如果控制效果不理想，调整控制器参数，直到获得较好的控制效果；8运动曲线文件保存在当前路径下，其中 pos_x.dat 为小车位置，pos_t.dat 为摆杆角度，con_u.dat 为控制量；9到 MatLab 中运行如下指令，MatLab 会将保存的曲线重新绘制出来。S=load(路径文件名)plot(S)1摆杆角度控制首先，需要把输出为摆杆角度时系统的传递函数用 Matlab 表示出来，建立一个

32、m-文件，将下面几行表示传递函数的语句拷贝进去，其中k代表比例系数PK：M = 1.096;m = 0.109;b = 0.1;I = 0.0034;g = 9.8;l = 0.25;q =(M+m)*(I+m*l2) -(m*l)2; %simplifies inputnum = m*l/q 0 0den = 1 b*(I+m*l2)/q -(M+m)*m*g*l/q -b*m*g*l/q 0kd=1k=1ki=1numPID= kd k ki ;denPID= 1 0 ;numc= conv ( num, denPID )denc= polyadd ( conv(denPID, den )

33、, conv( numPID, num ) ) word.t = 0 : 0.05 : 5;impulse ( numc , denc , t )其中函数 polyadd 是求两个多项式之和的函数，它不是 Matlab 工具，因此必须把它拷贝到 polyadd.m 文件中, 并把该文件的目录用 addpath 命令加到路径中。Polyadd 函数内容如下：functionpoly=polyadd(poly1,poly2)if length(poly1)0 poly=zeros(1,mz),short+long;else poly=long+short;end在这里我们假定比例、积分和微分控制都

34、是必需的。现在，就可以进行系统脉冲响应的 PID 控制仿真了。在前面的 m-文件中参加下面的语句就可以得到系统的脉冲响应仿真结果：运行结果及响应曲线如下：num = 2.3566 0 0den = 1.0000 0.0883 -27.8285 -2.3094 0kd = 1k = 1ki = 1numc =word. 2.3566 0 0 0denc = 1.0000 2.4449 -25.4720 0.0471 0 0 00.511.522.533.544.55012345678910 x 107Impulse Responsewith PID control:k=1,kd=1,ki=1Ti

35、me (sec)Amplitude图图 1717 初始初始 PIDPID 参数摆角状态图参数摆角状态图系统响应是不稳定的，不能满足要求，需要调整参数，和，直到获得满PKDKIK意的控制结果。首先增加比例系数，观察它对响应的影响，取=100，kd=1.系统响PKPK应如下：num = 2.3566 0 0den = 1.0000 0.0883 -27.8285 -2.3094 0kd = 1k = 100ki = 1numc = 2.3566 0 0 0denc = 1.0000 2.4449 207.8268 0.0471 0 0word.00.511.522.533.544.55-0.2-0

36、.15-0.1-0.0500.050.10.15Impulse Responsewith PID control k=100,ki=1,kd=1Time (sec)Amplitude图图 18 调节调节 PID 参数后摆角输出图参数后摆角输出图系统稳定时间约为 4 秒，满足要求。由于此时稳态误差为 0，所以不需要改变积分环节你可以改变积分系数，观察系统响应如何变化 ；系统响应的超调量比拟大，为了减小超调，增加微分系数，取=20，响应结果和响应曲线如下：DKDKnum = 2.3566 0 0den = 1.0000 0.0883 -27.8285 -2.3094 0kd = 20k = 100

37、ki = 1numc = 2.3566 0 0 0word.denc = 1.0000 47.2194 207.8268 0.0471 0 000.511.522.533.544.5500.010.020.030.040.050.060.070.080.090.1Impulse Responsewith PID control k=100,ki=20,kd=1Time (sec)Amplitude图图 19 微调微调 PID 参数后摆角状态曲线参数后摆角状态曲线系统稳定时间约为 1 秒，超调约为 0.04，响应满足指标要求。2小车位置变化仿真仿真小车位置变化的 m-文件内容如下：M = 1.0

38、96;m = 0.109;b = 0.1;I = 0.0034;g = 9.8;l = 0.25;q =(M+m)*(I+m*l2) -(m*l)2; %simplifies inputnum1 = m*l/q 0 0den1 = 1 b*(I+m*l2)/q -(M+m)*m*g*l/q -b*m*g*l/q 0num2 = -(I+m*l2)/q 0 m*g*l/qden2 = den1kd = 20k = 100ki = 1numPID = kd k ki;denPID = 1 0;word.numc = conv(num2,denPID)denc = polyadd(conv(denP

39、ID,den2),conv(numPID,num1)t=0:0.05:5;impulse(numc,denc,t)仿真结果如下：num1 = 2.3566 0 0den1 = 1.0000 0.0883 -27.8285 -2.3094 0num2 = -0.8832 0 23.0942den2 = 1.0000 0.0883 -27.8285 -2.3094 0kd = 20k = 100ki = 1numc = -0.8832 0 23.0942 0denc = 1.0000 47.2194 207.8268 0.0471 0 0word. 图图 20 小车位置曲线小车位置曲线实验结果及与仿真结果的比照分析实验结果及与仿真结果的比照分析我们组于 2022 年 10 月前往倒立摆实验室做实验，我们共做了 PID、LQR 和极点配置法，由于事先已经将参数设计好并经过精心的仿真修改，所以实验耗时并不长，我们在听完宫亮老师的详细解说后便开始了此次实验。首