单级倒立摆实验报告

合集下载

一阶倒立摆模糊控制实验报告

一阶倒立摆模糊控制实验报告

一阶倒立摆模糊控制实验报告一、实验目的本实验旨在通过模糊控制方法来控制一阶倒立摆系统,实现摆杆保持竖直的稳定控制。

二、实验原理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 控制的原理和方法,并应用于直线一级倒立摆的控制,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 为输入量,摆杆的角度θ为输出量构成一个单输入—单输出系统。

平面一级倒立摆实验报告

平面一级倒立摆实验报告

平面倒立摆实验一、实验装置简介平面倒立摆是在XY平台的基础上,设计平面倒立摆摆杆组件,组成平面倒立摆控制系统,倒立摆是研究自动控制原理和智能控制控制算法的研究平台,系统本身是一个多变量,强耦合的非线性系统。

1.系统组成一套完整的平面摆系统主要由以下三部分组成,见图片1-1:(1).控制对象,平面摆机械本体;(2).电控箱;(3).计算机。

图片 1-1 平面倒立摆系统组成用户在计算机上发送的指令通过电控箱转化为控制信号传达给机械本体的执行部件;反馈元件采集的信号通过电控箱送回计算机并转化为可视的数据、曲线、图像等在显示器上显示出来。

1.1 平面摆机械本体图片1-2所示,GPIP200X系列XY平台平面摆是由下端的GXY系列XY平台和上端的摆部件组成,部件全部采用工业级元件。

图片 1-2 XY 平台本体外观平面倒立摆摆体说明图片 1-3 平面一级倒立摆摆体外观1.2控制箱控制箱是平台控制部分的核心,与机械本体驱动电机配套,为交流伺服型,电控箱内置交流伺服驱动器、开关电源、断路器、接触器、运动控制器端子板,按钮开关等,外观见图片 1-4图片 1-4交流伺服型电控箱外形图1.3计算机为保证系统良好运行,建议计算机系统配置不低于一定标准。

二、平面一级倒立摆的建模在多种机器人动力学建模方法中,具有代表性的是牛顿-欧拉方法和拉格朗日方法。

用牛顿定律求解多体动力学问题时,需要把多体系统切开,将各个组成部分看作是独立的子结构,先建立各自的动力学方程,然后建立系统的动力学方程,求解驱动力的同时也解出切开处的铰链约束力;但是要解算大量的微分方程组,带来了一定的运算量。

由于倒立摆系统中关节处的约束力并无太大的意义,且由于拉格朗日方程组形式对称,表达方便,便于利用MATHEMATICA 强大的符号运算功能编程实现,简化了求解难度。

所以,本文采用拉格朗日方程推导平面一级倒立摆系统的动力学模型。

采用如图所示的坐标:根据几何知识:其中l是倒立摆摆杆长度,,分别是摆杆在x-z,y-z平面的映射长度,为摆杆与z轴方向的夹角,,分别为摆杆在x-z,y-z平面的映射与z轴方向的夹角。

直线一级倒立摆实验报告

直线一级倒立摆实验报告

Gs KDs2 KPs KI
s
相当于给系统增加了一个位于原点的开环极点和两个位置可变的开环零点,因此 对于低阶已知数学模型的系统,根据期望的性能指标可以采用根轨迹法确定PID 参数。
2、频域法确定PID参数 对于已知频率特性曲线的系统,PID控制器相当于 给频率特性曲线增加了积分环节和一个二阶微分环节,通过调整PID参数,可以 改变PID控制器的频率特性,进而改变闭环系统的频率特性。
当摆杆被控时,小车的运动的位移也受到导轨实际长度的限制。因此,输出量除 了摆杆角度外,还有一个小车运动的位移。位移与输入量小车加速度之间的关系 为:
X (s) 1
Rs s2
控制系统结构图:
1
s2
Transfer Fcn1
Pos
3
In1 Out1
Step
s2+-29.4
Addห้องสมุดไป่ตู้
Transfer Fcn
Step 0.08
0.06
0.04
0.02
0
0
1
2
3
4
5
6
7
8
9
10
Pos.
0
-2
-4
0
1
2
3
4
5
6
7
8
9
10
Ang.
4
3
2
1
0
0
1
2
3
4
5
6
7
8
9
10
由曲线可以看出,系统角度超调量为33.6%,调整时间接近0.55秒,位移变化平 稳,角度输出稳定。故这组参数可以作为PID控制参数;
2、基于计算机MATLAB 平台进行现场倒立摆控制,绘制实验曲线; 直线一级倒立摆系统是小车在光滑的导轨上运动,小车上铰链了一根摆杆,

