一阶直线倒立摆系统

一阶直线倒立摆系统
一阶直线倒立摆系统

一阶倒立摆控制系统

一阶直线倒立摆系统 姓名: 班级: 学号:

目录 摘要 (3) 第一部分单阶倒立摆系统建模 (4) (一)对象模型 (4) (二)电动机、驱动器及机械传动装置的模型 (6) 第二部分单阶倒立摆系统分析 (7) 第三部分单阶倒立摆系统控制 (11) (一)内环控制器的设计 (11) (二)外环控制器的设计 (14) 第四部分单阶倒立摆系统仿真结果 (16) 系统的simulink仿真 (16)

摘要: 该问题源自对于娱乐型”独轮自行车机器人”的控制,实验中对该系统进行系统仿真,通过对该实物模型的理论分析与实物仿真实验研究,有助于实现对独轮自行车机器人的有效控制。 控制理论中把此问题归结为“一阶直线倒立摆控制问题”。另外,诸如机器人行走过程中的平衡控制、火箭发射中的垂直度控制、卫星飞行中的姿态控制、海上钻井平台的稳定控制、飞机安全着陆控制等均涉及到倒立摆的控制问题。 实验中通过检测小车位置与摆杆的摆动角,来适当控制驱动电动机拖动力的大小,控制器由一台工业控制计算机(IPC)完成。实验将借助于“Simulink封装技术——子系统”,在模型验证的基础上,采用双闭环PID控制方案,实现倒立摆位置伺服控制的数字仿真实验。实验过程涉及对系统的建模、对系统的分析以及对系统的控制等步骤,最终得出实验结果。仿真实验结果不仅证明了PID方案对系统平衡控制的有效性,同时也展示了它们的控制品质和特性。 第一部分单阶倒立摆系统建模

(一) 对象模型 由于此问题为”单一刚性铰链、两自由度动力学问题”,因此,依据经典力学的牛顿定律即可满足要求。 如图1.1所示,设小车的质量为0m ,倒立摆均匀杆的质量为m ,摆长为2l ,摆的偏角为θ,小车的位移为x ,作用在小车上的水平方向上的力为F ,1O 为摆杆的质心。 图1.1 一阶倒立摆的物理模型 根据刚体绕定轴转动的动力学微分方程,转动惯量与角加速度乘积等于作用于刚体主动力对该轴力矩的代数和,则 1)摆杆绕其重心的转动方程为 sin cos y x l F J F l θθθ=-&& (1-1) 2)摆杆重心的水平运动可描述为 2 2(sin )x d F m x l dt θ=+ (1-2) 3)摆杆重心在垂直方向上的运动可描述为 2 2(cos )y d F mg m l dt θ-= (1-3) 4)小车水平方向运动可描述为 202x d x F F m dt -= (1-4)

一阶倒立摆系统的双闭环模糊控制方案范文,毕业设计

系统仿真课程设计报告 题目:一阶倒立摆系统的双闭环模糊控制方案专业、班级: 学生姓名: 学号: 指导教师: 分数: 2012 年 6 月9 日

目录 摘要: (2) 一、引言 (2) 二、设计目的 (3) 三、设计要求 (3) 四、设计原理 (3) 五、设计步骤 (3) 1、单级倒立摆系统的构成........................ 错误!未定义书签。 2、单级倒立摆的数学模型 (4) 3、模糊控制器的设计 (6) 3.1单阶倒立摆模糊控制的基本思路 (6) 3.2隶属函数的定义 (6) 3.3模糊控制器规则 (7) 3.4解模糊 (8) 4、仿真实验 (8) 4.1MATLAB模糊逻辑工具箱 (8) 4.2系统数字仿真模型的建立 (11) 5、基于MATLAB的数字仿真结果 (12) 六、结论 (13) 七、感想和建议 (13) 八、致谢 (14) 九、参考文献 (15)

摘要:通过对单阶倒立摆的双闭环的控制数学模型的分析,采用模糊控制理论对倒立摆的控制系统进行计算机仿真。其中,内环控制倒立摆的角度,外环控制倒立摆的位置。在Matlab环境下的仿真步骤包括:定义隶属函数及模糊控制规则集,解模糊。结果表明,摆杆角度和小车位置的控制过程均具有良好的动态性能和稳定性能。 关键词:倒立摆;模糊逻辑控制;计算机仿真;MATLAB Abstract:based on the ChanJie inverted pendulum double closed loop control mathematical model analysis, the fuzzy control theory of the inverted pendulum control system by computer simulation. Among them, the inner loop control the point of view of the inverted pendulum, outside loop control the position of the inverted pendulum. In the Matlab environment simulation steps include: definition membership function and fuzzy control rule sets, solution is fuzzy. The results show that, swinging rod Angle and the car position control process are good dynamic performance and stable performance. Keywords: inverted pendulum; Fuzzy logic control; The computer simulation; Matlab 一、引言 在人类自然科学的发展历史上,人们总是以追求事物的精确描述为目的来进行研究,并取得了大量的成果。随着科学技术的进步,在社会生产和生活中存在的大量的不确定性开始引起人们的注意。有关模糊不确定性的研究直到1965年,美国的L.A.Zadeh教授首次提出模糊集合的概念之后得到广泛开展。 “模糊”是与“精确”相对而言的概念,模糊性普遍存在于人类的思维和语言交流中,是一种不确定性的表现。随机性则是客观存在的另一类不确定性,两者虽然都是不确定性,单存在本质上的区别。模糊性主要是人对概念外延的主观理解上的不确定性,而随机性则主要反映客观上的自然的不确定性,即对事件或行为的发生与否的不确定性。 一阶直线倒立摆系统是一个典型的“快速、多变量、非线性、自不稳定系统”,将模糊控制方法应用于一阶倒立摆系统的控制问题,能够发挥模糊控制在非线性系统控制、复杂对象系统控制方面的优势,简化设计,提高控制系统的鲁棒性。

