考虑执行机构动态的非完整轮式移动机器人镇定控制
两轮差速移动机器人仿人智能自适应Backstepping点镇定控制.pptx
(2)提出了一种具有上下两层结构的仿人智能自适应 Backstepping(HSIAB)点镇定控制器,该控制器上层为基于多模 态仿人智能设计的智能决策控制层,下层为基于牛顿—欧拉法建 立的动力学模型的自适应Backstepping电流控制层,从而起到自 适应调节底层执行电机电流的作用。(3)针对执行器的饱和问题, 设计了电流可控直流电机双闭环调速系统,并搭建了直流电机双 闭环实物平台,在该平台上验证了电机电流可调控制的有效性, 实现了对电机启动加速度的控制,并使两轮差速移动机器人的两 个直流伺服电机系统的控制性能基本一致。
两轮差速移动机器人仿人智能自适应 Backstepping点镇定控制
两轮差速移动机器人具有结构简单、自重轻、承载大、行走速 度快、工作效率高等一系列的突出优点,这使得两轮差速移动机 器人被广泛地应用。两轮差速移动机器人属于典型的运动学非 完整约束系统,其驱动系统存在动力学饱和等非线性特性。
由于机器人车轮与电机的机械间隙、电机与齿轮箱的机械间隙 和电机轴上的黏性摩擦系数变化等因素的影响,导致系统模型参 数具有明显的不确定性。而这些因素往往会使控制系统的控制 效果变差,甚至导致系统不稳定。
因此针对上述问题的两轮差速移动机器人点镇定控制研究具有 重要的理论研究意义和实际应用价值。本文主要完成的研究内 容如下:(1)基于牛顿—欧拉法建立了具有反映机器人车轮与电 机的机械间隙、电机与齿轮箱的机械间隙和电机轴上的黏性摩 擦系数变化等因素的两轮差速移动机器人动力学模型,并分析了 相关系统模型特性。
(4)搭建了两轮差速移动机器人的仿真和实物平台。并在仿真平 台上比较了本文所提出的控制算法与Backstepping点镇定控制 算法的控制效果;在实物平台上比较了本文所提出的控制算法与 多模态仿人智能控制算法的控制效果。
证明了本文所提
非完整移动机器人鲁棒控制方法研究
（ ２ ）
（ ３ ）
（一） ・（ 一 ） 足 嘲 （ 【 ）
∞＝ ｓ（） ｇＰ 一 （ 豢・ｎ 一 （，） ， ｉ ｃ ）
。 一
．（ 】 ｓ） ｉ ｎ
（ ４ ）
取
其 ：ｔ） 二告 中（ ： 卫二 ｇ。 Ｐ ＿
， ） （一）制子 ＞ 得 ， ： 号 ， 因， ， ： （ 控 使
：
（ ）＜０ 晋一 。
（ ４ ）
根据李亚瞢诺夫直接法 ，， Ｉ正定 。， Ｉ 负定 。 因此满足式（ ） ４ 的控制输人［ｒ ］ 可使系统稳定于莱一 １ ｒ
点。
根 式 ２和 （ ， ． 。 一 （ ） 且 续 ￣ｌ ： ＋ 出ｉＩ 詈， 据 （ 式 ５ 知 ， 聋 号一 ≤ｏ 连 ， ｉ ） ） ≥Ｏ ｒ Ｊ ｍ ｏ； ｌ，： ｌ 推 ｍｃ ｉ ｍ
离呈单调关 系； ③识别的 目 标参考点随环境光照变化及摄像机视点动态变化在 目标的有界区域 内变动。
为此， 设计这类机器人运动控制器实现避障与轨迹跟踪一直受到关注［ 。基于 圆弧轨迹的避 障策略 卜引 满足非完整移动机器人运动特性 ， 对非完整轮式机器人有效实现多边形物体避障极 其重要［ ７ 目前 ３ ］ －。 提出的有效实现机器人圆弧轨迹控制的方法有模糊控 制器［ 、 ７ 神经 网络控制器［ 、 于李亚普诺夫稳 ］ Ｂ基 Ｊ
半径为 尺的圆弧 ， 如图中虚弧线所示 。 因此机器人的运动学方程可由式（ ） １ 表示。
收稿 日期 ： ０ — ２ ０ ２ ５ １ —２ ０ 作誊简介 ： 高庆吉（９６ 。 。 １６ 一）男 黑龙江桦 川人 ， 哈尔滨工业大学在读博士研究生 ． 主要从事研机器人导航控制方 面的研究
维普资讯
１ 系统运 动学模 型描述
轮式移动机器人有限时间镇定控制器设计
ａ Ｎｓ ｏ ｔ ｕ ｕ ｅ ｄ ａ ｋ ｃ ｎｒ ｌｌｗｓｉ ｒ ｐ ｓｄ ｂ ｓｎ ｈ ｅ ｍｉ ａ ｈ ｉｇ ｍｏ ｅ ｅ ｎ ｌｍｅ ｌｄ ａｏ ｇ Ｗｌ ｉｃ ｗｉ ｃ ｎｒｌｓｒｔ ｃ ｎｉ ｏ ｓ ｆｅ ｂ ｃ ｏ ｔｏ ａ ｓｐｏ ｏｅ ｙ ｕ ｉｇｔ ｅｔｒ ｎ ｌｓ ｄｒ ｄ ｏ ￣ｏ ｔｏ ｌ ｎ ｔ ａ ｐｅ ｃ ￣ ｏ ｔｏ ｔａｅ— ｎ ￣ ｉ ｈ ｇ ．Ｔｈ ｈ ｉｅ ｙ ｔｍ ｓ ｆ ｉｅ ｔ ｅ ｔｂｉｚ ｄ ｄ ｅ ｔ ｈ ｎｔ— ｍｅ ｃ ｎ ｅ ｇ ｎ ｅ ｐ ｐ ｒ ｆｔｅ ｔｍ ｆ ａ ｌｌｎ ｉｂ Ｙ ｅ ｃ ａｎ ｄ ｓ ｓｅ ｉ ｎ ｔ—ｉ ｓａ ｌ ｅ ｕ ｏ ｔｅ ｆ ｉ ｔ ｏ ｖ ｒｅ ｃ ｒ ｅ ｔ ｏ ｈ ｅ ｉ ｌｓｉ ｇ ｎｏ ｅ． Ｆｉａｌ ｔｅ ｉ ｍ ｉ ｉ ｅｉ ｏ ｙ ｎ ￣ ｉ ｎ ｌｙ， ｈ
中 图 分 类 号 ：Ｐ４ Ｔ ２２ 文献 标 识 码 ： Ａ
Ｆ ｎ ｔ —ｉ ｅ Ｓ ａ ｉ ｚ ｔ０ ｎ ｒ ｌ ｒ ｆ ｒ Ｗ ｈ ｅ ｅ ｏ ｉｅ Ｒｏ ｏ ｓ ｉ ｉｅ ｔ ｍ ｔ ｂ ｌ ａ ｉ ｎ Ｃｏ ｔ ｏ ｌ ｏ ｉ ｅ ｅ ｌｄ Ｍ ｂ ｌ ｂ ｔ
ＺＨＵ ａ＿ａ． ｏｃ ｉＤＯＮＧ Ｏ ｈ ａ， ＧＵ － ｕ ＨＵ — ｎ Ｄｅ ｗｅ
维普资讯
不确定轮式移动机器人的任意轨迹跟踪
不确定轮式移动机器人的任意轨迹跟踪庞海龙;马保离【摘要】本文研究参数不确定轮式移动机器人的任意轨迹跟踪统一控制问题.通过引入坐标变换、输入变换和辅助动态,将机器人模型转换为合适的形式;进而运用Lyapunov方法和自适应技术设计了一种自适应统一控制器,该控制器可以保证跟踪误差全局一致最终有界,且最终界大小可以通过调整控制器参数而任意调节.仿真结果验证了控制律的有效性.【期刊名称】《控制理论与应用》【年(卷),期】2014(031)003【总页数】8页(P285-292)【关键词】轮式移动机器人;统一控制器;实际稳定;自适应控制【作者】庞海龙;马保离【作者单位】北京航空航天大学自动化科学与电气工程学院,北京100191;北京航空航天大学自动化科学与电气工程学院,北京100191【正文语种】中文【中图分类】TP273轮式移动机器人的控制问题因其理论挑战性和广泛的实际应用价值而吸引了大批研究者.轮式移动机器人受到纯滚动约束,是典型的非完整系统.其基本运动控制目标可以表述为:1)两个位姿间的移动; 2)跟踪一个给定的时间轨迹;3)跟踪一个给定的几何路径.从控制的角度看,由于不存在连续时不变纯状态反馈实现非完整机器人位姿的渐近镇定[1],因此位姿镇定要难于轨迹跟踪和路径跟踪;同时也意味着,似乎有必要针对不同的控制任务设计不同的控制律.已有很多文献研究了机器人的镇定问题.Bloch等为几种不同类型的非完整系统设计了分段时不变连续控制律,实现了局部定点镇定[2].Canudas de Wit等为非完整机器人设计了全局指数镇定控制律[3]. Samson为二轮车设计了光滑时变反馈控制器,实现了局部渐近镇定[4].Jiang和Samson为一类非完整系统设计了全局渐近反馈控制律[5–6].为了使光滑时变控制器实现快速响应,Godhavn和M’Closkey等为一类非完整系统设计了局部指数镇定控制律[7–8]. Escober等为磁场定向感应电机设计了指数镇定控制律[9].Dixon等利用动态振荡器为轮式移动机器人设计了全局指数镇定控制器[10].机器人的跟踪问题也得到了广泛深入地研究. Kanayama等为自主移动机器人设计了光滑反馈控制律,实现了局部渐近跟踪[11].Walsh等为相似的线性化模型设计了局部指数跟踪控制律[12].在角加速度可测条件下,Jiang等为移动机器人设计了全局渐近跟踪控制器[13];在不必测量角加速度的情况下,为一般链式系统设计了半全局和全局渐近跟踪控制律[14].同时,文献[15–17]提出了不同的路径跟踪控制策略. 然而,笔者不希望使用不同的控制器完成不同的控制任务,而是希望机器人在不同的控制器之间连续切换.例如对于常见的进坞操作,笔者期望机器人按照预设的几何轨迹到达期望的位置和姿态.因此希望利用单一控制器同时实现轨迹跟踪与定点镇定. 一些学者已对统一控制问题进行了研究,以下简要介绍其中重要成果.在持续激励条件下,Dixon等为轮式移动机器人设计了全局指数跟踪控制律,通过设置某个参数为零,跟踪控制律也可用于定点镇定[18].在饱和约束条件下,Lee等为轮式移动机器人设计了全局动力学统一控制器,同时实现了跟踪和镇定目标,但是控制器参数选择与参考轨迹有关[19].为了实现轮式移动机器人的全局渐近跟踪和镇定,Do等设计了全局时变静态反馈统一控制器[20]和全局时变输出反馈统一控制器[21].然而,文献[18]提出的控制器是基于控制任务的,文献[18–21]提出的控制器只能跟踪特定类型的可行轨迹(包括固定点),但不能跟踪任意参考轨迹.为了跟踪任意可行/不可行轨迹,研究者转而设计实际稳定统一控制器,保证跟踪误差全局一致最终有界.Dixon等为轮式移动机器人分别设计了变结构统一控制律和鲁棒统一控制律,在有界扰动下可保证位置和姿态跟踪误差全局一致毕竟有界[22–23].Behal等将文献[22–23]的结果扩展到欠驱动水面船舶,提出了连续时变统一控制律,保证跟踪误差全局一致最终有界[24].文献[22–24]提出的控制器能够跟踪任意可行轨迹,但不能跟踪不可行轨迹.对于不可行轨迹跟踪,Bloch等利用滑模方法为一阶非完整积分器系统设计了运动学统一控制器,可以保证系统状态跟踪包括固定点和不可行轨迹在内的任意参考轨迹,且跟踪误差任意小[25].Morin等提出了横截函数方法,并利用此方法分别为可控无漂移非线性系统和轮式移动机器人设计了统一反馈控制器,均实现了对任意参考轨迹的实际跟踪[26–27].然而,为了获得小的跟踪误差,基于横截函数法设计的控制器会使得控制输入在暂态过程中幅值很大.本文针对参数不确定轮式移动机器人设计了自适应统一控制律,使得机器人对任意参考轨迹的跟踪误差全局一致最终有界,且最终界任意小.与文献[23]只能跟踪可行参考轨迹相比,本文设计的控制器可以跟踪任意参考轨迹,包括可行轨迹和不可行轨迹,且跟踪误差全局一致最终有界.本文内容安排如下:第2节给出了轮式移动机器人统一控制问题描述;第3节为控制律设计及证明;第4节进行了仿真验证:第5节为结论.轮式移动机器人的简化模型为[28]其中:(x,y)表示机器人质心在惯性坐标系下的位置; θ表示机器人的姿态角,即机器人线速度方向与横轴正向的夹角;(v,r)分别表示机器人的线速度和角速度;模型参数R表示轮子半径; 2L为两个后轮的间距;m为机器人的质量;I为机器人关于质心的转动惯量;为控制输入,τ1,τ2为后轮电机产生的控制力矩.假设1模型参数β1＞0,β2＞0未知.笔者期望机器人跟踪任意参考轨迹(xr(t),yr(t), θr(t)),可以是固定点或是可行/不可行轨迹.如果参考轨迹(xr(t),yr(t),θr(t))满足式(1)的运动学约束则称其为可行轨迹,否则称为不可行轨迹[26].对参考轨迹做如下假设:假设2始终有界.在实际中,目标(xr(t),yr(t),θr(t))的速度和加速度始终有界,因此这个假设是合理的. 轮式移动机器人任意轨迹跟踪统一控制器设计问题可以描述为:在假设1−2下,设计控制律((.),(.))使得机器人可以跟踪任意参考轨迹,即机器人位置和角度误差(x−xr,y−yr,θ−θr)全局一致最终有界,且最终界可以通过调节控制器参数被设置到任意小.接下来利用文献[18,22–23]的坐标变换将机器人的误差模型转换为一种有利的形式.首先定义如下误差变量:其中位置误差变量˜x,˜y定义为此时位置和角度误差动态可以表示为基于式(2)定义新的误差变量对式(5)求导并结合式(1)−(4),可得误差变量动态方程为其中式(6)为受扰的一阶非完整积分器,f为扰动项(见文献[25]),这种形式有利于统一控制器的设计.对式(7)中的u1,u2求导并结合式(1)−(6)可得其中此时机器人模型(1)转换为其中:在式(7)中给出.基于模型(10),本文的控制目标可以重新描述为:在假设1−2和参数γ1＞0,γ2＞0未知的情况下,设计控制输入使得跟踪误差(z1,z2,ω)全局一致最终有界,且最终界可以任意小.注1机器人跟踪可行轨迹时,参考轨迹可以表示为x˙r=vrcosθr,y˙r=vrsinθr,其中vr 表示参考轨迹线速度.此时设计如下虚拟速度控制律以镇定(z1,z2,ω):取备选Lyapunov函数,则利用Barbalat引理可以证明而且可以进一步证明:只要则由于篇幅限制,具体证明过程在此省略.基于虚拟控制律并结合自适应技术和后退法,可以进一步设计实际控制律使得然而,此控制律只能跟踪特定类型的可行参考轨迹,不能跟踪不可行或定常参考轨迹.因此,需要设计可以跟踪任意参考轨迹(包括不可行轨迹)的统一控制器.考虑到不可行轨迹跟踪最好的结果是全局一致最终有界跟踪[27],因此本文的控制目标是设计统一控制律保证跟踪误差(z1,z2,ω)全局一致最终有界,且最终界可以任意小.基于模型(10),本节分两步设计统一控制器: I)为(z1,z2,u1,u2)设计辅助轨迹使得(z1d,z2d)全局一致最终有界,且最终界可以任意小;II)设计自适应控制律使得(z1,z2, u1,u2)全局趋于.此时(z1,z2,ω)全局一致最终有界.3.1 辅助轨迹设计(Design of auxiliary trajectory)辅助轨迹设计为其中:ε2,ω,f在式(5)(7)中给出.引理1式(11)−(12)的辅助动态(z1d,z2d)保证: 1)(z1d,z2d,ρ)全局一致最终有界,最终界为(α1ε,且最终界可以通过减小ε而变得任意小;2)证对ρ求导可得.此式的解析解为由此可知,ρ(t)渐近趋于ε2,即ρ(t)≥ε2,ρ(t)→ε2.因此,(z1d,z2d,ρ)全局一致最终有界,最终界为(α1ε, α1ε,α1ε2),且可以任意小,其中α1＞1.由式(11)−(12)可以直接得到注2由引理1的证明过程可知f+k2ω不要求有界.实际上,无论f+k2ω是否有界,只要ρ(0)≥ε2,k1＞0,辅助轨迹(z1d,z2d)最终必定会收敛到一个稳定的极限环3.2 实际控制律设计(Design of actual control law)定义辅助误差变量其中:k3＞0,k4＞0.由式(10)(13)−(14)可得s1,s2状态方程为其中:基于式(15)−(16),设计控制输入使得,即相应结果在如下定理中给出.定理1基于假设1−2和辅助轨迹(11)−(12),并选择控制参数k7＞0,k8＞0,则如下的自适应控制律:可以保证:1)(s1,s2,ω)全局趋于零;2)模型(10)中的跟踪误差(z1,z2)全局一致最终有界,且最终界为控制输入全局有界.证将式(20)代入式(15)可得其中表示γ2的估计值.将式(19)−(20)代入式(16)得到其中用到等式表示γ1的估计值.构造备选Lyapunov函数结合式(21)−(24)可得1)变量s1,s2,ω全局趋于零.由于V1≥0,˙V1≤0,可得为了利用Barbalat引理证明(s1,s2)→0,需要证明˙V1一致连续,即证明有界.由于V1有界,因此(s1,s2,有界,有界.由式(14)得可得(e1,,e2,)有界.又因为(z1d,z2d)有界,所以(z1,z2)有界.基于以上分析和假设2可知,如果ω有界,则˙s1,˙s2有界.结合引理1中可得ω动态为然而,由于式(26)中)隐含ω,所以不能由式(26)直接得到ω的有界性.为了消除耦合项)项,引入状态变换并得到其中由于均有界,故fω有界.式 (27)显示¯ω有界,故ω也有界.因此,有界,¨V1有界,从而一致连续.综合以上分析和Barbalat引理可知,因此(s1,s2)→0,即因为且(z1d,z2d)全局一致最终有界,所以fω→0,总之s1,s2,e1,e2,˙e1,˙e2,ω均全局趋于零.最后,由以上分析和()的表达式(19)−(20)可知,控制输入全局有界.2)跟踪误差(z1,z2)全局一致最终有界,且最终界为(α1α2ε,α1α2ε),α2＞1.因为(e1,e2)→0,(z1d,z2d)全局一致最终有界且最终界为α1ε,因此z1=e1+z1d,z2=e2+z2d全局一致最终有界且最终界为(α1α2ε,α1α2ε).显然,最终界可通过减小ε而变得任意小.推论1引理1和定理1保证机器人位置和角度跟踪误差全局一致最终有界,最终界为且可以被设置到任意小.证由式(2)−(3)(5)可得应用范数不等式可以得到推论1可以由式(28)和定理1直接得到.注3在本文中,跟踪误差最终界可以任意小,但不能渐近收敛到零.这是因为式(11)−(12)中的辅助状态(z1d, z2d)最终收敛到极限环,而不是零.注4在暂态响应过程中,增大ρ(0)并减小k1可以减小控制输入的幅值.在稳态响应过程中,减小ε将导致控制输入幅值增大,增大ε将使得跟踪误差最终界增大.注5与文献[19–24]只能跟踪可行参考轨迹相比,本文的控制器可以跟踪任意参考轨迹,包括可行和不可行轨迹.与文献[26–27]相比,本文对系统模型参数不确定具有鲁棒性.本节通过仿真算例验证所设计控制律的有效性.在此给出4种参考轨迹:可行固定点、可行直线、可行圆、不可行轨迹.其中可行轨迹可以由式(29)产生:不可行轨迹不能由式(29)产生.基于文献[29]中给出的模型参数β1=0.167,β2=2.17,在此给出4种参考轨迹跟踪仿真结果.1)可行固定点轨迹.可行固定点轨迹由式(29)直接产生,初始值选为(vr,rr)(0)=(0,0),(xr,yr,θr)(0)=(0,0,0).机器人状态和估计值初始值选为控制参数选为可行固定点跟踪仿真结果如图1所示.2)可行直线轨迹.可行直线轨迹由式(29)直接产生,初始值选为(vr, rr)(0)=(0.2,0),(xr,yr,θr)(0)=(0,0,0).机器人状态和估计值初始值选为控制参数选为可行直线跟踪仿真结果如图2所示.3)可行圆轨迹.可行圆轨迹由式(29)直接产生,初始值选为(vr,rr)(0)=(0.2,0.04),(xr,yr,θr)(0)=(0,0,0).与前两个仿真算例相似,选择机器人状态和估计值初始值为控制参数选为可行圆跟踪仿真结果如图3所示.4)不可行轨迹.不可行参考轨迹可以由机器人模型间接产生:其中(xr,yr)表示机器人对称轴上距离质心L1的一点.在此选择机器人状态和估计值初始值选为并选择控制参数不可行轨迹跟踪仿真结果如图4所示.接下来,保持所有状态初始值和控制器参数不变,令ε=0.2,并得到仿真结果如图5所示.图1−5仿真结果表明:1)所设计的控制器可以跟踪任意参考轨迹,包括固定点、可行/不可行轨迹; 2)跟踪误差最终收敛到一个由ε值决定大小的原点邻域内;3)跟踪误差的最终界可以通过减小ε而减小,但是会增大控制输入的幅值.本文针对参数不确定轮式移动机器人设计了动态反馈统一控制律,该控制律可以跟踪任意参考轨迹,跟踪误差全局一致最终有界、且最终界可以任意小.构造的辅助轨迹克服了渐近稳定非完整系统所遇到的困难.利用Lyapunov方法得到的参数自适应控制律实现了对辅助轨迹的跟踪.所提出的控制律可以实际镇定任意参考轨迹(包括固定点、可行轨迹和不可行轨迹).下一步的工作是将本文的控制器设计方法推广到其他非完整欠驱动系统.庞海龙(1988–),男,硕士研究生,目前研究为非线性控制、轮式移动机器人控制,E-mail:****************;【相关文献】[1]BROCKETT R W.Asymptotic Stability and FeedbackStabilization[M].Boston:Birkhauser,1983.[2]BLOCH A M,REYHANOGLU M,MCCLAMROCH N H.Control and stabilization of nonholonomic dynamic systems[J].IEEE Transactions on AutomaticControl,1992,37(11):1746–1757.[3]DE WIT C C,SORDALEN O J.Exponential stabilization of mobile robots with nonholonomic constraints[J].IEEE Transactions on Automatic Control,1992,37(11):1791–1797.[4]SAMSON C.Velocity and torque feedback control of a nonholonomic cart[J].Advanced Robot Control,1991:125–151.[5]JIANGZP.Iterativedesignoftime-varyingstabilizersformulti-input systems in chained form[J].Systems&Control Letters,1996,28(5): 255–262.[6]SAMSON C.Control of chained systems application to path following and time-varying point-stabilization of mobile robots[J].IEEE Transactions on AutomaticControl,1995,40(1):64–77.[7]GODHAVN J M,EGELAND O.A Lyapunov approach to exponential stabilization of nonholonomic systems in power form[J].IEEE Transactions on AutomaticControl,1997,42(7):1028–1032.[8]M’CLOSKEY R T,MURRAY R M.Exponential stabi lization of driftless nonlinear control systems using homogeneous feedback[J]. IEEE Transactions on AutomaticControl,1997,42(5):614–628.[9]ESCOBAR G,ORTEGA R,REYHANOGLU M.Regulation and trackingofthenonholonomicdoubleintegrator:Af i eld-orientedcontrolapproach[J].Automatica,1998,34(1):125–131.[10]DIXON W E,JIANG Z P,DAWSON D M.Global exponential setpoint control of wheeled mobile robots:a Lyapunov approach[J]. Automatica,2000,36(11):1741–1746.[11]KANAYAMA Y,KIMURA Y,MIYAZAKI F,et al.A stable tracking control method for an autonomous mobile robot[C]//Proceedings of IEEE International Conference on Robotics and Automation.Cincinnati,OH:IEEE,1990:384–389.[12]WALSH G,TILBURY D,SASTRY S,et al.Stabilization of trajectories for systems with nonholonomic constraints[J].IEEE Transactions on Automatic Control,1994,39(1):216–222.[13]JIANG Z P,NIJMEIJER H.Tracking control of mobile robots:a case study in backstepping[J].Automatica,1997,33(7):1393–1399.[14]JIANG Z P,NIJMEIJER H.A recursive technique for tracking control of nonholonomic systems in chained form[J].IEEE Transactions on Automatic Control,1999,44(2):265–279.[15]AGUILAR M,SOUERES P,COURDESSES M,et al.Robust pathfollowing control with exponential stability for mobile robots[C] //Proceedings of IEEE International Conference on Robotics and Automation.Leuven:IEEE,1998,4:3279–3284.[16]DE WIT C C,KHENNOUF H,SAMSON C,et al.Nonlinear Control Design for Mobile Robots[M].Singapore:World Scientif i c,1993.[17]DEL RIO F D,JIM´ENEZ G,SEVILLANO J L,et al.Error adap tive tracking for mobile robots[C]//The 28th IEEE Annual Conference of the Industrial ElectronicsSociety].Sevilla,Spain:IEEE,2002,3: 2415–2420.[18]DIXON W E,DAWSON D M,ZHANG F,et al.Global exponential trackingcontrol of amobile robot systemvia a PEcondition[J].IEEE Transactions on,Systems,Man,andCybernetics,Part B:Cybernetics,2000,30(1):129–142.[19]LEE T C,SONG K T,LEE C H,et al.Tracking control of unicyclemodeled mobile robots using a saturation feedback controller[J]. IEEE Transactions on Control Systems Technology,2001,9(2):305–318.[20]DO K D,JIANG Z P,PAN J.Simultaneous tracking and stabilization of mobile robots:an adaptive approach[J].IEEE Transactions on Automatic Control,2004,49(7):1147–1151. [21]DO K D,JIANG Z P,PAN J.A global output-feedback controller for simultaneous tracking and stabilization of unicycle-type mobile robots[J].IEEE Transactions on Robotics and Automation,2004, 20(3):589–594.[22]DIXON W E,DAWSON D M,ZERGEROGLU E.Tracking and regulation control of a mobile robot system with kinematic disturbances: a variable structure-likeapproach[J].Journal of Dynamic Systems, Measurement,and Control,2000,122:616. [23]DIXON W E,DAWSON D M,ZERGEROGLU E,et al.Robust tracking and regulation control for mobile robots[J].International Journal of Robust and NonlinearControl,2000,10:199–216.[24]BEHAL A,DAWSON D M,DIXON W E,et al.Tracking and regulation control of an underactuated surface vessel with nonintegrable dynamics[J].IEEE Transactions on Automatic Control,2002,47(3): 495–500.[25]BLOCH A,DRAKUNOV S.Stabilization and tracking in the nonholonomic integrator via sliding modes[J].Systems&Control Letters,1996,29(2):91–99.[26]MORIN P,SAMSON C.Practical stabilization of driftless systems on Lie groups:the transverse function approach[J].IEEE Transactions on Automatic Control,2003,48(9):1496–1508.[27]MORIN P,SAMSON C.Control of nonholonomic mobile robots based on the transverse function approach[J].IEEE Transactions on Robotics,2009,25(5):1058–1073.[28]LAPIERRE L,SOETANTO D,PASCOAL A.Nonsingular path following control of a unicycle in the presence of parametric modelling uncertainties[J].International Journal of Robust and Nonlinear Control,2006,16(10):485–503.[29]CORRADINI M L,ORLANDO G.Control of mobile robots with uncertainties in the dynamical model:a discrete time sliding mode approach with experimentalresults[J].Control Engineering Practice, 2002,10(1):23–34.。
力矩受限的非完整WMR镇定与轨迹跟踪统一预测控制
设质 心 位 于后 轮轴 的 中点 上 ． ＷＭＲ可 由 以下 非 线性 微分方 程来 描述 Ｊ ：
＝Ｕ Ｏ（， ＝ｖｉ４， ＝Ｗ， ＣＳ ￣ ｓ ， ｎ
口＝Ｊ ＩＷ ：／ ｕ ， ８ｕ ， Ｉ ３ ２ ２ （） １
第２ ７卷
第 ３期
吉 林 化 工 学 院 学 报
Ｊ Ｕ Ｎ ＬＯ ＩＩ Ｎ Ｔ Ｔ Ｈ ＭＩＡ Ｅ Ｈ Ｏ ＯＧ Ｏ Ｒ Ａ ＦＪＬＮ Ｉ Ｓ ＩＵ ＥＯＦＣ Ｅ Ｃ ＬＴ Ｃ Ｎ
２１ ０ ０年 ６月
Ｊ ｎ。 ２ Ｏ ｕ Ｏｌ
考虑 机器人 的动 力学 模 型 ， 究其 统 一 预 测控 制 研 问题 ， 首先基 于控 制 李 雅 普诺 夫 （ ｙｐｎｖ 函 数 Ｌａｕｏ ）
方法 ， 计 了满 足 闭环 稳 定性 条 件 及输 人 约 束 的 设 终端 控制器 ， 出 了相 应的终 端域 ， 给 随后 以跟踪 圆
，
（ 一 ｄ ＋Ｕｓ ４ ， ） ｄｉ ￣ ｎ
Ｗ ，
同时令
（） ２
ｑｕ ＝ ｑ ２ ２，
＝
＝ ｌ “ｄ一“ ） （ｌ １，
车身质 量与转 动惯 量 ；１ ２ 为后 轮轴 的 长度 ， 为后 ｒ 轮的半径 ； Ｙ （ ）为质 心 坐 标 ， 为 车 身 相对 于 ， 轴 正 向的 方 向 角 ， 为 相 对 于垂 直 轴 的角 速 度 ； “ ｌ＝７ ＋＿和 ２＝ｒ —７ 为控制输入 ， ＿ ７ ｌ ２ １ Ｉ ２ 这里 ７ 与 ． １ ｒ分 别是后 轮两个 电机 所提供 的驱动力 矩． 考 虑到 电机 所 能提 供 的力矩 是 有 限的 ， 即存 在输 出饱 和情况 ， 控制 约束 由如下形 式描述
二阶非完整性水下机器人的路径跟踪与协调控制研究
华中科技大学博士学位论文二阶非完整性水下机器人的路径跟踪与协调控制研究姓名：向先波申请学位级别：博士专业：控制理论与控制工程指导教师：黄心汉2010-06-02华 中 科 技 大 学 博 士 学 位 论 文摘要21世纪是海洋的世纪，日益增长的海洋开发需求，以及自主式水下机器人(Autonomous Underwater Vehicle, AUV)技术的快速发展，使得欠驱动水下机器人已成为AUV家族的重要成员和海洋探测开发的重要工具。
欠驱动水下机器人属于二阶非完整性系统，且具有本质上的强非线性，其运动控制问题非常具有挑战性。
因此，二阶非完整性欠驱动水下机器人的非线性运动控制研究具有重要的理论价值和实用价值，已经成为水下机器人控制领域的热点问题。
本文深入分析了国内外关于二阶非完整性水下机器人运动控制方面的研究成果，并总结了所存在的问题，在此基础上完成了二阶非完整性水下机器人的路径跟踪控制，并对基于路径跟踪的机器人编队协调控制进行了研究。
主要研究内容如下：首先，简要介绍了非完整性系统，比较了路径跟踪与轨迹跟踪各自的特点，选择了建立路径跟踪误差动力学的合适方案。
以一阶非完整性移动机器人为研究对象，深入探讨机器人路径跟踪控制的设计方法，在Serret-Frenet移动坐标系下，提出基于虚拟参考目标点“协作式”路径跟踪的控制策略，完成具有“时空解耦”特性的控制器设计。
其次，建立水下机器人运动学、动力学模型，基于一阶与二阶非完整性系统运动控制的部分相似性，借鉴一阶非完整性机器人路径跟踪的控制策略，实现二阶非完整性水下机器人的三自由度全状态欠驱动路径跟踪控制器，并解除了普遍存在的角速度持续激励的路径跟踪限制条件。
通过引入建立在Serret-Frenet移动坐标系且可随路径曲率自适应变化的视线角，将其由传统的船舶直线路径跟踪，扩展到水下机器人曲线参考路径的跟踪控制。
采用“视线角导航”和“位置”分步设计，简化了路径跟踪控制律。
非完整约束AGV轨迹跟踪的非线性预测控制
[ 11] 王甦, 汪安圣. 认知 心理学 [ M ] . 北京: 北京 大学 出 版社, 2006. 08
[ 12] 齐从谦, 崔琼瑶. 基于参数化技术的 CAD 创新设计方 法研究[ J] . 中国机械工程,2003, 14( 8) : 681 683.
[ 13] 黄万, 王东林. 机械 设计中 的创新[ J] . 机 械设计 与 制造, 2004( 5) : 51 52.
∀ 681 ∀
践意义上来说, 轨迹跟踪更具有实际应用价值, 因 为即使对于镇定控制任务, 机器人也要沿某条可 行轨迹运动到目标点。为了解决 WM R 的运动 控制问题, 人们已经提出各种控制方法, 包括滑模 控制方法[ 1] 、反演控制方法[ 2] 等在内的非线性控 制方法, 自 适 应 控 制 方 法[ 3] , 神 经网 络 控 制 方 法[ 4] , 时变反馈 控制 法[ 5] , 非连续 反馈控 制法[ 6] 等, 取得了较好的控制效果。然而, 上述传统方法 的可调参数与控制性能之间的关系不是很直观, 参数整定很费力, 且在考虑实际存在控制输入约 束或状态约束时, 比较难处理。而模型预测控制 ( mo del pr edict iv e cont rol, M PC) 可以克服以上缺 陷, 模型预测控制利用求惩罚函数的最小化来确 定最优控制输入, 参数调整容易, 且状态约束及控 制输入约束可以在优化过程中直接考虑在内, 简 单明了。模型预测控制亦称为滚动优化控制( re ceding horizon co nt ro l, RH C) , 是近年来 发展起 来的一类新型计算机控制算法, 由于它采用模型 预测、滚动优化和反馈校正等控制策略, 且其处理 约束能力强, 因而控制效果好, 已成功应用于石 油、化工、机械等比较复杂且模型不容易精确建立 的工业生产过程。但是, 由于源于工程控制的预 测控制在设计时没有在理论上考虑系统的闭环镇 定性, 预测控制是在线反复求解开环优化问题, 而 开环最优不能保证闭环镇定, 因此, 如何保证预测 控制的镇定性成了一个关键问题。
受非完整性约束的移动机器人路径跟踪算法
受非完整性约束的移动机器人路径跟踪算法郁伉;肖本贤;李艳红【摘要】文章讨论了受非完整约束限制的两轮差动驱动机器人的路径跟踪问题,研究移动机器人在一个运动周期内的轨迹,找出该周期内机器人起点坐标和终点坐标之间的联系,推导出一种新模型;针对机器人跟踪任意期望几何路径,提出了斜率算法;对于期望路径是圆弧的特例,提出曲率半径算法,进一步提高跟踪速度平稳性和跟踪精度.【期刊名称】《合肥工业大学学报（自然科学版）》【年(卷),期】2010(033)009【总页数】5页(P1315-1319)【关键词】路径跟踪;运动周期;曲率;两轮差动驱动机器人;非完整系统【作者】郁伉;肖本贤;李艳红【作者单位】合肥工业大学,电气与自动化工程学院,安徽,合肥,230009;合肥工业大学,电气与自动化工程学院,安徽,合肥,230009;咸阳师范学院,物理系,陕西,咸阳,712000【正文语种】中文【中图分类】TP240 引言由于存在非完整约束，移动机器人路径跟踪控制十分具有挑战性。
文献[1]对系统在期望路径附近Taylor线性化，对得到的线性时变系统设计控制律，从而实现原系统的局部跟踪;文献[2]采用输入输出反馈线性化的方法，将非线性系统分解为2个子系统，再根据性能指标逐一设计控制律，以达到跟踪目的;文献[3]采用后退(back steping)方法的思想，将系统分解为低阶系统，利用中间虚拟变量和部分Lyapunov函数，设计了具有全局渐进稳定的跟踪控制器。
目前常见机器人模型有运动学模型、动力学模型以及位姿误差模型。
自文献[4]提出位姿误差模型以来，还很少见到新的模型。
本文针对两轮差动驱动移动机器人，在仔细分析其工作过程的基础上，推导出新的模型，并给出2种算法。
该模型在表达式上具有运动学模型简洁的优点，经过简单变换，得到1个运动周期内机器人位姿误差。
2种算法针对机器人初始位置在期望路径附近，相对于传统的基于Lyapunov函数的控制律设计，不必计算大量偏导数，在保证跟踪精度、跟踪速度的前提下，具有计算量小的优点;和反馈线性化算法相比，不存在奇异性问题[5]。
- 1、下载文档前请自行甄别文档内容的完整性，平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益，请联系客服反馈,我们会尽快为您处理(人工客服工作时间：9:00-18:30)。
以及混合控制方法 ຫໍສະໝຸດ Ｊ这些文献都是基于机器人 的运 动学模 型或 者更 全面 的动力 学模 型进行研 究 的， 没有考虑 机 器 人 的 动力 源 泉— — 驱动 电机 的 动态 特性． 相对 于其他类 型 的执行 机构 而言 ， 电机 的特 性 比较 复杂 ， 果 在 设 计控 制 规 律 将其 动 态 如 特性 忽略 ， 实 际实施 时系统 的性 能可 能会退 化． 在 考虑 驱动 电机 动 态 的文 献 有 ， 是 他 们 研 究 但
第 ２期
韩 光 信 ： 虑 执 行 机 构 动 态 的 非 完整 轮 式移 动机 器 人 镇 定 控 制 考
『
＝
４ ３
０
电感 Ｌ ， 、 ， 。 电阻 尺 ， 反 电动 势 的关 系 可 由如 ，尺 及
下方 程描 述 ：
５—．．／．。．．。．．．．．一 ２ ． ＝。３（。．．．．．ｒ ） ２ １ ．。Ｌ ． 。 ．． ． ．． ． ． ． ． ．
非 常成熟 ， 以在 各种 实 用 的移 动机 器 人 中以轮 所 式移 动机 器人最 为常 见． 众所 周 知 ， 式移 动机器 轮
人属于典型的非完整系统…． 虽然非完整约束 限 制了机器人的瞬时运动 ， 但是它们在位姿空间上 仍然是全局可控 的【 ， ２ 这一独特性质使得设计反 Ｊ
的驱 动 电机 都是 直 流 的 ， 电机 产 生 的力 矩 与 电 且
流成 正 比 ， 则
ｒ
学 控制 规律推 广 到动 力 学 模 型 ， 一 步将 驱 动 电 进
机的动态考虑在内， 后给出了典型镇定控制任 最
务 的仿真 结果 ．
收 稿 日期 ：０ ００ —９ ２ １ － ２ ３
其 中 ， ｋ
摘 要： 本文研究 了将执行机构动态考虑在内的非 完整轮式 移动机器人 （ ＷＭＲ） 的镇定控 制问题． 在运动
学时变镇定控制律 的基础上 ， 利用李雅普诺夫方 法及 Ｂ ｃ ｓ ｐ ｉｇ ａｋｔ ｐ 技术 ， ｅ ｎ 首先将运动学 控制器推 广到动 力学模型 ， 一步将驱 动电机的动态考虑在 内 ， 进 最后给出了典型镇定控制任务 的仿真结果． 关 键 词： 轮式 移动机 器人 ； 执行器动态 ； 镇定 ； 反步法
． ＿＿ ＿＿ ＿＿＿＿＿＿＿Ｌ
１ ： ｌ １ ＋ ２ ２ ＝ Ｘ１ ２ ， Ｗ — Ｘ１ ２ ， Ｗ ＋ ２ ＝ ２ ．
（。 丁 对应 右轮 ， 应 左 轮 ） 轮 子 只 能滚 动 不 能 ７对 － ．
的都是机器人的轨迹跟踪问题 ， 中文献 考虑 其
的是 电感为零 的简 化情 形 ， 文献 ［Ｏ 研究 的是 而 １］ 四轮全 向机器 人 的轨迹 跟踪 ． 于此 考 虑 ， 基 本文 考
虑机器人 的 动 力学 模 型 以及 驱 动 电机 的 动 态 特
侧 向滑动 的非完 整约 束可 以描述 为
￣ｉ ｓ ｍｐ一 ｏ ＝０ ｃ ｓ ．
下面考 虑执 行 机构 的动 态 ］ 假设 两 个 后 轮 ．
性， 研究 基于 时变控 制方 法镇 定控 制问题 ， 利用 李
雅 普诺夫 方 法 及 Ｂ ｃ ｓ ｐ ｉｇ技 术 ， ａｋｔ ｐｎ ｅ 首先 将 运 动
＝ （ １ ２ ， １． ＋ ） ｒ
Ｗ＝ ２ — ２ ． 卢（ ） ｌ
其中，。 ／ ， ＝ ／Ｉｎ 和 ， ＝１ ｌ ， ｒ ｚ 分别为 ＷＭ Ｒ的
质 量与 转 动 惯 量 ；ｌ 后 轮 轴 的 长度 ，ｒ 后 轮 ２为 ２为 的直径 ； ，） （ Ｙ 为质 心 坐标 ， 为车 身 相对 于 轴 正 向 的方 向角 ， 为 相对 于垂直 轴的 角速 度 ； 里 这 与 丁 分 别是 后 轮 两个 电机所 提 供 的驱 动力 矩 ：
２１ ０ ０年 ４月
文章编号 ：０ ７２ ５ （０ ０ ０ － ４ －４ １０ — ３ ２ １ ） ２０ ２０ ８ ０
考 虑 执 行 机 构 动 态 的 非 完 整 轮 式 移 动 机 器 人 镇 定 控 制
韩 光 信
（ 吉林化工学院 信息与控制工程学 院， 吉林 吉林 １２ ２ ） ３ ０ ２
文献标识码 ： Ａ 中图分类号 ： Ｐ ７ Ｔ ２３
现有 的移 动机器 人有 履带 式 、 式 、 式 以及 腿 轮
轮腿 式移 动机 构 ， 轮式 移 动 机 器 人在 机 械 设 计上
１ 动力学模型及 执行机构动态特性
对 于笛 卡尔 坐标 系 下 的轮 式 移 动 机器 人 ， 假
第２ ７卷
第 ２期
吉 林 化 工 学 院 学 报
Ｊ Ｕ Ｎ ＦＪＬ Ｎ Ｉ Ｓ Ｉ Ｕ Ｅ ＯＦＣ Ｍ Ｃ ＬＴ Ｃ Ｏ Ｏ Ｙ Ｏ Ｒ ＡＬ Ｏ ＩＩ Ｎ Ｔ Ｔ Ｔ ＨＥ Ｉ Ａ Ｅ ＨＮ Ｌ Ｇ
Ｖｏ ． ７ Ｎｏ ２ １２ ． Ａｐ ． ２ ０ ｒ ０１
下面设计镇定控制律 ， 定义李雅普诺夫函数
ｒ ● ●●●● ●●Ｊ ＿
ｒ 【 ０ Ｊ ，． ● １●● ０ Ｏ
蝈 】
其 中 ， ｋ 为 反 电 动 势 系数 ，
＋
１ ２
。 ＝ ＋
，
将 对时 间微 分得
，
１ ● ● ● ● ● ●● ● ● ● ｊ
为 比例 系 数． 电刷 输 人 电压 ， 与 ，
基金项 目： 吉林省教育厅 “ 十一 ・ 科技 研究资助项 目（０ ８３０ 五” ２ ０ —５ ） 作者简介 ： 韩光信 （９ １）男 ， １７ ． ， 吉林舒兰人 ， 吉林化工学院副教 授 ， 士 ， 博 主要从事约束 系统控制 、 鲁棒控 制 、 预测控 制应用方面的研究．
馈控 制器具 有挑 战性 ． 目前 ， 机器 人 的镇 定控 制策 略 主要 有 时变 控 制方 法 Ｌ 。不 连续 控 制 方法 ３ 、 ４ 刮
设质心位于后轮轴的 中点上． Ｒ可由以下非 ＷＭ 线 性微分 方 程来描述 ｎ ：
ｖ ｏｑ・ ｃｓ
＝ｖｉｑ， ｓｎ ￣
：
（） １