直线一级倒立摆系统实验报告

直线一级倒立摆系统实验报告

直线一级倒立摆系统实验报告西北工业大学姓名:张云虎探测制导与控制技术学号:2013300925 1.实验参数介绍2.根据实验指导书给的受力分析结合newton定律得出动力学方程:分析水平方向的合力有:M=F-f-N (1)分析摆杆水平方向的受力得;N-Fs=m(x+lsinθ) ps:Fs=0即N=m+mlθcosθ-mlθsinθ(2)把(2)带入(1)得到:(M+m)+f+ mlθcosθ-mlθsinθ=F(3)对垂直方向的合力进行分析得到:-P+mg+Fh=m(l-lcosθ) ps:Fh=0即P-mg= mlθsinθ+mlθcosθ(4)力矩平衡方程:Plsinθ+Nlcosθ+Iθ=0 (5)把公式(2)(4)带进(5)得到:(I+m)θ+mglsinθ=-ml(6)近似化处理得到:(I+m)ф-mglф=ml(M+m)+f-mlф=u写出状态空间模型:=Ax+Buy=Cx+Du==+ф+ uф=фф= +ф+ u写成矩阵形式,带入参数化简如下:фф =ф= uy= ф = фф+ u3.MATLAB分析:>> A=[0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0]A =0 1.0000 0 0 0 0 0 0 0 0 0 1.0000 0 0 29.4000 0>> B=[0;1;0;3]B =13>> C1=[1 0 0 0]C1 =1 0 0 0>> C2=[0 0 1 0]C2 =0 0 1 0>> C=[C1;C2]C =1 0 0 00 0 1 0>> D=[0;0]D =D1 =>> D2=[0]D2 =状态空间模型如下:>> sys1=ss(A,B,C,D)sys1 =a =x1 x2 x3 x4x1 0 1 0 0x2 0 0 0 0x3 0 0 0 1x4 0 0 29.4 0b =u1x1 0x2 1x3 0x4 3c =x1 x2 x3 x4y1 1 0 0 0y2 0 0 1 0d =u1y1 0y2 0Continuous-time state-space model.4.利用MATLAB判断系统的能控性与观性:>> Qc=ctrb(A,B);>> Qo1=obsv(A,C1);>> Qo2=obsv(A,C2);>> rank(Qc)ans =4>> rank(Qo1)ans =2>> rank(Qo2)ans =2>> rank(obsv(A,C))ans =4因为rank(ctrb(A.B))=4,所以系统可控;因为rank(obsv(A,C1))=2,所以输出1不可观测;因为rank(obsv(A,C2))=2,所以输出2不可观测;因为rank(obsv(A,C)=4,所以由全部输出是可观测的。

一阶倒立摆模型建立与正确性分析实验报告

一阶倒立摆模型建立与正确性分析实验报告

一阶倒立摆模型建立与正确性分析【实验目的】学会建立一阶倒立摆模型建立,并结合物理现象与数值结果分析模型的正确性。

【实验设备与软件】MATLAB/Simulink【实验原理】对于倒立摆系统,由于其本身是自不稳定的系统,实验建模存在一定的困难但是经过假设忽略掉一些次要的因素后,倒立摆系统就是一个典型的运动的刚体系统,可以在惯性坐标系内应用经典力学理论建立系统的动力学方程下面我们采用其中的牛顿欧拉方法建立直线型一阶倒立摆系统的数学模型.微分方程的推导:在忽略了空气阻力和各种摩擦之后,可将直线一阶倒立摆系统抽象成小车和匀质杆组成的系统.图一直线一阶倒立摆系统图取小车质量M=1.096kg,摆杆质量m=0.109kg,摆杆与小车间的摩擦系数b1=0.001N.m.s.,小车水平运动的摩擦系数b2=0.1N.m.s.,摆杆转动轴心到摆杆质心的长度l=0.25m,加在小车上的力F,小车位置X,摆的角度θ摆杆惯量J。

一.忽略摩擦摆杆绕其重心的转动方程为:J=—l (1)摆杆重心的水平运动可描述为:=m(x+) (2)摆杆重心在垂直方向上的运动可描述为:—mg= m(x+l) (3)小车水平方向运动可描述为:F—=M (4)由式(2)和式(4)得到:(M+m )x+ml (—)=F (5)由式(1)式(2)和式(3)得:J+mml=mgl (6)整理式(5)和式(6)得:(7)若只考虑θ=0 在其工作点附近(0*<θ<10)的细微变化,这时可近似认为 , sin θ=θ,cos θ=1,J=由此得到的简化近似模型为:代入数值得本实验中倒立摆的简化模型:二.有摩擦定义逆时针转动为正方向。

设摆杆的重心为(),则(1)根据牛顿定律建立系统垂直和水平运动力学方程:(1) 摆杆绕其重心转动的力学方程为:J=l+l b1 (2)式中,J 为摆杆绕其重心的转动惯量:2312123J mL L ml ==。

这里,杆重力的转动力矩为0,小车运动引起的杆牵连运动的惯性力的转矩也为0。

直线一级倒立摆控制详细报告

直线一级倒立摆控制详细报告

直线一级倒立摆控制一、课程设计目的学习直线一级倒立摆的数学建模方法,运用所学知识设计PID控制器,并应用MATLAB进行仿真。

通过本次课程设计,建立理论知识与实体对象之间的联系,加深和巩固所学的控制理论知识,增加工程实践能力。

二、课程设计要求1. 应用动力学知识建立直线一级倒立摆的数学模型(微分方程形式),并建立系统的开环传递函数模型。

2. 运用经典控制理论知识,按设计要求设计控制器。

3. 应用MATLAB的Simulink建立控制系统的仿真模型,得出仿真结果。

4. 控制要求:※小车的位置x和摆杆角度的稳定时间小于10秒;※阶跃响应摆杆角度的摆幅小于2°;※θ有≤8°扰动时,摆杆的稳定时间小于三秒。

对比仿真结果与控制要求,修正设计值,使之满足设计要求。

三、控制系统建模过程1、控制对象示意图图1.控制对象示意图图中对象参数:M 小车质量 1.32kg l 摆杆转动中心到杆质心的距离0.27mm 摆杆质量0.132kg F 作用在系统上的外力X 小车位移θ 摆杆与竖直方向的夹角,以垂直向上为起始位置,取逆时针方向为正方向。

b 小车摩擦阻尼系数 m/sec 2. 控制系统模拟结构图:图2.系统的模拟结构图其中G1(s )表示关于摆角θ的开环传递函数,D(S)表示PID 控制器的传递函数,G2(s )表示小车位移x 的传递函数。

由于摆角与垂直向上方向夹角为0时为平衡状态,故摆角的理想输出值应为R (S )=0。

3. 建模过程:T图3.小车及摆杆的受力分析图如图3所示,对小车及摆杆进行受力分析,得到以下平衡方程:对小车有: 22..................................(1)dx d xF F b N M dt dt=--=∑小车对摆杆有:2222(cos ) (2)(cos ).............................(3)d F N m x l dt d Fmg P m l l dtθθ==-=-=-∑∑水平竖直转矩:2222sin cos ...................................(4)1 (5)23ll d T I Pl Nl dt mr I dr ml l θθθ-==+==∑⎰为使摆杆直立,需使θ≪1,则有sin ,cos 1θθθ≈≈, 线性化(2)(3)(4)方程得:2222() (6)0.......................................................................(7)..............................d N m x l dtmg P d I Pl Nl dtθθθ=--==+................................(8) 由(1)(5)(6)(7)(8)式联立解得:222222222() (9)4 (10)3d x d dxF M m ml b dt dt dtd d xmgl ml ml dt dtθθθ=+-+=- 对(9)(10)两式进行拉式变换,得:22222()()()()()4()()()3F S M m s X s Mls s bsX s mgl s ml s s mls X s θθθ=+-+=- 传递函数:13222432()3()()(4)43()3()43()()(4)43()3s sG s F s Ml ml s bls M m gs gbX s ls gG s F s Ml ml s bls M m gs gbsθ==++-+--==++-+-将数值带入后得到系统的传递函数:132224323() 1.461240.10842.6888 2.941.0829.4() 1.461240.10842.6888 2.94sG s s s s s G s s s s s =+---=+--四、应用Simulink建立仿真模型进行实验1.控制系统的simulink仿真结构图及仿真结果其中PID控制器的传递函数参数的初步范围可以由劳斯判据确定,具体过程如下:设PID控制器的传递函数为1()P I DD s K K K ss=++,则以θ为输出量的系统特征方程为111()()0P ID K K K s G s s+++= 整理得321.46124(30.108)(342.6888)(3 2.94)0D P I s K s K s K +++-+-=通过劳斯判据可以确定,若使系统稳定,则有0.48708(3 2.94)0.98,0,14.22960.1083I I D P DK K K K K ->>>++通过模拟系统反复实验,根据PID 各个参数的作用进行数值调整,得到使系统满足要求的PID 控制器的传递函数为:1()90092650D s s s=++2. 系统响应曲线在单位阶跃输入下,θ(t )的响应曲线为:从该响应曲线可以看出,此时系统的稳定时间小于10s ,且摆杆的摆幅小于2度,满足控制要求。

一阶倒立摆实验报告(实验)

一阶倒立摆实验报告(实验)

一、实验介绍:1、背景介绍 (3)2、倒立摆简介 (3)3、实验目的 (5)4.预备知识 (5)二、实验内容:1.自学掌握MATLAB软件的基本使用方法 (6)2.自学掌握倒立摆的基本知识 (6)3.在MATLAB编程环境下完成以下实验操作 (6)4.在proteus环境下,完成倒立摆电机控制算法的仿真 (6)三、实验步骤:1.直线一阶倒立摆数学模型的推导‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥6 2.一阶倒立摆的微分方程模型‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥7 3.一阶倒立摆的传递函数模型‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥9 4.一阶倒立摆的状态空间模型‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥10 5.实际系统的传递函数与状态方程‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥12 6.用MATLAB的Simulink进行仿真‥‥‥‥‥‥‥‥‥‥‥‥‥‥‥13四、实验总结:1、实验结论 (18)2、实验收获 (19)五、参考文献:一、实验介绍:1、背景介绍倒立摆装置被公认为自动控制理论中的典型实验设备,也是控制理论教学和科研中不可多得的典型物理模型。

它深刻揭示了自然界一种基本规律,即一个自然不稳定的被控对象,运用控制手段可使之具有良好的稳定性。

通过对倒立摆系统的研究,不仅可以解决控制中的理论问题,还能将控制理论所涉及的三个基础学科:力学、数学和电学(含计算机)有机的结合起来,在倒立摆系统中进行综合应用。

在多种控制理论与方法的研究和应用中,特别是在工程实践中,也存在一种可行性的试验问题,将其理论和方法得到有效的经验,倒立摆为此提供一个从控制理论通往实践的桥梁。

2、直线一阶倒立摆简介:倒立摆是进行控制理论研究的典型实验平台,可以作为一个典型的控制对象对其进行研究。

最初研究开始于二十世纪50 年代,麻省理工学院(MIT)的控制论专家根据火箭发射助推器原理设计出一级倒立摆实验设备。

近年来,新的控制方法不断出现,人们试图通过倒立摆这样一个典型的控制对象,检验新的控制方法是否有较强的处理多变量、非线性和绝对不稳定系统的能力,从而从中找出最优秀的控制方法。

单级倒立摆实验报告

单级倒立摆实验报告

单级倒立摆实验报告1. 单级倒立摆系统的建模单级倒立摆系统的建模可采用受力分析或Lagrange 方程建立得到。

这里采用受力分析方法建模。

如图所示:根据牛顿第二定律:(cos )0Mx m x L u θθ++-= (2-1) cos sin 0mLxI mLg θθθ--= (2-2)以摆杆偏角θ、角速度θ 、小车的位移x 和小车速度x为状态变量,即令: ()TX x x θθ=(2-3)同时假设倒立摆摆杆的垂直倾斜角度θ与1(单位为rad )相比很小,即1θ 。

则可以近似处理:cos θ≈1,sin 0θ≈,并忽略高阶小量,则可得:2222()()m L g Ix u I m M mML I m M mML θ=+++++ (2-4)22()()()mL m M g mLu I m M mML I m M mMLθθ+=-+++++ (2-5)摆杆系统的状态方程为: 12222122344122()()()()()x x m L g I x x u I m M mML I m M mMLx x mL m M g mL x x u I m M mML I m M mML =⎧⎪⎪=+⎪++++⎨=⎪⎪+=-+⎪++++⎩(2-6) 写成向量的形式为:XAX Bu y CX Du ⎧=+⎨=+⎩(2-7)其中0100000A 0001000a b⎛⎫ ⎪⎪= ⎪ ⎪⎝⎭, 00c B d ⎛⎫⎪ ⎪= ⎪ ⎪⎝⎭,10000010C ⎛⎫= ⎪⎝⎭,00D ⎛⎫= ⎪⎝⎭(2-8) 参数a 、b 、c 、d 分别为:222()m L gb I m M mML =++ (2-9)2()()mL m M ga I m M mML +=-++(2-10)2()Ic I m M mML =++ (2-11)2()mLd 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.同时,这里建模时候使用的u是以力作为输入信号的,实际上采用的是以电压作为输入信号,通过电机作了一定的转化,这里我们约定:先暂时以力作为输入信号,最后再统一处理。

一阶倒立摆双闭环PID控制实验报告

一阶倒立摆双闭环PID控制实验报告

一阶倒立摆双闭环PID控制实验报告一、实验目的1. 学习并掌握一阶倒立摆原理及其数学模型;2. 了解反馈控制理论,学习PID控制原理及其在一阶倒立摆控制中的应用;3. 熟悉MATLAB/Simulink软件的使用,能够建立一阶倒立摆的模型,并进行控制仿真。

二、实验原理一阶倒立摆是指在一根杆上挂一个质量小于杆的质量的小球,通过控制杆上电动机的电流来控制小球的倾斜角度,实现倒立控制。

2. 数学模型根据机械臂的动力学方程,可以得到一阶倒立摆的状态方程:其中,θ为小球倾斜的角度,M为电机的转矩,l为杆的长度,g为重力加速度,J为小球和杆组成的转动惯量。

3. PID控制PID控制是目前最常用的控制方法之一,包括比例控制、积分控制和微分控制。

PID控制器的控制对象通常是一个差值,由控制器在比例、积分和微分的作用下不断调整输出,使差值达到期望设定值。

其中,比例作用是根据误差的大小进行调整,积分作用是积累误差从而消除静差,微分作用是根据误差的变化率进行调整,消除系统震荡和过冲。

三、实验步骤1. 建立模型首先建立一阶倒立摆的模型,输入电机的转矩,输出小球的倾斜角度。

模型如下所示:2. 设计控制器在模型基础上,设计PID控制器,控制小球的倾斜角度达到预定值。

3. 进行仿真四、实验结果根据一阶倒立摆的数学模型,建立了如下图所示的Simulink模型:输入变量为电机的转矩M,输出变量为小球的倾斜角度θ。

根据反馈控制理论和PID控制原理,设计了如下的PID控制器:其中,Kp、Ki和Kd分别为比例、积分和微分增益。

利用上述模型和控制器进行仿真,得到了小球的倾斜角度随时间的变化曲线如下图所示:可以看出PID控制器在控制小球倾斜方面表现良好,小球在稳态时达到了预定角度,并在稳定范围内波动。

五、结论1. 本次实验成功建立了一阶倒立摆的数学模型;。

单级倒立摆稳定控制实验

单级倒立摆稳定控制实验

单级倒立摆稳定控制实验一.实验目的1.了解单级倒立摆的原理与数学模型的建立;2.掌握LQR控制器的设计方法;3.掌握基于LQR控制器的单级倒立摆稳定控制系统的仿真方法。

二.实验内容图1 一级倒立摆原理图一级倒立摆系统的原理框图如上所示。

系统包括计算机、运动控制卡、伺服机构、倒立摆本体和光电码盘几大部分,组成了一个闭环系统。

光电码盘1将连杆的角度、角速度信号反馈给伺服驱动器和运动控制卡,摆杆的角度、角速度信号由光电码盘2反馈回控制卡。

计算机从运动控制卡中读取实时数据,确定控制决策,并由运动控制卡来实现该控制决策,产生相应的控制量,驱动电机转动,带动连杆运动,保持摆杆的平衡。

在忽略了空气阻力,各种摩擦之后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统,如下图2所示。

图2直线一级倒立摆系统其中:M 小车质量 m 摆杆质量 b 小车摩擦系数l 摆杆转动轴心到杆质心的长度 I 摆杆惯量 F 加在小车上的力 x 小车位置φ摆杆与垂直向上方向的夹角θ摆杆与垂直向下方向的夹角(考虑到摆杆初始位置为竖直向下) 下图是系统中小车和摆杆的受力分析图。

其中,N 和P 为小车与摆杆相互作用力的水平和垂直方向的分量。

注意:在实际倒立摆系统中检测和执行装置的正负方向已经完全确定,因而矢量方向定义如图所示,图示方向为矢量正方向。

图3 (a )小车隔离受力图; (b )摆杆隔离受力图分析小车水平方向所受的合力,可以得到以下方程:MxF bx N =-- (1) 由摆杆水平方向的受力进行分析可以得到下面等式:()22sin d N m x l dtθ=+ (2)即:2cos sin N mxml ml θθθθ=+- 为了推出系统的第二个运动方程,我们对摆杆垂直方向上的合力进行分析,可以得到下面方程:()22cos d P mg m l dtθ-= (3)即:2sin cos P mg ml ml θθθθ-=-- 力矩平衡方程如下:sin cos Pl Nl I θθθ--= (4) 注意:此方程中力矩的方向,由于θπφ=+,cos cos φθ=-,sin sin φθ=-故等式前面有负号。

平面一级倒立摆实验报告

平面一级倒立摆实验报告

平面倒立摆实验一、实验装置简介平面倒立摆是在XY平台的基础上,设计平面倒立摆摆杆组件,组成平面倒立摆控制系统,倒立摆是研究自动控制原理和智能控制控制算法的研究平台,系统本身是一个多变量,强耦合的非线性系统。

1.系统组成一套完整的平面摆系统主要由以下三部分组成,见图片1-1:(1).控制对象,平面摆机械本体;(2).电控箱;(3).计算机。

图片 1-1 平面倒立摆系统组成用户在计算机上发送的指令通过电控箱转化为控制信号传达给机械本体的执行部件;反馈元件采集的信号通过电控箱送回计算机并转化为可视的数据、曲线、图像等在显示器上显示出来。

1.1 平面摆机械本体图片1-2所示,GPIP200X系列XY平台平面摆是由下端的GXY系列XY平台和上端的摆部件组成,部件全部采用工业级元件。

图片 1-2 XY 平台本体外观平面倒立摆摆体说明图片 1-3 平面一级倒立摆摆体外观1.2控制箱控制箱是平台控制部分的核心,与机械本体驱动电机配套,为交流伺服型,电控箱内置交流伺服驱动器、开关电源、断路器、接触器、运动控制器端子板,按钮开关等,外观见图片 1-4图片 1-4交流伺服型电控箱外形图1.3计算机为保证系统良好运行,建议计算机系统配置不低于一定标准。

二、平面一级倒立摆的建模在多种机器人动力学建模方法中,具有代表性的是牛顿-欧拉方法和拉格朗日方法。

用牛顿定律求解多体动力学问题时,需要把多体系统切开,将各个组成部分看作是独立的子结构,先建立各自的动力学方程,然后建立系统的动力学方程,求解驱动力的同时也解出切开处的铰链约束力;但是要解算大量的微分方程组,带来了一定的运算量。

由于倒立摆系统中关节处的约束力并无太大的意义,且由于拉格朗日方程组形式对称,表达方便,便于利用MATHEMATICA 强大的符号运算功能编程实现,简化了求解难度。

所以,本文采用拉格朗日方程推导平面一级倒立摆系统的动力学模型。

采用如图所示的坐标:根据几何知识:其中l是倒立摆摆杆长度,,分别是摆杆在x-z,y-z平面的映射长度,为摆杆与z轴方向的夹角,,分别为摆杆在x-z,y-z平面的映射与z轴方向的夹角。

  1. 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
  2. 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
  3. 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.同时,这里建模时候使用的u是以力作为输入信号的,实际上采用的是以电压作为输入信号,通过电机作了一定的转化,这里我们约定:先暂时以力作为输入信号,最后再统一处理。

则有,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%.。

相关文档
最新文档