直线一级倒立摆的自动起摆与稳摆控制

直线一级倒立摆的自动起摆与稳摆控制
直线一级倒立摆的自动起摆与稳摆控制

直线一级倒立摆的自动起摆与稳摆控制(Simulink仿真)通过对倒立摆系统的力学及运动学分析,建立系统的非线性数学模型为

可见,直线一级倒立摆为单输入双输出系统,利用Simulink可建立上式的框图模型,如图1所示。

图1 直线一级倒立摆系统的非线性Simulink模型

倒立摆的起摆问题,是控制理论中的一个经典实验,其实质是倒立摆系统从一个稳定的平衡状态(垂直向下)在外力的作用下自动转移到另一个平衡状态(垂直向上)。在这个过程中,要求起摆快速,但又不能过于超调。由于输入、输出之间的非线性,许多常用的线性控制理论都不适用。基于非线性理论,目前常用的几种起摆方法为:Bang-Bang控制、能量控制、仿人智能控制等。这里采用Bang-Bang控制作为起摆方法,LQR控制作为稳摆方法,Simulink框图如图2所示。

图2 倒立摆自动起摆控制Simulink框图(Bang-Bang + LQR)

图2中,子系统“Inverted Pendulum”是直线一级倒立摆的非线性模型,如图1所示;S函数“ang_proc”模块用于摆杆角度的处理,即将任意角度信号转换为“ -π ~ π”之间的对应值;子系统“Bang-Bang Controller”为Bang-Bang控制器;子系统“LQR Controller”为LQR 控制器。

双击“Bang-Bang Controller”模块可打开Bang-Bang控制器框图如下:

图3 Bang-Bang控制器框图

图3中,bang_controller是为实现Bang-Bang控制算法而编写的S函数,信号Ang_s是Bang-Bang控制切换角,F_bang是Bang-Bang控制作用力。

双击“LQR Controller”子系统,打开LQR控制器框图如下:

图4 LQR控制器框图

运行图2中的仿真框图,则基于Bang-Bang控制和LQR控制算法的直线一级倒立摆自动起摆控制效果如图5所示。

(a)小车位置设定值x=0 (b)小车位置设定值x=1

图5 倒立摆自动起摆控制效果(Bang-Bang + LQR)

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

控制工程与仿真课程设计报告 报告题目直线一级倒立摆建模、分析及控制器的设计 组员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 =

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

