直线倒立摆的稳定控制算法设计.docx
- 文档编号:8885446
- 上传时间:2023-05-15
- 格式:DOCX
- 页数:14
- 大小:67.60KB
直线倒立摆的稳定控制算法设计.docx
《直线倒立摆的稳定控制算法设计.docx》由会员分享,可在线阅读,更多相关《直线倒立摆的稳定控制算法设计.docx(14页珍藏版)》请在冰点文库上搜索。
直线倒立摆的稳定控制算法设计
本科毕业设计(论文)
题目:
直线倒立摆的稳定控制算法设计
如需要完整文档及cad图等其他文件,请加球球:
一九八五六三九七五五
2013年5月
直线倒立摆的稳定控制算法设计
摘要
本文首先利用牛顿力学分析的方法和拉格朗日法建立了直线一级、二级、三级倒立摆实物系统的线性状态方程,并在此基础上分析了该系统是不稳定的,同时又是能控的和能观的。
基于此本文设计了直线倒立摆系统的机械本体部分,研究了直线一级、二级、三级倒立摆系统的PID、LQR和状态空间极点配置控制算法,同时利用MATLAB/Simulink对各个算法进行分析,由仿真结果表明:
对于像倒立摆这样的非线性模型,通过对其数学模型的建立,设计相应的控制器,并对其实现控制是可行的。
关键词:
直线倒立摆;PID;LQR;状态空间极点配置;仿真
Thestabilityoflinearinvertedpendulumcontrolalgorithmdesign
Abstract
Inthispaper,wefirstlyusetheNewtonmechanicsanalysismethodandtheLagrangemethodtoestablishthelinearlevel1,level2,level3invertedpendulumlinearstateequationofrealsystem.Inthemeantime,thesystemisunstablebyanalyzingthelinearstateequation,butitisalsocontrollableandobservable.Andthenwedescribeonthephysicalsystemofthelinearinvertedpendulum.Thispaperstudiedthelinearlevel1,level2,level3oftheinvertedpendulumsystemPID,LQRandstatespacepoleassignmentcontrolalgorithm,atthesametimeanalyzevariousalgorithmswithMATLAB/Simulink.Bythesimulationresultsshowthat:
Besimilarytoinvertedpendulumisforthenon-linearmodel,throughitsmathematicalmodel,theappropriatedesignofcontroller,andinitsimplementationcontrolisfeasiblly.
Keywords:
linearinvertedpendulum;PID;LQR;statespacepoleconfiguration;
simulation
目录
1绪论1
1.1前言1
1.2倒立摆系统研究背景及意义1
1.3国内外倒立摆控制研究发展及现状2
1.4本文主要工作4
2倒立摆机械系统设计及实现5
2.1倒立摆简介5
2.2倒立摆工作特性和工作原理5
2.2.1工作特性5
2.2.2系统工作原理5
2.3系统机械结构设计6
2.3.1底座设计6
2.3.2小车部分设计6
2.3.3传动部分设计7
2.3.4步进电机选择7
3一级直线倒立摆系统的建模分析与仿真10
3.1一级倒立摆模型分析10
3.1.1系统可观可控性分析13
3.1.2系统阶跃响应分析14
3.2一级直线倒立摆控制器设计与仿真15
3.2.1PID控制器设计及算法仿真15
3.2.2LQR控制器设计及算法仿真18
3.2.3状态空间极点配置控制设计及仿真20
3.2.4小结22
4二级直线倒立摆系统的建模分析与仿真24
4.1二级倒立摆模型的分析24
4.1.1二级倒立摆稳定性分析29
4.1.2能控性能观性分析29
4.2二级直线倒立摆控制器设计与仿真30
4.2.1LQR控制器设计及算法仿真30
4.2.2状态空间极点配置控制设计及仿真31
4.2.3小结32
5三级直线倒立摆系统建模分析与仿真34
5.1二级倒立摆模型分析34
5.1.1三级倒立摆稳定性分析39
5.1.2能控性能观性分析39
5.2三级直线倒立摆控制器设计与仿真40
5.2.1LQR控制器设计及算法仿真40
5.2.2状态空间极点配置控制设计及仿真41
5.2.3小结43
6总结与展望44
参考文献45
致谢46
毕业设计(论文)知识产权声明47
毕业设计(论文)独创性声明48
附录49
1绪论
1.1前言
倒立摆系统是一个非线性自然不稳定系统,是进行控制理论教学及开展各种控制策略的理想验证平台。
倒立摆系统的高阶次、不稳定、多变量、非线性和强藕合等特性,使得许多现代控制理论研究人员一直将它视为最佳的理论方法验证试验研究对象,不断从研究倒立摆控制中发掘出新的控制方法,并将其应用于航天科技、机器人学、海上钻井平台、火箭发射中的垂直度控制和卫星飞行中的姿态控制、太空探测器着陆控制和测量仪器展开稳定控制等各种高新科技领域[1]。
倒立摆系统在控制过程中能有效地反映控制中的许多关键问题,如非线性问题、系统的鲁棒性问题、随动问题、镇定问题及跟踪问题等。
作为一个实验装置,形象直观,结构简单,构件组成参数和形状易于改变,成本低廉。
倒立摆系统的控制效果可以通过其稳定性直观地体现,也可以通过摆杆角度、小车位移和稳定时间直接度量,其实验效果直观、显著。
1.2倒立摆系统研究背景及意义
对倒立摆系统的研究不仅仅在其结构简单、原理清晰、易于实现等特点,而且作为典型的多变量系统,可采用实验来研究控制理论中许多方面的问题。
在稳定性控制问题上,倒立摆既具有普遍性又具有典型性。
倒立摆的典型性在于,倒立摆系统作为一个控制装置,它结构简单、价格低廉,便于模拟和数字多种不同的方式控制,通过引入适当的控制方式使之成为一个稳定的系统,而且当一种新的控制理论和方法提出以后,在不能用理论加以严格证明时,可以考虑通过倒立摆装置来验证其正确性和实用性。
另一方面对系统的研究也比较有实用价值,从日常生活中所见的任何重心在上、支点在下的控制问题,到空间飞行器和各类伺服云台的稳定,都和倒立摆的控制有很大的相似性。
倒立摆的研究不仅有其深刻的理论意义,还有重要的工程背景。
它的工程背景如下:
(1)机器人的站立与行走类似双倒立摆系统,尽管第一台机器人在美国问
世至今已有三十年的历史,机器人的关键技术——机器人的行走控制至今仍未能很好解决。
(2)在火箭等飞行器的飞行过程中,为了保持其正确的姿态,要不断进行
实时控制。
(3)通信卫星中在预先计算好的轨道和确定的位置上运行的同时,要保持
其稳定的姿态,使卫星天线一直指向地球,使它的太阳能电池板直指向太阳。
(4)为防止单级火箭在拐弯时断裂而诞生的柔性火箭(多级火箭),其飞
行姿态的控制也可以用多级倒立摆系统进行研究。
(5)侦察卫星中摄像机的轻微抖动会对摄像的图象质量产生很大的影响,
为了提高摄像的质量,必须能自动地保持伺服云台的稳定,消除震动。
1.3国内外倒立摆控制研究发展及现状
在国外,倒立摆系统研究最早始于上世纪50年代,麻省理工学院机电工程系的控制论专家根据火箭发射助推器原理设计出一级倒立摆实验装置。
但是正式提出倒立摆概念的是在60年代后期。
在此基础上,世界各国专家和学者对倒立摆进行了拓展,产生了直线二级倒立摆、三级倒立摆、多级倒立摆、柔性直线倒立摆、环形倒立摆、平面倒立摆、环形并联多级倒立摆以及斜坡倒立摆等实验设备,并用不同的控制方法对其进行了控制。
1976年Morietc首先把倒立摆系统在平衡点附近线性化,利用状态空间方法设计比例微分控制器实现了一级倒立摆的稳定控制[2]。
1992年,Furuta等人应用最优状态调节器理论首次实现双电机三级倒立摆实物控制[3]。
80年代后期开始,较多的研究了倒立摆系统中的非线性特性,提出了一系列的基于非线性分析的控制策略,1993年,Wiklund等人应用基于李亚普诺夫的方法控制了环形一级倒立摆[4]。
国内对倒立摆的研究始于80年代,三级倒立摆及多级倒立摆的研究也取得了很大进展,不仅在系统仿真方面,而且在实物实验中,都出现了控制成功的范例。
尹征琦等成功的以模拟的降维观测器实现了二级倒立摆的控制[5]。
梁任秋等针对二级倒立摆系统给出了三种实用的数字控制器和降维观测器[6]。
1994年,北京航空航天大学教授张明廉将人工智能与自动控制理论相结合,提出“拟人智能控制理论”,实现了用单电动机控制三级倒立摆实物以及后来实现对二维单倒立摆控制[7]。
2005年,罗成等人实现了五级倒立摆的控制[8]。
对倒立摆这样的一个典型被控对象进行研究,它在理论上和方法上都具有重要意义。
不仅由于其级数增加而产生的控制难度是对人类控制能力的有力挑战,更重要的是实现其控制稳定的过程中不断发现新的控制方法、探索新的控制理论,并进而将新的控制方法应用到更广泛的受控对象中。
各种控制理论和方法都可以在这里得以充分实践,并且可以促成相互间的有机结合。
当前倒立摆的控制方法可分为以下几类:
(1)线性理论控制方法将倒立摆系统的非线性模型进行近似线性化处理,获得系统在平衡点附近的线性化模型,然后再利用各种线性系统控制器设计方法得到期望的控制器。
PID控制、状态反馈控制、LQR控制算法是其典型代表。
这类方法对一二级的倒立摆(线性化后误差较小模型较简单)控制时,可以解决常规倒立摆的稳定控制问题。
但对于像非线性较强、模型较复杂的多变量系统(三四级以及多级倒立摆)线性系统设计方法的局限性就十分明显,这就要求采用更有效的方法来进行合理的设计。
(2)预测控制和变结构控制方法由于线性控制理论在倒立摆控制中的局限性,使得研究者不得不去寻求更加有效的控制方法,于是先后开展了预测控制、变结构控制和自适应控制的研究。
预测控制是一种优化控制方法,强调的是模型的功能而不是结构。
变结构控制是一种非连续控制,可将控制对象从任意位置控制到滑动曲面上仍然保持系统的稳定性和鲁棒性,但是系统存在颤抖。
预测控制、变结构控制和自适应控制在理论上有较好的控制效果,但由于控制方法复杂、成本也高,不易在快速变化的系统上实时实现[9]。
(3)智能控制方法在倒立摆系统中用到的智能控制方法主要有神经网络控制、模糊控制、仿人智能控制、拟人智能控制和云模型控制等。
神经网络控制神经网络能够任意充分地逼近复杂的非线性关系,NN能够学习与适应严重不确定性系统的动态特性,所有定量或定性的信息都等势分布贮存于网络内的各种神经元,故有很强的鲁棒性和容错性;也可将Q学习算法和BP神经网络有效结合,实现状态未离散化的倒立摆的无模型学习控制。
但是神经网络控制方法存在的主要问题是:
缺乏一种专门适合于控制问题的动态神经网络,而且多层网络的层数、隐层神经元的数量、激发函数类型的选择缺乏指导性原则等。
模糊控制经典的模糊控制器利用模糊集合理论将专家知识或操作人员经验形成的语言规则直接转化为自动控制策略(通常是专家模糊规则查询标),其设计不依靠对象精确的数学模型,而是利用其语言知识模型进行设计和修正控制算法。
常规的模糊控制器的设计方法有很大的局限性,首先,难以建立一组比较完善的多维模糊控制规则,即使能凑成这样一组不完整的粗糙的模糊控制规则,其控制效果也是难以保证的。
但是模糊控制结合其他控制方法就可能产生比较理想的效果。
拟人智能控制模糊控制、神经网络控制等智能控制理论的问世促进了当代自动控制理论的发展。
然而,基于这些智能控制理论所设计的系统往往需要庞大的知识库和相应的推理机,不利于实现实时控制。
这又阻碍了智能控制理论的发展,因此,又有学者提出了一种新的理论——拟人控制理论。
拟人智能控制的核心是“广义归约”和“拟人”。
“归约”是人工智能中的一种问题求解方法。
这种方法是将等求解的复杂问题分解成复杂程度较低的若干问题集合,再将这些集合分解成更简单的集合,依此类推,最终得到一个本原问题集合,即可以直接求解的问题。
另一核心概念是“拟人”,其含义是在控制规律形成过程中直接利用人的控制经验直觉推理分析。
仿人智能控制仿人智能控制的基本思想是通过对人运动控制的宏观结构和手动控制行为的综合模仿,把人在控制中的“动觉智能”模型化,提出了仿人智能控制方法。
研究结果表明,仿人智能控制方法解决复杂、强非线性系统的控制具有很强的实用性。
云模型控制利用云模型实现对倒立摆的控制,用云模型构成语言值,用语言值构成规则,形成一种定性的推理机制。
这种拟人控制不要求给出被控对象精确的数学模型,仅仅依据人的经验、感受和逻辑判断,将人用自然语言表达的控制经验,通过语言原子和云模型转换到语言控制规则器中,就能解决非线性问题和不确定性问题[10]。
1.4本文主要工作
本论文的主要工作是设计了直线倒立摆系统的机械本体部分,并分别进行PID,线性二次最优控制,状态空间极点配置控制算法的设计,用MATLAB对一级、二级、三级倒立摆控制系统进行了仿真,验证了设计的可行性。
具体内容如下:
(1)详细论述了一级、二级、三级直线倒立摆数学建模方法,推导出它们的微分方程,以及线性化后的状态方程。
(2)分析了倒立摆系统的控制方法。
分别用现代控制理论及经典控制理论对直线倒立摆的位置控制和角度控制进行分析。
利用MATLAB仿真系统,讨论出现的问题及解决方法。
(3)设计绘制了直线倒立摆的装配图。
(4)对论文工作进行总结和展望。
2倒立摆机械系统设计及实现
2.1倒立摆简介
倒立摆系统包含倒立摆本体、电控箱及由运动控制卡和普通PC机组成的控制平台等三大部分。
直线倒立摆本体由底座、电机、同步带、带轮、滑竿、小车、摆杆、角编码器等组成。
小车由电机通过同步带驱动在滑杆上来回运动,保持摆杆平衡。
电机编码器和角编码器向运动控制卡反馈小车和摆杆位置(线位移和角位移)。
电气控制箱由电机驱动器、I/O接口板、开关电源、开关和指示灯等电气元件组成。
控制平台由PC机、运动控制卡、运动控制卡用户接口软件等组成。
2.2倒立摆工作特性和工作原理
2.2.1工作特性
倒立摆从形式和结构上来看是多种多样的,但是所有的倒立摆都具有以下的特性:
(1)非线性倒立摆是一个典型的非线性复杂系统,实际中可以通过线性化得到系统的近模型,线性化处理后再控制。
也可以利用非线性控制理论对其进行控制。
倒立摆的非线性控制正成为一个研究的热点。
(2)不确定性主要的模型误差以及机械传动间隙,各种阻力等,实际控制中一般通过减少各种误差来降低不确定性,如通过施加预紧力减少皮带或齿轮的传动误差,利用滚珠轴承减少摩擦阻力等不确定因素。
(3)耦合性倒立摆的各级摆杆之间,以及和运动模块之间都有很强的耦合关系,在倒立摆的控制中一般都在平衡点附近进行解耦计算,忽略一些次要的耦合量。
(4)开环不稳定性
2.2.2系统工作原理
倒立摆系统是由上位机作为控制界面的输出,通过上位机对倒立摆系统的仿真过程进行参数的选改,运动控制卡进行电机反馈和角度编码器的反馈计算,并将参数的反馈发送到电机驱动器,进而控制电机输出。
其工作原理如下图2.1所示:
图2.1直线倒立摆控制系统硬件框图
由图可以看出倒立摆系统是一个闭环系统,图中光电码盘l由伺服电机自带,可以根据该码盘的反馈通过换算获得小车的位移,小车的速度信号可以通过差分得到。
摆杆的角度由光电码盘测量出来并直接反馈到控制卡,角度的变化率信号可以通过差分得到。
计算机从运动控制卡中实时读取数据,确定控制决策(电机的输出力矩),并发送给运动控制卡。
运动控制卡经过DSP内部的控制算法实现该控制决策,产生相应的控制量,使电机转动,带动小车运动,保持摆杆平衡。
2.3系统机械结构设计
2.3.1底座设计
对于底座的设计,选用的是固定式的底座,如图2.2所示:
图2.2固定式底座
它的机构稳固,不会因为机器长时间运行而改变其水平条件,加工也简单,可以直接铸造得到。
2.3.2小车部分设计
为了实现倒立摆摆杆的自由摆动,同时测量摆杆转动角度,需要设计一个铰链来实现。
铰链由转轴、深沟球轴承和轴承座构成,转轴安装在滚动轴承上用来连接摆杆和光电编码器。
为使铰链转动灵活,必须保证轴承座中的两个深沟球轴承同心。
因此,轴承座安装轴承的孔应设计为通孔,并在车床上一次装夹加工完成,以避免产生二次装夹误差。
同时,光电编码器的安装没有选择现有倒立摆实验装置的安装方法即把编码器安装在支架上,而是直接把编码器固定在轴承座的一端,这样可以避免产生新的装配误差。
而且选择此方法还在轴承座加工中增加了一道加工工序,即车完轴承装配孔后将编码器安装面重车一刀,保证编码器安装面与轴承座的轴承安装孔垂直[11]。
转轴的设计直接关系到摆杆铰链的灵活程度,从而影响倒立摆控制的稳定性。
因此,必须保证转轴轴承装配面和编码器轴装配面是同心的。
同时为了保证编码器安装后与转轴同心,转轴的加工工序如下:
首先加工编码器安装孔,然后利用三爪夹盘将转轴固定,利用顶尖在编码器装配孔中以增加转轴在加工中的刚性,最后完成其余加工工序。
要满足小车在轨道上往复运动并尽量减少摩擦,系统采用直线轴承实现。
直线轴承座设计中的关键是保证两个直线轴承座轨道安装面是同心的。
因此,需要先将两个截面为正方形的长方体棒料在车床上利用四爪夹盘装夹,并在正方形截面的中心钻孔,留0.5毫米余量进行精加工,之后进行直线轴座装配。
两个直线轴承外端用孔用弹簧挡圈固定,内端用铝环代替孔用挡圈固定,降低了加工难度。
下图为小车部分的剖面图:
图2.3小车部分剖面图
2.3.3传动部分设计
a.同步带轮装置的设计及装配为了使小车往复运动灵活,提高系统精度,系统选择齿间距为3毫米的同步带。
同步带通过两个皮带轮装置联结以减少直接作用在电机轴的作用力,使整个系统更稳定。
b.电机与同步带装置连接装置为了降低皮带轮与电机轴装配的同心度要求,电机和皮带轮之间用联轴器联结。
这种设计保证了电机轴不受额外扭矩的作用。
2.3.4步进电机选择
步进电机是倒立摆系统中的唯一动力原件,对整个系统至关重要。
步进电机的选型主要是依据其功率、转矩和步距角,而且选择的电机必须具有高速度响应、运行稳定、抖动小等特点[10]。
从电动机角度考虑,电动机受到的主要负载为摩擦负载和惯性负载,摩擦负
载主要来源于作直线运动的倒立摆小车被控对象与运行轨道的摩擦力、传动装置同步带和齿轮之间的摩擦力,惯性负载除了电动机转子的惯性力外,还有摆和小车以及齿轮的惯性力,忽略齿轮的惯性力,现分别计算其它负载力(全部折算到电机轴上)。
电机启动加速力矩:
式中Ma---电机启动加速力矩(N.m)
Jm、Jt---电机自身惯量与负载惯量(Kg.m.s2)
n---电机所需达到的转速(r/min)
T---电机升速时间(s)
摩擦负载力矩:
式中Mf---导轨摩擦折算至电机的转矩(N.m)
u---摩擦系数
η---传递效率
r---与同步带相啮合的齿轮半径.
切削力矩:
估算电机输出的总力矩M=Ma+Mf+0
所以M=0.04+1.32=1.36N.m
在这里由于忽略了同步带与齿轮之间的摩擦及摆杆的惯性力矩,所以对电机的选择:
(1)能满足控制精度的要求
(2)能满足负载转矩的要求
(3)满足惯量的匹配原则
(4)应考虑到这些中间因素应该使得所选电机的额定输出功率=估算值的
2~3倍。
故在实际选型中选择了型号57BYG707的混和式步进电机。
其参数如下:
电压:
4.1V电流:
2.3A
步距角:
转子转动惯量:
230g.m2
重量:
1.0kg最大静转矩:
1.91Nm
与此步进电机配套的驱动器为BL-230M,驱动模块特点有[11]:
(1)适用于电压范围宽(24-40V)。
(2)采用恒流斩波,双极性全桥式驱动。
(3)运行特性良好,自动半流锁定,可靠性高。
(4)细分数可由拨码开关设定1/2,1/16,1/32,1/64,1/5,1/10,1/20,1/40。
(5)适配3A以下两相、四相混合式步进电机。
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 直线 倒立 稳定 控制 算法 设计