环形一级倒立摆设计.
(完整版)一级倒立摆系统分析
一级倒立摆的系统分析一、倒立摆系统的模型建立如图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)以上公式推理是根据牛顿力学的微分方程验证的。
基于双闭环PID控制的一阶倒立摆控制系统设计(完整资料)
基于双闭环PID控制的一阶倒立摆控制系统设计(完整资料)(可以直接使用,可编辑优秀版资料,欢迎下载)自动控制原理课程设计说明书基于双闭环PID控制的一阶倒立摆控制系统设计姓名:学号:学院:专业:指导教师:2018年 1月目录1 任务概述 (4)1.1设计概述 (4)1。
2 要完成的设计任务: (4)2系统建模 (5)2。
1 对象模型 (5)2。
2 模型建立及封装 (5)3仿真验证 (10)3。
1 实验设计 (10)3。
2 建立M文件编制绘图子程序 (10)4 双闭环PID控制器设计 (13)4.1内环控制器的设计 (14)4。
2外环控制器的设计 (14)5 仿真实验 (16)5.1简化模型 (16)5。
2 仿真实验 (18)6 检验系统的鲁棒性 (19)6.1 编写程序求系统性能指标 (19)6.2 改变参数验证控制系统的鲁棒性 (20)7 结论 (21)附录 (22)1任务概述1.1设计概述如图1 所示的“一阶倒立摆控制系统”中,通过检测小车位置与摆杆的摆动角,来适当控制驱动电动机拖动力的大小,控制器由一台工业控制计算机(IPC)完成.图1一阶倒立摆控制系统这是一个借助于“SIMULINK封装技术—-子系统”,在模型验证的基础上,采用双闭环PID控制方案,实现倒立摆位置伺服控制的数字仿真实验.1.2 要完成的设计任务:(1)通过理论分析建立对象模型(实际模型),并在原点进行线性化,得到线性化模型;将实际模型和线性化模型作为子系统,并进行封装,将倒立摆的振子质量m和倒摆长度L作为子系统的参数,可以由用户根据需要输入;(2)设计实验,进行模型验证;(3)一阶倒立摆系统为“自不稳定的非最小相位系统”。
将系统小车位置作为“外环”,而将摆杆摆角作为“内环",设计内化与外环的PID控制器; (4)在单位阶跃输入下,进行SIMULINK仿真;(5)编写绘图程序,绘制阶跃响应曲线,并编程求解系统性能指标:最大超调量、调节时间、上升时间;(6)检验系统的鲁棒性:将对象的特性做如下变化后,同样在单位阶跃输入下,检验所设计控制系统的鲁棒性能,列表比较系统的性能指标(最大超调量、调节时间、上升时间)。
基于双闭环PID控制的一阶倒立摆控制系统设计
基于双闭环PID控制的一阶倒立摆控制系统设计一阶倒立摆是一种常见的控制系统,它由一个旋转臂和一个悬挂在旋转臂末端的摆杆组成。
控制目标是使摆杆保持垂直位置并保持在指定的角度范围内。
本文将基于双闭环PID控制设计一阶倒立摆控制系统,并对其进行详细的分析和讨论。
首先,我们需要明确控制系统的结构。
一阶倒立摆控制系统可以分为两个闭环:内环和外环。
内环用于控制旋转臂的角度,并将输出作为外环的输入。
外环用于控制摆杆的角度,并根据测量的摆杆角度和设定的目标角度来调整内环的输入。
在进行控制系统设计之前,我们需要先建立一阶倒立摆的数学模型。
假设倒立摆的质量集中在摆杆的一端,摆杆的长度为L,质量为m,摩擦系数为b,重力加速度为g。
通过应用牛顿第二定律,可以得到如下动力学方程:mL²θ¨ + bLθ˙ + mgLsinθ = u其中,θ是旋转臂的角度,u是旋转臂的扭矩。
为了简化方程,我们进行恒定参数修正和线性化处理,得到线性方程:θ¨ + 2ξωnθ˙ + ωn²θ = kru其中,ξ是阻尼比,ωn是无阻尼自然频率,kr是旋转臂的增益。
接下来,我们将按照以下步骤设计基于双闭环PID控制的一阶倒立摆控制系统:1.内环设计:-选择合适的内环闭环控制器类型。
对于一阶倒立摆,可以选择PID控制器。
-根据倒立摆的特性和性能要求,选择合适的PID参数。
可以使用试错法、经验法、系统辨识等方法进行参数调整。
-将PID控制器的输入设置为旋转臂角度误差,输出为旋转臂的扭矩。
2.外环设计:-选择合适的外环闭环控制器类型。
对于一阶倒立摆,可以选择PID控制器。
-根据倒立摆的特性和性能要求,选择合适的PID参数。
-将PID控制器的输入设置为摆杆角度误差,输出为旋转臂的角度设定值。
3.进行系统仿真和调试:-使用MATLAB等仿真工具建立一阶倒立摆的数学模型,并将设计的控制器与模型进行集成。
-调整控制器的参数,以满足性能指标和系统稳定性的要求。
一级倒立摆【控制专区】系统设计
基于双闭环PID控制的一阶倒立摆控制系统设计一、设计目的倒立摆是一个非线性、不稳定系统,经常作为研究比较不同控制方法的典型例子。
设计一个倒立摆的控制系统,使倒立摆这样一个不稳定的被控对象通过引入适当的控制策略使之成为一个能够满足各种性能指标的稳定系统。
二、设计要求倒立摆的设计要求是使摆杆尽快地达到一个平衡位置,并且使之没有大的振荡和过大的角度和速度。
当摆杆到达期望的位置后,系统能克服随机扰动而保持稳定的位置。
实验参数自己选定,但要合理符合实际情况,控制方式为双PID控制,并利用MATLAB进行仿真,并用simulink对相应的模块进行仿真。
三、设计原理倒立摆控制系统的工作原理是:由轴角编码器测得小车的位置和摆杆相对垂直方向的角度,作为系统的两个输出量被反馈至控制计算机。
计算机根据一定的控制算法,计算出空置量,并转化为相应的电压信号提供给驱动电路,以驱动直流力矩电机的运动,从而通过牵引机构带动小车的移动来控制摆杆和保持平衡。
四、设计步骤首先画出一阶倒立摆控制系统的原理方框图一阶倒立摆控制系统示意图如图所示:分析工作原理,可以得出一阶倒立摆系统原理方框图:一阶倒立摆控制系统动态结构图下面的工作是根据结构框图,分析和解决各个环节的传递函数!1.一阶倒立摆建模在忽略了空气流动阻力,以及各种摩擦之后,可将倒立摆系统抽象成小车和匀质杆组成的系统,如下图所示,其中: M :小车质量 m :为摆杆质量 J :为摆杆惯量 F :加在小车上的力 x :小车位置θ:摆杆与垂直向上方向的夹角 l :摆杆转动轴心到杆质心的长度根据牛顿运动定律以及刚体运动规律,可知: (1) 摆杆绕其重心的转动方程为(2) 摆杆重心的运动方程为得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 θθ=+=-(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 θθθθθθθθθθθθ⎧+++-⎪=++-⎪⎨+-+⎪=⎪-++⎩式中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 θθθ 若取小车质量M=2kg,摆杆质量m=1kg,摆杆长度2 l =1m,重力加速度取g=2/10s m ,则可以得 一阶倒立摆简化模型:....0.44 3.330.412x F F θθθ⎧=-⎪⎨⎪=-+⎩即 G 1(s)= ; G 2(s)=一阶倒立摆环节问题解决!2.电动机驱动器选用日本松下电工MSMA021型小惯量交流伺服电动机,其有关参数如下:222()0.4()12() 1.110()s F s s x s s s s θθ-⎧=⎪-⎪⎨-+⎪=⎪⎩驱动电压:U=0~100V 额定功率:PN=200W 额定转速:n=3000r/min 转动惯量:J=3×10-6kg.m2 额定转矩:TN=0.64Nm 最大转矩:TM=1.91Nm 电磁时间常数:Tl=0.001s 电机时间常数:TM=0.003s经传动机构变速后输出的拖动力为:F=0~16N ;与其配套的驱动器为:MSDA021A1A ,控制电压:UDA=0~±10V 。
现控实验一级倒立摆状态反馈设计及时间响应实验总结
现控实验一级倒立摆状态反馈设计及时间响应实验总结
控制实验一级倒立摆的状态反馈设计可以分为以下几个步骤:
1. 系统建模:根据实际倒立摆的物理特性,建立系统的数学模型,包括倒立摆的运动方程和输出方程。
2. 设计状态反馈控制器:根据系统模型,设计状态反馈控制器的反馈矩阵K,使得系统在闭环下能够稳定并达到期望的性能指标。
3. 实施状态反馈控制器:根据设计好的控制器,对倒立摆系统进行实施。
4. 时间响应实验:进行时间响应实验,观察控制系统在不同输入下的响应情况。
可以通过给定不同的参考输入信号,如阶跃信号、正弦信号或任意波形信号等,来测试控制系统的性能。
根据实验结果进行总结时,需要注意以下几个方面:
1. 稳定性分析:观察控制系统是否能够保持稳定状态,即系统是否能够回到平衡位置并保持在该位置。
2. 超调量和调整时间分析:观察控制系统的过渡过程,检查系统是否出现过大的超调量和调整时间是否满足要求。
3. 鲁棒性分析:考察控制系统对参数变化、不确定性以及外部扰动的鲁棒性能。
4. 性能指标分析:根据实验结果,评估控制系统的性能指标,如误差大小、稳态误差、响应速度等。
总结实验时,尽量基于客观的实验数据和分析,对实验结果进行客观的评价和总结。
请注意,以上回答仅涉及到了一级倒立摆的状态反馈控制设计及时间响应实验总结的一般步骤,具体设计和总结要根据具体情境和实验要求进行。
环形一级倒立摆设计
1 绪论随着电脑技术和通信技术的飞速发展,控制理论的研究不断深入,自动控制技术在农业、工业、军队和家庭等社会各领域得到了广泛应用,对于提高劳动生产率做出了重要奉献。
倒立摆是一种理想的控制对象平台,它结构简单、成本较低,可以有效地检验众多控制方法的有效性。
对倒立摆系统这样一个典型的多变量、快速、非线性和自然不稳定系统的研究,无论在理论上和方法上都具有重要意义。
这不仅因为其级数增加而产生的控制难度是人类对其控制能力的有力挑战,更是因为在实现其稳定控制的过程中,众多的控制理论和方法被不断应用,新的控制理论和方法因而层出不穷。
各种控制理论和方法都可以在倒立摆这个控制对象平台上加以实现和检验,并可以促成控制理论和方法相互间的有机结合,进而使得这些新方法、新理论可以应用到更加广泛的受控对象中。
1.1 倒立摆系统的分类随着倒立摆系统控制方法研究的不断深入,倒立摆系统的种类也逐渐发展为多种形式。
目前研究的倒立摆大多为在二维空间仁即平面)内摆动的摆。
考虑倒立摆的不同结构形式,倒立摆系统可以分为以下几种类型1〕小车倒立摆系统仁或称为“直线倒立摆系统”)小车倒立摆系统主要由小车和摆杆两部分构成。
其中,摆杆可以是一级、两级、三级、四级甚至多级。
摆杆的级数越多,控制难度越大,而摆杆的长度也可能是变化的。
控制目标一般是通过给小车施加一个水平方向的力,使小车在期望的位置上稳定,而摆杆到达竖直向上的动态平衡状态。
2〕旋转倒立摆系统仁或称为“环形倒立摆系统”)旋转倒立摆系统是在小车倒立摆系统的基础上发展起来的。
与小车倒立摆不同,旋转倒立摆将摆杆安装在与电机转轴相连的水平旋臂上,通过电机带动旋臂在水平面的转动来控制摆杆的倒立,摆杆可以在垂直平面内旋转。
旋转倒立摆将小车倒立摆的平动控制改为旋转控制,使得整个系统更为复杂和不稳定,增加了控制的难度。
3〕平面倒立摆系统在平面倒立摆系统中,匀质摆杆底端可以在平面内作二维自由运动,摆杆 可沿竖直平面内任一轴线转动。
一阶倒立摆系统模型分析状态反馈与观测器设计
一阶倒立摆系统模型分析状态反馈与观测器设计一阶倒立摆系统是控制工程中常见的一个具有非线性特点的系统,它由一个摆杆和一个质点组成,质点在摆杆上下移动,而摆杆会受到重力的作用而产生摆动,需要通过控制来实现倒立的功能。
以下是一阶倒立摆系统的模型分析、状态反馈与观测器设计的详细介绍。
一、系统模型分析:一阶倒立摆系统是一个非线性动力学系统,可以通过线性化的方式来进行模型分析。
在进行线性化之前,首先需要确定系统的状态变量和输入变量。
对于一阶倒立摆系统,可以将摆杆角度和质点位置作为状态变量,将水平推力作为输入变量。
在对系统进行线性化之后,可以得到系统的状态空间表达式:x_dot = A*x + B*uy=C*x+D*u其中,x是状态向量,u是输入向量,y是输出向量。
A、B、C和D是系统的矩阵参数。
二、状态反馈设计:状态反馈是一种常用的控制方法,通过测量系统状态的反馈信号,计算出控制输入信号。
在设计状态反馈控制器之前,首先需要确定系统的可控性。
对于一阶倒立摆系统,可以通过可控性矩阵的秩来判断系统是否是可控的。
如果可控性矩阵的秩等于系统的状态数量,则系统是可控的。
在确定系统可控性之后,可以通过状态反馈控制器来实现控制。
状态反馈控制器的设计可以通过选择适当的反馈增益矩阵K来实现。
具体的设计方法是,根据系统的状态空间表达式,将状态反馈控制器加入到系统模型中。
状态反馈控制器的输入是状态变量,输出是控制输入变量。
然后,通过调节反馈增益矩阵K的值,可以实现对系统的控制。
三、观测器设计:观测器是一种常用的状态估计方法,通过测量系统的输出信号,估计系统的状态。
在设计观测器之前,首先需要确定系统的可观性。
对于一阶倒立摆系统,可以通过可观性矩阵的秩来判断系统是否是可观的。
如果可观性矩阵的秩等于系统的状态数量,则系统是可观的。
在确定系统可观性之后,可以通过观测器来实现状态估计。
观测器的设计可以通过选择适当的观测增益矩阵L来实现。
具体的设计方法是,根据系统的状态空间表达式,将观测器加入到系统模型中。
一阶倒立摆控制系统设计
一阶倒立摆控制系统设计首先,设计一阶倒立摆控制系统需要明确系统的参数和模型。
一阶倒立摆通常由一个平衡杆和一个摆组成。
平衡杆的长度、摆的质量和位置等都是系统的参数。
根据平衡杆的转动原理和摆的运动方程,可以得到一阶倒立摆的数学模型。
接下来,根据系统的数学模型,进行系统的稳定性分析。
稳定性分析是判断一阶倒立摆控制系统是否能够保持平衡的重要步骤。
常用的稳定性分析方法有判据法和根轨迹法。
判据法通过计算特征方程的根来判断系统的稳定性,根轨迹法则通过特征方程的根随一些参数变化的路径来分析系统的稳定性。
在进行稳定性分析的基础上,选择合适的控制策略。
常见的控制策略有比例控制、积分控制和微分控制等。
比例控制通过将系统的输出与期望值之间的差异放大一定倍数来控制系统;积分控制通过积分系统误差来进行控制;微分控制通过对系统误差的微分来进行控制。
在选择控制策略时,需要考虑系统的动态响应、稳态误差和鲁棒性等指标。
在选定控制策略后,进行控制器的设计和参数调节。
控制器是实现控制策略的核心部分。
控制器可以是传统的PID控制器,也可以是现代控制理论中的模糊控制器、神经网络控制器等。
控制器的参数需要通过试探法、经验法或者系统辨识等方法进行调节,以使系统达到最佳的控制效果。
最后,进行实验验证和性能评估。
在实验中,需要将控制器与倒立摆系统进行连接,并输入一定的控制信号。
通过测量系统的输出响应和误差,可以评估控制系统的性能,并进行调整和改进。
综上所述,一阶倒立摆控制系统设计的步骤包括系统参数和模型确定、稳定性分析、控制策略选择、控制器设计和参数调节、实验验证和性能评估等。
在设计过程中,需要综合考虑系统的稳定性、动态响应和鲁棒性等因素,以实现一个稳定可靠、性能优良的一阶倒立摆控制系统。
基于双闭环设计的一阶倒立摆PID控制方法1
基于双闭环设计的一阶倒立摆PID控制方法1摘要倒立摆控制是控制理论中的经典问题,双闭环控制方法在倒立摆控制中得到广泛应用,本文提出了一种基于双闭环设计的一阶倒立摆PID控制方法。
首先建立倒立摆的数学模型,选择控制器型号为PID控制器,并采用标准的Ziegler-Nichols方法进行控制器参数调节。
接着,设计了两级闭环控制系统:外环控制倒立摆的角度,内环控制电机输出的电压,以保证倒立摆稳定控制。
仿真结果表明,该控制器在扰动干扰下也能够实现稳定控制,具有较高的精度和稳定性。
关键词:双闭环,一阶倒立摆,PID控制,Ziegler-Nichols方法AbstractInverted pendulum control is a classic problem in control theory. The double closed-loop control method has been widely used in inverted pendulum control. This paper proposes a first-order inverted pendulum PID control method based on double closed-loop design. First, the mathematical model of the inverted pendulum is established, and the controller type is selected as PID controller. The standard Ziegler-Nichols method is used to adjust the controller parameters. Then, atwo-level closed-loop control system is designed: the outer loop controls the angle of the inverted pendulum, and the inner loop controls the voltage output of the motor to ensure stable control of the inverted pendulum. Simulation results show that the controller can achieve stable control even under disturbance interference, and has high accuracy and stability.Keywords: double closed-loop, first-order inverted pendulum, PID control, Ziegler-Nichols method一、引言倒立摆是一种在工业自动化控制、机器人自主导航、交通运输车辆控制等领域应用广泛的研究对象,其控制问题一直是研究的热点,也是控制理论中的经典问题。
一阶倒立摆控制设计与实现
一阶倒立摆控制设计与实现一阶倒立摆是一种常见的控制系统模型,它由一个垂直的支柱和一个质量为m 的物体组成,物体通过支柱与地面相连。
在控制系统中,我们需要设计一个控制器来控制物体的位置和速度,使其保持在垂直位置上。
本文将介绍一阶倒立摆控制设计与实现的相关内容。
一、一阶倒立摆模型一阶倒立摆模型可以用以下方程描述:m*d^2y/dt^2 = -mg*sin(y) + u其中,y是物体的位置,u是控制器的输出,m是物体的质量,g是重力加速度,t是时间。
该方程可以通过拉普拉斯变换转换为传递函数:G(s) = Y(s)/U(s) = 1/(ms^2 + mg)二、控制器设计为了控制一阶倒立摆,我们需要设计一个控制器来产生控制信号u。
常见的控制器包括比例控制器、积分控制器和微分控制器,它们可以组合成PID控制器。
在本文中,我们将使用比例控制器来控制一阶倒立摆。
比例控制器的输出与误差成正比,误差越大,输出越大。
比例控制器的传递函数为:Gc(s) = Kp其中,Kp是比例增益。
三、闭环控制系统将控制器和一阶倒立摆模型组合起来,得到闭环控制系统的传递函数:G(s) = Y(s)/R(s) = Kp/(ms^2 + mg + Kp)其中,R(s)是参考信号,表示我们期望物体保持的位置。
四、控制系统实现在实现控制系统之前,我们需要对一阶倒立摆进行建模和仿真。
我们可以使用MATLAB等工具进行建模和仿真。
在MATLAB中,我们可以使用Simulink模块来建立一阶倒立摆模型和控制器模型。
在建立模型之后,我们可以进行仿真,观察系统的响应和稳定性。
在实现控制系统时,我们需要选择合适的硬件平台和控制器。
常见的硬件平台包括Arduino和Raspberry Pi等,常见的控制器包括PID控制器和模糊控制器等。
在实现控制系统之后,我们需要进行调试和优化,以达到最佳控制效果。
五、总结本文介绍了一阶倒立摆控制设计与实现的相关内容,包括一阶倒立摆模型、控制器设计、闭环控制系统和控制系统实现。
一阶倒立摆控制设计与实现
一阶倒立摆控制设计与实现以一阶倒立摆控制设计与实现为题,本文将介绍倒立摆控制系统的设计原理和实现过程。
倒立摆是一种经典的控制系统问题,它涉及到动力学建模、控制算法设计和实时控制等多个方面。
本文将从这些方面逐步展开,为读者介绍一阶倒立摆控制的基本知识。
1. 动力学建模倒立摆是一个复杂的动力学系统,它由一个可以旋转的杆和一个连接在杆末端的质点组成。
杆的旋转可以由一个电机控制,质点则受到重力和杆的作用力。
为了建立倒立摆的动力学模型,我们需要考虑杆的旋转角度和质点的位置。
2. 控制算法设计一阶倒立摆的控制目标是使杆保持竖直位置,即旋转角度为零,并且使质点保持在某个给定的位置上。
为了实现这个目标,我们可以设计一个控制器来控制杆的旋转角度和质点的位置。
常用的控制算法有PID控制算法、模糊控制算法和神经网络控制算法等。
PID控制算法是一种经典的控制算法,它通过调节比例、积分和微分三个参数来实现控制效果。
模糊控制算法则利用模糊逻辑的思想,将输入和输出之间的关系用模糊集合表示。
神经网络控制算法则利用神经网络的学习能力,通过训练网络来实现控制效果。
3. 实时控制倒立摆的控制需要实时采集传感器数据,并根据这些数据计算控制信号。
在实际应用中,我们可以使用编码器来测量杆的旋转角度,使用加速度计来测量质点的加速度,然后通过控制器来计算电机的控制信号。
为了实现实时控制,我们可以使用嵌入式系统来实现。
嵌入式系统是一种专门设计用于控制和处理实时数据的计算机系统,它通常由微处理器、存储器和输入输出设备组成。
通过将控制算法和传感器接口集成到嵌入式系统中,我们可以实现倒立摆的实时控制。
总结本文介绍了一阶倒立摆控制的基本原理和实现方法。
倒立摆是一个复杂的动力学系统,控制它需要建立动力学模型,并设计合适的控制算法。
通过实时采集传感器数据并计算控制信号,我们可以实现倒立摆的控制。
希望本文对读者理解一阶倒立摆控制有所帮助,同时也希望读者能够进一步探索和研究这个有趣的控制问题。
一级倒立摆系统分析
一级倒立摆系统分析一级倒立摆系统由一个垂直的支撑杆和一个质量为m、长度为l的摆杆组成。
摆杆的一端通过一个旋转关节连接在支撑杆的顶端,另一端可以自由地在重力作用下摆动。
我们将摆杆的摆动角度定义为θ,并假设摆杆的运动是平面运动,不考虑摆杆在垂直方向上的移动。
首先,我们需要建立一级倒立摆系统的动力学方程。
根据牛顿第二定律和角动量守恒定律,可以得到以下方程:1.支撑杆垂直方向受力平衡方程:-mgl sinθ = 0其中g为重力加速度。
2. 摆杆绕旋转关节的转动惯量为I = ml^2/3,根据转动惯量的定义可以得到角加速度α与力矩τ之间的关系:τ=Iα其中τ = ml^2/3α。
3.摆杆绕旋转中心的转动方程:τ = Iα = ml^2/3α = -mgl sinθ可以得到α与θ之间的关系:α = -3g/(2l)sinθ。
以上方程可以描述一级倒立摆系统在垂直方向上的平衡和旋转运动。
其中,第一条方程表示摆杆在垂直方向上的受力平衡,第二条方程表示摆杆的转动惯量及其与角加速度之间的关系,第三条方程表示摆杆绕旋转中心的转动方程。
接下来,我们可以通过线性化分析来研究一级倒立摆系统的稳定性。
线性化是一种将非线性系统近似为线性系统的方法,通过计算系统在一些平衡点附近的一阶导数来实现。
我们首先要找到一级倒立摆系统的平衡点。
根据第一条方程,当θ=0时,系统达到平衡。
在这个平衡点,摆杆不再摆动,所有受力均平衡。
接下来,我们对系统进行线性化。
首先将θ分解为平衡点的偏差值Δθ和小量δθ,即:θ=θ_e+Δθ+δθ其中θ_e为平衡点的角度。
将上述表达式带入到第三条方程中,并只保留一阶项,可以得到线性化的转动方程:α = -3g/(2l)(sinθ_e + cosθ_e Δθ +cosθ_e δθ)。
我们可以进一步线性化该方程,即将sinθ_e和cosθ_e在一阶项展开,并忽略二阶项,得到:α=-3g/(2l)(θ_e+Δθ+δθ)。
环形倒立摆说明书
目录序言 (2)第一章环形一级倒立摆的数学模型 (3)第二章环形二级倒立摆的数学模型 (5)第三章最优控制 (9)第四章环形倒立摆系统的硬件和软件 (10)4.1控制系统的硬件 (10)4.2控制系统软件 (10)4.2.1VC版控制系统软件说明 (11)4.2.2实时数据保存 (14)4.2.3 Matlab版软件说明 (15)第五章系统使用说明 (23)5.1 环形倒立摆系统的操作步骤 (23)5.2 注意事项 (25)5.3日常维护 (25)序言在控制理论发展的过程中某一理论的正确性及实际应用中的可行性需要一个按其理论设计的控制器去控制一个典型对象来验证.倒立摆就是这样一个被控制对象.倒立摆系统是进行控制理论教学及开展各种控制实验的理想平台,它具有成本低廉、结构简单、物理参数和结构易于调整的优点,倒立摆系统本身是一个典型的非线性、高阶次、多变量、强耦合和绝对不稳定系统,许多抽象的控制概念如系统的稳定性、可控性、系统的收敛速度和系统的抗干扰能力等,都可以通过倒立摆直观地表现出来.此外,通过倒立摆系统还可以研究结构控制、非线性观测器、摩擦补偿、目标定位控制、混合系统和混沌系统等.利用倒立摆系统研究产生的方法和技术在半导体及精密仪器加工、机器人控制技术、人工智能、导弹拦截控制系统、航空对接控制技术、火箭发射中的垂直度控制、卫星飞行中的姿态控制和一般工业应用等方面都具有广阔的利用开发前景.倒立摆系列产品包括直线运动型、圆周运动型和平面运动倒立摆几大系列,主要特点包括:开放性:采用二轴运动控制板卡,机械部分和电气部分非常容易扩展,可以根据用户需要进行配置.系统软件接口充分开放,用户不仅可以使用配套的实验软件,而且可以根据自己的实际需要扩展软件的功能.模块化:系统的机械部分可以选用直线或者旋转平台,根据实际需要配置成一级、二级或者三级倒立摆.而三级摆可以方便地改装成二级摆,二级摆可以改装成一级摆.系统实验软件同样是基于模块化的思想设计,用户可以根据需要增加或者修改相应的功能模块.简易安全:倒立摆实验系统包括运动控制卡、电控箱、机械本体和微型计算机几个部分组成,安装升级方便.同时在机械、运动控制板卡和实验软件上都采取了积极措施,保证实验时人员的安全可靠和仪器安全.方便性:倒立摆系统易于安装、升级,同时软件界面操作简单.先进性:采用工业级二轴运动控制板卡作为核心控制系统,先进的交流伺服电机作为驱动,检测元件使用高精度高性能光电码盘.系统设计符合当今先进的运动控制发展方向.实验软件多样化:用于实验的软件包括Windows界面(VC++),以及控制领域使用最多的仿真工具Matlab提供完备的设备接口和程序接口,方便用户进行实验和开发.倒立摆系统适应如下课程的实验:《自动控制原理》、《现代控制理论》、《现代控制工程》、《最优控制》、《非线性系统控制》、《智能控制》、《模糊控制》和《神经网络控制》等等.第一章 环形一级倒立摆的数学模型在忽略了空气阻力、各种摩擦之后,将环形倒立摆系统抽象成匀质摆杆和水平杆组成的刚体系统.环形一级倒立摆的结构如图所示:图1 环形一级倒立摆的结构图水平杆与x 的夹角:0θ,摆杆与垂直方向的夹角:1θ表1 环形一级倒立摆的物理参数水平杆的质量0m 0.308 kg 水平杆绕端点的转动惯量 0J 0.0042kg m ⋅摆杆的质量1m 0.1323 kg 摆杆绕质心的转动惯量1J 0.01152kg m⋅水平杆的长度0L 0.2535 m摆杆质心到转轴的距离1l 0.2433m系统的拉格朗日算子:(,)(,)(,)L q qT q q V q q =- ,其中L 为拉格朗日算子、q 为系统的广义坐标、T 为系统的总动能、V 为系统的总势能. 拉格朗日方程:()i i id L LQ dt q q ∂∂-=∂∂ (1.1) 其中,1,2,3,...,i n =、i Q 为系统沿广义坐标i q 方向上的外力.在环形一级倒立摆系统中广义坐标:000111,,q qq θθθθθθ⎡⎤⎡⎤⎡⎤===⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦⎣⎦环形一级倒立摆系统的动能T :01m m T T T =+ (1.2)其中,0m T 为水平杆的动能、1m T 为摆杆的动能. 水平杆的动能:020012m T J θ=在距摆杆转动中心距离l 处取一小段dl ,这一小段的坐标如下:000100011cos sin sin sin cos sin cos x L l y L l z l θθθθθθθ=-⎧⎪=+⎨⎪=⎩则,这一小段的动能:222111[()()()]22dl dx dy dz dT m l dt dt dt=++ 摆杆的动能: 1120l m T dT =⎰(1.3)以水平杆所在的水平面为零势能面,则系统的势能V 即为摆杆的重力势能:1111cos m V V m gl θ==(1.4) 则,拉格朗日方程:011()()0d LL u dt d L L dt θθθθ∂∂⎧-=⎪∂∂⎪⎨∂∂⎪-=⎪∂∂⎩ (1.5) 其中,u 为施加到水平杆上的控制力矩.在倒立摆实物控制中,我们采用水平杆的角加速度作为输入即:0u θ= 系统的状态变量:0101T x θθθθ⎡⎤=⎣⎦ ,在平衡位置[]0000T 对系统模型进行线性化即:2cos 1,sin ,0θθθθ≈≈≈系统的状态空间模型:xAx Bu y Cx=+⎧⎨=⎩ (1.6) 其中,A 为系统的状态矩阵、B 为控制矩阵、y 为系统的输出、C 为系统的输出矩阵 由上述(1.5)微分方程的:42400100000101000,,000010100000A B C a b ⎡⎤⎡⎤⎢⎥⎢⎥⎡⎤⎢⎥⎢⎥===⎢⎥⎢⎥⎢⎥⎣⎦⎢⎥⎢⎥⎣⎦⎣⎦其中,04241133,44L ga b l l ==.第二章 环形二级倒立摆的数学模型在忽略了各种摩擦后,环形二级摆抽象成由两个摆杆和一个水平杆组成,系统结构如图所示:图2环形二级倒立摆的结构简化图水平杆与x 的夹角:0θ,下摆杆与垂直方向的夹角:1θ,上摆杆与垂直方向的夹角:2θ .表2环形二级倒立摆的物理参数水平杆的长度 0L 下摆杆绕质心的转动惯量 1J 下摆杆的长度1L 上摆杆绕质心的转动惯量 2J 下摆杆质心到转轴的距离 1l 下摆杆的质量 1m上摆杆质心到转轴的距离 2l 上摆杆的质量 2m水平杆绕端点的转动惯量0J系统的拉格朗日算子:(,)(,)(,)L q qT q q V q q =- ,其中L 为拉格朗日算子、q 为系统的广义坐标、T 为系统的总动能、V 为系统的总势能.拉格朗日方程:()i i i d L LQ dt qq ∂∂-=∂∂(2.1) 其中,1,2,3,...,i n =、i Q 为系统沿广义坐标i q 方向上的外力.在环形二级倒立摆系统中广义坐标:000111222,,q q q θθθθθθθθθ⎡⎤⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥===⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦⎣⎦.环形二级倒立摆系统的动能T : 012m m m T T T T =++ (2.2)其中,0m T 为水平杆的动能、1m T 为下摆杆的动能、2m T 为上摆杆的动能. 水平杆的动能:020012m T J θ=(2.3)在距下摆杆转动中心距离l 处取一小段dl ,这一小段的坐标如下:100011000111cos sin sin sin cos sin cos x L l y L l z l θθθθθθθ=-⎧⎪=+⎨⎪=⎩ 则,这一小段的动能:1222111111[()()()]2m dx dy dz dldT m L dt dt dt=++ 下摆杆的动能:1110L m m T dT =⎰(2.4) 在距下摆杆转动中心距离h 处取一小段dh ,这一小段的坐标如下:20010102200101022112cos sin sin sin sin sin cos sin cos sin cos cos x L L h y L L h z L h θθθθθθθθθθθθ=--⎧⎪=++⎨⎪=+⎩ 则,这一小段的动能:2222222221[()()()]22m dx dy dz dhdT m l dt dt dt=++ 上摆杆的动能:22220l m m T dT =⎰(2.5) 以水平杆所在的水平面为零势能面,则系统的势能V 即为摆杆的重力势能11122211cos (cos cos )V m gl m g l L θθθ=++(2.6) 则,拉格朗日方程:001122()()0()0d L Lu dt d L Ldt d L Ldt θθθθθθ⎧∂∂-=⎪∂∂⎪⎪∂∂-=⎨∂∂⎪⎪∂∂-=⎪∂∂⎩(2.7) 其中,u 为施加到水平杆上的控制力矩. 将上述微分方程写成:(,)(,)()M q q q C q q q G q τ++= (2.8)由(2.7)可知:111213111213212223212223313233313233,,00m m m c c c u M m m m C c c c m m m c c c τ⎡⎤⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥===⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦⎣⎦22110112201121210113002211222123011231133223332sin sin 2sin sin cos cos cos()m a a a b L m b L m b L m m m a m b L m m m m m a θθθθθθθθ⎧=+++⎪=⎪⎪=⎪=⎪⎪=⎨⎪=-⎪⎪=⎪=⎪⎪=⎩1112101101101012132020022010122110110101222230121231202201010sin 2sin 2cos sin sin 2sin 2sin cos sin cos cos sin 0sin()sin cos sin cos c c a b L b L c a b L b L c a b L c c b L c a b L θθθθθθθθθθθθθθθθθθθθθθθθθθθθθ==-+=-+=--==-=--2320111233sin()0c b L c θθθ⎧⎪⎪⎪⎪⎪⎪⎨⎪⎪⎪⎪⎪=--⎪=⎩ ,11020sin sin G b g b g θθ⎡⎤⎢⎥=-⎢⎥⎢⎥-⎣⎦ 其中已置,22222001020111121222202211121,,,,a J m L m L a J m l m L a J m lb m l b m l m L ++++++在倒立摆实物控制中,我们采用水平杆的角加速度作为输入即:0u θ= 系统的状态变量:012012Tx θθθθθθ⎡⎤=⎣⎦,在平衡位置[]000000T对系统模型进行线性化即:2cos 1,sin ,0θθθθ≈≈≈系统的状态空间模型:xAx Bu =+ ,其中,A 为系统的状态矩阵、B 为控制矩阵 525356263600100000001000000010,000000100000000A B a a b a a b ⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥==⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦其中,201215253222212011201011106263222212011201,()(),()()b L g a b ga a a ab L a a b L b b L g a b ga a a ab L a a b L -==-+-+-==-+-+,2012015221201001116221201()()()()L b a b L b a a b L b L b L a b a a b L -=-+--=-+表3环形二级倒立摆的物理参数:水平杆的长度0L 0.2135m 下摆杆绕质心的转动惯量1J 0.00332kg m ⋅ 下摆杆的长度1L 0.175m 上摆杆绕质心的转动惯量2J 0.00882kg m ⋅ 下摆杆质心到转轴的距离1l 0.1329m 下摆杆的质量1m 0.1617㎏ 上摆杆质心到转轴的距离 2l 0.221m 上摆杆的质量2m 0.1225 ㎏ 水平杆绕端点的转动惯量0J 0.0042kg m ⋅第三章 最优控制在经典控制理论中,设计控制系统的各种方法大多建立在试凑的基础上,设计结果与设计人员的经验有很大关系.对于多输入-多输出系统,或者要求较高精度的复杂系统,经典控制方法显得无能为力,迫切需要探索新的设计方法.20世纪60年代,由于空间技术的迅猛发展和计算机的广泛应用,动态系统的优化理论得到了迅速发展,形成了最优控制这一重要的学科分支,并在控制工程、经济管理与决策以及人口控制等领域得到了成功应用,取得了显著的成效.最优控制在被控对象已知的情况下,已经成为设计复杂系统的有效方法之一.最优控制是现代控制理论的核心.最优控制研究的主要问题是:根据已建立的被控对象的数学模型,选择一个容许的控制规律,使得被控对象按预定要求运行,并使某一性能指标达到极小值(或极大值).从数学观点来看,最优控制研究的问题是求解一类带有约束条件的泛函极值问题,属于变分学的范畴.然而经典的控制理论只能解决控制无约束,即容许控制属于开集的一类最优问题,而实际工程实践中所遇到的多为控制有约束,即容许控制属于闭集的一类最优控制问题.为了满足工程实践的需要,20世纪50年代中期,出现了变分理论,其中最常用的方法是动态规划和极小值原理.如果所研究的系统是线性的,且性能指标为状态变量和控制变量的二次型函数,则最优控制问题称为线性二次型问题.由于线性二次型问题的最优解具有统一的解析表达式,且可导致一个简单的线性状态反馈控制律,易于构成闭环最优反馈控制,便于工程实现,因而在实际工程中得到了广泛的应用.利用线性二次型性能指标设计的控制器称作LQR 控制器。
环形一级倒立摆的建模与控制
环形一级倒立摆的建模与控制
环形一级倒立摆是一种基于完全线性模型动力学系统的重要机构。
它通过将一个简单
形状的圆环和两个非常简单的支撑结构放在环上,将圆环内外连接起来,从而实现倒立摆
运动的目的。
环形一级倒立摆机构在实验性机械力学研究以及实用机器设计中都有着广泛
应用。
首先,动力学建模的目的是确定环形一级倒立摆的运动学行为,特别是整个系统在不
断变化外输入下的响应规律,在此基础上构造一种有效的控制策略进行控制。
准确确定环
形一级倒立摆机构的动力学参数也是实现接下来的控制过程的基础,因此一定要全面准确
地确定环形一级倒立摆的动力学参数。
其次,环形一级倒立摆的控制是机构动力学建模的核心,也是机构技术应用的关键。
为了确保系统实现预定的动作,实现系统的稳定运行,首先要给出环形一级倒立摆的数学
模型,考虑到机构参数量多,一定要注意合理地选择力学参数及控制参数,根据机构特性
进行有效地搭建。
此外,在搭建环形一级倒立摆的控制系统时,还要特别考虑抗干扰性能,通过优化控制技术,增大控制比例带下限,来实现机构的高精度控制。
环形一级倒立摆的建模与控制需要综合考虑动力学因素和控制因素。
根据物理实验和
数学建模的结果,设计并实施一种有效的控制策略,可以有效地实现环形式一级倒立摆的
控制,获得较高的控制效果。
总的来说,环形一级倒立摆的建模与控制有助于揭示机构的动力学特性,并帮助控制
者有效地实现控制目标,在实际工程中可以广泛应用。
单级环形倒立摆设计
K=place(A,B,P1),求解 K。 A=[0,1,0,0;0,0,-0.717,0;0,0,0,1;0,0,15.776,0]; B=[0;0.976;0;-1.463]; C=[1,0,0,0]; P1=[-3;-2;-2+2j;-2-2j]; K=place(A,B,P1) K = -3.3453 -4.4604 -36.2550 -9.1274
由状态反馈矩阵可得状态反馈模型仿真图如下图所示
图 6.SIMULINK 状态模拟仿真图
初始值 M=3,θ = 0.152的零状态响应,响应曲线如下图所示。
图 7.状态反馈系统 和 零状态响应曲线
9
从上图可以看出在 3 秒左右,摆杆和竖直方向的夹角θ = 0系统达到稳定。 4.2 最优线性二次型对旋转倒立摆的控制 线性二次型是指系统的状态方程是线性的,性能指标函数是对象状态变量和 控制输入变量的二次型函数。 对于线形系统,若性能指标为二次性函数,这样实现 的控制叫做线性二次型最优控制。 二次型最优控制问题就是在线性系统的约束条 件下,选择控制输入使得二次型目标函数达到最小。其最终目标是为系统设计线 性二次型调节器简称 LQR。 线性二次型最优控制方法是 20 世纪 60 年代发展起来的一种普遍采用的最优 控制系统设计方法。在工程实际中应用线性二次型最优控制是非常普遍的。这是 因为,二次型性能指标有较为明确的物理概念;而且采用二次型性能指标在数学 处理上比较简单,甚至能得到解析形式表达的线性反馈规律,可以实现状态的线 性反馈,线性二次型控制理论是反馈系统设计的一种重要工具,它为多变量反馈 系统的设计提供了一种有效的分析方法,可以适应于时变系统,能够处理扰动信 号和测量噪声问题,并可以处理有限和无限的时间区间。 状态调节器是指采用状态反馈,使状态向量的各分量迅速趋近于零,而不 消耗很多能量的系统。考虑系统被控对象的状态空间方程为 ẋ = AX(t) + BU(t) y = x(t) 其中,x 为 n 维状态向量,u 为 r 维控制向量,且不受约束,A 为 n*n 维常数矩阵,B 为 n*r 维常数矩阵。寻找一个状态反馈控制律 u'()t=一 Kx()t,即确定最优控制 矩阵 K,使得系统下面的性能指标为最小。 1 1 J= x + 2 2 [x Q(t)x + u R(t)u]dt
(完整word版)一级倒立摆控制系统设计
基于双闭环PID控制的一阶倒立摆控制系统设计一、设计目的倒立摆是一个非线性、不稳定系统,经常作为研究比较不同控制方法的典型例子。
设计一个倒立摆的控制系统,使倒立摆这样一个不稳定的被控对象通过引入适当的控制策略使之成为一个能够满足各种性能指标的稳定系统.二、设计要求倒立摆的设计要求是使摆杆尽快地达到一个平衡位置,并且使之没有大的振荡和过大的角度和速度.当摆杆到达期望的位置后,系统能克服随机扰动而保持稳定的位置。
实验参数自己选定,但要合理符合实际情况,控制方式为双PID控制,并利用MATLAB进行仿真,并用simulink对相应的模块进行仿真。
三、设计原理倒立摆控制系统的工作原理是:由轴角编码器测得小车的位置和摆杆相对垂直方向的角度,作为系统的两个输出量被反馈至控制计算机。
计算机根据一定的控制算法,计算出空置量,并转化为相应的电压信号提供给驱动电路,以驱动直流力矩电机的运动,从而通过牵引机构带动小车的移动来控制摆杆和保持平衡.四、设计步骤首先画出一阶倒立摆控制系统的原理方框图一阶倒立摆控制系统示意图如图所示:分析工作原理,可以得出一阶倒立摆系统原理方框图:一阶倒立摆控制系统动态结构图下面的工作是根据结构框图,分析和解决各个环节的传递函数!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 θθθθθθθθθθθθ⎧+++-⎪=++-⎪⎨+-+⎪=⎪-++⎩式中J 为摆杆的转动惯量:32m l J =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 θθ=+=-若只考虑θ在其工作点附近θ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 θθθ 若取小车质量M=2kg,摆杆质量m=1kg,摆杆长度2 l =1m ,重力加速度取g=2/10s m ,则可以得一阶倒立摆简化模型:....0.44 3.330.412x F F θθθ⎧=-⎪⎨⎪=-+⎩ 拉氏变换即 G 1(s )= ; G 2(s)=一阶倒立摆环节问题解决!2.电动机驱动器选用日本松下电工MSMA021型小惯量交流伺服电动机,其有关参数如下: 驱动电压:U=0~100V 额定功率:PN=200W 额定转速:n=3000r/min 转动惯量:J=3×10-6kg 。
PID控制的一阶倒立摆控制系统设计
PID控制的一阶倒立摆控制系统设计一阶倒立摆控制系统是一种常见的控制系统,通过PID控制器对倒立摆系统进行稳定控制,使其在一定的时间内达到平衡位置。
本文将详细介绍一阶倒立摆控制系统的设计流程和方法。
1.引言一阶倒立摆控制系统是一类具有非线性动力学特性的控制系统。
其基本结构包含一个摆杆和一个摆杆在垂直方向上运动的小车。
该控制系统的目标是通过调节小车的运动,使摆杆能够在垂直方向上保持平衡。
为了实现这个目标,我们需要设计一个有效的控制方案,并使用PID控制器对系统进行控制。
2.模型建立首先,我们需要建立一阶倒立摆系统的数学模型。
假设摆杆的长度为L,摆杆与水平线的夹角为θ,小车与水平线的位置为x,小车与水平线的速度为v。
根据牛顿运动定律和平衡条件,可以得到如下模型:m*x'=m*a=F(1)M*x'' = -F*l*sin(θ) - b*v (2)I*θ'' = F*l*cos(θ) - M*g*l*sin(θ) (3)其中,m是小车的质量,M是摆杆的质量,l是摆杆的长度,b是摩擦系数,g是重力加速度,I是摆杆的转动惯量。
将式(3)对时间t求导得到:I*θ''' = -b*l*θ' - M*g*l*cos(θ) (4)3.控制设计为了设计PID控制器,我们需要首先将系统模型线性化。
可以将非线性的动力学模型近似为线性模型,并在静态平衡点附近进行线性化。
静态平衡点是系统的平衡位置,满足以下条件:x=0,v=0,θ=0,θ'=0。
我们可以对系统模型进行泰勒级数展开,保留一阶项,得到如下线性化模型:m*x'=F(5)M*x''=-F*l*θ(6)I*θ''=F*l(7)经过线性化,系统的动力学模型变为了一组线性微分方程。
接下来,我们使用PID控制器对系统进行控制。
4.PID控制器设计PID控制器由比例项、积分项和微分项组成,用于校正系统输出与目标值之间的差异。
一级倒立摆的课程设计
一级倒立摆的课程设计目录摘要 (3)1.一阶倒立摆的概述 (4)1.1倒立摆的起源与国内外发展现状 (4)1.2倒立摆系统的组成 (5)1.3倒立摆的分类: (5)1.4倒立摆的控制方法: (5)1.5本文研究内容及安排 (6)1.6系统内部各相关参数为: (6)2.一阶倒立摆数学模型的建立 (7)2.1概述 (7)2.2数学模型的建立 (8)2.3一阶倒立摆的状态空间模型: (11)2.4实际参数代入: (12)3.定量、定性分析系统的性能 (13)3.1,对系统的稳定性进行分析 (13)3.2 对系统的稳定性进行分析: (15)4.状态反馈控制器的设计 (16)4.1反馈控制结构 (16)4.2单输入极点配置 (17)4.3利用MATLAB编写程序 (20)5.系统的仿真研究,校验与分析 (22)5.1使用Matlab中的SIMULINK仿真 (22)6.设计状态观测器,讨论带有状态观测器的状态反馈系统的第 1 页性能。
(26)6.1观测器的设计思路: (26)6.2利用MATLAB进行编程 (27)6.3状态观测器的仿真 (29)小结 (32)参考文献: (33)第 2 页摘要倒立摆是进行控制理论研究的典型实验平台。
倒立摆也是机器人技术,控制理论,计算机控制等多个领域,多种技术的有机结合,其被控系统本身又是一个绝对不稳定,多变量,强耦合的非线性系统。
可以作为一个典型的被控对象对其进行研究。
最初的研究开始于二十世纪50年代,专家根据火箭发射助推器原理设计出一级倒立摆实验设备。
近年来,新的控制方法不断出现,人们试图通过倒立摆的一个典型的控制对象,检验新的控制方法是否有较强的处理多变量,非线性和绝对不稳定系统的能力,从而从中找出好的控制方法。
倒立摆不仅仅是一种优秀的教学实验仪器,同时也是进行控制理论研究的理想实验平台。
倒立摆的研究不仅具有深刻的理论意义,还有重要的工程背景,在多种控制理论与方法的研究中,特别是在工程实践中,也存在一种可行性的实验问题,使其理论与方法得到有效检验,倒立摆就能为此提供一个从理论通往实践的桥梁,目前,对倒立摆的研究也引起了国内外学者的广泛关注,是控制领域的热门课题之一。
(完整版)一阶环形倒立摆毕业论文
本文以利用电位器检测角度的一阶倒立摆系统作为研究对象,研究了其在摆角信号含有大噪声的情况下的平衡稳定控制问题,这对解决实际工程中的相关问题有一定的指导意义。本文首先设计了一阶环形倒立摆的模型。使用电位器作为姿态测量传感器不断测量摆杆的的姿态信息,通过转换这些模拟信息传送给作为控制核心的8位单片机,经过数据处理后,单片机通过驱动电路将控制信号以PWM方式去驱动直流电机的,达到调节摆杆姿态的目的。
现阶段检验某种控制方法或控制理论是否有较强的解决非线性和不稳定性问题的能力,一般都通过对倒立摆系统控制的研究来实现,倒立摆的研究不仅有其深刻的理论意义,同时还有重要的工程背景。从日常生活中所见到的空间飞行器和各种伺服云台的稳定,到任何重心在上、支点在下的控制问题,都类似于倒立摆的控制,故对倒立摆系统的稳定控制研究在实际中有很多应用,如火箭发射、海上钻井平台以及卫星发射架的稳定控制、化工过程控制、控制飞机安全着陆等都属于这类问题。由于其运动过程与人类的行走姿态相似,而其平衡控制又与火箭飞行的控制类似,致使倒立摆系统的研究在直升机的飞行控制、火箭发射过程中的姿态控制、双足机器人的直立行走控制等领域中具有重要的现实意义。随着现代控制理论的发展,倒立摆系统研究的相关科研成果己广泛应用于机器人、军工、航天科技及一般工业过程等诸多领域。
一级倒立摆课程设计--倒立摆PID控制及其Matlab仿真
一级倒立摆课程设计--倒立摆PID控制及其Matlab仿真倒立摆PID控制及其Matlab仿真学生姓名:学院:电气信息工程学院专业班级:专业课程:控制系统的MATLAB仿真与设计任课教师:2014 年 6 月 5 日倒立摆PID控制及其Matlab仿真Inverted Pendulum PID Control and ItsMatlab Simulation摘要倒立摆系统是一个典型的快速、多变量、非线性、不稳定系统,对倒立摆的控制研究无论在理论上和方法上都有深远的意义。
本论文以实验室原有的直线一级倒立摆实验装置为平台,重点研究其PID 控制方法,设计出相应的PID控制器,并将控制过程在MATLAB上加以仿真。
本文主要研究内容是:首先概述自动控制的发展和倒立摆系统研究的现状;介绍倒立摆系统硬件组成,对单级倒立摆模型进行建模,并分析其稳定性;研究倒立摆系统的几种控制策略,分别设计了相应的控制器,以MATLAB为基础,做了大量的仿真研究,比较了各种控制方法的效果;借助固高科技MATLAB实时控制软件实验平台;利用设计的控制方法对单级倒立摆系统进行实时控制,通过在线调整参数和突加干扰等,研究其实时性和抗千扰等性能;对本论文进行总结,对下一步研究作一些展望。
关键词:倒立摆;PID控制器;MATLAB仿真设计报告正文1.简述一级倒立摆系统的工作原理;倒立摆是一个数字式的闭环控制系统,其工作原理为:角度、位移信号检测电路获取后,由微分电路获取相应的微分信号。
这些信号经A/D转换器送入计算机,经过计算及内部的控制算法解算后得到相应的控制信号,该信号经过D/A变换、再经功率放大由执行电机带动皮带卷拖动小车在轨道上做往复运动,从而实现小车位移和倒立摆角位移的控制。
2.依据相关物理定理,列写倒立摆系统的运动方程;2lO1小车质量为M ,倒立摆的质量为m ,摆长为2l ,小车的位置为x ,摆的角度为θ,作用在小车水平方向上的力为F ,1O 为摆杆的质心。
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
1 绪论随着计算机技术和通信技术的飞速发展,控制理论的研究不断深入,自动控制技术在农业、工业、军队和家庭等社会各领域得到了广泛应用,对于提高劳动生产率做出了重要贡献。
倒立摆是一种理想的控制对象平台,它结构简单、成本较低,可以有效地检验众多控制方法的有效性。
对倒立摆系统这样一个典型的多变量、快速、非线性和自然不稳定系统的研究,无论在理论上和方法上都具有重要意义。
这不仅因为其级数增加而产生的控制难度是人类对其控制能力的有力挑战,更是因为在实现其稳定控制的过程中,众多的控制理论和方法被不断应用,新的控制理论和方法因而层出不穷。
各种控制理论和方法都可以在倒立摆这个控制对象平台上加以实现和检验,并可以促成控制理论和方法相互间的有机结合,进而使得这些新方法、新理论可以应用到更加广泛的受控对象中。
1.1 倒立摆系统的分类随着倒立摆系统控制方法研究的不断深入,倒立摆系统的种类也逐渐发展为多种形式。
目前研究的倒立摆大多为在二维空间仁即平面)内摆动的摆。
考虑倒立摆的不同结构形式,倒立摆系统可以分为以下几种类型1)小车倒立摆系统仁或称为“直线倒立摆系统”)小车倒立摆系统主要由小车和摆杆两部分构成。
其中,摆杆可以是一级、两级、三级、四级甚至多级。
摆杆的级数越多,控制难度越大,而摆杆的长度也可能是变化的。
控制目标一般是通过给小车施加一个水平方向的力,使小车在期望的位置上稳定,而摆杆达到竖直向上的动态平衡状态。
2)旋转倒立摆系统仁或称为“环形倒立摆系统”)旋转倒立摆系统是在小车倒立摆系统的基础上发展起来的。
与小车倒立摆不同,旋转倒立摆将摆杆安装在与电机转轴相连的水平旋臂上,通过电机带动旋臂在水平面的转动来控制摆杆的倒立,摆杆可以在垂直平面内旋转。
旋转倒立摆将小车倒立摆的平动控制改为旋转控制,使得整个系统更为复杂和不稳定,增加了控制的难度。
3)平面倒立摆系统在平面倒立摆系统中,匀质摆杆底端可以在平面内作二维自由运动,摆杆 可沿竖直平面内任一轴线转动。
小车倒立摆的摆杆底端运动轨迹是直线,旋转 倒立摆的摆杆底端运动轨迹是圆周,而平面倒立摆的摆杆底端在二维平面内无 固定的运动轨迹,这也是它与前两种倒立摆的主要区别。
4)柔性倒立摆系统在柔性倒立摆系统中,由于将匀质刚体摆杆换成了柔性摆杆,这种倒立摆 的摆杆本身已经变成了非线性分布参数系统。
5)直线柔性连接倒立摆系统所谓直线柔性连接倒立摆系统,就是在直线刚性倒立摆的基础上,加入自 由弹簧系统:电机连接一个主动小车,而主动小车通过一根弹簧作用于从动小 车,对固定在从动小车上的倒立摆实施控制。
1.2设计内容及要求设计内容:1. 构建单级旋转倒立摆模型;;2. 实现单级旋转倒立摆摆杆的稳定控制;;3. 基于MATLAB 完成稳定控制仿真;基本要求:1. 摆角稳定控制范围:1010θ-≤≤ ;2. 旋臂转角可在0360 进行控制。
1.3课题研究的意义倒立摆系统作为研究控制理论的一种典型的实验装置,具有较为简单的结构、可以有效地检验众多控制方法的有效性、参数和模型易于改变、相对低廉的成本等优点,研究控制理论的很多科研人员一直将它们视为主要的研究对象,用它们来描述线性控制领域中不稳定系统的稳定性以及在非线性控制领域中的无源性控制、变结构控制、非线性观测器、自由行走、非线性模型降阶、摩擦补偿等控制思想,且从中不断开发出新的控制方法和控制理论,所以倒立摆系统是研究智能控制方法较为理想的实验装置。
不仅如此,倒立摆系统也是进行控制理论教学的理想平台。
很显然,这种实验教学方法难以培养学生综合素质和实践能力。
所以必须在实验环节的内容和形式上进行改革与创新,以培养学生的创新意识和实践动手能力。
因此,进行设计性、开放性的综合实验具有极其重要的现实意义。
1.4本人侧重点本人主要工作是旋转倒立摆系统的lagrange方程建模及性能分析。
倒立摆系统是一个异常复杂而又对准确性、快速性要求很高的非线性不稳定控制问题.显然一个典型的非线性、不稳定系统的研究成果无论在理论上或是在方法论上都有重要的意义.而倒立摆数学模型的建立对研究其稳定性具有指导作用.实验证明在此建模基础上采用状态反馈法对倒立摆系统的稳定控制相当成功,并可在此基础上对其进行分析,为计算机控制提供理论与实践的依据.2 旋转倒立摆系统的Lagrange方程建模与可控性分析在建立倒立摆系统的模型时,传统的方法一般采用牛顿运动定律来求解。
但在用牛顿运动定律来求解质点组的运动问题时,常常要列解大量的微分方程组。
在许多实际问题中,求解微分方程会遇到困难。
特别是当质点组存在约束情况时,还需要确定各质点间的相互作用力、位移、速度、加速度关系,联立求解这些方程则更为困难。
为了简化旋转倒立摆系统的数学建模过程,本章采用了分析力学中的Lagrange方程推导旋转倒立摆的系统模型,并对该系统的可控性进行了分析。
首先,在第2.1节中分析了Lagrange方程的物理意义和特点;接下来,在第2.2节中讨论了旋转式倒立摆系统的特点,对倒立摆系统进行了动力学分析;然后,在第2.3节中根据Lagrange 方程运用动力学理论对旋转倒立摆系统建立数学模型;随后,在第 2.4节中分析了旋转倒立摆系统模型中的非线性因素以及局部线性化带来的问题;最后,在第2.5节中对旋转倒立摆系统的可控性进行了分析。
2.1 Lagrange 方程及其特点Lagrange 方程是分析力学中的一个重要方程,它不仅在理论上揭示了系统的最小势能原理,在实用上也有很大价值。
分析力学是理论力学的重要组成部分,主要从能量角度来研究力学体系的运动规律,把系统作为一个整体来考察,用动能和势能的标量函数来描述系统,使很多受理想约束的非自由质点系动力学问题的研究和求解过程大为简化。
当系统的动能和势能的表达式可求的情况下,使用Lagrange 方程可以使系统动力学方程的形式和求解变得很简单。
设n q q q ,...,21为系统的广义坐标;n q q q,...,21为系统的广义速度,即广义坐标对时间的导数;H 是用广义坐标和广义速度表示的系统功能;n Q Q Q ,...,21为对应于各个广义坐标的广义力,则系统的运动满足下列方程组: )qH (Q )q H (dt d i i i ∂∂+=∂∂ (i=1,2...n ) (2-1) 上式为Lagrange 方程的一般形式。
其物理意义为广义动量对时间的变化率等于系统广义力和拉格朗日力之和。
iq H ∂∂叫拉格朗日力,表示惯性力的投影。
广义力i Q 的物理意义主要决定于广义坐标的量纲,例如,当i q 表示长度时,则i Q 表示作用力;当i q 表示面积时,则i Q 表示表面张力;当i q 表示体积时,则i Q 表示应力;当i q 表示转角时,则i Q 表示力矩。
当作用于系统的主动力为保守力,即系统为保守系统时,可将方程写为 0=∂∂-∂∂)H ()H (dt d q q ii (i=1,2...n ) (2-2) 这里H 为系统的动能T 和势能V 之差(H=T-V )。
在分析力学中称H 为Lagrange函数。
为减少实验的盲目性,简化系统的建模过程,采用Lagrange方程推导旋转倒立摆的系统模型。
Lagrange方程有如下特点:1)它是以广义坐标表达的任意完整系统的运动方程式,方程式的数目和系统自由度数是一致的。
2)理想约束反力不出现在方程组中,因此在建立运动方程式时,只需分析已知的主动力,而不必分析未知的约束反力。
3 ) Lagrange方程是以能量观点建立起来的运动方程式,为了列出系统的运动方程式,只需要从两个方面去分析,一个是表征系统运动的动力学量--系统的动能,另一个是表征主动力作用的动力学量--广义力。
因此用拉格朗日方程来求解系统的动力学方程可以大大简化建模过程。
2.2旋转倒立摆的特点及系统动力学分析2.2.1旋转倒立摆的特点目前在倒立摆的研究中,以小车式倒立摆为控制对象的文章很多。
人们对于小车驱动式倒立摆的研究进行的比较深入,提出了多种不同的控制算法,为控制理论的发展做出了重要贡献。
但是,小车式倒立摆在机械系统上需要有很长的导轨,这占用了较大的空间。
另外,由于小车式倒立摆有着繁多的传动机构,在实验过程中经常因为机城系统的误差和故障影响控制效果,从而干扰对控制算法本身性能的有效判断。
旋转式倒立摆与小车式倒立摆不同,出于将小车的平动控制改为旋臂的旋转控制,在硬件结构上减少了中问传动机构,使其系统结构更加简单牢固,相对于小车式倒立摆具有更大的非线性、不稳定性和复杂性,对控制算法提出了更高的要求。
在本文中我们研究的是一种新型的旋转倒立摆装置。
作为一种新型的倒立摆装置,旋转倒立摆系统主要有以下四个特点:(1)不确定性:主要是由模型的参数误差以及机械传动过程中的减速齿轮间隙所导致。
但是与小车倒立摆系统相比,由于没有了导轨上用于拖动小车的皮带,影响程度相对较小。
(2)耦合特性:旋转倒立摆系统的摆杆和水平旋臂之闷j,以及多级倒立摆系统的上下摆杆之削都有较强的耦合作用。
(3)开环不稳定性:丌坏时微小的扰动就会使系统离丌平衡点而倾倒。
(4)行程无限制:旋转倒立摆系统的水平旋臂没有行程限制,而小车倒立摆系统中小车的行程是有物理限制的,因而增加了控制的约束,使得一些控制算法在小车倒立摆系统上无法实现。
2. 2. 2旋转倒立摆系统的动力学分析对旋转倒立摆系统建立数学模型是实现倒立摆控制的基础,下面对课题采用的单级旋转倒立摆系统的数学模型进行动力学分析。
旋转倒立摆的模型结构如图2-1所示,在忽略各种阻力和摩擦的条件下,旋臂和摆杆可以抽象为的两个匀质杆,其中旋臂长度为r,相对其水平方向零位的角位移为θ;摆杆质心与铰链距离为L,相对其竖直方向零位的角位移为α.相应地,θ 为旋臂角速度,α 为摆杆角速度。
图2-1 旋转倒立摆系统模型分析下面根据动力学理论介绍单级旋转倒立摆的动力学方程推导。
摆杆质心的速度由水平和竖直两个分量构成:y L x L V ˆ)(sin ˆ)(cos αααα --=摆杆质心 (2-3) 其中,x L ˆ)(cos αα -表示摆杆质心的水平速度分量,y L ˆ)(sin αα -表示摆杆质心的竖直速度分量。
旋臂和摆杆一起运动,其沿水平方向x 的线速度为:θr V =旋臂 (2-4) 摆杆质心在x 方向和y 方向的速度分量为:)(sin )(cos ααααθ L V L r V y x -=-= (2-5) 方程组式(2-5)给出了完整的摆杆速度描述,应用Lagrange 方程可推导出系统的动态方程。
2.3旋转倒立摆系统的Lagrange 方程建模以旋臂所在水平面为零势能面,则系统的势能V 即为摆杆的重力势能,因 此系统势能V 可以表示为:αcos mgL mgh V ==系统的动能T 由四部分因素构成,它们包括:旋臂在水平面内的转动,摆杆 在竖直平面内的转动,摆杆质心沿x 轴方向的速度、沿y 轴方向的速度(参见 图2一1),对应的动能分量这里分别用T 1、T 2、T 3、T 4表示:4321T T T T T +++=其中: 21121θ J T = α 2221J T =23))(cos (21ααθ L r m T -=24))(sin (21αα L m T -=故系统动能T 可以表示为:22221))(sin (21))(cos (212121ααααθαθ L m L r m J J T -+-++= (2-6) 设R 为摆杆长度,由于L 为R 的一半,即R=2L 。