(完整版)一级倒立摆系统分析

一级倒立摆的系统分析 一、倒立摆系统的模型建立 如图1-1所示为一级倒立摆的物理模型 图1-1 一级倒立摆物理模型 对于上图的物理模型我们做以下假设: M:小车质量 m:摆杆质量 b:小车摩擦系数 l:摆杆转动轴心到杆质心的长度 I:摆杆惯量 F:加在小车上的力 x:小车位置 ?:摆杆与垂直向上方向的夹角 θ:摆杆与垂直向下方向的夹角(考虑到摆杆初始位置为竖直向下)图1-2是系统中小车和摆杆的受力分析图。其中,N和P为小车与摆

杆相互作用力的水平和垂直方向的分量。注意:实际倒立摆系统中的检测和执行装置的正负方向已经完全确定,因而矢量方向定义如图所示,图示方向为矢量正方向。 图1-2 小车及摆杆受力分析 分析小车水平方向受力,可以得到以下方程: M x?=F-bx?-N (1-1) 由摆杆水平方向的受力进行分析可以得到以下方程: N =m d 2dt (x +l sin θ) (1-2) 即: N =mx?+mlθcos θ?mlθ2sin θ (1-3) 将这个等式代入式(1-1)中,可以得到系统的第一个运动方程: (M +m )x?+bx?+mlθcos θ?mlθ2sin θ=F (1-4) 为推出系统的第二个运动方程,我们对摆杆垂直方向上的合力进行分析,可以得出以下方程: P ?mg =m d 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θ=?mlx?cosθ (1-8) 设θ=π+?,假设?与1(单位是弧度)相比很小,即?<<1,则 可以进行近似处理:cosθ=?1,sinθ=??,(dθ dt ) 2 =0。用u来 代表被控对象的输入力F,线性化后的两个运动方程如下: {(I+ml2)??mgl?=mlx? (M+m)x?+bx??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 ?g s ]Φ(s) (1-11) 或改写为:Φ(s) X(s)=mls2 (I+ml2)s2?mgl (1-12) 如果令v=x?,则有:Φ(s) V(s)=ml (I+ml2)s2?mgl (1-13) 如果将上式代入方程组的第二个方程,可以得到: (M+m)[(I+ml2) ml ?g s ]Φ(s)s2+b[(I+ml2) ml +g s ]Φ(s)s?mlΦ(s)s2= U(s) (1-14) 整理后可得传递函数: Φ(s) U(s)= ml q s2 s4+b(I+ml 2) q s3?(M+m)mgl q s2?bmgl q s (1-15)

一级倒立摆的建模与控制分析

控制工程与仿真课程设计报告 报告题目直线一级倒立摆建模、分析及控制器的设计 组员1专业、班级14自动化1 班姓名朱永远学号1405031009 组员1专业、班级14自动化1 班姓名王宪孺学号1405031011组员1专业、班级14自动化1 班姓名孙金红学号1405031013 报告评分标准 评分项目权重评价内容评价结果项目得分 内容70设计方案较合 理、正确,内容 较完整 70-50分 设计方案基本合 理、正确,内容 基本完整 50-30分 设计方案基本不 合理、正确,内 容不完整 0-30分 语言组织15语言较流顺,标 点符号较正确 10-15分语言基本通顺, 标点符号基本正 确 5-10分 语言不通顺,有 错别字,标点符 号混乱 5分以下 格式15 报告格式较正 确,排版较规范 美观 10-15分 报告格式基本正 确,排版不规范 5-10分 报告格式不正 确,排版混乱 5分以下总分

直线一级倒立摆建模、分析及控制器的设计 一状态空间模型的建立 1.1直线一级倒立摆的数学模型 图1.1 直线一级倒立摆系统 本文中倒立摆系统描述中涉及的符号、物理意义及相关数值如表1.1所示。

图1.2是系统中小车的受力分析图。其中,N 和P 为小车与摆杆相互作用力的水平和垂直方向的分量。 图1.2 系统中小车的受力分析图 图1.3是系统中摆杆的受力分析图。F s 是摆杆受到的水平方向的干扰力, F h 是摆杆受到的垂直方向的干扰力,合力是垂直方向夹角为α的干扰力F g 。

图1.3 摆杆受力分析图 分析小车水平方向所受的合力,可以得到以下方程: ()11- 设摆杆受到与垂直方向夹角为α 的干扰力Fg ,可分解为水平方向、垂直方向的干扰力,所产生的力矩可以等效为在摆杆顶端的水平干扰力FS 、垂直干扰力Fh 产生的力矩。 ()21- 对摆杆水平方向的受力进行分析可以得到下面等式: ()θsin 22 l x dt d m F N S +=- ()31- 即: αθθθθsin sin cos 2f F ml ml x m N +-+= ()41- 对图1.3摆杆垂直方向上的合力进行分析,可以得到下面方程: ()θcos 22 l l dt d m F mg P h -=++- ()51- 即 θθθθ αcos sin cos 2 ml ml F mg P g +=++- ()61- 力矩平衡方程如下: 0cos sin sin cos cos sin =++++θθθθαθα I Nl Pl l F l F g g ()71- 代入P 和N ,得到方程: () 0cos 2sin sin 2cos sin cos 2cos sin 2222=+-++++θθθθθθθαθαx ml ml mgl ml I l F l F g g ()81- 设φπθ+=,(φ是摆杆杆与垂直向上方向之间的夹角,单位是弧度),代入上式。假设φ<<1,则可进行近似处理: φφφφφφφ===?? ? ??==2sin ,12cos ,0,sin ,1cos 2 dt d N x f F x M --= α sin g S F F =α cos g h F F =

