最新倒立摆模型推导
- 格式:docx
- 大小:155.49 KB
- 文档页数:11
一级倒立摆的系统分析一、倒立摆系统的模型建立如图1-1所示为一级倒立摆的物理模型图1-1 一级倒立摆物理模型对于上图的物理模型我们做以下假设:M:小车质量m:摆杆质量b:小车摩擦系数l:摆杆转动轴心到杆质心的长度I:摆杆惯量F:加在小车上的力x:小车位置ɸ:摆杆与垂直向上方向的夹角θ:摆杆与垂直向下方向的夹角(考虑到摆杆初始位置为竖直向下)图1-2是系统中小车和摆杆的受力分析图。
其中,N和P为小车与摆杆相互作用力的水平和垂直方向的分量。
注意:实际倒立摆系统中的检测和执行装置的正负方向已经完全确定,因而矢量方向定义如图所示,图示方向为矢量正方向。
图1-2 小车及摆杆受力分析分析小车水平方向受力,可以得到以下方程:M ẍ=F-bẋ-N (1-1)由摆杆水平方向的受力进行分析可以得到以下方程:N =md 2dt 2(x +l sin θ) (1-2)即: N =mẍ+mlθcos θ−mlθ2sin θ (1-3)将这个等式代入式(1-1)中,可以得到系统的第一个运动方程: (M +m )ẍ+bẋ+mlθcos θ−mlθ2sin θ=F (1-4)为推出系统的第二个运动方程,我们对摆杆垂直方向上的合力进行分析,可以得出以下方程: P −mg =md 2dt 2(l cos θ) (1-5)P −mg =− mlθsin θ−mlθ2cos θ (1-6) 利用力矩平衡方程可以有:−Pl sinθ−Nl cosθ=Iθ (1-7)注意:此方程中的力矩方向,由于θ=π+ɸ,cosɸ=−cosθ,sinɸ=−sinθ,所以等式前面含有负号。
合并两个方程,约去P和N可以得到第二个运动方程:(I+ml2)θ+mgl sinθ=−mlẍcosθ (1-8)设θ=π+ɸ,假设ɸ与1(单位是弧度)相比很小,即ɸ<<1,则可以进行近似处理:cosθ=−1,sinθ=−ɸ,(dθdt )2=0。
用u来代表被控对象的输入力F,线性化后的两个运动方程如下:{(I+ml2)ɸ−mglɸ=mlẍ(M+m)ẍ+bẋ−mlɸ=u(1-9)假设初始条件为0,则对式(1-9)进行拉普拉斯变换,可以得到:{(I+ml2)Φ(s)s2−mglΦ(s)=mlX(s)s2(M+m)X(s)s2+bX(s)s−mlΦ(s)s2=U(s) (1-10) 由于输出为角度ɸ,求解方程组的第一个方程,可以得到:X(s)=[(I+ml2)ml −gs2]Φ(s) (1-11)或改写为:Φ(s)X(s)=mls2(I+ml2)s2−mgl(1-12)如果令v=ẍ,则有:Φ(s)V(s)=ml(I+ml2)s2−mgl(1-13)如果将上式代入方程组的第二个方程,可以得到:(M+m)[(I+ml2)ml −gs]Φ(s)s2+b[(I+ml2)ml+gs2]Φ(s)s−mlΦ(s)s2=U(s) (1-14) 整理后可得传递函数:Φ(s) U(s)=mlqs2s4+b(I+ml2)qs3−(M+m)mglqs2−bmglqs(1-15)其中q=[(M+m)(I+ml2)−(ml)2]假设系统状态空间方程为:X=AX+Buy=CX+Du (1-16) 方程组对ẍ,ɸ解代数方程,可以得到解如下:{ẋ=ẋẍ=−(I+ml2)bI(M+m)+Mml2ẋ+m2gl2I(M+m)+Mml2ɸ+(I+ml2)I(M+m)+Mml2uɸ=ɸɸ=−mlbI(M+m)+Mml2ẋ+mgl(M+m)I(M+m)+Mml2ɸ+mlI(M+m)+Mml2u(1-17)整理后可以得到系统状态空间方程:[ẋẍɸɸ]=[01000−(I+ml2)bI(M+m)+Mml2m2gl2I(M+m)+Mml200010−mlbI(M+m)+Mml2mgl(M+m)I(M+m)+Mml20][xẋɸɸ]+[(I+ml2)I(M+m)+Mml2mlI(M+m)+Mml2]uy=[xɸ]=[10000010][xẋɸɸ]+[0]u(1-18)由(1-9)的第一个方程为:(I+ml2)ɸ−mgl ɸ=mlẍ对于质量均匀分布的摆杆可以有:I=13ml2于是可以得到:(13ml2+ml2)ɸ−mgl ɸ=mlẍ化简可以得到:ɸ=3g4l ɸ+34lẍ(1-19)设X={x, ẋ, ɸ , ɸ},u=ẍ则有:[ẋẍɸɸ]=[010000000001003g4l0][xẋɸɸ]+[134l]uy=[xɸ]=[10000010][xẋɸɸ]+[0]u(1-20)以上公式推理是根据牛顿力学的微分方程验证的。
一、直线一级倒立摆系统的数学模型1、倒立摆系统是一种复杂的非线性系统,为了简化对系统的反洗,在建立数学模型的过程中,作以下假设:1.)小车、摆杆在运动过程中都是不变得刚体;2.)皮带轮与传动带之间没有相对滑动,皮带不能拉伸变长,传动带没有抖振以及伸长的现象;3.)交流伺服电机的输入和输出之间是纯线性的关系;而且忽略不计电机的电枢绕组中的电感等动态特性;4.)将整个系统运行中的摩擦、各种阻力及机械传动间隙等不确定性忽略不计。
通过上述假设,则可以将直线一级倒立摆系统抽象成小车和均质敢组成的系统,如图1.1所示。
图1.1倒立摆系统2、各参数符号含义如下:符号含义单位数值M 小车质量kg 1.096m 摆杆质量kg 0,109b 小车摩擦系数N/m/sec 0.1l 摆杆转动轴心到杆质心的长度m 0.25I 摆杆转动惯性Kg*m²0.0034g 重力加速度N/kg 9.8x 小车的水平位置mθ摆角大小radN 小车对摆杆水平方向作用力NP 小车对摆杆竖直方向作用力NF 电动机经传动机构给小车的力Nφ摆杆与垂直向上方向的夹角rad3、采用牛顿--欧拉方法建立直线型一级倒立摆系统的数学模型。
图1.2是系统中小车和摆杆的受力分析图。
(a)小车的受力分析 (b)摆杆受力分析图1.2小车与摆杆的受力分析对小车水平方向所受的力进行受力分析,可以得到方程:N x b F x M --=⋅⋅⋅ 式(1.1)对摆杆水平方向所受的力进行受力分析并化简整理,可以得到等式:θθθθsin cos 2⋅⋅⋅⋅⋅-==ml ml x m N 式(1.2)将式(1.2)带入式(1.1)中,可以得到系统的第一个运动方程:θθθθsin cos )(2⋅⋅⋅⋅⋅⋅-+++=ml ml x b x m M F 式(1.3)对摆杆垂直方向所受的力进行受力分析并化简整理,可以得到下面等式:θθθθcos sin 2⋅⋅⋅--=ml ml mg P 式(1.4)力矩平衡方程如下:⋅⋅=--θθθI Nl Pl cos sin 式(1.5)将有关P 和N 的等式代入式(1.5)中,得到系统的第二个运动方程:θθθcos sin )(2⋅⋅⋅⋅-=++x ml mgl ml I 式(1.6)假设φ与1(单位弧度)相比很小,即φ<<1,并设θ=π+φ(φ是摆杆与垂直向上方向的夹角),可以作近似处理:φθθθ-=-==⎪⎭⎫⎝⎛s i n ,1c o s,02dt d 式(1.7)将被控对象的输入力F 用u 来表示,可以得到两个线性化后运动方程,如下 所示:⎪⎩⎪⎨⎧=-++=-+⋅⋅⋅⋅⋅⋅⋅⋅⋅u m l x b x m M x m l m glm l I φφφ)()(2式(1.8)对方程组式(1.8)进行拉氏变换,得到:⎪⎩⎪⎨⎧=Φ-++=Φ-Φ+)()()()()()()()()(22222s U s s ml s bX s s X m M s s mlX s mgl s s ml I 式(1.9)假设初始条件为零,对上述方程组的第一个方程求解,可得:)()()(22s s g ml ml I s X Φ⎥⎦⎤⎢⎣⎡-+= 式(1.10)将式(1.10)代入方程组式(1.9)中的第二个方程,可得:222222)()()()()()()(s s ml s s s g ml ml I b s s s g ml ml I m M s U Φ-Φ⎥⎦⎤⎢⎣⎡-++Φ⎥⎦⎤⎢⎣⎡-++= 式(1.11)整理,可以得到摆角的传递函数为:sq bm gl s q m gl m M s q m l I b s sqm l s U s -+-++=Φ23242)()()()( 式(1.12)式中:]))([(222l m ml I m M q -++=将倒立摆的实际参数值代入上式,得到摆角的传递函数为:ss s s s s U s 3141.28853.270883.03566.2)()(2342-++=Φ 式(1.13)同理,可以得到小车位置的传递函数:sq bm gl s q m gl m M s q m l I b s qm gls q m l I s U s X -+-++-+=23242)()()()()( 式(1.14)将实际的参数值代入,得到小车位置的传递函数为:s s s s s s U s X 3141.28853.270883.01413.238832.0)()(2342--+-= 式(1.15)在方程组(1.8)中对⋅⋅x 、⋅⋅φ求解代数方程,得到解如下:⎪⎪⎪⎪⎩⎪⎪⎪⎪⎨⎧+++++++++-==++++++++++-==⋅⋅⋅⋅⋅⋅⋅⋅⋅⋅u Mm l m M I m l Mm l m M I m M m gl x Mm l m M I m lb u Mm l m M I m l I Mm l m M I gl m x Mm l m M I b m l I x xx 2222222222)()()()()()()()()(φφφφφ 式(1.16)设系统状态空间方程为:⎪⎩⎪⎨⎧+=+=⋅Du Cx y Bu Ax x 式(1.17)整理式(1.16),得到系统状态空间方程:u Mml m M I ml Mml m M I ml I x x Mml m M I m M mgl Mml m M I mlb Mml m M I gl m Mml m M I bml I x x ⎥⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎢⎣⎡++++++⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎣⎡⎥⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎢⎣⎡+++++-+++++-=⎥⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎢⎣⎡⋅⋅⋅⋅⋅⋅⋅⋅2222222222)(0)()(00)()()(010000)()()(00010φφφφ 式(1.18)u x x x y ⎥⎦⎤⎢⎣⎡+⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=⋅⋅0001000001φφφ 式(1.19)将已知的M 、m 、b 、g 、l 、I 代入式(1.18)可得状态方程u x x x x ⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡+⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎣⎡⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡--=⎥⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎢⎣⎡⋅⋅⋅⋅⋅⋅⋅⋅3566.208832.0008285.272357.00100006293.00883.000010φφφφ 式(1.20)输出方程u x x x y ⎥⎦⎤⎢⎣⎡+⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=⋅⋅0001000001φφφ 式(1.21)。
倒立摆原理的基本原理倒立摆是一种具有非线性动力学特性的系统,它由一个可以在垂直平面上旋转的杆和一个连接在杆顶端的质量块组成。
倒立摆在控制理论、机器人学和自动化领域有着广泛的应用,例如机器人控制、姿态稳定等。
倒立摆系统具有很高的非线性特性,因为它受到重力、惯性、摩擦等多种因素的影响。
为了使倒立摆保持平衡,需要对其进行控制,以实现杆垂直或近似垂直于地面。
动力学模型为了分析倒立摆系统的动力学行为,我们首先需要建立其动力学模型。
假设杆的长度为L,质量为m,质量块与杆之间没有弹簧和阻尼,并且杆与地面之间也没有摩擦。
根据牛顿第二定律和角动量定理,可以得到倒立摆系统的运动方程:1.杆绕固定点(底部)转动:Iθ=mL2θ=−mgLsin(θ)2.质量块沿杆方向运动:mLẍ=−mgsin(θ)其中,θ表示杆与垂直线之间的夹角,x表示质量块在杆上的位置,I表示杆对底部转动的惯性矩。
线性化由于倒立摆系统的动力学方程是非线性的,为了进行控制设计和分析,通常需要对其进行线性化处理。
线性化可以通过泰勒级数展开来实现。
假设倒立摆处于平衡点附近,即θ=0和θ=0,则可以将非线性动力学模型线性化为以下形式:1.杆绕固定点(底部)转动:mL2θ=−mgLθ2.质量块沿杆方向运动:mLẍ=−mgθ这样得到的是一个简化的线性模型,使得控制器设计更加容易。
但需要注意的是,在实际应用中,由于存在误差和不确定性等因素,可能需要对系统进行更复杂的建模和控制。
控制方法倒立摆系统的控制旨在使其保持平衡或实现特定任务。
常用的控制方法包括PID控制、模糊控制和最优控制等。
1.PID控制:PID控制是一种经典的反馈控制方法,通过比较实际输出与期望输出之间的差异,并根据比例、积分和微分三个部分的调节系数来调整控制信号。
在倒立摆系统中,可以根据杆与垂直线之间的夹角和质量块在杆上的位置来计算误差,并通过PID控制器生成合适的力或扭矩来驱动系统。
2.模糊控制:模糊控制是一种基于经验知识的控制方法,它使用模糊逻辑和模糊推理来处理系统不确定性和非线性特性。
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二级倒立摆系统的物理模型倒立摆装置主要由沿导轨运动的小车和固定到小车上的两个摆体组成。
一阶倒立摆系统模型分析状态反馈与观测器设计一阶倒立摆系统是控制工程中常见的一个具有非线性特点的系统,它由一个摆杆和一个质点组成,质点在摆杆上下移动,而摆杆会受到重力的作用而产生摆动,需要通过控制来实现倒立的功能。
以下是一阶倒立摆系统的模型分析、状态反馈与观测器设计的详细介绍。
一、系统模型分析:一阶倒立摆系统是一个非线性动力学系统,可以通过线性化的方式来进行模型分析。
在进行线性化之前,首先需要确定系统的状态变量和输入变量。
对于一阶倒立摆系统,可以将摆杆角度和质点位置作为状态变量,将水平推力作为输入变量。
在对系统进行线性化之后,可以得到系统的状态空间表达式:x_dot = A*x + B*uy=C*x+D*u其中,x是状态向量,u是输入向量,y是输出向量。
A、B、C和D是系统的矩阵参数。
二、状态反馈设计:状态反馈是一种常用的控制方法,通过测量系统状态的反馈信号,计算出控制输入信号。
在设计状态反馈控制器之前,首先需要确定系统的可控性。
对于一阶倒立摆系统,可以通过可控性矩阵的秩来判断系统是否是可控的。
如果可控性矩阵的秩等于系统的状态数量,则系统是可控的。
在确定系统可控性之后,可以通过状态反馈控制器来实现控制。
状态反馈控制器的设计可以通过选择适当的反馈增益矩阵K来实现。
具体的设计方法是,根据系统的状态空间表达式,将状态反馈控制器加入到系统模型中。
状态反馈控制器的输入是状态变量,输出是控制输入变量。
然后,通过调节反馈增益矩阵K的值,可以实现对系统的控制。
三、观测器设计:观测器是一种常用的状态估计方法,通过测量系统的输出信号,估计系统的状态。
在设计观测器之前,首先需要确定系统的可观性。
对于一阶倒立摆系统,可以通过可观性矩阵的秩来判断系统是否是可观的。
如果可观性矩阵的秩等于系统的状态数量,则系统是可观的。
在确定系统可观性之后,可以通过观测器来实现状态估计。
观测器的设计可以通过选择适当的观测增益矩阵L来实现。
具体的设计方法是,根据系统的状态空间表达式,将观测器加入到系统模型中。
倒立摆拉格朗日建模方法倒立摆是一个经典的力学系统,它由一个固定于垂直支点上并能够绕该支点自由旋转的杆和一个固定在杆上的质点构成。
通过对倒立摆进行建模,可以研究其动力学特性以及控制方法。
本文将介绍一种常用的倒立摆拉格朗日建模方法。
倒立摆的拉格朗日建模方法是基于拉格朗日力学原理。
首先,我们需要确定倒立摆的广义坐标和其相关约束。
对于一个简单的倒立摆,可以选择摆杆与竖直方向的夹角作为广义坐标,记为θ。
同时,倒立摆存在一个约束条件,即摆杆与支点之间的距离为常数L。
接下来,我们需要确定倒立摆的动能和势能函数。
倒立摆的动能函数由摆杆和质点的动能之和构成。
摆杆的动能可以表示为Its(th)+⋯+Its(ph)+⋯+Itgph+⋯+Itgkh+⋯),(0)其中,I表示质量矩阵,ts表示杆的转动惯量,qs表示杆的角速度,g表示重力加速度,kh表示摆杆的质心距离支点的垂直距离。
质点的动能可以表示为(1)其中,ms表示质点的质量,ps表示质点的速度。
倒立摆的势能函数由质点重力势能和杆的重力势能之和构成。
质点的重力势能可以表示为(2)其中,zs表示质点的垂直位置。
杆的重力势能可以表示为(3)其中,zs表示杆的质心位置的垂直距离。
然后,我们需要确定倒立摆的拉格朗日函数。
拉格朗日函数可以表示为动能减去势能。
拉格朗日函数可以表示为(4)接下来,我们需要计算拉格朗日方程。
拉格朗日方程描述了系统的运动方程。
其中,q表示广义坐标,L表示拉格朗日函数,t表示时间,λ表示拉格朗日乘子。
最后,我们对拉格朗日方程进行求解,得到倒立摆的运动方程。
根据拉格朗日方程我们可以得到(6)通过求解这个方程,我们可以得到倒立摆的运动方程。
综上所述,倒立摆的拉格朗日建模方法主要包括确定广义坐标和约束、计算动能和势能函数、确定拉格朗日函数、计算拉格朗日方程、求解运动方程。
这种建模方法能够描述倒立摆的动力学特性,并为后续的控制方法提供基础。
总结:本文介绍了倒立摆的拉格朗日建模方法。
倒立摆控制方法倒立摆是一种经典的控制系统问题,它是指一个竖直放置的杆子上面安装了一个质量集中在一点上的小球,通过控制杆子底部的电机或者其他形式的能源输入来控制小球在杆子上面做周期性运动。
倒立摆广泛应用于机器人、汽车、飞行器等领域,其控制方法也是研究自适应控制、非线性控制等领域的重要课题。
本文将介绍倒立摆的基本模型和常见的控制方法。
一、倒立摆模型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为符号函数。
倒立摆拉格朗日建模方法倒立摆是一种经典的控制系统问题,用于研究平衡和控制的稳定性。
拉格朗日建模方法是描述运动系统的一种常用方法。
以下是关于倒立摆拉格朗日建模方法的10条详细描述:1. 倒立摆是由一根可以旋转的杆(摆杆)和一个可以在摆杆上移动的质点(摆点)组成。
我们的目标是使摆点在垂直位置保持平衡。
2. 拉格朗日建模方法利用拉格朗日方程来描述运动系统中的动能和势能之间的关系。
这个方法非常适用于复杂的系统,因为它能够自然地引入约束条件和非线性项。
3. 拉格朗日方程可以写成以下形式:L = T - V,其中 L 是拉格朗日函数,T 是系统的动能,V 是系统的势能。
4. 在倒立摆的拉格朗日建模中,我们需要首先确定系统的广义坐标。
对于倒立摆,一个广义坐标可以是摆杆的角度θ。
5. 然后,我们需要计算系统的动能和势能。
摆杆的动能可以写成 T_1 = (1/2) * m * L^2 * (dθ/dt)^2,其中 m 是摆杆的质量,L 是摆杆的长度,dθ/dt 是摆杆角度的导数。
6. 摆点的动能可以写成 T_2 = (1/2) * M * (dx/dt)^2,其中 M 是摆点的质量,dx/dt 是摆点在摆杆上移动的速度。
7. 摆杆的势能可以写成V_1 = (1/2) * m * g * L * cos(θ),其中 g 是重力加速度。
8. 摆点的势能可以写成V_2 = M * g * x * cos(θ),其中 x 是摆点在摆杆上的位置。
9. 将动能和势能代入拉格朗日方程中,我们可以得到系统的拉格朗日函数 L = T - V。
10. 我们可以使用拉格朗日方程描述系统的运动方程,例如:d/dt(∂L/∂(dθ/dt)) - ∂L/∂θ = 0 和 d/dt(∂L/∂(dx/dt)) - ∂L/∂x = 0。
通过求解这些方程,我们可以得到倒立摆系统的运动行为和稳定性分析的结果。
倒立摆的拉格朗日建模方法是一种用于描述运动系统的常用方法。
倒立摆离散状态空间方程倒立摆是一个重要的物理模型,在控制理论和机器人领域中被广泛应用。
它能够展示出非线性动力学系统的特点,并且需要通过控制算法来实现其稳定性。
本文将详细介绍倒立摆的离散状态空间方程。
首先,让我们来了解一下倒立摆的基本构造。
倒立摆由一个可旋转的杆和一个连接在其顶端的物体组成。
杆可以绕其一端的铰链点自由旋转。
我们可以将倒立摆的运动分为两个自由度:杆的角度和物体的位置。
假设杆的质量可以忽略不计,我们可以简化模型为单质量倒立摆。
我们使用以下符号表示倒立摆的变量:θ -杆的角度x -物体的位置l -杆的长度m -物体的质量g -重力加速度为了推导倒立摆的离散状态空间方程,我们需要应用Euler法来离散化系统。
我们首先用速度跟踪控制器来控制倒立摆的杆,然后使用积分来估计杆的角度。
根据牛顿第二定律,倒立摆的动力学方程可以表示为:m * l^2 * θ'' = - m * g * l * sin(θ) + u其中,θ''是角加速度,u是施加在摆上的控制力。
但是,这个方程是连续时间的,我们需要将其离散化。
首先,我们对角加速度进行估计。
我们可以使用中央差分公式来近似角加速度:θ''(k) ≈ (θ'(k+1) - θ'(k-1)) / (2Δt)其中,k是时间步,θ'(k)是k时刻的角速度,Δt是时间步长。
然后,我们可以将动力学方程重写为:θ'(k+1) ≈ θ'(k) + Δt* θ''(k)= θ'(k) + Δt * [(θ'(k+1) - θ'(k-1)) / (2Δt)]= θ'(k) + [θ'(k+1) - θ'(k-1)] / 2接下来,我们来看看物体的位置x。
由于速度为x',所以可以使用欧拉法离散化物体位置:x(k+1) ≈ x(k) + Δt * x'(k)最后,我们需要估计控制力u。
1.一阶倒立摆建模在忽略了空气流动阻力,以及各种摩擦之后,可将倒立摆系统抽象成小车和匀质杆组成的系统,如下图所示,其中:M :小车质量 m :为摆杆质量 J :为摆杆惯量 F :加在小车上的力 x :小车位置θ:摆杆与垂直向上方向的夹角 l :摆杆转动轴心到杆质心的长度根据牛顿运动定律以及刚体运动规律,可知: (1) 摆杆绕其重心的转动方程为 (2) 摆杆重心的运动方程为得 (3)小车水平方向上的运动为22..........(4)x d xF F M d t-=联列上述4个方程,可以得出一阶倒立精确气模型:()()()()()()()2222222222222222sin .sin cos cos cos .sin cos .lg sin cos J ml F ml J ml m l g x J ml M m m l ml F m l M m m m l M m J ml θθθθθθθθθθθθ⎧+++-⎪=++-⎪⎨+-+⎪=⎪-++⎩&&&&&& sin cos ..........(1)y x J F l F l θθθ=-&&2222(sin ) (2)(cos ).........(3)x y d F m x l d td F mg m l d t θθ=+=-式中J 为摆杆的转动惯量:32ml J =若只考虑θ在其工作点附近θ0=0附近(︒︒≤≤-1010θ)的细微变化,则可以近似认为:⎪⎩⎪⎨⎧≈≈≈1cos sin 02θθθθ&⎪⎪⎩⎪⎪⎨⎧++-+=++-+=2..2222..)(lg )()()(Mml m M J mlF m m M Mml m M J g l m F ml J x θθθ 2.2 模型建立及封装1、建立以下模型:图2 模型验证原理图2、由状态方程可求得:Fcn:(4/3*u[1]+4/3*m*l*sin(u[3])*power(u[2],2)-10*m*sin(u[3])*cos(u[3] ))/(4/3*(1+m)-m*power(cos(u[3]),2))Fcn1:(cos(u[3])*u[1]+m*l*sin(u[3])*cos(u[3])*power(u[2],2)-10*(1+m)*s in(u[3]))/(m*l*power(cos(u[3]),2)-4/3*l*(1+m))Fun2:(4*u[1]-30*m*u[3])/(4+m)Fun3:(u[1]-10*(1+m)*u[3])/(m*l-4/3*l*(1+m))(其中J =mL^2/3,小车质量M=1kg,倒摆振子质量m=1Kg,倒摆长度l=1m,重力加速度g=10m/s^2)将以上表达式导入函数。
倒立摆拉格朗日建模方法(一)倒立摆拉格朗日建模介绍倒立摆是一种经典的控制系统问题,它常用于教育和研究领域。
拉格朗日建模是一种用来描述力学系统动力学的数学方法。
本文将详细介绍倒立摆的拉格朗日建模方法,包括各种方法的详细说明。
方法一:拉格朗日方程1.第一步:定义坐标系。
倒立摆通常使用极坐标系,其中θ表示摆杆的角度。
2.第二步:确定系统的势能能量。
根据重力势能的定义,势能能量可以表示为mgL(1 - cosθ),其中m是摆杆的质量,g是重力加速度,L是摆杆的长度。
3.第三步:确定动能能量。
动能能量可以表示为2θ2,其中L是摆杆的长度。
4.第四步:应用拉格朗日方程。
拉格朗日方程可以表示为d/dt(∂T/∂θ̇) - ∂T/∂θ = ∂V/∂θ,其中T是系统的总动能,V 是系统的总势能。
通过求解拉格朗日方程,可以得到系统的运动方程。
方法二:线性化方法1.第一步:使用欧拉-拉格朗日方程。
欧拉-拉格朗日方程可以表示为∑(∂L/∂qi)d q̇i = q之力 - q之耗散,其中L是拉格朗日函数,qi是系统的广义坐标,q i̇是广义速度。
2.第二步:线性化倒立摆方程。
在小角度下,可以通过将sinθ近似为θ,将cosθ近似为1来线性化倒立摆方程。
3.第三步:线性化的拉格朗日方程可以简化为M q̇ = τ - C q̇ -Gq,其中M是质量矩阵,q̇是广义加速度,τ是外部输入力矩,C是速度相关的阻尼矩阵,G是重力矩阵。
方法三:控制方法1.第一步:设计控制器。
倒立摆系统可以用PID控制器来控制。
PID控制器包括比例部分、积分部分和微分部分,可以通过调整各个部分的参数来实现系统的稳定控制。
2.第二步:实施控制。
将PID控制器的输出作为输入力矩τ,通过不断调整输入力矩来控制倒立摆的角度。
3.第三步:闭环控制。
通过实施闭环控制,将实际角度与目标角度进行比较,并根据误差调整控制器的输出,以实现系统的精确控制。
方法四:倒立摆模拟1.第一步:选择合适的模拟软件。
倒立摆基本原理范文倒立摆是一种有趣的机械模型,它可以保持平衡并在保持平衡的同时做出一系列动态动作。
倒立摆的基本原理涉及到物体的重心、重力和稳定性等概念。
首先,倒立摆由两部分组成:一个上部称为摆杆,一个下部称为摆座。
摆杆可以自由旋转,摆座则被固定在一个支撑点上。
当摆杆竖直时,重心位于摆杆的下端,这时倒立摆处于稳定的平衡状态。
当摆杆稍微偏离垂直方向时,重心会发生改变,这导致两个重要的力的产生:重力和惯性力。
重力是每个物体都具有的属性,它是由地球或其他大型物体的引力引起的。
在倒立摆中,重力作用于摆杆的重心上,这会使得摆杆产生一个力矩,试图将其恢复到垂直方向。
这种力矩被称为重力矩,其中重力矩等于重力乘以重心到支撑点的垂直距离。
惯性力是物体在加速度或减速度时产生的力。
当摆杆向一侧倾斜时,它会倾向于继续向同一侧运动。
这是由于惯性力试图保持物体的运动状态不变。
在倒立摆中,当摆杆被推到一侧时,它会生成一个惯性力矩,试图将其恢复到垂直方向。
总结以上两种力矩,我们可以得到摆杆所受到的合力矩。
如果合力矩为零,摆杆将保持在倾斜的位置,并保持平衡。
如果合力矩不为零,则摆杆将继续倾斜直到合力矩为零。
这种稳定性是由倒立摆的物理性质所决定的。
然而,在实际情况中,倒立摆的稳定性受到一些附加因素的影响。
例如,空气阻力会使得摆杆缓慢衰减,并导致稳定性下降。
为了解决这个问题,可以通过加入一个控制系统来稳定倒立摆。
控制系统可以实时监测摆杆的位置,并通过施加力或应用适当的力矩来校正偏差。
最常见的控制系统是PID(比例-积分-微分)控制器,它可以根据误差的大小和变化率来调整控制力。
总的来说,倒立摆是通过平衡重力和惯性力的力矩来保持稳定的。
通过调整这些力矩,可以控制摆杆的倾斜和回正,从而实现倒立摆的基本原理。
然而,在实际应用中,还需要考虑控制系统和其他因素的影响,以确保倒立摆的稳定性和正常运行。
倒立摆基本原理前言倒立摆是进行控制理论研究的典型实验平台。
由于倒立摆系统的控制策略和杂技运动员顶杆平衡表演的技巧有异曲同工之处,极富趣味性,而且许多抽象的控制理论概念如系统稳定性、可控性和系统抗干扰能力等等,都可以通过倒立摆系统实验直观的表现出来,因此在欧美发达国家的高等院校,它已成为必备的控制理论教学实验设备。
学习自动控制理论的学生通过倒立摆系统实验来验证所学的控制理论和算法,非常的直观、简便,在轻松的实验中对所学课程加深了理解。
倒立摆不仅仅是一种优秀的教学实验仪器,同时也是进行控制理论研究的理想实验平台。
由于倒立摆系统本身所具有的高阶次、不稳定、多变量、非线性和强耦合特性,许多现代控制理论的研究人员一直将它视为典型的研究对象,不断从中发掘出新的控制策略和控制方法,相关的科研成果在航天科技和机器人学方面获得了广阔的应用。
二十世纪九十年代以来,更加复杂多种形式的倒立摆系统成为控制理论研究领域的热点,每年在专业杂志上都会有大量的优秀论文出现。
第一部分倒立摆系统介绍一、倒立摆系统简介倒立摆是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合,其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统,可以作为一个典型的控制对象对其进行研究。
最初研究开始于二十世纪50 年代,麻省理工学院(MIT)的控制论专家根据火箭发射助推器原理设计出一级倒立摆实验设备。
近年来,新的控制方法不断出现,人们试图通过倒立摆这样一个典型的控制对象,检验新的控制方法是否有较强的处理多变量、非线性和绝对不稳定系统的能力,从而从中找出最优秀的控制方法。
倒立摆系统作为控制理论研究中的一种比较理想的实验手段,为自动控制理论的教学、实验和科研构建一个良好的实验平台,以用来检验某种控制理论或方法的典型方案,促进了控制系统新理论、新思想的发展。
由于控制理论的广泛应用,由此系统研究产生的方法和技术将在半导体及精密仪器加工、机器人控制技术、人工智能、导弹拦截控制系统、航空对接控制技术、火箭发射中的垂直度控制、卫星飞行中的姿态控制和一般工业应用等方面具有广阔的利用开发前景。
仅供学习与交流 收集于网络,如有侵权请联系管理员删除 倒立摆系统模型研究 控制系统的数学模型是描述系统内部物理量或变量之间关系的数学表达式。在静态条件下(即变量各阶导数为零),描述变量之间关系的代数方程称为静态数学模型;而描述变量各阶导数之间关系的微分方程称为动态数学模型。如果已知输入量及变量的初始条件,对微分方程求解,则可以得到系统输出量的表达式,并由此对系统进行性能分析。因此,建立控制系统的数学模型是进行控制系统分析和设计的首要工作。 系统建模可以分为两种方式:实验建模和机理建模。实验建模是通过在研究对象上加入各种由研究者事先确定的输入信号,激励研究对象,并通过传感器检测其可观测的输出,应用系统辩识的手法分析输入-输出关系,建立适当的数学模型逼近实际系统。机理建模就是在了解研究对象的运动规律基础上,通过物理、化学的知识和数学手段建立起系统的运动方程。 对于倒立摆系统,由于其本身是自不稳定的系统,实验建模存在一定的困难,故而选用机理建模的方法。为了在数学上推导和分析的方便,可作出如下假设: 1) 摆杆在运动中是不变形的刚体; 2) 齿型带与轮之间无相对滑动,齿型带无拉长现象; 3) 各种摩擦系数固定不变; 4) 忽略空气阻力; 在忽略掉这些次要的因素后,倒立摆系统就是一个典型的运动刚体系统,可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。本文采用分析力学Lagrange方程建立一、二级倒立摆的数学模型。Lagrange方程有如下特点: 1) 它是以广义坐标表达任意完整系统的运动方程式,方程的数目和系统的自由度数是一致的。 2) 理想的约束反力不出现在方程组中,因此在建立系统的运动方程时,只需分析已知的主动力,而不必分析未知的约束反力。 3) Lagrange方程是以能量的观点建立起来的运动方程式,为了列出系统的运动方程式,只需从两个方面进行分析,一个是表征系统运动的动力学能量——系统的动能,另一个是表征主动力作用的动力学量——广义力。因此,用Lagrange建模可以大大简化系统的建模过程。 采用拉格朗日的方法建立系统的数学模型。Lagrange算子可以描述如下: (,)(,)()LqqTqqVq (1.1)
其中: T :系统的动能
V :系统的势能
q :系统的广义坐标
则系统的动力学方程可用Lagrange算子描述如下:
dLLDUdtqqq
仅供学习与交流 收集于网络,如有侵权请联系管理员删除 (1.2) Lagrange方程可以简单的理解为系统的能量的变化随着系统外加作用力的变化而变化。
1.1 一级倒立摆系统 1.1.1 拉格朗日方法建立一级倒立摆系统的数学模型 可以将一级倒立摆系统抽象成小车和质量均匀的摆杆组成,小车以向左方向运动为正,摆杆角度以自然下垂位置为零点,逆时针为正,如图2.1所示。
图2.1 一级倒立摆示意图 各参数的物理意义及取值如表2.1: 表 2.1 倒立摆物理参数符号意义及取值 符号 物理意义 取值及单位 M 小车质量 1.096 kg
m 摆杆质量 0.109 kg
c0 小车摩擦系数 0.1 Nm-1sec
-1
c1 摆杆摩擦系数 0.0022 Nm-1sec-1
l 摆杆转动轴心到质心的长度 0.25 m
J 摆杆惯量 0.0034 kgm2
u 控制力 N
x 小车位移 m
小车速度 m sec-1 摆杆角度 rad 摆杆角速度 rad sec-1
首先计算小车的动能(MT)、摆杆的动能(mT)和系统的总动能(T):
x仅供学习与交流
收集于网络,如有侵权请联系管理员删除 2222
1211(sin)(cos)22MmMmTMxdxldlTJmdtdtTTT
(1.3) 不妨假定导轨所在的水平面势能为零,在一级倒立摆的运动过程中,小车的势能始终为零,系统的总势能为: (cos)Vmgl
(1.4) 小车与导轨之间的摩擦力和摆杆与小车之间的摩擦力,使得系统能量的损失分别为: 210
221
1212DcxDc
(1.5) 则系统总共损失的能量为:
(1.6)
取系统的广义坐标系为: x、,则拉格朗日算子为: LTV
(1.7)
则系统的拉格朗日方程可以表示为:
0dLLDudtxxxdLLDdt
(1.8) 借助Mathemetica软件,由以上方程组可以得到一级倒立摆系统的动力学方程,具体的推导过程可以参看附录一。
021
cossincossin0MmmlxxucmlmlmlJmglc
(1.9)
12DDD仅供学习与交流 收集于网络,如有侵权请联系管理员删除 1.1.2 一级倒立摆系统在倒立点附近线性化处理 现行的许多一级倒立摆稳摆控制[39]需要将倒立摆在倒立点附近做近似线性化处理。首先由式(2.9)可得:
22102222
2012222
cos(sin)()(sin)()()coscos()(cos()sincossin)()()cosmlmglcJmlucxmlxMmJmlmlmlcxMmcmluMmgmlMmJmlml
(1.10) 在倒立点附近,摆杆角度接近为零,角速度也较小,可以认为: 2sin0 , sin , cos1
(1.11) 将式(2.11)代入式(2.10),可得 2222012
012
()()()()()()JmlcxmlgJmlucmlxMmJMmlmlcxumlMmmglMmcMmJMml
(1.12) 令 : T
Xxx
(1.13) 将2.12写成矩阵形式,可以得到一级倒立摆在倒立点附近线性化模型的状态空间方程,如下: XAXBuYCXDu
(1.14) 其中:
222
01
222
01
222
0100()0()()()0001()()0()()()JmlccmlmlgMmJMmlMmJMmlMmJMmlAmlcMmcMmmglMmJMmlMmJMmlMmJMml
仅供学习与交流 收集于网络,如有侵权请联系管理员删除 22
2
0()0()JmlMmJMmlBmlMmJMml
10000010C
0
0D
1.2 二级倒立摆系统 1.2.1 拉格朗日方法建立二级倒立摆系统的数学模型 将二级倒立摆系统抽象成小车和质量均匀的内、外摆杆组成,小车以向左方向运动为正,摆杆角度以自然下垂位置为零点,逆时针为正,如图2.2所示。各参数的物理意义及取值如表2.2所示。
图2.2 二级倒立摆示意图 表 2.2 倒立摆物理参数符号意义及取值 符号 物理意义 取值及单位 M 小车质量 1.32 kg
m1 内杆质量 0.04 kg
m2 外杆质量 0.132 kg
m3 质量块质量 0.208 kg
c0 小车摩擦系数 0.1 N/m/sec
c1 内杆-小车摩擦系数 0 N/m/sec
c2 内-外杆摩擦系数 0 N/m/sec
l1 内杆转动轴心到质心的长度 0.09 m
L1 内杆长度 0.18 m
l2 外杆转动轴心到质心的长度 0.27 m
J1 内杆惯量 0.000108 kg*m2
J2 外杆惯量 0.0034 kg*m2
u 控制力 N
x 小车位移 m