级倒立摆的建模与控制分析
- 格式:docx
- 大小:84.54 KB
- 文档页数:8
直线一级倒立摆的建模及控制分析摘要:本文利用牛顿—欧拉方法,建立了直线型一级倒立摆系统的数学模型。
在分析的基础上, 采用状态反馈控制中极点配置法设计了用于直线型一级倒立摆系统的控制器。
此外,用MATLAB 仿真绘制了相应的曲线并做了分析。
一、问题描述倒立摆控制系统是机器人技术、控制理论、计算机控制等多个领域和多种技术的有机结合,其被控系统本身是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统,是控制理论研究中较为理想的实验对象。
它为控制理论的教学、实验和科研构建了一个良好的实验平台,促进了控制系统新理论、新思想的发展。
倒立摆系统可以采用多种理论和方法来实现其稳定控制,如PID,自适应、状态反馈、智能控制等方法都己经在倒立摆控制系统上得到实现。
由于直线一级倒立摆的力学模型较简单,又是研究其他倒立摆的基础,所以本文利用所学的矩阵论知识对此倒立摆进行建模和控制分析。
二、方法简述本文利用牛顿—欧拉方法,建立了直线型一级倒立摆系统的数学模型。
在分析的基础上, 采用状态反馈控制中极点配置法设计了用于直线型一级倒立摆系统的控制器。
此外,用MATLAB 仿真绘制了相应的曲线并做了分析。
三、模型的建立及分析3.1 微分方程的推导在忽略了空气阻力,各种摩擦之后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统,如下图1所示。
图1 直线一级倒立摆系统假设 M 为小车质量;m 为摆杆质量;b 为小车摩擦系数;l 为摆杆转动轴心到杆质心的长度;I 为摆杆惯量;F 为加在小车上的力;x 为小车位置;φ为摆杆与垂直向上方向的夹角;θ为摆杆与垂直向下方向的夹角。
图2是系统中小车和摆杆的受力分析图。
其中,N 和P 为小车与摆杆相互作用力的水平和垂直方向的分量。
值得注意的是: 在实际倒立摆系统中检测和执行装置的正负方向已确定, 因而矢量方向定义如图2所示, 图示方向为矢量正向。
(a) (b)图2 小车和摆杆的受力分析图分析小车水平方向所受的合力,可以得到以下方程:N x b F x M --= (1)由摆杆水平方向的受力进行分析可以得到下面等式:θθθθs i n c o s 2ml ml x m N -+= (2) 把这个等式代入上式中,就得到系统的第一个运动方程:()F ml ml x b x m M =-+++θθθθsin cos 2 (3)为了推出系统的第二个运动方程,我们对摆杆垂直方向上的合力进行分析,可以得到下面方程:θθθθc o s s i n 2 ml ml mg P --=- (4) 力矩平衡方程如下:θθθI Nl Pl =--cos sin (5)合并这(4)、(5)两个方程,约去P 和N ,得到第二个运动方程:()θθθc o s s i n 2x ml mgl ml I -=++ (6) 假设φ与1(单位是弧度)相比很小,即φ《1,则可以进行近似处理:0d d s i n 1c o s 2=⎪⎭⎫ ⎝⎛-=-=t θφθθ,, (7) 用u 来代表被控对象的输入力F ,线性化后两个运动方程如下:()()⎩⎨⎧=-++=-+u ml x b x m M xml mgl ml I φφφ 2 (8) 3.2 状态空间方程方程组(8)对φ,x 解代数方程,整理后的系统状态空间方程为: ()()()()()()()()u Mm l m M I m l Mm l m M I m lI x x Mm l m M I m M m gl Mm l m M I m lbMm l m M I gl m Mm l m M I b m l I x x ⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎣⎡++++++⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎣⎡+++++-+++++-=⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡222222222200001000000010φφφφ u x x x y ⎥⎦⎤⎢⎣⎡+⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=0001000001φφφ 对于质量均匀分布的摆杆有:3/2ml I =,于是可得:()x ml mgl ml ml =-+φφ223/ 化简得:xll g 4343+=φφ设}{x u x x X ==1,,,,φφ ,则有:14301004300100000000010u l x x l g x x⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡+⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡=⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡φφφφ10001000001u x x x y ⎥⎦⎤⎢⎣⎡+⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=φφφ 3.3 实际系统模型实际系统模型参数: M =1.096 Kg ;m =0.109 Kg ;b =0.1 N/m/s ; l =0.25 m ;I =0.0034 kg ·m ·m ;采样频率 T =0.005 s 。
一级倒立摆系统仿真及分析1•摘要本次课程设讣,我们小组选择一级倒立摆系统作为物理模型,首先通过物理分析建立数学模型,得到系统的传递函数,通过对传递函数的极点,根轨迹,单位阶跃响应来分析系统稳定性。
建立状态空间模型,利用matlab进行能控能观性分析, 输入阶跃信号,分析系统输出响应。
通过设定初始条件,查看系统稳定性,利用simulink绘制系统状态图。
再对系统进行极点配置,进行状态反馈,使得系统在初始状态下处于稳定状态,并绘制系统状态图。
2・;3课程设计目的倒立摆系统是一个经典的快速、多变量、非线性、绝对不稳定系统,是用来检验某种控制理论或方法的典型方案。
倒立摆控制理论产生的方法和技术在半导体及精密仪器加E.机器人技术、导弹拦截控制系统和航空器对接控制技术等方面具有广阔的开发利用前景。
因此研究倒立摆系统具有重要的实践意义。
4.课程设计题目描述和要求本次课程设计•我们小组选择环节项H三:系统状态响应、输出响应的测量。
<环节目的:1. 利用MATLAB分析线性定常系统。
2. 利用SIMULINK进行系统状态空间控制模型仿真,求取系统的状态响应及输出响应。
环节内容、方法:1•给定系统状态空间方程,对系统进行可控性、可观性分析。
并利用SIMULINK 绘制系统的状态图,求取给定系统输入信号和初始状态时的状态响应及输出响应。
2.给定两个系统的状态空间模型,分别求两个系统的特征值;将两个系统的系统矩阵化为标准型;求出给定系统初始状态时,状态的零输入响应;求两个系统的传递函数并分析仿真结果。
4.课程设计报告内容数学模型的建立及分析对于倒立摆系统,山于其本身是自不稳定的系统,实验建模存在一定的困难。
但是经过小心的假设忽略掉一些次要的因素后,倒立摆系统就是一个典型的运动的刚体系统,可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。
下面我们采用其中的牛顿一欧拉方法建立直线型一级倒立摆系统的数学模型。
在忽略了空气阻力,各种摩擦之后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统,如下图1所示我们不妨做以下假设:M小车质量、m摆杆质量、b小车摩擦系数、I摆杆转动轴心到杆质心的长度、I摆杆惯、F加在小车上的力、x小车位置、<1)摆杆与垂直向上方向的夹角、0 摆杆与垂直向下方向的夹角(考虑到摆杆初始位置为竖直向下)。
直线一级倒立摆的建模及性能分析1 直线一级倒立摆数学模型的建立 (1)2 直线一级倒立摆系统的实际模型 (5)3 直线一级倒立摆系统的性能分析 (6)相关理论的介绍 (6)倒立摆系统的性能分析 (7)1 直线一级倒立摆数学模型的建立所谓系统的数学模型,是指利用数学结构来反映实际系统内部之间、系统内部与外部某些主要相关因素之间的精确的定量表示。
数学模型是分析、设计、预测以及控制一个系统的理论基础。
因此,对于实际系统的数学模型的建立就显得尤为重要。
系统数学模型的构建可以分为两种:实验建模和机理建模。
实验建模就是通过在研究对象上加上一系列的研究者事先确定的输入信号,激励研究对像并通过传感器检测其可观测的输出,应用数学手段建立起系统的输入-输出关系。
机理建模就是在了解研究对象的运动规律的基础上,通过物理、化学的知识和数学手段建立起系统内部的输入-状态关系。
对于倒立摆系统,由于其本身是不稳定的系统,无法通过测量频率特性的方法获取其数学模型,实验建模存在一定的困难。
但是经过小心的假设忽略掉一些次要的因素后,倒立摆系统是一个典型的机电一体化系统,其机械部分遵守牛顿运动定律,其电子部分遵守电磁学的基本定律,因此可以通过机理建模得到系统较为精确的数学模型。
为了简单起见,在建模时忽略系统中的一些次要的难以建模的因素,例如空气阻力、伺服电机由于安装而产生的静摩擦力、系统连接处的松弛程度、摆杆连接处质量分布不均匀、传动皮带的弹性、传动齿轮的间隙等。
将小车抽象为质点,摆杆抽象为匀质刚体,摆杆绕转轴转动,这样就可以通过力学原理建立较为精确的数学模型。
我们可以应用牛顿力学的分析方法或者欧拉-拉格朗日原理建立系统的动力学模型。
对于直线一级倒立摆这样比较简单的系统,我们采用通俗易懂的牛顿力学分析法建模。
为了建立直线一级倒立摆的数学模型,采用如下的坐标系:图1直线一级倒立摆的物理模型其中,F 为加在小车上的力,M 为小车质量,m 为摆杆质量,I 为摆杆惯量, l 为摆杆转动轴心到杆质心的长度,x 为小车位移,φ为摆杆与垂直向上方向的夹角,b 为小车在滑轨上所受的摩擦力,N 和P 为摆杆相互作用力的水平和垂直方向的分量。
系统的建模及性能分析倒立摆系统的构成及其参数1倒立摆系统的基本结构本设计所用到的倒立摆模型直线一级倒立摆系统。
整个系统是由6大部分所组成的一个闭环系统,包括计算机、数据采集卡、电源及功率放大器、直流伺服电机、倒立摆本体和两个光电编码器等模块。
如图2.1所示:图2.1 倒立摆系统的结构组成示意图Fig 2.1 Structure of the linear single inverted pendulum system2系统主要组成部分简介直线一级倒立摆装置如图2.2所示[13]:图2.2直线一级倒立摆装置Fig 2.2 Straight linear 1-stage inverted pendulum deviceQuanser倒立摆系统包含倒立摆本体、数据采集电控模块以及控制平台等三大部分,其中控制平台是由装有Quanser专用实时控制软件的通用PC机组成。
1.直线倒立摆主体倒立摆主体是由Quanser直线运动控制伺服单元IP02与直线一级摆杆组成,并配有专用的小车直线轨道。
这里主要介绍下Quanser直线运动控制伺服单元IP02(即倒立摆运动小车)及导轨的组成:图2.3伺服单元IP02的组成Fig 2.3 Servo unit IP02 parts编号名称英文(01)IP02小车IP02 Cart(02)不锈钢滑轨Stainless Steel Shaft(03)齿轮导轨Rack(04)小车位移齿轮Cart Position Pinion(05)小车电机传动齿轮Cart Motor Pinion(06)小车电机传动齿轮轴Cart Motor Pinion Shaft(07)摆杆传动轴Pendulum Axis(08)IP02小车位移编码器IP02 Cart Encoder(09)IP02摆杆角度编码器IP02 Pendulum Encoder(10)IP02小车位移编码器接口IP02 Cart Encoder Connector(11)IP02摆杆角度编码器接口IP02 Pendulum Encoder Connector(12)电机接口Motor Connector(13)直流伺服电机DC Motor(14)变速器Planetary Gearbox(15)直线滑轨支撑轴Linear Bearing图2.4系统导轨结构图Fig 2.4 System guide rail structure直线一级倒立摆系统的倒立摆的摆杆连接在IP02小车的摆杆连接套上,IP02小车由电机通过齿轮传动机构在导轨上来回运动,保持摆杆平衡。
2倒立摆系统的模型建立2.1 倒立摆特性●非线性倒立摆是一个典型的非线性复杂系统,实际中可以通过线性化得到系统的近似线性模型,线性化处理后再进行控制。
也可以利用非线性控制理论对其进行控制。
●不确定性模型误差以及机械传动间隙,各种阻力带来实际系统的不确定性。
实际控制中一般通过减少各种误差降低不确定性,如施加预紧力减少皮带或齿轮的传动误差,利用滚珠轴承减少摩擦阻力等不确定性因素。
●耦合性倒立摆的各级摆杆之间,以及和运动模块之间都有很强的耦合关系,在倒立摆的控制中一般都在平衡点附近进行解耦计算,忽略一些次要的耦合量。
●开环不稳定性倒立摆的平衡状态只有两个,即垂直向上的状态和垂直向下的状态,其中垂直向上为绝对不稳定平衡点,垂直向下为稳定平横点。
●约束限制由于机构的限制,如运动模块的行程限制,电机力矩限制等。
为了制造方便和降低成本,倒立摆的结构尺寸和电机的功率尽量要求最小。
行程限制对倒立摆的摆起影响尤为突出,容易出现小车撞边现象[22]。
2.2 一阶倒立摆数学模型倒立摆系统是典型的运动的刚性系统,可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。
下面分别采用牛顿力学方法和拉格朗日方法建立直线型一级,二级倒立摆系统的数学模型。
2.2.1 一级倒立摆物理模型在忽略了空气阻力和各种摩擦之后,可将直线型一级倒立摆系统抽象成小车和匀质杆组成的系统,如图2.1所示:皮带轮图2.1 单级倒立摆系统物理模型2.2.2 一级倒立摆数学模型 各符号代表的意义及相关的数值:表2.1 一级倒立摆参数表参 数 参数意义 参数值 M 小车质量 1.096Kg m 摆杆质量 0.13Kg b 小车摩擦系数0.1N/m/sec l 摆杆转动轴心到杆质心的长度0.25m I 摆杆转动惯量 0.0034Kg*m*mf 加到小车上的力 x小车位置φ摆杆与竖直向上方向的夹角通过对系统中小车和摆杆进行受力分析,分别可得到以下运动方程:2()cos sin F M m x bx ml ml θθθθ=++-+ (2.1) 22()sin cos 2sin (sin cos )I ml mgl mlx ml θθθθθθθθ+-=++ (2.2)22222cos sin cos 2sin sin 2sin cos M m ml x F bx ml ml ml I ml mgl ml θθθθθθθθθθ+-⎛⎫--⎛⎫⎛⎫=⎪⎪⎪----⎝⎭⎝⎭⎝⎭(2.3) 2.3 二阶倒立摆数学模型2.3.1 二级倒立摆物理模型如图2.3所示为直线型二级倒立摆物理模型皮带轮图2.3二级倒立摆系统的物理模型倒立摆装置主要由沿导轨运动的小车和固定到小车上的两个摆体组成。
三级倒立摆线性系统理论作业:以三级倒立摆为研究对象,建立对象模型,设计状态观测器,设计控制器(要有仿真结果)。
一倒立摆1概述倒立摆的控制是控制理论应用的一个典型范例,一个稳定的倒立摆系统对于证实状态空间理论的实用性是非常有用的,倒立摆系统就其本身而言是一个高阶次、不稳定、多变量、非线性、强耦合系统。
将这样一个复杂系统作为被控对象,在控制过程中能有效地反映出控制中的许多关键问题, 如非线性问题、鲁棒性问题、随动问题、镇定问题、跟踪问题、解耦问题以及不稳定问题等。
2分类倒立摆系统按摆杆数量的不同,可分为一级,二级,三级倒立摆等,多级摆的摆杆之间属于自由连接(即无电动机或其他驱动设备)。
现在由中国的北京师范大学李洪兴教授领导的“模糊系统与模糊信息研究中心”暨复杂系统智能控制实验室采用变论域自适应模糊控制成功地实现了四级倒立摆。
是世界上第一个成功完成四级倒立摆实验的国家。
3倒立摆的控制目标摆的控制问题就是使摆杆尽快地达到一个平衡位置,并且使之没有大的振荡和过大的角度和速度。
当摆杆到达期望的位置后,系统能克服随机扰动而保持稳定的位置。
4倒立摆的控制方法倒立摆系统的输入为小车的位移(即位置)和摆杆的倾斜角度期望值,计算机在每一个采样周期中采集来自传感器的小车与摆杆的实际位置信号,与期望值进行比较后,通过控制算法得到控制量,再经数模转换驱动直流电机实现倒立摆的实时控制。
直流电机通过皮带带动小车在固定的轨道上运动,摆杆的一端安装在小车上,能以此点为轴心使摆杆能在垂直的平面上自由地摆动。
作用力u平行于铁轨的方向作用于小车,使杆绕小车上的轴在竖直平面内旋转,小车沿着水平铁轨运动。
当没有作用力时,摆杆处于垂直的稳定的平衡位置(竖直向下)。
为了使杆子摆动或者达到竖直向上的稳定,需要给小车一个控制力,使其在轨道上被往前或朝后拉动。
二.三级倒立摆系统的数学模型1.系统的结构三级倒立摆系统主要由控制对象, 导轨, 电机,皮带轮, 传动带以及电气测量装置组成,控制对象由小车,下摆, 中摆,上摆组成,上、中、下摆由轴承连接,并且可以在平行导轨的铅垂平面内自由转动,三个电位器分别安装在连接处 ,测量摆的相对偏角11223--θθθθθ,,其原理结构图如图 1 所示,系统运动分析示意图 如图 2 所示2.系统的数学模型 2.1假设条件(1)、上、中 、下摆及小车都是刚体;(2)、皮带轮与传动带之间无相对滑动,传动带无伸长现象; (3)、小车的驱动力与直流放大器的输入成正比,且无滞后, 忽略电机电枢绕组中的电感;(4)、小车运动时所受的摩擦力正比于小车的速度 ; (5)、各摆的摩擦力矩与相对速度(角速度)成正比 2.2系统参数说明m0 —小车系统的等效质量 1.32822kg ; m1 —下摆质量 0 .22kg ; m2—中摆质量 0 .22kg ;m3—上摆质量 0 .187kg ;J1—下摆质心至转轴处转动惯量 0.004963kg .m ; d1—下摆质心至转轴之间的距离 0 .304m ; J2—中摆质心至转轴处转动惯量 0.004963 kg .m ; d2—中摆质心至转轴之间的距离 0 .304m ; J3—上摆质心至转轴处转动惯量 0.004824 kg .m ; d3—上摆质心至转轴之间的距离 0 .226m ; d4 —中、下摆转轴间的距离 0.49m ; d5 —上、中摆转轴间的距离 0.49m ; d6—上摆杆长度;f0—小车系统的摩擦系数 22.9147 kg/s;f1—下摆转轴处的摩擦阻力矩系数 0.007056kg .m/s; k0—电机的机电常数 0.9467N;f2—中摆转轴处的摩擦阻力矩系数 0.002646 kg .m/s; k1—功放的电压增益 8.0;f3 —上摆转轴处的摩擦阻力矩系数 0.002646 kg .m/s; R0 —电机的电枢绕组内阻 8.55Ω; R1—功放输出电阻 1 .252Ω; d —皮带轮直径 0.13m ; g —重力加速度。
单级倒立摆系统的建模与控制器设计摘要:本文主要研究的是单级倒立摆的建模、控制与仿真问题。
倒立摆是一类典型的快速、多变量、非线性、强耦合、自然不稳定系统。
由于在实际中有很多这样的系统,因此对它的研究在理论上和方法论上均有深远的意义。
本文首先建立了单级倒立摆的数学模型,对其进行了近似线性化处理,得到了它的状态空间描述,并对系统的开环特性进行了仿真和分析。
然后,基于极点配置方法设计了单级倒立摆系统的控制器。
最后,用Matlab对系统进行了数值仿真,验证了所设计的控制算法的有效性。
关键词:单级倒立摆;极点配置;建模与控制目录1 绪论 (3)2 单级倒立摆系统的建模与分析 (4)2.1单级倒立摆系统的建模 (4)2.2单级倒立摆系统的模型分析 (8)3 单级倒立摆系统的极点配置控制器设计 (13)3.1单级倒立摆系统控制器设计的目标 (13)3.2单级倒立摆系统的能控性分析 (13)3.3单级倒立摆系统的极点配置控制器设计 (14)3.4闭环系统仿真分析 (16)4 结论 (20)致谢 (21)参考文献 (22)1 绪论倒立摆控制系统是一个复杂的、不稳定的、非线性系统,是进行控制理论教学及开展各种控制实验的理想实验平台。
对倒立摆系统的研究能有效的反映控制中的许多典型问题:如非线性问题、鲁棒性问题、镇定问题、随动问题以及跟踪问题等。
通过对倒立摆的控制,用来检验新的控制方法是否有较强的处理非线性和不稳定性问题的能力。
通过对它的研究不仅可以解决控制中的理论和技术实现问题,还能将控制理论涉及的主要基础学科:力学,数学和计算机科学进行有机的综合应用。
其控制方法和思路无论对理论或实际的过程控制都有很好的启迪,是检验各种控制理论和方法的有效的“试金石”。
倒立摆的研究不仅有其深刻的理论意义,还有重要的工程背景。
在多种控制理论与方法的研究与应用中,特别是在工程实践中,也存在一种可行性的实验问题,使其理论与方法得到有效检验,倒立摆就能为此提供一个从理论通往实践的桥梁,目前,对倒立摆的研究已经引起国内外学者的广泛关注,是控制领域研究的热门课题之一。
基于倒立摆顺摆控制的建模与仿真研究基于倒立摆顺摆控制的建模与仿真研究倒立摆是一种经典的非线性控制系统,其稳定性分析和控制方法一直是控制理论研究的热点。
本文将介绍基于倒立摆顺摆控制的建模与仿真研究。
一、倒立摆系统建模倒立摆系统由一个质量为m、长度为l的杆和一个质量为M的小车组成,杆与小车通过一根无摩擦的轴连接。
小车可以在水平方向上移动,杆可以在竖直方向上旋转。
系统的状态变量为小车的位置x、小车的速度v、杆的角度θ和杆的角速度ω。
根据牛顿第二定律和杆的运动方程,可以得到系统的动力学方程:m x'' = F - m g sinθ - m l θ'^2M x'' = F + m l θ'' cosθ - m l θ'^2 sinθl θ'' + g sinθ = x'' cosθ其中,F为小车受到的外力,g为重力加速度。
二、顺摆控制顺摆控制是一种基于状态反馈的控制方法,其目的是使倒立摆系统保持在竖直方向上。
顺摆控制器的设计需要满足系统的稳定性和性能要求。
首先,需要将系统的动力学方程转化为状态空间形式:x' = Ax + Buy = Cx其中,x为状态向量,u为控制输入,y为输出向量,A、B和C为系统的矩阵。
然后,可以设计状态反馈控制器:u = -Kx其中,K为状态反馈矩阵。
最后,可以通过极点配置法或线性二次调节法来确定状态反馈矩阵K,以满足系统的稳定性和性能要求。
三、仿真研究为了验证顺摆控制器的有效性,可以进行仿真研究。
使用MATLAB/Simulink软件,可以建立倒立摆系统的仿真模型,并进行控制器的设计和仿真。
首先,需要建立倒立摆系统的仿真模型。
可以使用Simulink中的Simscape Multibody工具箱,将倒立摆系统建模为一个多体动力学系统。
然后,可以添加控制器模块,设计顺摆控制器,并将其与倒立摆系统相连。
倒立摆控制方法倒立摆是一种经典的控制系统问题,它是指一个竖直放置的杆子上面安装了一个质量集中在一点上的小球,通过控制杆子底部的电机或者其他形式的能源输入来控制小球在杆子上面做周期性运动。
倒立摆广泛应用于机器人、汽车、飞行器等领域,其控制方法也是研究自适应控制、非线性控制等领域的重要课题。
本文将介绍倒立摆的基本模型和常见的控制方法。
一、倒立摆模型1.单自由度倒立摆模型单自由度倒立摆模型是指小球只能在竖直方向上运动,并且可以忽略小球与杆子之间的滑动摩擦力和空气阻力。
这种模型可以用如下图所示的简单结构来表示:其中,m为小球质量,l为杆长,g为重力加速度,θ为小球相对竖直方向偏离角度。
2.多自由度倒立摆模型多自由度倒立摆模型是指考虑了小球与杆子之间滑动摩擦力和空气阻力等因素,可以用如下图所示的结构来表示:其中,x为小球与竖直方向的位移,θ为小球相对竖直方向偏离角度,u为输入控制量。
二、常见的倒立摆控制方法1.线性控制方法线性控制方法是指利用线性系统理论来设计控制器,使得系统能够稳定运行。
常见的线性控制方法包括PID控制器、LQR控制器等。
(1)PID控制器PID控制器是一种经典的线性反馈控制器,其输出信号由比例、积分和微分三个部分组成。
对于单自由度倒立摆模型,其PID控制器可以表示为:其中,Kp、Ki和Kd分别表示比例、积分和微分增益系数。
(2)LQR控制器LQR(Linear Quadratic Regulator)是一种基于最优化理论的线性反馈控制方法。
对于单自由度倒立摆模型,其LQR控制器可以表示为:其中,Q和R分别为状态权重矩阵和输入权重矩阵。
2.非线性控制方法非线性控制方法是指利用非线性系统理论来设计控制器,使得系统能够稳定运行。
常见的非线性控制方法包括滑模控制、自适应控制等。
(1)滑模控制滑模控制是一种基于变结构控制理论的非线性反馈控制方法,其主要思想是通过引入一个滑动面来实现系统稳定。
对于单自由度倒立摆模型,其滑模控制器可以表示为:其中,s为滑动面,sgn为符号函数。
环形一级倒立摆的建模与控制
环形一级倒立摆是一种基于完全线性模型动力学系统的重要机构。
它通过将一个简单
形状的圆环和两个非常简单的支撑结构放在环上,将圆环内外连接起来,从而实现倒立摆
运动的目的。
环形一级倒立摆机构在实验性机械力学研究以及实用机器设计中都有着广泛
应用。
首先,动力学建模的目的是确定环形一级倒立摆的运动学行为,特别是整个系统在不
断变化外输入下的响应规律,在此基础上构造一种有效的控制策略进行控制。
准确确定环
形一级倒立摆机构的动力学参数也是实现接下来的控制过程的基础,因此一定要全面准确
地确定环形一级倒立摆的动力学参数。
其次,环形一级倒立摆的控制是机构动力学建模的核心,也是机构技术应用的关键。
为了确保系统实现预定的动作,实现系统的稳定运行,首先要给出环形一级倒立摆的数学
模型,考虑到机构参数量多,一定要注意合理地选择力学参数及控制参数,根据机构特性
进行有效地搭建。
此外,在搭建环形一级倒立摆的控制系统时,还要特别考虑抗干扰性能,通过优化控制技术,增大控制比例带下限,来实现机构的高精度控制。
环形一级倒立摆的建模与控制需要综合考虑动力学因素和控制因素。
根据物理实验和
数学建模的结果,设计并实施一种有效的控制策略,可以有效地实现环形式一级倒立摆的
控制,获得较高的控制效果。
总的来说,环形一级倒立摆的建模与控制有助于揭示机构的动力学特性,并帮助控制
者有效地实现控制目标,在实际工程中可以广泛应用。
基于拉格朗日建模的单级倒立摆起摆与稳定控制拉格朗日建模是一种经典的用来描述物体运动的数学方法。
倒立摆是一个典型的动态系统,在控制领域中有着广泛的应用。
通过拉格朗日建模可以描述单级倒立摆的运动方程,进而实现其起摆和稳定控制。
单级倒立摆由一个固定在支撑平面上的杆和一个可以沿杆轴旋转的质量小车组成。
杆的角度记为θ,小车的位置记为x。
首先,通过拉格朗日方程可以得到倒立摆的动力学方程:L = T - U其中,L为系统的拉格朗日函数,T为系统的动能,U为系统的势能。
对于单级倒立摆,可以将系统的动能和势能表示为:T = 1/2*m*ẋ^2 + 1/2*I*θ̇^2U = m*g*l*cos(θ)其中,m为小车的质量,I为杆的转动惯量,g为重力加速度,l为杆的长度。
ẋ和θ̇分别表示小车和杆的速度。
将动能和势能代入拉格朗日方程,即可得到系统的动力学方程:d/dt(∂L/∂ẋ) - ∂L/∂x = Fd/dt(∂L/∂θ̇) - ∂L/∂θ = 0其中,F为施加在小车上的外力。
经过计算,可以得到如下的方程:m*ẍ - m*l*θ̈*cosθ + m*l*θ̇^2*sinθ = FI*θ̈+ m*l*ẍ*cosθ - m*g*l*sinθ = 0这就是单级倒立摆的动力学方程,描述了杆的运动以及小车的受力等关系。
接下来,可使用控制理论中的各种控制方法,例如线性控制、非线性控制等,来实现单级倒立摆的起摆和稳定控制。
通过施加合适的控制输入F,使得杆保持在垂直位置附近,并稳定在指定的位置。
总之,基于拉格朗日建模的单级倒立摆起摆与稳定控制,通过分析系统的动能和势能,得到系统的动力学方程,然后使用控制理论中的方法进行控制设计,从而实现摆杆的起摆与稳定控制。
基于拉格朗日建模的单级倒立摆起摆与稳定控制1. 引言在探讨基于拉格朗日建模的单级倒立摆起摆与稳定控制之前,我们先来了解一下拉格朗日力学。
拉格朗日力学是一种研究物体运动的动力学方法,通过建立适当的广义坐标和拉格朗日函数,可以得到物体的运动方程。
倒立摆是一种典型的非线性控制系统,通过拉格朗日建模可以对其进行深入理解,从而实现稳定控制。
2. 基本概念拉格朗日力学的基本概念包括广义坐标、广义速度、拉格朗日函数等。
在单级倒立摆系统中,我们可以选取摆角作为广义坐标,角速度作为广义速度,通过拉格朗日函数可以描述系统的动力学行为。
在这里,我们要重点介绍拉格朗日方程,它是描述系统运动方程的核心。
3. 拉格朗日建模在单级倒立摆系统中,我们可以利用拉格朗日方程对系统进行建模。
我们需要确定系统的动能和势能函数,然后通过拉格朗日方程得到系统的运动学和动力学方程。
拉格朗日建模可以将系统的非线性特性充分考虑,从而更准确地描述系统的运动规律。
4. 单级倒立摆起摆单级倒立摆是一种经典的非线性控制系统,其起摆过程表现出了复杂的动力学行为。
在起摆过程中,系统需要克服重力和惯性力的作用,通过拉格朗日建模可以对系统的起摆过程进行深入分析。
在实际控制中,了解起摆过程的特点对于设计稳定控制很有帮助。
5. 稳定控制基于拉格朗日建模的单级倒立摆系统稳定控制是一个研究热点。
稳定控制的目标是使倒立摆在外部扰动的作用下能够保持平衡状态。
通过拉格朗日建模可以建立系统的控制方程,然后设计合适的控制器来实现稳定控制。
在稳定控制中,需要考虑系统的非线性特性和外部环境的影响,这就需要充分利用拉格朗日建模的优势。
6. 个人观点基于拉格朗日建模的单级倒立摆起摆与稳定控制是一个非常有挑战性的课题。
在研究和应用中,我认为需要充分理解拉格朗日力学的基本原理,深入掌握拉格朗日方程的推导和应用,同时结合倒立摆系统的动力学特性,才能够实现有效的稳定控制。
拉格朗日建模为我们提供了一种非常有力的工具,可以帮助我们更准确地描述和分析系统的动力学行为,从而实现高效稳定的控制。
直线一级倒立摆的数学建模和根轨迹控制直线一级倒立摆是一种基于控制理论的研究对象,它可以通过数学建模来进行分析和控制。
数学建模的过程中,需要将倒立摆的动力学方程、控制器以及传感器等元器件进行建模。
根据建模结果可以分析系统的稳定性、响应速度等特征,并为设计控制策略提供参考。
根轨迹控制是一种常用于控制系统设计的方法,它通过分析控制系统的传递函数,绘制根轨迹图来评估控制系统的稳定性和性能。
对于直线一级倒立摆,可以根据其数学模型进行传递函数分析,得出控制系统的传递函数,并绘制根轨迹图。
在根轨迹图上,可以根据根轨迹的位置来判断系统的稳定性和响应速度,从而确定控制策略并调整控制参数,以实现目标控制效果。
因此,直线一级倒立摆的数学建模和根轨迹控制在控制理论研究和工程应用中具有重要意义,可以为控制系统设计提供有效的方法和手段。
一阶倒立摆系统建模与仿真研究一阶倒立摆系统是一种典型的非线性控制系统,具有多种状态和复杂的运动特性。
在实际生活中,倒立摆被广泛应用于许多领域,如机器人平衡控制、航空航天、制造业等。
因此,对一阶倒立摆系统进行建模与仿真研究具有重要的理论价值和实际意义。
ml''(t) + b*l'(t) + k*l(t) = F(t)其中,m为质量,b为阻尼系数,k为弹簧常数,l(t)为摆杆的位移,l'(t)为摆杆的加速度,l''(t)为摆杆的角加速度,F(t)为外界作用力。
在仿真过程中,需要设定摆杆的初始位置和速度。
一般而言,初始位置设为0,初始速度设为0。
边界条件则根据具体实验需求进行设定,如限制摆杆的最大位移、最大速度等。
利用MATLAB/Simulink等仿真软件进行建模和实验,可以方便地通过改变输入信号的参数(如力F)或系统参数(如质量m、阻尼系数b、弹簧常数k)来探究一阶倒立摆系统的性能和反应。
通过仿真实验,我们可以观察到一阶倒立摆系统在受到不同输入信号的作用下,会呈现出不同的运动规律。
在适当的输入信号作用下,摆杆能够达到稳定状态;而在某些特定的输入信号作用下,摆杆可能会出现共振现象。
在仿真过程中,我们可以发现一阶倒立摆系统具有一定的鲁棒性。
在一定范围内,即使输入信号发生变化或系统参数产生偏差,摆杆也能够保持稳定状态。
然而,当输入信号或系统参数超过一定范围时,摆杆可能会出现共振现象,导致系统失稳。
因此,在实际应用中,需要对输入信号和系统参数进行合理控制,以保证系统的稳定性。
为了避免共振现象的发生,可以通过优化系统参数或采用其他控制策略来实现。
例如,适当增加阻尼系数b能够减小系统的振荡幅度,有利于系统尽快达到稳定状态。
可以采用反馈控制策略,根据摆杆的实时运动状态调整输入信号,以抑制系统的共振响应。
本文对一阶倒立摆系统进行了建模与仿真研究,通过观察不同参数设置下的系统性能和反应,对其运动规律、鲁棒性及稳定性进行了分析。
研究生《现代控制理论及其应用》课程小论文一级倒立摆的建模与控制分析学院:机械工程学院班级:机研131姓名:尹润丰2014年6月2日目录1. 问题描述及状态空间表达式建立............................ - 0 -问题描述............................................... - 0 - 状态空间表达式的建立................................... - 0 - 直线一级倒立摆的数学模型........................... - 0 -直线一级倒立摆系统的状态方程...................... - 1 - 2.应用MATLAB分析系统性能.................................. - 2 -直线一级倒立摆闭环系统稳定性分析....................... - 2 - 系统可控性分析........................................ - 2 - 系统可观测性分析...................................... - 2 - 3. 应用matlab进行综合设计................................. - 3 -状态反馈原理........................................... - 3 - 全维状态反馈观测器和simulink仿真...................... - 3 -4.应用Matlab进行系统最优控制设计.......................... - 5 -5.总结..................................................... - 6 -1.问题描述及状态空间表达式建立问题描述倒立摆是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合,其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统,可以作为一个典型的控制对象对其进行研究。
倒立摆系统作为控制理论研究中的一种比较理想的实验手段,为自动控制理论的教学、实验和科研构建一个良好的实验平台,以用来检验某种控制理论或方法的典型方案,促进了控制系统新理论、新思想的发展。
下对于倒立摆系统,经过小心的假设忽略掉一些次要的因素后,它就是一个典型的运动的刚体系统,可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。
下面采用其中的牛顿—欧拉方法建立直线一级倒立摆系统的数学模型。
状态空间表达式的建立直线一级倒立摆的数学模型图直线一级倒立摆系统本文中倒立摆系统描述中涉及的符号、物理意义及相关数值如表所示。
图是系统中小车的受力分析图。
其中,N和P为小车与摆杆相互作用力的水平和垂直方向的分量。
图系统中小车的受力分析图图是系统中摆杆的受力分析图。
Fs 是摆杆受到的水平方向的干扰力, Fh是摆杆受到的垂直方向的干扰力,合力是垂直方向夹角为α的干扰力F g 。
图 摆杆受力分析图分析小车水平方向所受的合力,可以得到以下方程:设摆杆受到与垂直方向夹角为α 的干扰力Fg ,可分解为水平方向、垂直方向的干扰力,所产生的力矩可以等效为在摆杆顶端的水平干扰力FS 、垂直干扰力Fh 产生的力矩。
对摆杆水平方向的受力进行分析可以得到下面等式:即:对图摆杆垂直方向上的合力进行分析,可以得到下面方程:即 θθθθαcos sin cos 2&&&ml ml F mg P g +=++- ()61-力矩平衡方程如下:代入P 和N ,得到方程:设φπθ+=,(φ是摆杆杆与垂直向上方向之间的夹角,单位是弧度),代入上式。
假设φ<<1,则可进行近似处理: 由于:231ml I = 方程化为:令:()αφαcos sin --=g f F F ,则()91-可化为:()101-即是化简后的直线一级倒立摆系统微分方程。
带入实际数据后,微分方程为: 当忽略了F f 时,系统的微分方程如式(1-12)所示忽略干扰力后,直线一级倒立摆系统是单输入二输出的四阶系统,考虑干扰力后,直线一级倒立摆系统是二输入二输出的四阶系统。
其内部的4个状态量分别是小车的位移x 、小车的速度x &、摆杆的角度θ、摆杆的角速度θ&。
系统输出的观测量为小车的位移x 、摆杆的角度θ。
其控制量为小车的加速度θ&&将微分方程(1-12)化为关于加速度输入量和角度输出量的传递函数:直线一级倒立摆系统的状态方程实验所使用的直线一级倒立摆系系统是加速度x &&作为系统的控制输入,所以根据式(1-12)建立系统的状态方程为:整理后得到系统状态方程:将实际参数代入得到一级倒立摆系统的状态空间方程为: αcos g h F F =2.应用MATLAB 分析系统性能直线一级倒立摆闭环系统稳定性分析构建如图所示闭环系统,则系统的闭环极点为()、() :图 闭环系统结构图由于有实部为正的极点,所以闭环系统不稳定,必须设计控制器使系统稳定。
可以通过MATLAB Simulink 中对其进行仿真,判断其稳定性。
构建图所示系统的仿真程序e1,加入1m/s 2的阶跃信号由上图也能清楚的知道一级倒立摆系统是不稳定的。
系统可控性分析系统的可控性可根据秩判据进行可控性判断。
线性定常连续系统完全可控的充分必要条件是:1()n rank B AB A B n -⋅⋅⋅=,其中n 为系统矩阵A 的阶次,1()n M B AB A B -=⋅⋅⋅为系统的可控性矩阵。
matlab 程序及运行结果如下:>> A=[0 1 0 0;0 0 0 0;0 0 0 1;0 0 0];>> B=[0;1;0;3];>> T=ctrb(A,B);>> rank(T)ans =4由于rank (Ic )=4,可见该系统是完全可控的。
系统可观测性分析系统的可控性可根据秩判据进行可控性判断。
线性定常连续系统完全可控的充分必要条件是:1n C CA rank N rank n CA -⎡⎤⎢⎥⎢⎥⎢⎥⋅==⎢⎥⋅⎢⎥⎢⎥⋅⎢⎥⎢⎥⎣⎦或21(()())T T T T T T n T rank C A C A C A C n -⋅⋅⋅= 其中n 为系数矩阵A 的阶次。
matlab 程序及运行结果如下:>> A=[0 1 0 0;0 0 0 0;0 0 0 1;0 0 0];>> C=[1 0 0 0;0 0 1 0];>> T0=obsv(A,C);rank(T0)ans =4由于rank (T0)=4,故该系统是可观测的。
3.应用matlab 进行综合设计状态反馈原理设n维线性定常系统:其中x,u,y 分别是n 维、p 维、q 维向量;A 、B 、C 分别是n*n 维,n*p 维,n*q 维实数矩阵。
状态反馈系统的控制量u 取为状态x 的线性函数:其中,v 为p 参考输入向量,K 为p*n 维实反馈增益矩阵。
加入状态反馈后系统的结构图如图所示:图 系统的全状态反馈结构图则系统状态反馈的动态方程为:全维状态反馈观测器和simulink 仿真状态反馈的的实现是利用状态反馈使系统的闭环极点位于所希望的极点位置。
而状态反馈任意配置闭环极点的充分必要条件是被控系统可控。
直线一级倒立摆系统是可控的。
设系统期望极点为[]4321λλλλ=[]i i 343432--+---,则系统期望特征多项式为:列写状态反馈系统的特征多项式:令两个特征多项式各项系数对应相等,则可解出K 阵。
由matlab 求出状态反馈矩阵K ,编程如下:A=[0 1 0 0;0 0 0 0;0 0 0 1;0 0 0];>> B=[0;1;0;3];>> K=acker(A,B,[-2 -3 -4+3i -4-3i])K =系统加入s 2的阶跃输入,在构成的状态反馈调节器控制下,MATLAB 中进行系统的阶跃响应仿真,编程如下:A=[0 1 0 00 0 0 00 0 0 10 0 0];B1=[013];C=[1 0 0 00 1 0 00 0 1 00 0 0 1];D1=[0 0 0 0]';dt=;ieof=801;for i=1:ieof;U(:,i)=[];T(i)=i*dt;end;%%离散化op=[-2 %期望极点-3-4+3i-4-3i];K=place(A,B1,op)Ak0=[(A-B1*K)];Bk0=[B1];Ck0=[C];Dk0=[D1];lqrop=eig(Ak0);x=[0 0 0 0]';dt=;%离散时[dA,dB]=c2d(Ak0,Bk0,dt);%经离散化得到离散状态方程Ak1=[(A-B1*K)];Bk1=[B1];Ck1=[C];Dk1=[D1];sys=ss(Ak1,Bk1,Ck1,Dk1);[Y,X]=lsim(sys,U,T);plot(T,-Y),grid;legend('Cart','VCart','single','Vs');图 极点配置为[-2 -3 -4+3i -4-3i]时的全状态反馈仿真图横轴时间单位秒,从图中可以看出,系统稳定。
4.应用Matlab 进行系统最优控制设计最优控制问题就是寻找一个控制系统的最优控制方案或最优控制规律,使系统能最优地达到预期的目标。
对于线性连续系统,提出二次型目标函数:其中,R(t)正定,S 及Q (t)半正定,且设它们为对称矩阵,f t t ,0固定。
当f t 趋近无穷时,在)()(t x t y =情况下,该问题即为无限时间输出调节器问题。
此时稳态误差项趋于零,在此题目中假设二次型最优控制性能指标为:其中:⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡=100000500000300000500Q R=1 Matlab 编程如下: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 1 0 0;0 0 1 0;0 0 0 1];D=[0 0 0 0];Q=[500 0 0 0;0 30 0 0;0 0 50 0;0 0 0 10];R=1;>> [K,P,e]=lqr(A,B,Q,R)K =在simulink下进行仿真模型的建立,如图:图 LQR仿真模型将K输入后,进行仿真,结果如图:图 LQR仿真结果由图可见,在二次型最优控制下系统稳定性得到明显改善。