哈工大一阶倒立摆

哈尔滨工业大学 控制科学与工程系 控制系统设计课程设计报告

姓名:院(系): 专业:自动化班号: 任务起至日期: 2014 年9 月9 日至 2014 年9 月20 日 课程设计题目:直线一级倒立摆控制器设计 已知技术参数和设计要求: 本课程设计的被控对象采用固高公司的直线一级倒立摆系统GIP-100-L。 系统内部各相关参数为: M小车质量0.5kg; m摆杆质量0.2kg; b小车摩擦系数0.1N/m/sec; l摆杆转动轴心到杆质心的长度0.3m; I摆杆惯量0.006kg*m*m; T采样时间0.005秒。 设计要求: 1.推导出系统的传递函数和状态空间方程。用Matlab进行阶跃输入仿真,验证系统的稳定性。 2.设计PID控制器,使得当在小车上施加0.1N的脉冲信号时,闭环系统的响应指标为: (1)稳定时间小于5秒; (2)稳态时摆杆与垂直方向的夹角变化小于0.1弧度。 3.设计状态空间极点配置控制器,使得当在小车上施加0.2m的阶跃信号时,闭环系统的响应指标为: (1)摆杆角度错误!未找到引用源。和小车位移x的稳定时间小于3秒 (2)x的上升时间小于1秒 (3)错误!未找到引用源。的超调量小于20度(0.35弧度) (4)稳态误差小于2%。 工作量: 1.建立直线一级倒立摆的线性化数学模型; 2.倒立摆系统的PID控制器设计、Matlab仿真及实物调试; 3.倒立摆系统的极点配置控制器设计、Matlab仿真及实物调试。

哈尔滨工业大学 (1) 控制系统设计课程设计报告 (1) 一.实验设备简介 (3) 二.直线一阶倒立摆数学模型的推导 (6) 2.1概述 (6) 2.2数学模型的建立 (7) 2.3一阶倒立摆的状态空间模型: (9) 2.4实际参数代入: (10) 三.定量、定性分析系统的性能 (11) 3.1 对系统的稳定性进行分析 (11) 3.2 对系统的稳定性进行分析: (12) 四. 实际系统的传递函数与状态方程 (13) 五. 系统阶跃响应分析 (14) 六.一阶倒立摆PID控制器设计 (15) 6.1 PID控制分析 (15) 6.2 PID控制参数设定及MATLAB仿真 (17) 6.3 PID控制实验 (18) 七.状态空间极点配置控制器设计 (19) 7.1 状态空间分析 (20) 7.2 极点配置及MA TLAB仿真 (21) 7.3 利用爱克曼公式计算 (21) 八.课程设计心得与体会 (22) 一.实验设备简介 倒立摆控制系统:Inverted Pendulum System (IPS) 倒立摆控制系统是一个复杂的、不稳定的、非线性系统,是进行控制理论教学及开展各种控制实验的理想实验平台。对倒立摆系统的研究能有效的反映控制中的许多典型问题:如非线性问题、鲁棒性问题、镇定问题、随动问题以及跟踪问题等。通过对倒立摆的控制,用来检验新的控制方法是否有较强的处理非线性和不稳定性问题的能力。同时,其控制方法在军工、航天、机器人和一般工业过程领域中都有着广泛的用途,如机器人行走过程中的平衡控制、火箭发射中的垂直度控制和卫星飞行中的姿态控制等。 倒立摆是进行控制理论研究的典型实验平台。倒立摆是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合,其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统,可以作为一个典型的控制对象对其进行研究。最初研究开始于二十世纪50 年代,麻省理工学院(MIT)的控制论专家根据火箭发射助推器原理设计出一级倒立摆实验设备。近年来,新的控制方法不断出现,人们试图通过倒立摆这样一个典型的控制对象,检验新的控制方法是否有较强的处理多变量、非线性和绝对不稳定系统的能力,从而从中找出最优秀的控制方法。

单级倒立摆系统的分析与设计

单级倒立摆系统的分析与设计 小组成员:武锦张东瀛杨姣 李邦志胡友辉 一.倒立摆系统简介 倒立摆系统是一个典型的高阶次、多变量、不稳定和强耦合的非线性系统。由于它的行为与火箭飞行以及两足机器人行走有很大的相似性,因而对其研究具有重大的理论和实践意义。由于倒立摆系统本身所具有的上述特点,使它成为人们深入学习、研究和证实各种控制理论有效性的实验系统。 单级倒立摆系统(Simple Inverted Pendulum System)是一种广泛应用的物理模型,其结构和飞机着陆、火箭飞行及机器人的关节运动等有很多相似之处,因而对倒立摆系统平衡的控制方法在航空及机器人等领域有着广泛的用途,倒立摆控制理论产生的方法和技术将在半导体及精密仪器加工、机器入技术、导弹拦截控制系统、航空器对接控制技术等方面具有广阔的开发利用前景。 倒立摆仿真或实物控制实验是控制领域中用来检验某种控制理论或方法的典型方案。最初研究开始于二十世纪50年代,单级倒立摆可以看作是一个火箭模型,相比之下二阶倒立摆就复杂得多。1972年,Sturgen等采用线性模拟电路实现了对二级倒立摆的控制。目前,一级倒立摆控制的仿真或实物系统已广泛用于教学。 二.系统建模 1.单级倒立摆系统的物理模型 图1:单级倒立摆系统的物理模型

