单级倒立摆实验报告
一阶倒立摆模糊控制实验报告
一阶倒立摆模糊控制实验报告一、实验目的本实验旨在通过模糊控制方法来控制一阶倒立摆系统，实现摆杆保持竖直的稳定控制。
二、实验原理1. 一阶倒立摆系统一阶倒立摆系统由一个垂直的支撑杆和一个在杆顶端垂直摆动的杆组成。
系统的输入为杆的控制力矩，输出为杆的角度。
系统的动力学方程可以表示为：Iθ''(t) + bθ'(t) + mgl sin(θ(t)) = u(t)其中，I为倒立摆的转动惯量，b为摩擦阻尼系数，θ为倒立摆的角度，m为倒立摆的质量，l为杆的长度，g为重力加速度，u为输入的控制力矩。
2. 模糊控制方法模糊控制方法是一种基于模糊逻辑的控制方法，通过将模糊集合与模糊规则相结合，构建模糊控制器来实现对系统的控制。
在本实验中，可以使用模糊控制器来实现倒立摆系统的稳定控制。
三、实验步骤1. 搭建实验平台，包括倒立摆系统、传感器和执行器。
2. 训练模糊控制器a. 定义模糊集合：根据角度误差和角速度误差定义模糊集合，并确定模糊集合的划分方式。
b. 构建模糊规则：根据经验或系统建模，确定模糊规则。
c. 设计模糊控制器：根据模糊集合和模糊规则，设计模糊控制器，包括模糊推理和模糊解模块。
d. 调整模糊控制器参数：根据系统响应实验，根据控制效果调整模糊控制器参数。
3. 实施模糊控制a. 读取传感器数据：获取倒立摆的角度和角速度数据。
b. 计算控制器输出：根据模糊控制器和传感器数据计算控制力矩的输出。
c. 执行控制器输出：将控制力矩作用在倒立摆上。
4. 监测系统响应：实时监测倒立摆的角度和角速度，判断控制效果。
5. 调整模糊控制器参数：根据实验监测结果，调整模糊控制器参数，以提高控制效果。
四、实验结果分析通过实验，我们可以观察到倒立摆系统在模糊控制下的稳定控制效果。
通过实时监测倒立摆的角度和角速度，可以验证控制器的性能。
实验结果可以通过绘制控制力矩输入和倒立摆角度响应曲线，以及观察系统的稳态误差来分析。
电气系统综合设计实验报告直线一级倒立摆控制系统设计
电气控制系统设计——直线一级倒立摆控制系统设计学院轮机工程学院班级电气1111姓名李杰学号 36姓名韩学建学号 35成绩指导老师肖龙海2014 年 12 月 25 日小组成员与分工：韩学建主要任务：二阶系统建模与性能分析,二阶控制器的设计,二阶系统的数字仿真与调试,二阶系统的实物仿真与调试;二阶状态观测器的数字仿真与调试,二阶状态观测器的实物仿真与调试;李杰主要任务：四阶系统建模与性能分析,四阶控制器的设计,四阶系统的数字仿真与调试,四阶系统的实物仿真与调试;四阶状态观测器的数字仿真与调试,四阶状态观测器的实物仿真与调试;前言倒立摆系统是非线性、强耦合、多变量和自然不稳定的系统,倒立摆是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合,其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统,可以作为一个典型的控制对象对其进行研究;倒立摆系统作为控制理论研究中的一种比较理想的实验手段,为自动控制理论的教学、实验和科研构建一个良好的实验平台,以用来检验某种控制理论或方法的典型方案,促进了控制系统新理论、新思想的发展;本报告通过设计二阶、四阶两种倒立摆控制器来加深对实际系统进行建模方法的了解和掌握随动控制系统设计的一般步骤及方法;熟悉倒立摆系统的组成及基本结构并利用MATLAB对系统模型进行仿真,利用学习的控制理论对系统进行控制器的设计,并对系统进行实际控制实验,对实验结果进行观察和分析,研究调节器参数对系统动态性能的影响,非常直观的了解控制器的控制作用;目录第一章设计的目的、任务及要求倒立摆系统的基本结构 (4)设计的目的 (4)设计的基本任务 (4)设计的要求 (4)设计的步骤 (5)第二章一级倒立摆建模及性能分析微分方程的推导 (5)系统的稳定性和能控能观性分析 (11)二阶的能观性、能控性分析 (13)四阶的能观性、能控性分析 (18)第三章倒立摆系统二阶控制器、状态观测器的设计与调试设计的要求 (22)极点配置 (22)控制器仿真设计与调试 (23)状态观测器仿真设计与调试 (28)第四章倒立摆系统四阶控制器、状态观测器的设计与调试设计的要求 (26)极点配置 (26)控制器仿真设计与调试 (27)状态观测器仿真设计与调试 (28)心得体会 (31)参考文献 (31)第一章设计的目的、任务及要求倒立摆系统的基本结构与工作原理图倒立摆系统硬件框图图倒立摆系统工作原理框图倒立摆系统通过计算机、I/O卡、伺服系统、倒立摆本体和光电码盘反馈测量元件组成一个闭环系统;以直线一级倒立摆为例,其工作原理框图如图所示;图中光电码盘1由伺服电机自带,小车的位移可以根据该码盘的反馈通过换算获得,速度信号可以通过对位移的差分得到;各个摆杆的角度由光电码盘2测量并直接反馈到I/O卡,而角速度信号可以通过对角度的差分得到;计算机从I/O卡实时读取数据,确定控制决策电机的输出力矩,并发给I/O卡;I/O卡经过电控箱内部电路产生相应的控制量,驱动电机转动,使小车按控制要求进行运动,以达到控制目的;实验过程中需要了解倒立摆装置基本结构;了解编码盘、行程开关等的基本工作原理;进行行程开关、编码盘和电机基本测试;设计的目的本设计要求我们针对设计要求,利用课堂所学知识及实验室实测来的系统数据采用工程设计法进行一级直线倒立摆控制系统设计;绘制原理图,同时在实验室进行实验检验设计结果,分析数据,编写设计报告;目的是使学生掌握随动控制系统设计的一般步骤及方法;设计的基本任务本课程设计的被控对象采用固高科技生产的GLIP2001一级直线倒立摆;通过设计与调试使学生能够：1熟悉倒立摆系统的组成及其基本结构；2掌握通过解析法建立系统数学模型及进行工作点附近线性化的方法；3掌握系统性能的计算机辅助分析；4掌握系统控制器的设计与仿真；5研究调节器参数对系统动态性能的影响;设计的要求1.熟悉倒立摆系统结构,熟悉倒立摆装置的基本使用方法；2.建立系统的数学模型,并在工作点附近线性化；3.分析系统的稳定性、频域性能、能控性与能观性；4.采用状态空间的极点配置法设计控制器,要求系统调节时间ts<=3s,阻尼比ξ>= and ξ<=1;实验步骤1.倒立摆系统基本结构分析2.对象的建模3..系统性能分析4.控制器设计与调试5.设计报告的撰写第二章一级倒立摆建模及性能分析系统建模可以分为两种：机理建模和实验建模;实验建模就是通过在研究对象上加上一系列的研究者事先确定的输入信号,激励研究对象并通过传感器检测其可观测的输出, 应用数学手段建立起系统的输入－输出关系;这里面包括输入信号的设计选取,输出信号的精确检测,数学算法的研究等等内容;机理建模就是在了解研究对象的运动规律基础上,通过物理、化学的知识和数学手段建立起系统内部的输入－状态关系;对于倒立摆系统,由于其本身是自不稳定的系统,实验建模存在一定的困难;但是忽略掉一些次要的因素后,倒立摆系统就是一个典型的运动的刚体系统,可以在惯性坐标系内应用经典力学理论建立系统的动力学方程;下面采用牛顿－欧拉方法建立直线型一级倒立摆系统的数学模型;微分方程的推导在忽略了空气阻力和各种摩擦之后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统,如图所示;我们不妨做以下假设：M 小车质量m 摆杆质量b 小车摩擦系数l 摆杆转动轴心到杆质心的长度I 摆杆惯量 F 加在小车上的力x 小车位置φ摆杆与垂直向上方向的夹角θ摆杆与垂直向下方向的夹角考虑到摆杆初始位置为竖直向下图是系统中小车和摆杆的受力分析图;其中,N 和P 为小车与摆杆相互作用力的水平和垂直方向的分量;注意：在实际倒立摆系统中检测和执行装置的正负方向已经完全确定,因而矢量方向定义如图所示,图示方向为矢量正方向;分析小车水平方向所受的合力,可以得到以下方程：①由摆杆水平方向的受力进行分析可以得到下面等式：②即：③把这个等式代入①式中,就得到系统的第一个运动方程④为了推出系统的第二个运动方程,对摆杆垂直方向上的合力进行分析,可以得到下面方程：⑤⑥力矩平衡方程如下：⑦注意：此方程中力矩的方向,由于θ= π+φ,cosφ= -cosθ,sinφ= -sinθ,故等式前面有负号; 合并这两个方程,约去P 和N ,得到第二个运动方程：⑧设θ=π+φφ是摆杆与垂直向上方向之间的夹角,假设φ与1单位是弧度相比很小,即φ<<1,则可以进行近似处理：用u 来代表被控对象的输入力F ,线性化后两个运动方程如下：⑨对式3-9进行拉普拉斯变换,得到⑩注意：推导传递函数时假设初始条件为0;由于输出为角度φ,求解方程组的第一个方程,可以得到：⑾⑿如果令则有⒀把上式代入方程组的第二个方程,得到：⒁整理后得到传递函数：⒂其中,该系统状态空间方程为：⒃方程组对解代数方程,得到解如下：⒄整理后得到系统状态空间方程：⒅由9的第一个方程为对于质量均匀分布的摆杆有：于是可以得到：化简得到：⒆⒇以小车加速度为输入的系统状态空间方程：稳定性分析P=polyA;r=rootsP;ii=findrealr>0;n=lengthii;ifn>0disp'不稳定';elsedisp'稳定';end不稳定由此得到系统在未加控制器之前是发散的,不稳定的能控能观性分析A= 0 1 0 0;0 0 0 0;0 0 0 1;0 0 0;B= 0 1 0 3';C= 1 0 0 0;0 0 1 0;D= 0 0 ';>> n=4;Uc=ctrbA,B;Vo=obsvA,C;>> ifrankUc==nifrankVo==ndisp'系统状态即能控又能观'else disp'系统状态即能控,但不能观'endelse ifrankVo==ndisp'系统状态能观,但不能控'else disp'系统状态不能控,但也不能观' endend系统状态即能控又能观二阶的能观性、能控性分析>> A=0 1; 0;>> B=0 3';>> C=0 0 ;1 0;>> D=0;二阶能控性分析：>> M=ctrbA,BM =0 33 0>> rankMans =2说明系统是能控的二阶能观性分析：>> N=obsvA,CN =0 11 0>> rankNans =2说明系统是能观的四阶的能观性、能控性>> A=0 1 0 0; 0 0 0 0;0 0 0 1;0 0 0;;>> B=0 1 0 3';>> C= 1 0 0 0;0 0 1 0;>> D=0 0';四阶能控性分析:>> M=ctrbA,BM =0 0 00 0 00 00 0>> rankMans =4说明系统是能控的四阶能观性分析：>> N=obsvA,CN =0 0 00 0 00 0 00 0 00 0 0 00 0 00 0 0 00 0 0>> rankNans =4说明系统是能观的第三章倒立摆系统二阶控制器的设计设计的要求建立以X’’为输入,Φ与Φ’为状态变量,y为输出的模型分析系统的稳定性,能控能观性设计状态反馈控制器进行极点配置,是系统ξ>= ts<=3s极点配置取ξ=,Ts=；则Wn=,极点为±利用MATLAB进行计算:clear;T=input'T=';zeta=input'zeta=';Wn=4/Tzeta;A=0 1; 0;B=0;3;S1=-zetaWn-Wnsqrtzeta^2-1;S2=-zetaWn+Wnsqrtzeta^2-1;P=S1,S2;K=placeA,B,P则：K0=,K1=;控制器的仿真测试与调试图二阶系统结构图以小车加速度为输入,摆杆偏移角度和角速度为状态变量的模型,K值为反馈矩阵,输出为角度的波形图仿真波形图：取 &= 极点为：Wn=则 K0= K1= 图仿真结果波形图有次图可得加入控制器之后系统可以稳定,可见控制器的设计是合理的硬件调试硬件调试结构图以小车加速度为输入,摆杆偏移角度和角速度为状态变量的模型,加入Л模块纠正反馈角度符号通过调试K值,当K取的时候,可使仿真结果较稳定;从摆杆的角度可以看出,角度可以稳定下来,施加一干扰后,摆杆可以很快恢复稳定;状态观测器的仿真测试与调试图二阶状态观测器数字仿真图以小车加速度为输入,摆杆偏移角度和角速度为状态变量的模型,K值为反馈矩阵,输出为角度的波形图仿真波形图：取 &= 极点为：Wn=则 K0= K1= 图仿真结果波形图反馈矩阵G的求法T=input'T=';zeta=input'zeta=';Wn=4/Tzeta;A=0 1; 0;B=0;3;C=1 0;S1=-zetaWn-Wnsqrtzeta^2-1;S2=-zetaWn+Wnsqrtzeta^2-1;P=S1,S2;OP=5P;G=placeA',C',OPG=实物调试由图可知,施加扰动后摆杆能很快恢复,符合系统要求;第四章倒立摆系统四阶控制器的设计设计要求根据设计要求,确定系统闭环极点,设计状态反馈控制器,并进行仿真、调试验证;极点配置取 &= T= Wn= 极点为：±；-20±利用MATLAB进行计算:T=input'T=';zeta=input'zeta=';Wn=4/Tzeta;A=0 1 0 0;0 0 0 0;0 0 0 1;0 0 0;B=0;1;0;3;S1=-zetaWn-Wnsqrtzeta^2-1;S2=-zetaWn+Wnsqrtzeta^2-1;P=,-20+,S1,S2;K=placeA,B,Pk0=,k1=,k2= ,k3=;则K=控制器的仿真测试与调试图四阶系统仿真结构图以小车加速度为输入,摆杆角度、角速度、小车位移、加速度为状态变量,上半部分为位移输出,下半部分为角度输出仿真结果：位移：角度：实物调试：图硬件调试结构图将K1、K2、K3、K4合并后反馈作用系统,系统为单输入双输出四阶一级倒立摆状态空间极点配置实时控制结果平衡时上为位移,下位角度直线一级倒立摆状态空间极点配置实时控制结果施加干扰上为位移,下位角度状态观测器仿真设计与调试图四阶状态观测器数字仿真图四阶系统仿真结构图以小车加速度为输入,摆杆角度、角速度、小车位移、加速度为状态变量,上半部分为位移输出,下半部分为角度输出反馈矩阵G的求法T=input'T=';zeta=input'zeta=';Wn=4/Tzeta;A=0 1 0 0;0 0 0 0;0 0 0 1;0 0 0;B=0;1;0;3;C=1 0 0 0;0 0 1 0;S1=-zetaWn-Wnsqrtzeta^2-1;S2=-zetaWn+Wnsqrtzeta^2-1;P=,-10+,S1,S2;OP=3P;G=placeA',C',OP'G =实物调试反馈矩阵G和增益矩阵K分别调用matlab程序即可实物仿真与结果心得体会通过此次课程设计,使我更加扎实的掌握了有关MATLAB方面的知识,在设计过程中虽然遇到了一些问题,但经过一次又一次的思考,一遍又一遍的检查终于找出了原因所在,也暴露出了前期我在这方面的知识欠缺和经验不足;实践出真知,通过亲自动手制作,使我们掌握的知识不再是纸上谈兵;课程设计诚然是一门专业课,给我很多专业知识以及专业技能上的提升,同时又是一门讲道课,一门辩思课,给了我许多道,给了我很多思,给了我莫大的空间;同时,设计让我感触很深;使我对抽象的理论有了具体的认识;通过这次课程设计,我掌握了倒立摆装置的识别和测试；熟悉了控制系统的设计原理；了解了现代控制理论的设计方法；以及如何提高倒立摆系统的性能等等,掌握了MATLAB、simulink的使用方法和技术,通过查询资料,对所学知识有了很多新的认识;自己写主要参考文献：1.夏德玲、翁贻方,自动控制理论．北京,北京工业大学出版社,2006年1月2.刘豹、唐万生,现代控制理论．北京,机械工业出版社,2006年6月3.李国勇、谢克明,计算机仿真技术与CAD．北京,电子工业出版社,2009年1月4.Googol Technology直线倒立摆系统GLIP系列安装与使用手册固高科技。
小车倒立摆
小车单级倒立摆模糊控制实验报告小车倒立摆系统的控制问题一直是控制研究中的一个典型问题，下面先简单介绍一下这个系统。
小车倒立摆系统由一个杆、一个导轨和一辆滑车组成，滑车可以沿导轨水平运动。
在一定的初始条件下，通过在滑车质心处施加一个力μ(控制力)，使杆尽可能的平衡,如下图。
本次实验采用多种控制方法，并进行一下比较。
1.单级倒立摆的经典PID 控制 建立系统的动力学方程:假设小车质量为M,摆的质量是m ，小车位置为x ，摆的角度为θ,如上图。
现假设摆杆偏离垂直线的角度为θ，同时规定摆杆重心的坐标为G(Xc,Yc ），则有： Xc=x+lsin θ Yc=lcos θ根据牛顿定律，可以建立摆杆水平和垂直运动状态方程。
摆杆围绕其重心的转动运动可用力矩方程来描述： ..sin cos I Vl Hl θθθ=- 式中，I 为摆杆围绕其重心的转动惯量。
摆杆重心的水平运动由下式描述：22(sin )d m x l Hdt θ+=摆杆重心的垂直运动由下式描述：22cos d m l V mgdt θ=-小车的水平运动由下式描述：22d xm u Hdt =-假设θ很小，sin θ≈θ，cos θ≈1。
则以上各式变为： ..I Vl Hl θθ=- 1.1 ....()m x l H θ+= 1.2 0V mg =- 1.3 ..M x u H =- 1.4 由式1.2和1.4得：....()M m x ml u θ++= 1.5 由式1.2和1.3得：....2()I ml ml x mgl θθ++= 1.6 由1.5和1.6可得单级倒立摆方程：..22()()()m m M gl mlu m M I Mml m M I Mml θθ+=-++++222..22()()m gl I ml x u m M I Mml m M I Mml θ+=-++++ 式中，2112I mL =， l=0.5L .控制指标共有四个，即单级倒立摆的摆角θ、摆速.θ，小车位置x 和小车速度.x 。
直线一级倒立摆PID控制实验报告
直线一级倒立摆PID 控制实验一.实验目的本实验的目的是让实验者理解并掌握PID 控制的原理和方法，并应用于直线一级倒立摆的控制，PID 控制并不需要对系统进行精确的分析，因此我们采用实验的方法对系统进行控制器参数的设置。
二.实验设备1：直线一级倒立摆：直线倒立摆是在直线运动模块上装有摆体组件，直线运动模块有一个自由度，小车可以沿导轨水平运动，在小车上装载一级倒立摆。
2．PC机和运动控制卡主机箱三.实验原理经典控制理论的研究对象主要是单输入单输出的系统，控制器设计时一般需要有关被控对象的较精确模型。
PID 控制器因其结构简单，容易调节，且不需要对系统建立精确的模型，在控制上应用较广。
首先，对于倒立摆系统输出量为摆杆的角度，它的平衡位置为垂直向上的情况。
系统控制结构框图如下：图 1 直线一级倒立摆闭环系统图图中KD(s) 是控制器传递函数，G(s) 是被控对象传递函数。
考虑到输入r(s) = 0，结构图可以很容易的变换成：图 2 直线一级倒立摆闭环系统简化图该系统的输出为：其中num ——被控对象传递函数的分子项den ——被控对象传递函数的分母项numPID ——PID 控制器传递函数的分子项denPID ——PID 控制器传递函数的分母项通过分析上式就可以得到系统的各项性能。
由(3-13)可以得到摆杆角度和小车加速度的传递函数：PID 控制器的传递函数为：需仔细调节PID 控制器的参数，以得到满意的控制效果。
在控制的过程中，小车位置输出为：通过对控制量v 双重积分即可以得到小车位置。
四.仿真步骤及结果图 3 直线一级倒立摆PID 控制MATLAB 仿真模型其中PID Controller 为封装（Mask ）后的PID 控制器，双击模块打开参数设置窗口 先设置PID 控制器为P 控制器，令0,0,===kd ki kp ，得到以下仿真结果图4从图4中可以看出，闭环控制系统持续振荡，周期约为0.7s 。
倒立摆实验报告(现代控制理论)
现代控制理论实验报告——倒立摆小组成员：指导老师：2013.5实验一建立一级倒立摆的数学模型一、实验目的学习建立一级倒立摆系统的数学模型，并进行Matlab仿真。
二、实验内容写出系统传递函数和状态空间方程，用Matlab进行仿真。
三、Matlab源程序及程序运行的结果（1）Matlab源程序见附页（2）给出系统的传递函数和状态方程（a）传递函数gs为摆杆的角度：>> gsTransfer function:2.054 s-----------------------------------s^3 + 0.07391 s^2 - 29.23 s - 2.013（b）传递函数gspo为小车的位移传递函数：>> gspoTransfer function:0.7391 s^2 - 20.13---------------------------------------s^4 + 0.07391 s^3 - 29.23 s^2 - 2.013 s（c）状态矩阵A,B,C,D：>> sysa =x1 x2 x3 x4x1 0 1 0 0x2 0 -0.07391 0.7175 0x3 0 0 0 1x4 0 -0.2054 29.23 0b =u1x1 0x2 0.7391x3 0x4 2.054c =x1 x2 x3 x4y1 1 0 0 0y2 0 0 1 0d =u1y1 0y2 0Continuous-time model.（3）给出传递函数极点和系统状态矩阵A的特征值（a）传递函数gs的极点>> PP =5.4042-5.4093-0.0689（b）传递函数gspo的极点>> PoPo =5.4042-5.4093-0.0689（c）状态矩阵A的特征值>> EE =-0.06895.4042-5.4093（4）给出系统开环脉冲响应和阶跃响应的曲线（a）开环脉冲响应曲线（b）阶跃响应曲线四、思考题（1）由状态空间方程转化为传递函数，是否与直接计算传递函数相等？答：由状态空间方程转化为传递函数：>> gso=tf(sys)Transfer function from input to output...0.7391 s^2 - 6.565e-016 s - 20.13#1: ---------------------------------------s^4 + 0.07391 s^3 - 29.23 s^2 - 2.013 s2.054 s + 4.587e-016#2: -----------------------------------s^3 + 0.07391 s^2 - 29.23 s - 2.013#1为gspo传递函数，#2为gs的传递函数而直接得到的传递函数为：>> gspoTransfer function:0.7391 s^2 - 20.13---------------------------------------s^4 + 0.07391 s^3 - 29.23 s^2 - 2.013 s>> gsTransfer function:2.054 s-----------------------------------s^3 + 0.07391 s^2 - 29.23 s - 2.013通过比较可以看到，gspo由状态空间方程转化的传递函数比直接得到的传递函数多了s的一次项，而6.565e-016非常小几乎可以忽略不计，因此可以认为两种方法得到的传递函数式相同的，同理传递函数gs也可以认为是相同的。
倒立摆实验报告
专 业 实 验 报 告 实验名称倒立摆实验 实验时间 姓名 学号一、实验内容1、直线一级倒立摆建模1.1 受力分析针对直线一级倒立摆，在实际的模型建立过程中，可忽略空气流动阻力和其它次要的摩擦阻力，则倒立摆系统抽象成小车和匀质刚性杆组成的系统，如图所示。
图1 小车系统各参数定义：M ：小车质量m ：摆杆质量β：小车摩擦系数l: 摆杆转动轴心到杆质心的长度I ：摆杆惯量F ：加在小车上的力X ：小车位置Ф：摆杆与垂直向上方向的夹角θ：摆杆与垂直向下方向的夹角摆杆受力和力矩分析图2 摆杆系统摆杆水平方向受力为：H摆杆竖直方向受力为：V由摆杆力矩平衡得方程：cos sin Hl Vl I φφθθπφθφ⎧-=⎪=-⎨⎪=-⎩&&&&&& （1） 代入V 、H ，得到摆杆运动方程。
当0φ→时，cos 1θ=，sin φθ=-，线性化运动方程：1.2 传递函数模型以小车加速度为输入、摆杆角度为输出，令，进行拉普拉斯变换得到传递函数：22()()mlG sml I s mgl=+-（2）倒立摆系统参数值：M=1.096 % 小车质量，kgm=0.109 % 摆杆质量，kg0.1β=% 小车摩擦系数g=9.8 % 重力加速度，l=0.25 % 摆杆转动轴心到杆质心的长度，mI= 0.0034 % 摆杆转动惯量，以小车加速度为输入、摆杆角度为输出时，倒立摆系统的传递函数模型为：20.02725()0.01021250.26705G ss=-（3）1.3 倒立摆系统状态空间模型以小车加速度为输入，摆杆角度、小车位移为输出，选取状态变量：(,,,)x x xθθ=&&（4）由2()I ml mgl mlxθθ+-=&&&&得出状态空间模型01001000000013300044xxxxxgglμθθθθ⎡⎤⎡⎤⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥'==+⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦⎢⎥⎢⎥⎣⎦⎣⎦&&&&&&&&（5）μθθθ'⎥⎦⎤⎢⎣⎡+⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=11&&xxxy（6）由倒立摆的参数计算出其状态空间模型表达式：（7）111()()n n n n f s sI A BK s a s a s a --=--=++++L （11）设期望特征根为***12,,,n λλλL ，则期望特征多项式为：***1111()()()n n n n n f x s s s b s b s b λλ--=--=++++L L （12）由*()()f s f s =求得矩阵K 。
直线一级倒立摆系统实验报告
直线一级倒立摆系统实验报告1. 实验目的：通过对直线一级倒立摆系统进行分析，掌握系统的基本原理、参数设置和控制策略；提高学生实际动手能力和科学实验能力。
2. 实验内容：（1）搭建直线一级倒立摆系统实验平台；（2）设置系统的动力学模型，采集系统的状态变量；（3）根据系统的特性设计控制策略，实现系统的稳定控制；（4）记录实验数据，并进行数据处理和分析。
3. 实验原理：直线一级倒立摆系统是一种经典的非线性控制系统，其原理和稳定性分析可以使用动力学建模方法来描述。
系统由直线弹簧、质量块、直线导轨和质量块的摆杆组成。
当摆杆处于垂直状态时，系统处于平衡状态；当摆杆被扰动后，系统进入不稳定状态，需要通过控制策略来实现其稳定控制。
在实验中，我们选取了单摆系统作为直线一级倒立摆系统的原形。
单摆系统由一个质点和一个线性弹簧组成，其状态变量为质点的位置和速度。
当质点处于平衡位置时，系统拥有稳定状态；当质点被扰动后，系统进入不稳定状态，需要通过控制策略来实现其稳定控制。
因此，我们可以使用单摆系统来研究直线一级倒立摆系统的控制策略。
4. 实验步骤：（1）搭建实验平台：搭建直线一级倒立摆系统实验平台，包括直线导轨、摆杆、质点、力传感器、位移传感器和控制电路等。
将质点放置在导轨上，并用摆杆将其固定在弹簧上。
使用力传感器和位移传感器来测量系统的状态变量。
（2）设置系统模型：对实验平台的动力学模型进行建模，将系统的状态变量与控制策略联系起来。
（3）设计控制策略：根据系统的特性设计相应的控制策略，使系统保持稳定状态。
常用的控制策略包括模型预测控制、PID控制、滑模控制等。
（4）记录实验数据：实验过程中需要记录系统的状态变量和控制参数，并进行数据处理和分析，得到实验结论。
5. 实验结果分析：通过对直线一级倒立摆系统的实验研究，我们发现系统的稳定控制需要根据其特性和实际情况来确定相应的控制策略。
在实验中，我们采用了模型预测控制策略，通过对系统的状态变量进行预测和调节，成功实现了系统的稳定控制。
倒立摆实验报告西工大版
计算机仿真与倒立摆实验报告⒈问题说明设有一个在平面上运动的安装在马达传动车上的单级倒立摆系统，如图1-1所示。
图1-1 单级倒立摆模型示意图图中z为小车相对参考系的线位移，θ为倒立摆偏离垂直位置的角位置，l为摆杆长度，m为摆质量，M为小车质量，u为施加给小车的控制力，G为摆的质量，G mg=。
为了简化问题并保留问题实质，忽略摆杆质量、小车马达的惯量、摆轴、车轮轴、车轮与接触面之间的摩擦、风力等因素。
⒉模型建立2.1运动方程的建立及线性化设小车的位移为z，则摆心位置为(sin)z lθ+。
小车及摆在控制力u作用下均产生加速度运动，根据牛顿第二运动定律，它们在水平直线运动方向的惯性力应与控制力平衡，于是有2222(sin )d z d Mmz l u dtdtθ++=即2()cos sin M m z m l m l u θθθθ++- = 摆绕摆轴旋转运动的惯性力矩应与重力矩平衡，于是有22[(sin )]cos sin d mz l l mgl dtθθθ+=即22cos cos sin cos sin z l l g θθθθθθθ+- = 以上两个方程都是非线性方程，除了可用数值方法求解以外，不能求得解析解，因此须作进一步简化。
由于控制目的在与保持倒立摆直立，只要施加的控制力合适，作出θ和.θ接近于零的假定将是正确的。
于是可认为：sin θθ≈，cos 1θ≈，且忽略.2θθ 项，于是有()M m z ml u z l g θθθ++= +=联立求解上述两个方程可得11()12d m g zu dt MMd M m g u dt M l M lθθθ=-++=- 第式第式由第1式求出θ，与第2式联立可得如下四阶标量微分方程： (4)()1M m gg zz uu M lMM l+-=-2.2 传递函数的建立在只控制摆杆的角度θ，而不控制滑块的位移z 的情况下，以控制力u 为输入量，摆杆的角度θ为输出量构成一个单输入—单输出系统。
- 1、下载文档前请自行甄别文档内容的完整性，平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益，请联系客服反馈,我们会尽快为您处理(人工客服工作时间：9:00-18:30)。
单级倒立摆实验报告
1. 单级倒立摆系统的建模
单级倒立摆系统的建模可采用受力分析或Lagrange 方程建立得到。
这里采用受力分析方法建模。
如图所示：
根据牛顿第二定律：
(cos )0Mx m x L u θθ++-= (2-1) cos sin 0mLx
I mLg θθθ--= (2-2)
以摆杆偏角θ、角速度θ 、小车的位移x 和
小车速度x
为状态变量，即令： ()
T
X x x θθ=
(2-3)
同时假设倒立摆摆杆的垂直倾斜角度θ与1
（单位为rad ）相比很小，即1θ 。
则可以近似处理：cos θ≈1，sin 0θ≈，并
忽略高阶小量，则可得：
2222
()()m L g I
x u I m M mML I m M mML θ=+++++ （2-4）
22
()()()mL m M g mL
u I m M mML I m M mML
θ
θ+=-+++++ （2-5）
摆杆系统的状态方程为： 1222
2122
344122
()()()()()x x m L g I x x u I m M mML I m M mML
x x mL m M g mL x x u I m M mML I m M mML =⎧⎪⎪=+⎪++++⎨
=⎪⎪+=-+⎪++++⎩
（2-6） 写成向量的形式为：
X
AX Bu y CX Du ⎧=+⎨
=+⎩
(2-7)
其中
0100000A 00010
00a b
⎛⎫ ⎪
⎪= ⎪ ⎪
⎝⎭, 00c B d ⎛⎫
⎪ ⎪= ⎪ ⎪⎝⎭
,10000010C ⎛⎫= ⎪⎝⎭,00D ⎛⎫= ⎪⎝⎭
（2-8） 参数a 、b 、c 、d 分别为：
222()m L g
b I m M mML =
++ （2-9）
2
()()mL m M g
a I m M mML +=-
++
（2-10）
2
()I
c I m M mML =
++ （2-11）
2
()mL
d I m M mML =++
（2-12）
选择摆杆的倾斜角度θ和小车的水平位移x 作为系统的输出，则输出方程为：
y CX = (2-13)
根据金棒-2型倒立摆系统实验平台的参数，m=0.2kg ，M=0.6kg ，L=0.158m ，I=0.001654kg.m 2 ，g=10N/kg.同时，这里建模时候使用的ｕ是以力作为输入信号的，实际上采用的是以电压作为输入信号，通过电机作了一定的转化，这里我们约定：先暂时以力作为输入信号，最后再统一处理。
则有，a=2.3121，b=-58.5337，c=0.3830，d=7.3167。
因此，010000 2.31210A 00010058.53370⎛⎫ ⎪
⎪= ⎪ ⎪-⎝⎭,00.383007.3167B ⎛⎫
⎪ ⎪= ⎪ ⎪⎝⎭
2. 全状态反馈设计 2.1. 检验系统可控性
可控性矩阵纯ctrB=105
*0
00.00020.005300.00020.00530.148200.0001-0.00310.09370.0001-0.00310.0937 2.5164-⎡⎤⎢⎥--⎢
⎥⎢⎥⎢⎥-⎣⎦
显然rank(ctrB)=4,系统可控. 2.2. 反馈设计
要求：稳定调节时间3s n
t s π
ξω=
<，摆角5θ< ，(5/90100) 5.56p σ<⨯= ，
p e
σ=得0.47ξ>，=0.707ξ取,则
1.483n π
ωξ
>
=，取4n ω=，则可取主导极点为
1,2n p j ξωω=-±1,22p j =-±选择远极点使得其距原点距离
大于15p ，在此取3415=20p p =，，因此希望的极点为1,22p j =-±3,420p =-。
设计反馈后特征式:(+20)(+20)(22s s s j s j ∆=+-++，同时与
det ()sI A BK --特征式各系数进行比较可得K=[162.7 56.9 62.2 3.0 ]. 因此得到控制量-162.756.962.2 3.0KX x x μθθ==+++ .以上可以用Matlab 编程实现，源程序为：
A=[0 1 0 0; 0 0 2.3121 0;0 0 0 1;0 0 -58.5337 0]; B=[0;0.3830;0;7.3167]; C=[1 0 0 0;0 0 1 0]; D=[0;0]; G=ss(A,B,C,D);
P=[-2+j*2*sqrt(3),-2-j*2*sqrt(3),-20,-20]; K=acker(A,B,P); A=A-B*K; Gk=ss(A,B,C,D); t=[0:0.1:10];
impulse(G,t); hold on ; impulse(Gk,t); grid;
开环响应
全状态反馈响应
可见在脉冲输入下可以获得良好的控制特性：倒立摆在2s稳定在了平衡位置，摆角θ的最大摆幅1.1%，小车位置偏离平衡位置6%，满足设计要求。
当在小车上施加1m 的阶跃信号时，闭环系统的响应如下图：
可见响应满足下列指标
(1) 杆角度θ和小车位移x的稳定时间小于3秒
(2) x的上升时间小于1秒
(3) θ的超调量小于1度（0.35弧度）
(4) x的稳态误差小于0.5%.。