单级倒立摆系统的分析与设计 小组成员:武锦张东瀛杨姣 李邦志胡友辉 一.倒立摆系统简介 倒立摆系统是一个典型的高阶次、多变量、不稳定和强耦合的非线性系统。由于它的行为与火箭飞行以及两足机器人行走有很大的相似性,因而对其研究具有重大的理论和实践意义。由于倒立摆系统本身所具有的上述特点,使它成为人们深入学习、研究和证实各种控制理论有效性的实验系统。 单级倒立摆系统(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中仿真

单级倒立摆控制系统设计及simulink仿真 摘要:倒立摆系统是一个典型的多变量、非线性、强藕合和快速运动的自然不稳定系统。因此倒立摆在研究双足机器人直立行走、火箭发射过程的姿态调整和直升机飞行控制领域中有重要的现实意义,相关的科研成果己经应用到航天科技和机器人学等诸多领域。单级倒立摆系统是一种广泛应用的物理模型。控制单级倒立摆载体的运动是保证倒立摆稳定性的关键因素。为了避免常用的物理反馈分析方法和运动轨迹摄像制导控制方法的某些缺点,本文从力学的角度提出对倒立摆的运动进行纯角度制导分析,完成了对倒立摆载体的角度制导运动微分方程的数学建模,设计了该模型的模糊控制系统,并利用Matlab\simulink软件工具对倒立摆的运动进行了计算机仿真。实验表明,这种模糊控制配合代数解析方法的运算速度和计算机仿真的效果均较物理反馈制导控制方法有了一定的提高。该方法可以有效地改善单级倒立摆控制系统的性能。本论文的主要工作是研究了直线一级倒立摆系统的模糊控制问题,用Matlab和Simulink对一级倒立摆模糊控制系统进行了仿真,验证了设计的可行性。本文论述了一级倒立摆数学建模方法,推导出他们的微分方程,以及线性化后的状态方程。讨论了单级倒立摆系统的模糊控制方法和操作步骤。用Simulink实现了单级倒立摆模糊控制仿真系统,分别给出一级倒立摆系统控制量的响应曲线。通过仿真说明控制器的有效性和实现性。关键词:单级倒立摆;仿真;模糊控制;运动;建模;Simulink Design of single stage inverted pendulum control system and Simulink simulation Abstract: inverted pendulum system is unstable system with a typical multi variable, nonlinear, strong coupled and fast motion. So the research on the attitude adjustment of the double foot robot and the attitude adjustment of the rocket launching process and the helicopter flight control field have practical,significance. The related scientific research achievements have been applied to many fields such as aerospace science and robotics. Single inverted pendulum system is a widely used physical model. Controlling the movement of the single inverted pendulum is the key factor to guarantee the stability of the inverted pendulum. In order to avoid some shortings of mon physical feedback analysis method and motion trajectory camera guidance control method, this paper presents a pure angle guidance analysis on the motion of the inverted pendulum, and designs the

一阶倒立摆控制系统

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

目录 摘要 (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)

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

研究生《现代控制理论及其应用》课程小论文 一级倒立摆的建模与控制分析 学院:机械工程学院 班级:机研131 姓名:尹润丰 学号: 201321202016 2014年6月2日

目录 1. 问题描述及状态空间表达式建立..............................................................- 1 - 1.1问题描述.......................................................................................................................................- 1 - 1.2状态空间表达式的建立...............................................................................................................- 1 - 1.2.1直线一级倒立摆的数学模型 ..........................................................................................- 1 - 1.2.2 直线一级倒立摆系统的状态方程 .................................................................................- 5 - 2.应用MATLAB分析系统性能 .....................................................................- 6 - 2.1直线一级倒立摆闭环系统稳定性分析 ......................................................................................- 6 - 2.2 系统可控性分析.........................................................................................................................- 7 - 2.3 系统可观测性分析.....................................................................................................................- 8 - 3. 应用matlab进行综合设计.........................................................................- 8 - 3.1状态反馈原理...............................................................................................................................- 8 - 3.2全维状态反馈观测器和simulink仿真 .......................................................................................- 9 - 4.应用Matlab进行系统最优控制设计 ........................................................ - 11 - 5.总结 ............................................................................................................. - 13 -

单级旋转倒立摆系统

《现代控制理论》课程综合设计 单级旋转倒立摆系统 1 引言 单级旋转倒立摆系统一种广泛应用的物理模型,其物理模型如下:图示为单级旋转倒立摆系统原理图。其中摆的长度1l =1m ,质量1m =0.1kg ,横杆的长度2l =1 m ,质量2m =0.1kg ,重力加速度20.98/g m s =。以在水平方向对横杆施加的力矩M 为输入,横杆相对参考系产生的角位移1θ为输出。控制的目的是当横杆在水平方向上旋转时,将倒立摆保持在垂直位置上。 图1 单级旋转倒立摆系统模型 单级旋转倒立摆可以在平行于纸面3600的范围内自由摆动。倒立摆控制系统的目的是使倒立摆在外力的推动下,摆杆仍然保持竖直向上状态。在横杆静止的状态下,由于受到重力的作用,倒立摆的稳定性在摆杆微小的扰动下,就会使倒立摆的平衡无法复位,这时必须使横杆在平行于纸面的方向通过位移产生相应的加速度。作用力与物体位移对时间的二阶导数存在线性关系,故单级倒立摆系统是一个非线性系统。 本文综合设计以以在水平方向对横杆施加的力矩M 为输入,横杆相对参考系产生的角位移1θ为输出,建立状态空间模型,在原有系统上中综合带状态观测器状态反馈系统,从而实现当横杆在旋转运动时,将倒立摆保持在垂直位置上。 2 模型建立 本文将横杆和摆杆分别进行受力分析,定义以下物理量:本文将横杆和摆杆

分别进行受力分析,定义以下物理量:M 为加在横杆上的力矩;1m 为摆杆质量; 1l 为摆杆长度;1I 为摆杆的转动惯量;2m 为横杆的质量;2l 为横杆的长度;2I 为横杆的转动惯量;1θ为横杆在力矩作用下转动的角度;2θ为摆杆与垂直方向的夹角;N 和H 分别为摆杆与横杆之间相互作用力的水平和垂直方向的分量。倒立摆模型受力分析如图2所示。 图2 倒立摆模型受力分析 摆杆水平方向受力平衡方程: 2 111222(0sin )2 l d N m l dt θθ=++ (1θ2l —横杆的转动弧长即位移) 摆杆垂直方向受力平衡方程: 211 1122(cos )22 l l d H m g m dt θ-=- 摆杆转矩平衡方程: 22111222sin cos 22 d l l J H N dt θθθ=- 横杆转矩平衡方程: 21 222 d M Nl J dt θ-= N

单级倒立摆稳定控制实验

单级倒立摆稳定控制实验 一.实验目的 1.了解单级倒立摆的原理与数学模型的建立; 2.掌握LQR控制器的设计方法; 3.掌握基于LQR控制器的单级倒立摆稳定控制系统的仿真方法。 二.实验内容 图1 一级倒立摆原理图 一级倒立摆系统的原理框图如上所示。系统包括计算机、运动控制卡、伺服机构、倒立摆本体和光电码盘几大部分,组成了一个闭环系统。光电码盘1将连杆的角度、角速度信号反馈给伺服驱动器和运动控制卡,摆杆的角度、角速度信号由光电码盘2反馈回控制卡。计算机从运动控制卡中读取实时数据,确定控制决策,并由运动控制卡来实现该控制决策,产生相应的控制量,驱动电机转动,带动连杆运动,保持摆杆的平衡。 在忽略了空气阻力,各种摩擦之后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统,如下图2所示。 图2 直线一级倒立摆系 统

其中: M 小车质量 m 摆杆质量 b 小车摩擦系数 l 摆杆转动轴心到杆质心的长度 I 摆杆惯量 F 加在小车上的力 x 小车位置 φ 摆杆与垂直向上方向的夹角 θ 摆杆与垂直向下方向的夹角(考虑到摆杆初始位置为竖直向下) 下图是系统中小车和摆杆的受力分析图。其中,N 和P 为小车与摆杆相互作用力的水平和垂直方向的分量。 注意:在实际倒立摆系统中检测和执行装置的正负方向已经完全确定,因而矢量方向定义如图所示,图示方向为矢量正方向。 图3 (a )小车隔离受力图; (b ) 摆杆隔离受力图 分析小车水平方向所受的合力,可以得到以下方程: Mx F bx N =--&&& (1) 由摆杆水平方向的受力进行分析可以得到下面等式: ()2 2sin d N m x l dt θ=+ (2) 即:2cos sin N mx ml ml θθθθ=+-&&&&&

单级倒立摆

2011级自动化1班 杨辉云 P111813841 一级倒立摆的模糊控制 一.倒立摆的模型搭建 1. 单级倒立摆系统的数学模型 对于单级倒立摆,如果忽略了空气阻力和各种摩擦阻力之后,可将直线一级倒立摆系统抽象成沿着光滑导轨运动的小车和通过轴承链接的均质摆杆组成,如图所示,其中小车的质量M=1.40kg ,摆杆质量m=0.08kg ,摆杆质心到转动轴心距离L=0,.2m ,摆杆与垂直向下方向的夹角为,小车华东摩擦系数 f c =0.1。 摆杆 θ 传送带 导轨 直线单级倒立摆 2. 倒立摆控制系统数学模型的建立方法利用PID 控制和拉格朗日方程两种建模。 一级倒立摆系统的拉格朗日方程应为 L (q ,。 .q )=V (q ,。 q )—G (q ,。 q ) (1) 式中:L 是拉格朗日算子,V 是系统功能;G 系统势能。 dt d x ??L — x ??L + x ??D = fi (2)

式中:D 是系统耗散能, f c 为系统的第i 个广义坐标上的外力。 一级倒立摆系统的总动能为: V=θθcos x ml ml 3 2)(212 22。。。+++x m M (3) 一级倒立摆系统的势能为: G=θcos mgl θ (4) 一级倒立摆系统的耗散能为: D= 2 2 1 。x f c (5) 一级倒立摆系统的拉格朗日方程为: 0=??+??-??θ θθD L L dt d (6) F X D X L X L dt d =??+??-?? (7) 将(1)到(5)式带入(6)式得到如下: 0sin sin sin cos m 3 422=-+。。。。。。 ——θθθθθθθθmgl x ml x ml x l ml (8) (M+m )F x ml ml x f c =+ +θθθθsin cos 2。 。 — (9) 一级倒立摆系统有四个变量:。 。,,, θθx x 根据(7)式中的方程写出系统的状态方程,并在平衡点进行线性化处理,得 到系统的状态空间模型如下: =。X ? ?????0 000 0189.000748 .01-- 579.20 386.00 ??????0100+x ? ???? ? ??? ???-8173.007467 .00

一级倒立摆【控制专区】系统设计

基于双闭环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 θθ=+=-

单级倒立摆控制的极点配置方法

一级倒立摆控制的极点配置方法 摘要 倒立摆系统是一个典型的多变量、非线性、强耦合和快速运动的自然不稳定系统。因此倒立摆在研究双足机器人直立行走、火箭发射过程的姿态调整和直升机飞行控制领域中有重要的现实意义,相关的科研成果己经应用到航天科技和机器人学等诸多领域。 本文通过极点配置, 实现了用现代控制理论对一级倒立摆的控制。利用牛顿第二定律及相关的动力学原理等建立数学模型,对小车和摆分别进行受力分析,并采用等效小车的概念,列举状态方程,进行线性化处理想, 最后通过极点配置,得到变量系数阵。利用Simulink建立倒立摆系统模型,特别是利用Mask封装功能, 使模型更具灵活性,给仿真带来很大方便。实现了倒立摆控制系统的仿真。仿真结果证明控制器不仅可以稳定倒立摆系统,还可以使小车定位在特定位置。 关键词:倒立摆,数学建模,极点配置

THE POLE PLACEMENT CONTROL TO A SINGLE INVERTED PENDULUM Abstract Inverted pendulum system is multivariable, nonlinear, strong-coupling and instability naturally. The research of inverted pendulum has many important realistic meaning in the research such as, the walking of biped robot, the lunching process of rocket and flying control of helicopter, and many correlative productions has applications in the field of technology of space flight and subject of robot. Through the pole placement method, the control of the inverted pendulum is realized. We get the mathematic model according to the second law of Newton and the foundation of the dynamics, analysis the force of the cart and pendulum, and adopt the concept of "the equivalent cart”. During writing the equitation of the system, the equitation has been processed by linear. At last,we get coefficient of the variability. The simulation of inverted pendulum system is done by the SIMULINK Tool box. Specially Mask function is applied, it makes simulation model more agility, the simulation work become more convenient. The result shows that it not only has quite goods ability, but also is able to make the cart of the pendulum moving to the place where it is appointed by us in advance along the orbit. Key words: inverted pendulum, mathematic model, pole placement

一级直线倒立摆系统模糊控制器设计---实验指导书

一级直线倒立摆系统模糊控制器设计 实验指导书

目录 1 实验要求................................................................................. . (3) 1.1 实验准备................................................................................. . (3) 1.2 评分规则................................................................................. . (3) 1.3 实验报告容................................................................................. .. (3) 1.4 安全注意事项................................................................................. .. (3) 2 倒立摆实验平台介绍................................................................................. .. (4) 2.1 硬件组成................................................................................. . (4) 2.2 软件结构................................................................................. . (4) 3 倒立摆数学建模(预习 容) .............................................................................. (6) 4 模糊控制实验................................................................................. (8) 4.1 模糊控制器设计(预习容)............................................................................... (8) 4.2 模糊控制器仿真................................................................................. (12) 4.3 模糊控制器实时控制实验................................................................................. .. (12) 5 附录:控制理论中常用的MATLAB 函

单级倒立摆经典控制系统

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

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

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

直线一级倒立摆控制 一、课程设计目的 学习直线一级倒立摆的数学建模方法,运用所学知识设计PID控制器,并应用MATLAB进行仿真。通过本次课程设计,建立理论知识与实体对象之间的联系,加深和巩固所学的控制理论知识,增加工程实践能力。 二、课程设计要求 1. 应用动力学知识建立直线一级倒立摆的数学模型(微分方程形式),并建立系统的开环传递函数模型。 2. 运用经典控制理论知识,按设计要求设计控制器。 3. 应用MATLAB的Simulink建立控制系统的仿真模型,得出仿真结果。 4. 控制要求: ※小车的位置x和摆杆角度的稳定时间小于10秒; ※阶跃响应摆杆角度的摆幅小于2°; ※θ有≤8°扰动时,摆杆的稳定时间小于三秒。 对比仿真结果与控制要求,修正设计值,使之满足设计要求。 三、控制系统建模过程 1、控制对象示意图

/ 10 1 图1.控制对象示意图 图中对象参数: M 小车质量 1.32kg l 摆杆转动中心到杆质心的距离 0.27m m 摆杆质量 0.132kg F 作用在系统上的外力

/ 10 2 X 小车位移 θ 摆杆与竖直方向的夹角,以垂直向上为起始位置,取逆时针方向为正方向。 b 小车摩擦阻尼系数 0.1N/m/sec 2. 控制系统模拟结构图: 图2.系统的模拟结构图 其中G1(s )表示关于摆角θ的开环传递函数,D(S) 表示PID 控制器的传递函数,G2(s )表示小车位移x 的传递函数。由于摆角与垂直向上方向夹角为0时为平衡状态,故摆角的理想输出值应为R (S )=0。 3. 建模过程: T 图3.小车及摆杆的受力分析图 如图3所示,对小车及摆杆进行受力分析,得到以下平衡方程: 对小车有: 22..................................(1)dx d x F F b N M dt dt =--=∑小车 对摆杆有:

直线一级倒立摆的自动起摆与稳摆控制

直线一级倒立摆的自动起摆与稳摆控制(Simulink仿真)通过对倒立摆系统的力学及运动学分析,建立系统的非线性数学模型为 可见,直线一级倒立摆为单输入双输出系统,利用Simulink可建立上式的框图模型,如图1所示。 图1 直线一级倒立摆系统的非线性Simulink模型 倒立摆的起摆问题,是控制理论中的一个经典实验,其实质是倒立摆系统从一个稳定的平衡状态(垂直向下)在外力的作用下自动转移到另一个平衡状态(垂直向上)。在这个过程中,要求起摆快速,但又不能过于超调。由于输入、输出之间的非线性,许多常用的线性控制理论都不适用。基于非线性理论,目前常用的几种起摆方法为:Bang-Bang控制、能量控制、仿人智能控制等。这里采用Bang-Bang控制作为起摆方法,LQR控制作为稳摆方法,Simulink框图如图2所示。 图2 倒立摆自动起摆控制Simulink框图(Bang-Bang + LQR)

图2中,子系统“Inverted Pendulum”是直线一级倒立摆的非线性模型,如图1所示;S函数“ang_proc”模块用于摆杆角度的处理,即将任意角度信号转换为“ -π ~ π”之间的对应值;子系统“Bang-Bang Controller”为Bang-Bang控制器;子系统“LQR Controller”为LQR 控制器。 双击“Bang-Bang Controller”模块可打开Bang-Bang控制器框图如下: 图3 Bang-Bang控制器框图 图3中,bang_controller是为实现Bang-Bang控制算法而编写的S函数,信号Ang_s是Bang-Bang控制切换角,F_bang是Bang-Bang控制作用力。 双击“LQR Controller”子系统,打开LQR控制器框图如下: 图4 LQR控制器框图 运行图2中的仿真框图,则基于Bang-Bang控制和LQR控制算法的直线一级倒立摆自动起摆控制效果如图5所示。 (a)小车位置设定值x=0 (b)小车位置设定值x=1 图5 倒立摆自动起摆控制效果(Bang-Bang + LQR)

基于PID控制的一级倒立摆系统的研究

本科生毕业设计(论文) 论文题目:基于PID控制的一级倒立摆系统的研究 姓名: 学院: 专业: 班级、学号: 指导教师:

摘要 本文的研究对象为一级倒立摆系统,主要是基于PID控制的一级倒立摆控制系统的设计。利用PID参数整定的多种方法对PID的三个参数进行调节,并对其优化,然后用利用Matlab对其进行仿真,并对最后仿真图的结果进行分析与比较。 倒立摆是一种典型的非线性、多变量、强耦合、快速的、自然不稳定的系统。在实际生产生活中有很多类似的系统,故研究一级倒立摆系统的PID控制具有很大的实际意义。本文介绍了多种PID参数整定算法,主要采用了的是Z-N整定法,并详细介绍了PID参数整定算法的相关理论和具体操作方法。在本文中还建立了一级倒立摆的数学模型和物理模型。本文着重讲述了Z-N整定法和试凑法对PID三个参数的进行优化的具体方法。用Matlab对一级倒立摆系统进行了仿真,并且比较这些方法的优缺点,对最后的仿真图结果研究和分析。得出PID参数整定方法的优缺点。 关键词: PID控制器参数整定一级倒立摆 Matlab仿真

Abstract Object of this paper is an inverted pendulum system is mainly based on PID control an inverted pendulum control system design. Use a variety of PID parameter tuning method to adjust the three parameters of PID, and its optimization, and then use them using matlab simulation, and the results of the last simulation diagram analysis and comparison. Inverted pendulum is a typical non-linear, multi-variable, strong coupling, fast, naturally unstable system. In real life there are a lot of similar production systems, it is of an inverted pendulum system PID control has great practical significance. This article describes a variety of PID parameter tuning algorithm, the main use of the Z-N entire titration, and details of the PID parameter tuning algorithms related theory and specific methods of operation. In this article, also established a mathematical model of the inverted pendulum and physical models. This paper focuses on the ZN Tuning Method for PID and genetic algorithms to optimize the three parameters of specific methods. Using Matlab on an inverted pendulum system is simulated, and compare the advantages and disadvantages of these methods, drawing on the final results of the simulation study and

相关文档
最新文档