单级倒立摆系统是如下的物理模型:在惯性参考系下的光滑水平平面上,放置一个可以在平行于纸面方向左右自由移动的小车(cart ),一根刚性的摆杆(pendulum leg )通过其末端的一个不计摩擦的固定连接点(flex Joint )与小车相连构成一个倒立摆。倒立摆和小车共同构成了单级倒立摆系统。倒立摆可以在平行于纸面180°的范围内自由摆动。倒立摆控制系统的目的是使倒立摆在外力的摄动下摆杆仍然保持竖直向上状态。在小车静止的状态下,由于受到重力的作用,倒立摆的稳定性在摆杆受到微小的摄动时就会发生不可逆转的破坏而使倒立摆无法复位,这时必须使小车在平行于纸面的方向通过位移产生相应的加速度。依照惯性参考系下的牛顿力学原理,作用力与物体位移对时间的二阶导数存在线性关系,单级倒立摆系统是一个非线性系统。 各个参数的物理意义为: M — 小车的质量 m — 倒立摆的质量 F — 作用到小车上的水平驱动力 L — 倒立摆的长度 x — 小车的位置 θ— 某一时刻摆角 整个倒立摆系统就受到重力、驱动力和摩擦阻力的三个外力的共同作用。这里,驱动力F 是由连接小车的传动装置提供,控制倒立摆的稳定实际上就是依靠控制驱动力F 使小车在水平面上做与倒立摆运动相关的特定运动。为了简化模型以利于仿真,假设小车与导轨以及摆杆与小车铰链之间的摩擦均为0。 2.单级倒立摆系统的数学模型 令小车的水平位移为x ,运动速度为v ,加速度a 。 小车的动能为212kc E Mx =,选择特定的参考平面使得小车的势能为0。 摆杆的长度为L ,某时刻摆角为θ,在摆杆上与固定连接点距离为q (0

一级倒立摆控制方法比较

一级倒立摆控制方法比较 摘要:倒立摆系统是一个典型的多变量、非线性、强耦合和快速运动的自然不稳定系统。针对一级倒立摆系统,首先利用牛顿力学的知识建立了数学模型,然后利用Simulink 及其封装功能建立倒立摆的仿真模型,使模型更具灵活性,给仿真带来很大方便。根据状态方程判断系统的能控、能观性。通过LQR控制算法和极点配置设计控制器使系统达到稳定状态,分析两种方法的优缺点,并利用Matlab仿真加以证实。 关键词:倒立摆; LQR ;极点配置 ;Matlab DISCUSSION ON CONTROLOF INVERTED PENDULUM Abstract:the inverted pendulum system is a typical multi-variable, nonlinear, strong coupling and rapid movement of the natural unstable system. According to the level of inverted pendulum system, firstI make use of Newtonian mechanics knowledge to establishthe mathematical model, and use the Simulink and packaging function to establish inverted pendulum simulation model.The model is more flexibility, bringing a lot of convenience for simulation. By the equation of state, controllability and observablityof system can be sure. Designing the LQR control algorithm and pole-place makes the system stable state, analyzes the advantages and disadvantages of two methods confirmed through the simulation of MATLAB. Key words:Inverted pendulum ;LQR ;pole-place ;Matlab 0引言 倒立摆系统作为研究控制理论的一种典型的实验装置,具有成本低廉,结构简单,物理参数和结构易于调整的优点。研究倒立摆系统具有很强的理论意义,同时也具有深远的实践意义。许多抽象的控制概念如稳定性、能控性和能观性,都可以通过倒立摆系统直观地表现出来。希望对倒立摆的研究能够加深对控制理论的了解,为后面学习奠定坚实的基础。 倒立摆[1]的稳定控制主要可分为线性控制和智能控制两大类,下面分别对其归纳介绍。 1)线性理论控制方法 应用线性控制方法的基本前提是倒立摆处在平衡点附近,偏移很小时,系统可以用

倒立摆系统的建模及Matlab仿真资料

第1 页共11 页 倒立摆系统的建模及Matlab仿真 1.系统的物理模型 考虑如图(1)所示的倒立摆系统。图中,倒立摆安装在一个小车上。这里仅考虑倒立摆在图面内运动的二维问题。 图(1)倒立摆系统 假定倒立摆系统的参数如下。 摆杆的质量:m=0.1g l=1m小车的质量:摆杆的长度:2重力加速度:g=9.8m/M=1kg s摆杆的质量在摆杆的中心。 设计一个控制系统,使得当给定任意初始条件(由干扰引起)时,最大超调量?≤10%,调节时间ts ≤4s ,通过小车的水平运动使倒立摆保持在垂直位置。 2.系统的数学模型 2.1建立倒置摆的运动方程并将其线性化。 为简化问题,在数学模型中首先假设:1)摆杆为刚体;2)忽略摆杆与支点之间的摩擦;3)忽略小车与接触面间的摩擦。 ?),在u设小车瞬时位置为z,摆心瞬时位置为(作用下,小车及摆均产生加速远 动,sin?lz根据牛顿第二定律,在水平直线远动方向的惯性力应与u平衡,于是有 22dzd?)?sinu?M?m(zl22dtdt???2????z(M?mml?)cos?mlusin? 即:??①

绕摆轴转动的惯性力矩与重力矩平衡,因而有. 第2 页共11 页 2??d??? sin??lcosm(z?lsinmgl)??2dt?????22???????即: nis?l?ocgcosincoszs?ls??② 以上两个方程都是非线性方程,为求得解析解,需作线性化处理。由于控制的目的是保持倒立摆直?2?????且可忽略则,立,在试驾合适的外力条件下,假定θ很小,接近于零时合理的,1sincos??,项。于是有 ???M?zm?u?ml??)(③ ????g?z?l??④联立求解可得1mg?u?z????MM 1)?m(M????u??MlMl 列写系统的状态空间表达式。2.2??T xx,x,x,,选取系统变量则 xx,x,xx?,42134123xx??211mgux???x?32MM x?x?431)(M?mu?x?x? 34MlMl 即00100????z??1mg??????000?z?????d MM??Bu?Ax?xux????????00001???dt????1gm?(M)????000??????? MlMl??????Cx?0?y?xx1001代入数据计算得到:0100????000?1??????T0D,?0??1BA?,?001,C100??1000??00011?? 11 页3 页共第 3.设计控制器3.1判断系统的能控性和稳定性 1100????0011????23BBAABAB?Q?故被控对象完全可控, rank()=4,Q kk??11?0?10??011?10???22???11?。出现大于零的特征值,故被,,0 解得特征值为 0由特征方程0??11I?A?)(控对象不稳定3.2确定希望的极点, 另一对为远极点,认为系统性能主要由主导,选其中一对为主导极点和希望的极点n=4ss21极点决定,远极点只有微小影响。根据二阶系统的关系式,先确定主导极点???42??1????10.?e??t1.67?有,闭环可得;取误差带,于是取,则6.?059?0.02.?0? pns??n2????1?js??=-10.8j,远极点选择使它和原点的距离大于主导极点与原点 距离主导极点为?n,21s??15倍,取的54,33.3采用状态反馈方法使系统稳定并配置极点 ??kkkk?k;状态反馈系统的状态方程,馈状态反的控制规律为为kxu??3102?,其

一级倒立摆控制系统设计

基于双闭环PID控制的一阶倒立摆控制系统设计 一、设计目的 倒立摆是一个非线性、不稳定系统,经常作为研究比较不同控制方法的典型例子。设计一个倒立摆的控制系统,使倒立摆这样一个不稳定的被控对象通过引入适当的控制策略使之成为一个能够满足各种性能指标的稳定系统。 二、设计要求 倒立摆的设计要求是使摆杆尽快地达到一个平衡位置,并且使之没有大的振荡和过大的角度和速度。当摆杆到达期望的位置后,系统能克服随机扰动而保持稳定的位置。实验参数自己选定,但要合理符合实际情况,控制方式为双PID控制,并利用MATLAB进行仿真,并用simulink对相应的模块进行仿真。 三、设计原理 倒立摆控制系统的工作原理是:由轴角编码器测得小车的位置和摆杆相对垂直方向的角度,作为系统的两个输出量被反馈至控制计算机。计算机根据一定的控制算法,计算出空置量,并转化为相应的电压信号提供给驱动电路,以驱动直流力矩电机的运动,从而通过牵引机构带动小车的移动来控制摆杆和保持平衡。 四、设计步骤 首先画出一阶倒立摆控制系统的原理方框图 一阶倒立摆控制系统示意图如图所示: 分析工作原理,可以得出一阶倒立摆系统原理方框图:

一阶倒立摆控制系统动态结构图 下面的工作是根据结构框图,分析和解决各个环节的传递函数! 1.一阶倒立摆建模 在忽略了空气流动阻力,以及各种摩擦之后,可将倒立摆系统抽象成小车和匀质杆组成的系统,如下图所示,其中: M :小车质量 m :为摆杆质量 J :为摆杆惯量 F :加在小车上的力 x :小车位置 θ:摆杆与垂直向上方向的夹角 l :摆杆转动轴心到杆质心的长度 根据牛顿运动定律以及刚体运动规律,可知: (1) 摆杆绕其重心的转动方程为 (2) 摆杆重心的运动方程为 得 sin cos ..........(1)y x J F l F l θθθ=- 2 22 2(sin ) (2) (cos ) (3) x y d F m x l d t d F mg m l d t θθ=+=-

倒立摆系统的建模及Matlab仿真

倒立摆系统的建模及Matlab 仿真 1.系统的物理模型 考虑如图(1)面内运动的二维问题。 图(1)倒立摆系统 假定倒立摆系统的参数如下。 摆杆的质量:m=0.1g 摆杆的长度:l =1m 小车的质量: M=1kg 重力加速度:g=9.8m/2s 摆杆的质量在摆杆的中心。 设计一个控制系统,使得当给定任意初始条件(由干扰引起)时,最大超调量δ ≤10%,调节时 间ts ≤4s ,通过小车的水平运动使倒立摆保持在垂直位置。 2.系统的数学模型 2.1建立倒置摆的运动方程并将其线性化。 为简化问题,在数学模型中首先假设:1)摆杆为刚体;2)忽略摆杆与支点之间的摩擦;3)忽略小车与接触面间的摩擦。 设小车瞬时位置为z,摆心瞬时位置为(θsin l z +),在u 作用下,小车及摆均产生加速远动,根据牛顿第二定律,在水平直线远动方向的惯性力应与u 平衡,于是有 u l z dt d m dt z d M =++)sin (22 22θ 即: u ml ml z m M =-++θθθθsin cos )(2&&&&& ① 绕摆轴转动的惯性力矩与重力矩平衡,因而有

θθθsin cos )sin (22mgl l l z dt d m =??? ????+ 即: θθθθθθθsin cos sin cos cos 22g l l z =-+&&&&& ② 以上两个方程都是非线性方程,为求得解析解,需作线性化处理。由于控制的目的是保持倒立摆直 立,在试驾合适的外力条件下,假定θ很小,接近于零时合理的,则1cos ,sin ≈≈θθθ,且可忽略θ θ2&项。于是有 u ml z m M =++θ&&&& )( ③ θθg l z =+&&&& ④ 联立求解可得 u Ml Ml m M u M M mg z 1)(1 -+=+- =θθθ&&&& 2.2列写系统的状态空间表达式。 选取系统变量4321,,,x x x x , []T x x x x x 4321,,,=则 u Ml x Ml m M x x x u M x M mg x x x 1 )(134433221-+= =+-==&&&& 即 []Cx x x y Bu Ax u Ml M x Ml g m M M mg z z dt d x ===+=?????? ? ???????-+?????????? ??? ? +- =???? ????????=000110100)(0 010 0000000 1 1θθ&&& 代入数据计算得到: [][]0,0001,1010,01100 1000010000 1 0==-=? ? ??? ? ??? ???-=D C B A T

一阶倒立摆控制系统设计

课程设计说明书 课程名称:控制系统课程设计设计题目:一阶倒立摆控制器设计院系:信息与电气工程学院班级: 设计者: 学号: 指导教师: 设计时间:2013年2月25日到2013年3月8号

课程设计(论文)任务书 指导教师签字:系(教研室)主任签字: 2013年3月5日

目录 一、建立一阶倒立摆数学模型 (4) 1. 一阶倒立摆的微分方程模型 (4) 2. 一阶倒立摆的传递函数模型 (6) 3. 一阶倒立摆的状态空间模型 (7) 二、一阶倒立摆matlab仿真 (9) 三、倒立摆系统的PID控制算法设计 (13) 四、倒立摆系统的最优控制算法设计 (23) 五、总结............................................................................................... 错误!未定义书签。 六、参考文献 (29)

一、建立一阶倒立摆数学模型 首先建立一阶倒立摆的物理模型。在忽略空气阻力和各种摩擦之后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统,如图1所示。 系统内部各相关参数定义如下: M 小车质量 m 摆杆质量 b 小车摩擦系数 l 摆杆转动轴心到杆质心的长度 I 摆杆惯量 F 加在小车上的力 x 小车位置 φ摆杆与垂直向上方向的夹角 θ摆杆与垂直向下方向的夹角(考虑到摆杆初始位置为竖直向下)1.一阶倒立摆的微分方程模型 对一阶倒立摆系统中的小车和摆杆进行受力分析,其中,N和 P为小车与摆杆相互作用力的水平和垂直方向的分量。

图1-2 小车及摆杆受力图 分析小车水平方向所受的合力,可以得到以下方程: (1-1)由摆杆水平方向的受力进行分析可以得到下面等式: (1-2)即: (1-3) 把这个等式代入式(1-1)中,就得到系统的第一个运动方程: (1-4) 为了推出系统的第二个运动方程,我们对摆杆垂直方向上的合力进行分析,可以得到下面方程: (1-5) 即: (1-6)力矩平衡方程如下: (1-7) 由于所以等式前面有负号。

单级倒立摆经典控制系统

单级倒立摆经典控制系统 摘要:倒立摆控制系统虽然作为热门研究课题之一,但见于资料上的大多采用现代控制方法,本课题的目的就是要用经典的方法对单级倒立摆设计控制器进行探索。本文以经典控制理论为基础,建立小车倒立摆系统的数学模型,使用PID控制法设计出确定参数(摆长和摆杆质量)下的控制器使系统稳定,并利用MATLAB软件进行仿真。 关键词:单级倒立摆;经典控制;数学模型;PID控制器;MATLAB 1绪论 自动控制理论是研究自动控制共同规律的技术科学。它的发展初期,是以反馈理论为基础的自动调节原理,并主要用于工业控制。 控制理论在几十年中,迅速经历了从经典理论到现代理论再到智能控制理论的阶段,并有众多的分支和研究发展方向。 1.1经典控制理论 控制理论的发展,起于“经典控制理论”。早期最有代表性的自动控制系统是18世纪的蒸汽机调速器。20世纪前,主要集中在温度、压力、液位、转速等控制。20世纪起,应用范围扩大到电压、电流的反馈控制,频率调节,锅炉控制,电机转速控制等。二战期间,为设计和制造飞机及船用自动驾驶仪、火炮定位系统、雷达跟踪系统及其他基于反馈原理的军用装备,促进了自动控制理论的发展。

至二战结束时,经典控制理论形成以传递函数为基础的理论体系,主要研究单输入-单输出、线性定常系统的分析问题。经典控制理论的研究对象是线性单输入单输出系统,用常系数微分方程来描述。它包含利用各种曲线图的频率响应法和利用拉普拉斯变换求解微分方程的时域分析法。这些方法现在仍是人们学习控制理论的入门之道。 1.2倒立摆 1.2.1倒立摆的概念 图1 一级倒立摆装置 倒立摆是处于倒置不稳定状态,人为控制使其处于动态平衡的一种摆。如杂技演员顶杆的物理机制可简化为一级倒立摆系统,是一个复杂、多变量、存在严重非线性、非自治不稳定系统。

倒立摆设计

倒立摆控制系统实验 一、查阅倒立摆相关文献 要求: 1 掌握单级倒立摆数学模型的建立过程 2 理解当前单级倒立摆的基本控制方法 3 了解倒立摆控制技术的现状和未来发展趋势 二、倒立摆系统简介 1、倒立摆式机器人技术、控制理论、计算机控制等多个领域,多种技术的有机结合,其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统,可以作为一个典型的控制对象对其进行研究。最初研究开始于二十世纪50年代,麻省理工学院(MIT)的控制论专家根据火箭发射助推器原理设计出一级倒立摆实验设备。近年来,新的控制方法不断出现,人们试图通过倒立摆这样一个典型的控制对象,检验新的控制方法是否有较强的处理多变量、非线性和绝对不稳定系统的能力,从而从中找出最优秀的控制方法。 2、倒立摆系统作为控制理论研究中的一种比较理想的实验手段,为自动控制理论的教学、实验和科研构建一个良好的实验平台,以用来检验某种控制理论或方法的典型方案,促进了控制系统新理论、新思想的发展。由于控制理论的广泛应用,由此系统研究产生的方法和技术将在半导体及粳米仪器加工、机器人控制技术、人工智能、导弹拦截控制系统、航空对接控制技术、火箭发射中的垂直度控制、卫星飞行中的姿态控制和一般工业应用等方面具有广阔的利用开发前景。平面倒立摆可以比较真实的模拟火箭的飞行控制和步行机器人的稳定控制等方面的研究。 三、倒立摆分类 1、倒立摆已经由原来的直线一级倒立摆扩展出很多种类,典型的有直线倒立摆,环形倒立摆,平面倒立摆和复合倒立摆等,倒立摆系统是在运动模块上装有倒立摆装置,由于在相同的运动模块上可以装载不同的倒立摆装置,倒立摆的种类由此而丰富很多。 按倒立摆的结构来分,有以下类型的倒立摆: ?1、直线倒立摆系列 ?直线倒立摆是在直线运动模块上装有摆体组件,直线运动模块有一个自由度,小车可以沿导轨水平运动,在小车上装载不同的摆体组件,可以组成很多类别的倒立摆,直线柔性倒立摆和一般直线倒立摆的不同之处在于,柔性倒立摆有两个可以沿导轨滑动的小车,并且在主动小车和从动小车之间增加了一个弹簧,作为柔性关节。直线倒立摆系列产品如图1 所示。 图 1 直线倒立摆系列图 2 环形倒立摆系列 2、环形倒立摆系列 环形倒立摆是在圆周运动模块上装有摆体组件,圆周运动模块有一个自由度,可以围绕齿轮中心做圆周运动,在运动手臂末端装有摆体组件,根据摆体组件的级数和串连或并联的方式,可以组成很多形式的倒立摆。如图2所示。 3、平面倒立摆系列

(完整word版)倒立摆系统研究意义历史与现状

倒立摆系统研究意义历史与现状 1倒立摆系统研究的意义 (1) 2 倒立摆的种类 (2) (1)直线倒立摆 (2) (2)环形倒立摆 (3) (3)平面倒立摆 (3) (4)柔性连接倒立摆 (4) (5)Acrobot、Penduot等其他形式的倒立摆 (4) 3 倒立摆研究的历史与现状 (4) 3.1倒立摆系统在国外的研究现状 (4) 3.2倒立摆系统在国内的研究现状 (5) 1倒立摆系统研究的意义 倒立摆系统是一个典型的高阶次、多变量、严重不稳定和强耦合的非线性系统,是控制理论研究中理想的被控制对象,它为控制理论的教学、实验和科研构建了一个良好的实验平台。由于倒立摆具有以上特点,使得人们一直将它视为典型的研究对象,不断地从中发掘和检验新的控制策略。迄今人们已经利用经典控制理论、现代控制理论以及各种智能控制理论实现了多种倒立摆系统的稳定控制。 20世纪90年代以来,各种复杂的倒立摆系统不断地采用不同的控制方法,极大的促进了控制理论的发展,同时这些新的控制方法又在航天航空控制和机器人控制方面的得到了广泛的应用。 在控制理论发展的过程中,某一理论的正确性及在实际应用中的可行性需要一个按其理论设计的控制器去控制一个典型对象来验证这一理论,倒立摆就是这样的一个典型的被控对象。倒立摆的典型性在于:作为一个实验装置,它成本低廉、结构简单、形象直观、构件组成参数和形状易于改变、便于实现模拟和数字两种不同的控制方式;作为一个被控对象又相当复杂,就其本身而言,是一个高阶次、不稳定、多变量、非线性、强耦合的快速系统,只有采用行之有效的控制方法才能使之稳定。此外对于倒立摆的稳定控制,会涉及到控制理论中的许多关键性问题,比如非线性问题、系统的鲁棒性问题、随动问题、镇定问题及跟随问题等等。倒立摆系统可以用多种理论和方法来实现其稳定控制,如PID、自适应、状态反馈、智能控制、模糊控制及人工神经元网络等多种理论和方法都能在倒立

一级倒立摆系统仿真及分析

一级倒立摆系统仿真及分析 1.摘要 本次课程设计,我们小组选择一级倒立摆系统作为物理模型,首先通过物理分析建立数学模型,得到系统的传递函数,通过对传递函数的极点,根轨迹,单位阶跃响应来分析系统稳定性。建立状态空间模型,利用matlab进行能控能观性分析,输入阶跃信号,分析系统输出响应。通过设定初始条件,查看系统稳定性,利用simulink绘制系统状态图。再对系统进行极点配置,进行状态反馈,使得系统在初始状态下处于稳定状态,并绘制系统状态图。 2.; 3.课程设计目的 倒立摆系统是一个经典的快速、多变量、非线性、绝对不稳定系统,是用来检验某种控制理论或方法的典型方案。倒立摆控制理论产生的方法和技术在半导体及精密仪器加工、机器人技术、导弹拦截控制系统和航空器对接控制技术等方面具有广阔的开发利用前景。因此研究倒立摆系统具有重要的实践意义。 4.课程设计题目描述和要求 本次课程设计我们小组选择环节项目三:系统状态响应、输出响应的测量。 < 环节目的: 1.利用MATLAB分析线性定常系统。 2.利用SIMULINK进行系统状态空间控制模型仿真,求取系统的状态响应及输出响应。 环节内容、方法: 1.给定系统状态空间方程,对系统进行可控性、可观性分析。并利用SIMULINK 绘制系统的状态图,求取给定系统输入信号和初始状态时的状态响应及输出响应。 }

2.给定两个系统的状态空间模型,分别求两个系统的特征值;将两个系统的系统矩阵化为标准型;求出给定系统初始状态时,状态的零输入响应;求两个系统的传递函数并分析仿真结果。 4.课程设计报告内容 数学模型的建立及分析 对于倒立摆系统,由于其本身是自不稳定的系统,实验建模存在一定的困难。但是经过小心的假设忽略掉一些次要的因素后,倒立摆系统就是一个典型的运动的刚体系统,可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。下面我们采用其中的牛顿-欧拉方法建立直线型一级倒立摆系统的数学模型。 ~ 在忽略了空气阻力,各种摩擦之后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统,如下图1所示 图l 直线一级倒立摆系统 我们不妨做以下假设: M小车质量、m摆杆质量、b小车摩擦系数、l摆杆转动轴心到杆质心的长度、I 摆杆惯、F加在小车上的力、x 小车位置、φ摆杆与垂直向上方向的夹角、θ摆杆与垂直向下方向的夹角(考虑到摆杆初始位置为竖直向下)。

倒立摆控制系统概述

倒立摆控制系统:Inverted Pendulum System (IPS) 倒立摆控制系统是一个复杂的、不稳定的、非线性系统,是进行控制理论教学及开展各种控制实验的理想实验平台。对倒立摆系统的研究能有效的反映控制中的许多典型问题:如非线性问题、鲁棒性问题、镇定问题、随动问题以及跟踪问题等。通过对倒立摆的控制,用来检验新的控制方法是否有较强的处理非线性和不稳定性问题的能力。同时,其控制方法在军工、航天、机器人和一般工业过程领域中都有着广泛的用途,如机器人行走过程中的平衡控制、火箭发射中的垂直度控制和卫星飞行中的姿态控制 分类: 倒立摆系统按摆杆数量的不同,可分为一级,二级,三级倒立摆等,多级摆的摆杆之间属于自由连接(即无电动机或其他驱动设备)。现在由中国的大连理工大学李洪兴教授领导的“模糊系统与模糊信息研究中心”暨复杂系统智能控制实验室采用变论域自适应模糊控制成功地实现了四级倒立摆。因此,中国是世界上第一个成功完成四级倒立摆实验的国家。 倒立摆的控制问题就是使摆杆尽快地达到一个平衡位置,并且使之没有大的振荡和过大的角度和速度。当摆杆到达期望的位置后,系统能克服随机扰动而保持稳定的位置。 倒立摆系统的输入为小车的位移(即位置)和摆杆的倾斜角度期望值,计算机在每一个采样周期中采集来自传感器的小车与摆杆的实际位置信号,与期望值进行比较后,通过控制算法得到控制量,再经数模转换驱动直流电机实现倒立摆的实时控制。直流电机通过皮带带动小车在固定的轨道上运动,摆杆的一端安装在小车上,能以此点为轴心使摆杆能在垂直的平面上自由地摆动。作用力u平行于铁轨的方向作用于小车,使杆绕小车上的轴在竖直平面内旋转,小车沿着水平铁轨运动。当没有作用力时,摆杆处于垂直的稳定的平衡位置(竖直向下)。为了使杆子摆动或者达到竖直向上的稳定,需要给小车一个控制力,使其在轨道上被往前或朝后拉动。 二级倒立摆:当一个人用手托起一个竹竿使他不倒,类似这种系统就是一个一级倒立摆系统,通过对竹竿的底端的移动让竹竿的重心维持在它的正下方附近摆动,形成一个动态的平衡,使竹竿不会倒下来,如果在这个竹竿上面再顶一个竹竿,使两个竹竿都立在手上不倒(其中一个顶在另一个的上面),这样的系统就叫二级倒立摆系统,倒立摆级别越高,叠起来的竹竿就越多也越难以控制,倒立摆系统一般应用于控制理论的研究

相关文档
最新文档