工程科学学报，第37卷，第7期：955964,2015年7月 Chinese Journal of Engineering,Vol.37,No.7:955-964,July 2015 DOI:10.13374/j.issn2095-9389.2015.07.019:http://journals.ustb.edu.cn 基于分段模糊Lyapunov函数的轮式移动机器人轨迹 跟踪控制 张佳媛四，李洪波》，刘贺平) 1)北京科技大学自动化学院，北京1000832)清华大学计算机科学与技术系，北京100084 ☒通信作者，E-mail:zhangjiayuan(01290129@126.com 摘要研究了具有控制输入约束和外部干扰的轮式移动机器人的轨迹跟踪问题.在轨迹跟踪位姿误差的T$模型和并行 分布补偿框架下，利用分段模糊Lyapunov理论给出了满足控制输入约束的H.控制器设计方法，并证明了闭环系统的稳定 性.仿真结果验证了所提方法的有效性. 关键词移动机器人；轨迹：跟踪：模糊控制：Lyapunov函数 分类号TP242.6 Trajectory tracking control for wheeled mobile robots based on a piecewise fuzzy Lyapunov function ZHANG Jia-yuan,LI Hong-bo,LIU He-ping 1)School of Automation and Electrical Engineering,University of Science and Technology Beijing,Beijing 100083,China 2)Department of Computer Science Technology,Tsinghua University,Beijing 100084,China Corresponding author,E-mail:zhangjiayuan01290129@126.com ABSTRACT A trajectory tracking problem is investigated for wheeled mobile robots with control input constraints and external disturbances.Firstly,the trajectory tracking posture error model is transformed into a T-S fuzzy model.Under this framework and parallel distributed compensation,a design method of constrained H controllers is developed via the piecewise fuzzy Lyapunov func- tion approach,and the stability conditions of the closed-oop system are also derived.Finally,simulation results are given to illustrate the effectiveness of the proposed method. KEY WORDS mobile robots:trajectory:tracking:fuzzy control:Lyapunov function 近年来，轮式移动机器人(wheeled mobile robot, 移动机器人轨迹跟踪控制问题进行研究，通过设计运 WMR)在工业制造、军事航海、采掘、农业、服务业等领动学控制器使机器人达到期望轨迹，其输出的角速度 域得到了日益广泛的应用，操作任务层次和难度的提 和线速度作为动力学控制器的参考输入，从而控制电 高对机器人轨迹跟踪控制能力的要求亦逐渐提高.因 机力矩达到期望值.文献B4)利用反演法设计轨迹 而，轮式移动机器人系统的高度非线性和非完整约束 跟踪控制器.文献5-]则是将自适应控制方法用于 特性的轨迹跟踪控制问题一直是学术界研究的热点问 含有参数不确定性的轮式移动机器人轨迹跟踪控制的 题.针对上述问题，近些来研究学者提出了许多很有研究.此外，智能控制方法也被广泛应用于轨迹跟踪 意义的方法.文献ū-2]利用滑模变控制方法对轮式控制中.例如文献8]和文献9]分别利用神经网络 收稿日期：2014-04-18 基金项目：国家重点基础研究发展计划资助项目(2012CB821206):国家自然科学基金资助项目(61174069)：北京市自然科学基金资助项目 (4122037)
工程科学学报，第 37 卷，第 7 期: 955--964，2015 年 7 月 Chinese Journal of Engineering，Vol． 37，No． 7: 955--964，July 2015 DOI: 10． 13374 /j． issn2095--9389． 2015． 07． 019; http: / /journals． ustb． edu． cn 基于分段模糊 Lyapunov 函数的轮式移动机器人轨迹 跟踪控制 张佳媛1) ，李洪波2) ，刘贺平1) 1) 北京科技大学自动化学院，北京 100083 2) 清华大学计算机科学与技术系，北京 100084 通信作者，E-mail: zhangjiayuan01290129@ 126． com 摘 要 研究了具有控制输入约束和外部干扰的轮式移动机器人的轨迹跟踪问题． 在轨迹跟踪位姿误差的 T-S 模型和并行 分布补偿框架下，利用分段模糊 Lyapunov 理论给出了满足控制输入约束的 H∞ 控制器设计方法，并证明了闭环系统的稳定 性． 仿真结果验证了所提方法的有效性． 关键词 移动机器人; 轨迹; 跟踪; 模糊控制; Lyapunov 函数 分类号 TP242. 6 Trajectory tracking control for wheeled mobile robots based on a piecewise fuzzy Lyapunov function ZHANG Jia-yuan1) ，LI Hong-bo2) ，LIU He-ping1) 1) School of Automation and Electrical Engineering，University of Science and Technology Beijing，Beijing 100083，China 2) Department of Computer Science ＆ Technology，Tsinghua University，Beijing 100084，China Corresponding author，E-mail: zhangjiayuan01290129@ 126． com ABSTＲACT A trajectory tracking problem is investigated for wheeled mobile robots with control input constraints and external disturbances． Firstly，the trajectory tracking posture error model is transformed into a T-S fuzzy model． Under this framework and parallel distributed compensation，a design method of constrained H∞ controllers is developed via the piecewise fuzzy Lyapunov function approach，and the stability conditions of the closed-loop system are also derived． Finally，simulation results are given to illustrate the effectiveness of the proposed method． KEY WOＲDS mobile robots; trajectory; tracking; fuzzy control; Lyapunov function 收稿日期: 2014--04--18 基金项目: 国家重点基础研究发展计划资助项目( 2012CB821206) ; 国家自然科学基金资助项目( 61174069) ; 北京市自然科学基金资助项目 ( 4122037) 近年来，轮式移动机器人( wheeled mobile robot， WMＲ) 在工业制造、军事航海、采掘、农业、服务业等领 域得到了日益广泛的应用，操作任务层次和难度的提 高对机器人轨迹跟踪控制能力的要求亦逐渐提高． 因 而，轮式移动机器人系统的高度非线性和非完整约束 特性的轨迹跟踪控制问题一直是学术界研究的热点问 题． 针对上述问题，近些来研究学者提出了许多很有 意义的方法． 文献［1--2］利用滑模变控制方法对轮式 移动机器人轨迹跟踪控制问题进行研究，通过设计运 动学控制器使机器人达到期望轨迹，其输出的角速度 和线速度作为动力学控制器的参考输入，从而控制电 机力矩达到期望值． 文献［3--4］利用反演法设计轨迹 跟踪控制器． 文献［5--7］则是将自适应控制方法用于 含有参数不确定性的轮式移动机器人轨迹跟踪控制的 研究． 此外，智能控制方法也被广泛应用于轨迹跟踪 控制中． 例如文献［8］和文献［9］分别利用神经网络
·956· 工程科学学报，第37卷，第7期 控制和模糊控制研究轮式移动机器人轨迹跟踪。然 究同时具有控制输入约束与外部干扰的轮式移动机器 而，模糊规则的建立十分棘手，神经网络的在线或离线 人轨迹跟踪控制问题.本文结合运动学的位姿误差推 学习降低系统实时性，因此智能控制方法与其他控制 导轮式移动机器人轨迹跟踪的动力学误差模型，在建 算法相结合日益流行.比如文献0]采用自递归小波 立动力学误差T$模糊模型基础上，利用分段模糊 神经网络算法近似建立含有不确定性和外部扰动的轮 Lyapunov函数方法和并行分布补偿原理研究了具有控 式移动机器人模型，提出了自适应滑模变控制器.文 制力受限特性和外部干扰的移动机器人轨迹跟踪控制 献D1一13]分别将遗传算法、优化算法与模糊控制相 问题，提出了轮式移动机器人轨迹跟踪模糊H_算法， 结合来研究轨迹跟踪控制.上述文献均假定机器人满 并进行稳定性分析.仿真结果表明了所提方法的有效 足非完整约束，然而在实际环境中，轮式移动机器人会 性和可用性 不可避免地产生滑动，从而破坏非完整约束.针对此 1 问题描述 问题，文献04-16]在考虑打滑因素的基础上，对轮式 移动机器人的轨迹跟踪控制问题进行研究.值得注意 本文研究的轮式移动机器人示意图如图1所示， 的是，轮式移动机器人在实际应用中会存在电机输出 其动力学模型可描述如下四： 力矩饱和与外界干扰等问题，从而降低机器人轨迹跟 x=vcos0, 踪的性能.因此，综合考虑轮式移动机器人系统的非 完整约束特性和控制力受限特性的H,控制问题是具 (1) 有重要理论意义和实际价值的重要问题 =Bu, 另一方面，Takagi和Sugeno于1985年提出的TS 模糊控制能够以任意精度逼近任意连续的非线性函 =B2u2 数-，已逐渐成为解决某些非线性问题强有力的工 式中，(x,Y)为机器人质心坐标，v和ω分别为线速度 具.其基本思路是将非线性系统描述为TS模型，在 和角速度，0为v与X轴的夹角，山1=T1+T2和42= 并行分布补偿(parallel distributed compensation,PDC) T1-T2为系统的控制输入，T1和2分别为后驱动轮电 框架下将满足各个子系统的Lyapunov方程中的公共 机提供的驱动力矩.B,=1/bm,B=1/bl,m与I分别为 矩阵P的求解转换为线性矩阵不等式(linear matrix 轮式移动机器人的质量和转动惯量，21和b分别为驱 inequality,LMI)可行解问题，进而利用凸优化技术进 动轮的轴长和半径.值得指出的是，一般情况下电机 行高效求解四.文献20]基于TS模型，利用并行分 存在输出饱和现象，因此控制变量需满足如下约束： 布补偿原理提出了适用于带有执行机构饱和约束与外 |山，|≤4.si=1,2. (2) 部干扰的轮式移动机器人轨迹跟踪控制算法.然而在 其中山，m为轮式移动机器人允许的控制输入山：的最 实际应用中，随着某些模糊系统规则数目和前提变量 大值. 的增多，线性矩阵不等式的求解难度往往会随之变大， 可能会出现无解的情况，此方法的保守性显而易见。 为解决上述问题，分段模糊Lyapunov函数方法1-四将 模糊空间划分为几个模糊子区域，在任意时刻只有一 个模糊子区域被激活，且处于同一区域的前件变量激 活相同的模糊规则，进而可以在每个子区域上求解 Lyapunov函数来大大降低求解难度.近些年来，分段 模糊Lyapunov函数方法已有诸多研究成果，文献23] 利用分段模糊Lyapunov函数方法研究了具有外部扰 图1轮式移动机器人简化示意图 动的T$模糊系统的稳定问题，但所提定理中的不等 Fig.1 Simplified diagrammatic sketch of WMR 式含有未知矩阵变量乘积的非线性项，不便于利用线 性矩阵不等式工具箱直接进行仿真.文献24]则研究 设轮式移动机器人轨迹跟踪系统状态为q=(x, 了TS模糊系统的稳定性分析和保性能控制.然而到 y,6,,a)T,期望轨迹为q.=(x,y.,6.,,w.)T.下面 目前为止，针对同时具有输入约束控制和外部干扰的 利用运动学位姿误差来推导轮式移动机器人轨迹跟踪 T$模糊系统稳定的研究，特别是面向轮式移动机器 的动力学误差微分方程 人轨迹跟踪问题的研究，尚不多见 轨迹跟踪位姿误差坐标如图2，其中(x。,y。,6)是 基于上述分析，本文对文献20]提出的TS模糊 轮式移动机器人的位姿误差.根据文献26]，位姿误 控制方法进行改进，利用分段模糊Lyapunov函数来研 差方程为
工程科学学报，第 37 卷，第 7 期 控制和模糊控制研究轮式移动机器人轨迹跟踪． 然 而，模糊规则的建立十分棘手，神经网络的在线或离线 学习降低系统实时性，因此智能控制方法与其他控制 算法相结合日益流行． 比如文献［10］采用自递归小波 神经网络算法近似建立含有不确定性和外部扰动的轮 式移动机器人模型，提出了自适应滑模变控制器． 文 献［11--13］分别将遗传算法、优化算法与模糊控制相 结合来研究轨迹跟踪控制． 上述文献均假定机器人满 足非完整约束，然而在实际环境中，轮式移动机器人会 不可避免地产生滑动，从而破坏非完整约束． 针对此 问题，文献［14--16］在考虑打滑因素的基础上，对轮式 移动机器人的轨迹跟踪控制问题进行研究． 值得注意 的是，轮式移动机器人在实际应用中会存在电机输出 力矩饱和与外界干扰等问题，从而降低机器人轨迹跟 踪的性能． 因此，综合考虑轮式移动机器人系统的非 完整约束特性和控制力受限特性的 H∞ 控制问题是具 有重要理论意义和实际价值的重要问题． 另一方面，Takagi 和 Sugeno 于 1985 年提出的 T-S 模糊控制能够以任意精度逼近任意连续的非线性函 数［17--18］，已逐渐成为解决某些非线性问题强有力的工 具． 其基本思路是将非线性系统描述为 T-S 模型，在 并行分布补偿( parallel distributed compensation，PDC) 框架下将满足各个子系统的 Lyapunov 方程中的公共 矩阵 P 的求解转换为线性矩阵不等式( linear matrix inequality，LMI) 可行解问题，进而利用凸优化技术进 行高效求解［19］． 文献［20］基于 T-S 模型，利用并行分 布补偿原理提出了适用于带有执行机构饱和约束与外 部干扰的轮式移动机器人轨迹跟踪控制算法． 然而在 实际应用中，随着某些模糊系统规则数目和前提变量 的增多，线性矩阵不等式的求解难度往往会随之变大， 可能会出现无解的情况，此方法的保守性显而易见． 为解决上述问题，分段模糊 Lyapunov 函数方法［21--22］将 模糊空间划分为几个模糊子区域，在任意时刻只有一 个模糊子区域被激活，且处于同一区域的前件变量激 活相同的模糊规则，进而可以在每个子区域上求解 Lyapunov 函数来大大降低求解难度． 近些年来，分段 模糊 Lyapunov 函数方法已有诸多研究成果，文献［23］ 利用分段模糊 Lyapunov 函数方法研究了具有外部扰 动的 T-S 模糊系统的稳定问题，但所提定理中的不等 式含有未知矩阵变量乘积的非线性项，不便于利用线 性矩阵不等式工具箱直接进行仿真． 文献［24］则研究 了 T-S 模糊系统的稳定性分析和保性能控制． 然而到 目前为止，针对同时具有输入约束控制和外部干扰的 T-S 模糊系统稳定的研究，特别是面向轮式移动机器 人轨迹跟踪问题的研究，尚不多见． 基于上述分析，本文对文献［20］提出的 T-S 模糊 控制方法进行改进，利用分段模糊 Lyapunov 函数来研 究同时具有控制输入约束与外部干扰的轮式移动机器 人轨迹跟踪控制问题． 本文结合运动学的位姿误差推 导轮式移动机器人轨迹跟踪的动力学误差模型，在建 立动力学误差 T-S 模糊模型基础上，利 用 分 段 模 糊 Lyapunov 函数方法和并行分布补偿原理研究了具有控 制力受限特性和外部干扰的移动机器人轨迹跟踪控制 问题，提出了轮式移动机器人轨迹跟踪模糊 H∞ 算法， 并进行稳定性分析． 仿真结果表明了所提方法的有效 性和可用性． 1 问题描述 本文研究的轮式移动机器人示意图如图 1 所示， 其动力学模型可描述如下［25］: x · = vcosθ， y · = vsinθ， θ · = ω， v · = β1 u1， ω · = β2 u2 ． ( 1) 式中，( x，y) 为机器人质心坐标，v 和 ω 分别为线速度 和角速度，θ 为 v 与 X 轴的夹角，u1 = τ1 + τ2 和u2 = τ1 － τ2为系统的控制输入，τ1 和 τ2 分别为后驱动轮电 机提供的驱动力矩． β1 = 1 / bm，β2 = l / bI，m 与 I 分别为 轮式移动机器人的质量和转动惯量，2l 和 b 分别为驱 动轮的轴长和半径． 值得指出的是，一般情况下电机 存在输出饱和现象，因此控制变量需满足如下约束: | ui | ≤ui，max，i = 1，2． ( 2) 其中 ui，max为轮式移动机器人允许的控制输入 ui 的最 大值． 图 1 轮式移动机器人简化示意图 Fig． 1 Simplified diagrammatic sketch of WMＲ 设轮式移动机器人轨迹跟踪系统状态为 q = ( x， y，θ，v，ω) T ，期望轨迹为 qr = ( xr，yr，θr，vr，ωr ) T ． 下面 利用运动学位姿误差来推导轮式移动机器人轨迹跟踪 的动力学误差微分方程． 轨迹跟踪位姿误差坐标如图 2，其中( xe，ye，θe ) 是 轮式移动机器人的位姿误差． 根据文献［26］，位姿误 差方程为 · 659 ·
张佳媛等：基于分段模糊Lyapunov函数的轮式移动机器人轨迹跟踪控制 ·957· (7) 根据泰勒公式可知 (u,sin0e）=,sin0。|。o+(u,sin6）a-0~6。=,0e (8) 将式(8)带入式(7)，并在x。=y。=0.=0处线性化，整 理得 (9) 图2轮式移动机器人轨迹跟踪位姿误差坐标 Fig.2 Trajectory tracking posture error coordinate of WMR 结合式(4)、式(5)和式(6)，令 rie=立1+B301, ,x。=y0-D+D,C0s0。, (10) j。=-xew+,sin, (3) on=d2-B402 其中 0=w.-0. i1=-B,山1+B1h.cos0。-t,sin6， (11) 同时，i。=i,-i=B1u1-B1山1=Bu1o。=0,-ù= B2u2-B22=B2u2·则该系统具有外部干扰的动力学 2=-β2u2 (12) 误差微分方程为 将式(9)、式(10)带入式(4)，则轮式移动机器人轨迹 跟踪系统的动力学误差状态方程可转换为 元.=y.w-D+"Cos6。, e=A(t)e+B ir+B,w(t). (13) y.=-xw+v,sine., 其中，e=(x。y6。tew)T为误差状态变量，t=(, 0。=0-w, (4) 立，)T为控制变量，w()的定义同式(4)，且 D。=B1u1+B3101 0 0.01 0 00 w。=B2u2+B,02· -0,0v,00 00 式中，B,=1/m,B,=1/几，w()=(w,w2)T为加在控制 A(t)= 0 0001 B= 00 B2= 输入变量的外部干扰. 0 0000 10 本文旨在研究上述轨迹跟踪误差系统（式(4）)， 0 0000 01 利用分段模糊Lyapunov函数方法和并行分布补偿原 0 0 理设计状态反馈控制器，使其跟踪给定的参考轨迹，并 0 且满足H,性能约束和控制输入约束 0 0 考虑到电机的输出饱和现象，控制变量 2主要结果 B 0 0 -B 2.1轮式移动机器人动力学误差模型 需满足如下约束： 在式(4)中，若x.和0.先于y。趋于0，则y。=0, 1i|≤立msj=1,2. (14) 当y。很大时，系统会不稳定。鉴于此，作如下定义： q=qr+qn=(v,cos00,)T+(v0)T.(5) 其中，心.是系统式(13)所允许的控制输入心的最大值. 2.2基于分段模糊Lyapunov函数的TS模型 其中，9=（知o),q。=(m.a),9:=(,cos0.o,)T为 本节讨论的是利用分段模糊Lyapunov函数建立 假设的中间变量，其期望值为9=(。w)T=(0 系统TS模型的问题.考虑具有外部输入扰动的非线 0)T,令q为qa和期望值9的差值， 性系统，可由有限个IF-THEN规则描述： 9e=9-9B=(Dw）T=（-U。-w)T.(6) R:F专(t）isMi,…,and忘n(t)isM 结合式(4)、式(5)和式(6)可知 THEN(t）=A,(i)x(t）+B:u(t）+B2w(t）, 0 0 0x. y(）=C(t)x(t), 00x x(0)=x。i=1,2,…,z 0 00八 (15)
张佳媛等: 基于分段模糊 Lyapunov 函数的轮式移动机器人轨迹跟踪控制 图 2 轮式移动机器人轨迹跟踪位姿误差坐标 Fig． 2 Trajectory tracking posture error coordinate of WMＲ x · e = yeω － v + vrcosθe， y · e = － xeω + vrsinθe， θ · e = ωr － ω { ． ( 3) 同时，v · e = v · r － v · = β1 ur1 － β1 u1 = β1 ue1，ω · e = ω · r － ω · = β2 ur2 － β2 u2 = β2 ue2 ． 则该系统具有外部干扰的动力学 误差微分方程为 x · e = yeω － v + vrcosθe， y · e = － xeω + vrsinθe， θ · e = ωr － ω， v · e = β1 ue1 + β3w1， ω · e = β2 ue2 + β4w2 ． ( 4) 式中，β3 = 1 /m，β4 = 1 / I，w( t) = ( w1 w2 ) T 为加在控制 输入变量的外部干扰． 本文旨在研究上述轨迹跟踪误差系统( 式( 4) ) ， 利用分段模糊 Lyapunov 函数方法和并行分布补偿原 理设计状态反馈控制器，使其跟踪给定的参考轨迹，并 且满足 H∞ 性能约束和控制输入约束． 2 主要结果 2. 1 轮式移动机器人动力学误差模型 在式( 4) 中，若 xe 和 θe 先于 ye 趋于 0，则 y · e = 0， 当 ye 很大时，系统会不稳定． 鉴于此，作如下定义［27］: q = qF + qB = ( vrcosθeωr ) T + ( vcωc ) T ． ( 5) 其中，q = ( v ω) T ，qB = ( vc ωc ) T ，qF = ( vrcosθe ωr ) T 为 假设的 中 间 变 量，其 期 望 值 为 qBr = ( vcr ωcr ) T = ( 0 0) T ，令 qBe为 qB 和期望值 qBr的差值， qBe = qBr － qB = ( vceωce ) T = ( － vc － ωc ) T ． ( 6) 结合式( 4) 、式( 5) 和式( 6) 可知 x · e y · e θ · e = 0 ωr 0 － ωr 0 0 0 0 0 xe ye θ e + － 1 ye 0 － xe 0 － 1 vc ω( ) c + 0 vrsinθe 0 ． ( 7) 根据泰勒公式可知 ( vrsinθe ) = vrsinθe θe = 0 + ( vrsinθe ) ' θe = 0·θe = vr ·θe ． ( 8) 将式( 8) 带入式( 7) ，并在 xe = ye = θe = 0 处线性化，整 理得 x · e y · e θ · e = 0 ωr 0 － ωr 0 vr 0 0 0 xe ye θ e + 1 0 0 0 0 1 vce ω( ) ce ． ( 9) 结合式( 4) 、式( 5) 和式( 6) ，令 v · ce = u槇1 + β3w1， ω · ce = u槇2 － β4w2 { ． ( 10) 其中 u槇1 = － β1 u1 + β1 u1rcosθe － vrωce sinθe， ( 11) u槇2 = － β2 ue2 ． ( 12) 将式( 9) 、式( 10) 带入式( 4) ，则轮式移动机器人轨迹 跟踪系统的动力学误差状态方程可转换为 e · = A( t) e + B1u槇 + B2w( t) ． ( 13) 其中，e = ( xe ye θe vce ωce ) T 为误差状态变量，u槇 = ( u槇1 u槇2 ) T 为控制变量，w( t) 的定义同式( 4) ，且 A( t ) = 0 ωr 0 1 0 － ωr 0 vr 0 0 0 0 0 0 1 0 0 0 0 0 0 0 0 0 0 ，B1 = 0 0 0 0 0 0 1 0 0 1 ，B2 = 0 0 0 0 0 0 β3 0 0 － β 4 ． 考虑到电机的输出饱和现象，控制变量 需满足如下约束: | u槇j | ≤u槇j，max，j = 1，2． ( 14) 其中，u槇j，max是系统式( 13) 所允许的控制输入 u槇j 的最大值． 2. 2 基于分段模糊 Lyapunov 函数的 T-S 模型 本节讨论的是利用分段模糊 Lyapunov 函数建立 系统 T-S 模型的问题． 考虑具有外部输入扰动的非线 性系统，可由有限个 IF-THEN 规则描述: Ｒi : IF ξ1 ( t) is Mi 1，…，and ξq ( t) is Mi q THEN x ·( t) = Ai ( t) x( t) + B1iu( t) + B2iw( t) ， y( t) = Ci ( t) x( t) ， x( 0) = x0，i = 1，2，…，z ( 15) · 759 ·
·958· 工程科学学报，第37卷，第7期 其中：R表示第i个模糊控制规则，z是F-THEN规则 闭环系统的形式可描述如下： 的个数，M是模糊集合，x(d)∈R”为状态变量，u(t)∈R" 是控制输入变量，w(t)eR”是外部干扰，y(t)eR“为 e∑hmu (21) 系统性能输出，(t)∈R是前件变量，假设(t)和 x(t)= y()均不依赖于控制输入变量，x。是系统初始向量， hn (g)hu(g)[(Ar+BuKu)x(t)+Bznw (t)] A、B:、B,:和C:是维数适当的常量.同时，每个子系统 需满足如下控制约束： (22) 14(）1≤4.寸j=1,2,…,m. (16) y0=名，8c0 (23) 4.为系统所允许的第j个控制输入山，()的最大值 式中，A:、BB和C:是各个模糊子区域内维数适当 在时刻，TS模糊系统的总输出为 的常量矩阵.在时刻，整个模糊区域内有 ()h.([A.(x()+B()+B(]. [x()= 言Ag合合A.因〖A,+ y(d= ∑A,(E)C,()x). BKa)x(t）+Bw()], (17) y(= 三A,0= 式中，h,()=凸 三4图 49=直M,》为 会A份名，图Cx0. (24) 专属于模糊集合M的隶属度.且4，()和h,()具有以 其中： 下性质≥0.合4>0：A)≥0，豆A,9=1 入，()={ l,专eS: 0,否则. 针对T$模糊模型的每个子系统，均设计一个如 下的并行分布补偿控制器： 三A因1 C:IFs(t）is,…,and专，(t）isM, 2.3满足控制约束的H.控制器的设计 THEN(）=Kx(）,i=1,2,…,z(18) 本节针对式(24)描述的模糊闭环系统，设计并行 其模糊集合与式(15)一致，K,∈Rx是一个常反馈增 分布补偿控制器，使闭环系统渐近稳定并且满足控制 益矩阵，那么整个控制器的输出可以表示为 约束式和H.性能约束.假设闭环系统式(24)的分段 u()=∑h,(Ku() 模糊Lyapunov函数为 (19) 台 V(x()=∑，(E)V(x(d). (25) 若保证由式(17)和式(19)组成的闭环控制系统渐近 稳定，需存在矩阵P>0,使其满足 其中：V,(x()= NP+PNn≤0，l1≤i≤j≤r. (20) ∑：()xr()Pr()是第i个子 其中，N=[A,+BK)T+(A+BK)]/2 区域的模糊Lyapunov函数：Pa是正定对称矩阵，l≤l≤ fl≤i≤G. 然而，式(20)存在着很大的保守性.因为在实际 引理对于任意适维向量x、y和矩阵Y,若矩阵 应用中，系统往往存在高度非线性和复杂性，规则数目 R正定，则 和前件变量会增加，那么公共矩阵P存在的可能性极 x'Yx+yYxsx'YR-Yx+y Ry (26) 小.为解决上述问题，本文采用分段模糊Lyapunov函 定理对于模糊闭环控制系统式(24)，给定标量 数的方法. 在任意时刻进行并行分布补偿控制器设计时，为 y>0、中和h()可导，且1h()I≤中，其中假设干 降低求解难度，只需考虑由前件变量(）∈R激活的 扰的能量是有界的，且‖w(）‖≤wa若存在矩阵 X>0和矩阵M(1≤j,l≤∫，1≤i≤r)满足下列矩阵 2条规则.鉴于此，根据处于同一区域的前件变量将 不等式 激活相同的2”条模糊规则的原则，将整个前件变量空 间化分为几个模糊子区域.因此，任意时刻只有一个 Ψ B2u X.CE X 模糊子区域被激活.令S:表示第i个模糊子区域，G B -yl 0 0 CiX 0 -yl 0 <0, 和∫分别为模糊子区域数和每个子区域中激活的规则 数，l表示第i个区域内的规则数，h()表示S:中激 X 0 0 活规则的隶属度，则在S内，并行分布补偿控制器和
工程科学学报，第 37 卷，第 7 期 其中: Ｒi 表示第 i 个模糊控制规则，z 是 IF-THEN 规则 的个数，Mi j 是模糊集合，x( t) ∈Ｒn 为状态变量，u( t) ∈Ｒm 是控制输入变量，w( t) ∈Ｒp 是外部干扰，y( t) ∈Ｒn1 为 系统性能输出，ξ ( t) ∈Ｒq 是前件变量，假设 ξ( t) 和 y( t) 均不依赖于控制输入变量，x0 是系统初始向量， Ai、B1i、B2i和 Ci 是维数适当的常量． 同时，每个子系统 需满足如下控制约束: | uj ( t) | ≤uj，max，j = 1，2，…，m． ( 16) uj，max为系统所允许的第 j 个控制输入 uj ( t) 的最大值． 在时刻 t，T-S 模糊系统的总输出为 x ·( t) = ∑ z i = 1 hi ( ξ) ［Ai ( t) x( t) + B1iu( t) + B2iw( t) ］， y( t) = ∑ z i = 1 hi ( ξ) Ci ( t) x( t) { ． ( 17) 式中，hi ( ξ) = μi ( ξ) ∑ r i = 1 μi ( ξ) ，μi ( ξ) = ∏ q j = 1 Mi j( ξj ) ，Mi j ( ξj) 为 ξj 属于模糊集合 Mi j 的隶属度． 且 μi ( ξ) 和 hi ( ξ) 具有以 下性质: μi≥0，∑ z i = 1 μi ＞ 0; hi ( ξ) ≥0，∑ z i = 1 hi ( ξ) = 1． 针对 T-S 模糊模型的每个子系统，均设计一个如 下的并行分布补偿控制器: Ci : IF ξ1 ( t) is Mi 1，…，and ξq ( t) is Mi q THEN u( t) = Kix( t) ，i = 1，2，…，z ( 18) 其模糊集合与式( 15) 一致，Ki∈Ｒm × n 是一个常反馈增 益矩阵，那么整个控制器的输出可以表示为 u( t) = ∑ z i = 1 hi ( ξ) Kiu( t) ． ( 19) 若保证由式( 17) 和式( 19) 组成的闭环控制系统渐近 稳定，需存在矩阵 P ＞ 0，使其满足 NT ijP + PNij≤0，1≤i≤j≤r． ( 20) 其中，Nij = ［( Ai + B1iKj ) T + ( Aj + B1j Ki ) ］/2． 然而，式( 20) 存在着很大的保守性． 因为在实际 应用中，系统往往存在高度非线性和复杂性，规则数目 和前件变量会增加，那么公共矩阵 P 存在的可能性极 小． 为解决上述问题，本文采用分段模糊 Lyapunov 函 数的方法． 在任意时刻进行并行分布补偿控制器设计时，为 降低求解难度，只需考虑由前件变量 ξ( t) ∈Ｒq 激活的 2q 条规则． 鉴于此，根据处于同一区域的前件变量将 激活相同的 2q 条模糊规则的原则，将整个前件变量空 间化分为几个模糊子区域． 因此，任意时刻只有一个 模糊子区域被激活． 令 Si 表示第 i 个模糊子区域，G 和 f 分别为模糊子区域数和每个子区域中激活的规则 数，l 表示第 i 个区域内的规则数，hli ( ξ) 表示 Si 中激 活规则的隶属度，则在 Si 内，并行分布补偿控制器和 闭环系统的形式可描述如下: ui ( t) = ∑ f i = 1 hli ( ξ) Klix( t) ， ( 21) x ·( t) = ∑ f l = 1 ∑ f k = 1 hli ( ξ) hki ( ξ) ［( Ali + B1liKki ) x( t) + B2liw( t) ］， ( 22) yi ( t) = ∑ f l = 1 hli ( ξ) Clix( t) ． ( 23) 式中，Ali、B1li、B2li和 Cli是各个模糊子区域内维数适当 的常量矩阵． 在时刻 t，整个模糊区域内有 x ·( t) = ∑ G i = 1 λi ( ξ) ∑ f l = 1 ∑ f k = 1 hli ( ξ) hki ( ξ) ［( Ali + B1liKki ) x( t) + B2liw( t) ］， y( t) = ∑ G i = 1 λi ( ξ) yi ( t) = ∑ G i = 1 λi ( ξ) ∑ f l = 1 hli ( ξ) Clix( t) ． ( 24) 其中: λi ( ξ) = 1， ξ∈Si ; {0， 否则． ∑ G i = 1 λi ( ξ) = 1． 2. 3 满足控制约束的 H∞ 控制器的设计 本节针对式( 24) 描述的模糊闭环系统，设计并行 分布补偿控制器，使闭环系统渐近稳定并且满足控制 约束式和 H∞ 性能约束． 假设闭环系统式( 24) 的分段 模糊 Lyapunov 函数为 V( x( t) ) = ∑ G i = 1 λi ( ξ) Vi ( x( t) ) ． ( 25) 其中: Vi ( x( t) ) = ∑ f l = 1 hli ( ξ) xT ( t) Pli x( t) 是第 i 个子 区域的模糊 Lyapunov 函数; Pli是正定对称矩阵，1≤l≤ f，1≤i≤G． 引理 对于任意适维向量 x、y 和矩阵 Y，若矩阵 Ｒ 正定，则 xT Yx + yT YT x≤xT YＲ － 1YT x + yT Ｒy． ( 26) 定理 对于模糊闭环控制系统式( 24) ，给定标量 γ ＞ 0、ρi和 hρi ( ξ) 可导，且 | h · ρi ( ξ) | ≤ρi，其中假设干 扰的能量是有界的，且‖w( t) ‖2 2≤wmax ． 若存在矩阵 Xji ＞ 0 和矩阵 Mlji ( 1≤j，l≤f，1≤i≤r) 满足下列矩阵 不等式 Ψjlli B2li XjiCT li Xji BT 2li － γI 0 0 CliXji 0 － γI 0 Xji 0 0 － ∑ f ρ = 1 ρiXρ i ＜ 0， · 859 ·
张佳媛等：基于分段模糊Lyapunov函数的轮式移动机器人轨迹跟踪控制 959 i=1,2,…,Gj,l=1,2,…f (27) 「曲 2BwX证 X B -yl 0 √2B -yl 0 0 0 -Yl 0 Bi -yl <0.(33) X 0 CX 0 -yI s=1,2,…,m:i=1,2,…G:l,k,j=1,2,…,(29) 则系统式(24)全局渐近稳定，同时满足H.性能约束 所以平西+ 名，X,<0,整理可得 L上<y和约束控制式 1,8咒1e-1w2 三B+mH0 (34) 1u.(t）1≤u,s=1,2,,m. (30) 同理，对式(28)应用Schur引理可知 其中，e,为空间R"的第s个标准向量基，a:=yw+ V(x(0),X2=P,三=(CCa+CC)n,M际= 「m+2∑中XXX2万BwX三 KX,Ψ=X元A话+AaX元+MB五+B1GM际，Tm= <0 2Bi -yl 0 XA+AaX元+X元A后+AuXe+M标Bi+B1wM+ 三仙X 0 -yl MrBig +BuM (35) 则反馈增益矩阵为K。=MX. 证明： 所以T+2∑中XXX<0,整理可得 (1)稳定性证明. 令w(t)=0,结合式(25)，考虑Lyapunov函数 2套+m++m+)<0 V(x(t)),其导数为 (36) (x())= h(( 且h(（)≥0，h.()≥0，hu()≥0，结合式(32)、 式(34)和式(36)，可得当定理中的条件满足时， 名ag0Pr0+0P0].aU (x())<0,即系统在其各个模糊子区域上渐近稳 将式(22)带入式(31)，整理可得 定.进而根据式(25)，可知(x(t))<0,所以闭环系 0)=会.r0r0+ 统式(24)全局渐近稳定. (2)H.性能约束证明. 会马，{合会A.因.0r0A.+ 在零初始条件下，令 Ji,(x()+)y.()-yw()w().(37) BK)Px()+x()P.(A.+BK)x(] 当w()≠0时，由式(22)带入式(31)并整理可得 令Hm=Ai+B1Ka,由Ih(E)I≤中可得 x≤会会与ggro(会P.+ x0）=名.groP0+ 点名会，gh:gh.日FoH+ +P,A)r]小+名会合 P.Hn)x(t)+wBiPx (t)+x(t)P B2nw (] ,gh,A.e{r@P.P+ 考虑到Ih()I≤中，同时应用引理，且令R=y, (H+)'P,+P.(H+H)x().(32) )≤名0Pr0+名名点，9 对式(27)应用Schur引理可知 h (g)h(g)x (t)(P +P,H)x(t)+
张佳媛等: 基于分段模糊 Lyapunov 函数的轮式移动机器人轨迹跟踪控制 i = 1，2，…，G; j，l = 1，2，…，f． ( 27) Γjlki 槡2B2li XjiΞT lki Xji 槡2BT 2li － γI 0 0 ΞlkiXji 0 － γI 0 Xji 0 0 － 2∑ f ρ = 1ρiXρ i ＜ 0， i = 1，2，…，G; j = 1，2，…，f; 1≤k ＜ l≤f． ( 28) u2 i，s，max αi eT s ( Mlji + Mkji 槡 ) ( 2 Mlji + Mkji 槡 ) 2 T es X ji ＞ 0， s = 1，2，…，m; i = 1，2，…G; l，k，j = 1，2，…，f． ( 29) 则系统式( 24) 全局渐近稳定，同时满足 H∞ 性能约束 sup ‖w‖2≠0，‖w‖2 ＜ ∞ ‖y‖2 ‖w‖2 ＜ γ 和约束控制式 | ui，s ( t) | ≤ui，s，max，s = 1，2，…，m． ( 30) 其中，es 为空间 Ｒm 的第 s 个标准向量基，αi = γwmax + Vi ( x ( 0) ) ，Xji = P － 1 ji ，Ξlki = ( CT li Cki + CT ki Cli ) 1 /2 ，Mlji = KliXji，Ψjlli = Xji AT li + Ali Xji + MT lji BT 1li + B1li Mlji，Γjlki = XjiAT li + Ali Xji + Xji AT ki + Aki Xji + MT kji BT 1li + B1liMkji + MT ljiBT 1ki + B1kiMlji ． 则反馈增益矩阵为 Kli = MljiX － 1 ji ． 证明: ( 1) 稳定性证明． 令 w( t) = 0，结 合 式 ( 25 ) ，考虑 Lyapunov 函 数 Vi ( x( t) ) ，其导数为 V · i ( x( t) ) = ∑ f ρ = 1 h · ρi ( ξ) xT ( t) Pρix( t) + ∑ f l = 1 hli ( ξ) ［x ·T ( t) Plix( t) + xT ( t) Plix ·( t) ］． ( 31) 将式( 22) 带入式( 31) ，整理可得 V · i ( x( t) ) = ∑ f ρ = 1 h · ρi ( ξ) xT ( t) Pρix( t) + ∑ f j = 1 hji ( ξ) { ∑ f l = 1 ∑ f k = 1 hli ( ξ) hki ( ξ) ［xT ( t) ( Ali + B1liKki ) T Pjix( t) + xT ( t) Pji ( Ali + B1liKki ) x( t) ］} ． 令 Hlki = Ali + B1liKki，由| h · ρi ( ξ) | ≤ρi可得 V · i ( x( t) ) ≤ ∑ f j =1 ∑ f l =1 hji ( ξ) h2 li ( ξ [ ) xT ( t ( ) ∑ f ρ =1 ρiPρi + HT lliPji + PjiHlli ) x( t ] ) + ∑ f j = 1 ∑ f k = 1 ∑ f k ＜ l hji ( ξ) hli ( ξ) hki ( ξ) { xT ( t [ ) 2 ∑ f ρ = 1 ρiPρi + ( Hlki + Hkli ) T Pji + Pji ( Hlki + Hkli ] ) x( t) } ． ( 32) 对式( 27) 应用 Schur 引理可知 Ψjlli B2li XjiCT li BT 2li － γI 0 CliXji 0 － γ I － Xji 0 ( 0 － ∑ f ρ = 1 ρiXρi ) － 1 ( Xji 0 0) ＜ 0． 整理得 Ψjlli + ∑ f ρ = 1 ρiXjiX－1 ρi Xji B2li XjiCT li BT 2li － γI 0 CliXji 0 － γ I ＜ 0． ( 33) 所以 Ψjlli + ∑ f ρ = 1 ρiXjiX － 1 ρi Xji ＜ 0，整理可得 ∑ f ρ = 1 ρiPρi + HT lliPji + PjiHlli ＜ 0． ( 34) 同理，对式( 28) 应用 Schur 引理可知 Γjlki + 2∑ f ρ = 1 ρiXjiX－1 ρi Xji 槡2B2li XjiΞT lki 槡2BT 2li － γI 0 ΞlkiXji 0 － γ I ＜ 0． ( 35) 所以 Γjlki + 2 ∑ f ρ = 1 ρiXjiX － 1 ρi Xji ＜ 0，整理可得 2 ∑ f ρ = 1 ρiPρi + ( Hlki + Hkli ) T Pji + Pji ( Hlki + Hkli ) ＜ 0． ( 36) 且 hji ( ξ) ≥0，hli ( ξ) ≥0，hki ( ξ) ≥0，结合 式 ( 32 ) 、 式( 34) 和 式 ( 36 ) ，可 得 当 定 理 中 的 条 件 满 足 时， V · i ( x( t) ) ＜ 0，即系统在其各个模糊子区域上渐近稳 定． 进而根据式( 25) ，可知 V · ( x( t) ) ＜ 0，所以闭环系 统式( 24) 全局渐近稳定． ( 2) H∞ 性能约束证明． 在零初始条件下，令 J V · i ( x( t) ) + 1 γ yT i ( t) yi ( t) － γwT ( t) w( t) ． ( 37) 当 w( t) ≠0 时，由式( 22) 带入式( 31) 并整理可得 V · i ( x( t) ) = ∑ f ρ = 1 h · ρi ( ξ) xT ( t) Pρix( t) + ∑ f j = 1 ∑ f l = 1 ∑ f k = 1 hji ( ξ) hli ( ξ) hki ( ξ) ［xT ( t) ( HT lkiPji + PjiHlki ) x( t) + wT BT 2liPjix( t) + xT ( t) PjiB2liw( t) ］． 考虑到| h · ρi ( ξ) | ≤ρi，同时应用引理，且令 Ｒ = γ， V · ( x( t) ) ≤ ∑ f ρ = 1 ρixT ( t) Pρix( t) + ∑ f j = 1 ∑ f k = 1 ∑ f l = 1 hji ( ξ)· hli ( ξ) hki ( ξ [ ) xT ( t) ( HT lkiPji + PjiHlki ) x( t) + · 959 ·
·960· 工程科学学报，第37卷，第7期 Ix()PB.BP()+yw()w()= 名++ 吾名，g@(会，P.++ A+cc.0,所以y.()< 2p,BB,]xo}+yw'(0w(0.(（38） yIw()I,即 由式(23)可知， IIy ()2 (47) 00=(会：cx0）' ()2 所以系统在其各个模糊子区域上满足H。控制性能指 cr0=合合A.gh.gr'occx0= 标根据式(25，可知0L<y,所以闭环系统 "w() 名(cc,x+ 式(24)在全局上满足H.控制性能指标. (3)控制约束证明. 名名4，eAgr0cc+cc0. 根据式(46)，V（x(t)<y川w()I2+ (39) V,(x(0),即V(x()<a,即 将式(38)、式(39)带入式(37)，整理可得 ()()<1 (48) JK合合ro(会.+P+ 若P和Ku满足式(29)，则 PA。+pR+cc小r0]+ 名誉)e誉 会名名r02名P+ 整理得 (H+H)P:+P.(+) (M+M)'e.e (M+MX (49) C a,B,+（cc+cc)]小k0}(ao 将M=K。X带入式(49)，并将不等式左右两边分别 对式(33)、式(35)应用Schur补定理得 左乘右乘P,整理得 业+名+A+cc<0. (K+K)ce (K+K)P y 22,ms (41) 进一步整理可得 +2名中Xg+子8B以+ 盈249A.9d 上X三三aX,<0. (42) 2子，ms 因三三=CCu+CC,令P分别左乘右乘式(41)、 盒会立，③A.③，③B 式(42)并整理得
工程科学学报，第 37 卷，第 7 期 1 γ xT ( t) PjiB2liBT 2liPjix( t) + γwT ( t) w( t ] ) = ∑ f j = 1 ∑ f l = 1 hji ( ξ) h2 li ( ξ [ ) xT ( t ( ) ∑ f ρ = 1 ρiPρi + HT lliPji + PjiHlli + 1 γ PjiB2liBT 2liPji ) x( t) + γwT ( t) w( t ] ) + ∑ f j = 1 ∑ f l = 1 ∑ f k ＜ l hji ( ξ) hli ( ξ) hki ( ξ) { xT ( t [ ) 2 ∑ f ρ = 1 ρiPρi + ( Hlki + Hkli ) T Pji + Pji ( Hlki + Hkli ) + 2 γ PjiB2liBT 2liPji ] x( t) + 2γwT ( t) w( t) } = ∑ f j = 1 ∑ f l = 1 hji ( ξ) h2 li ( ξ [ ) xT ( t ( ) ∑ f ρ = 1 ρiPρi + HT lliPji + PjiHlli + 1 γ PjiB2liBT 2liPji ) x( t ] ) + ∑ f j = 1 ∑ f l = 1 ∑ f k ＜ l hji ( ξ) hli ( ξ) hki ( ξ) { xT ( t [ ) 2 ∑ f ρ = 1 ρiPρi + ( Hlki + Hkli ) T Pji + Pji ( Hlki + Hkli ) + 2 γ PjiB2liBT 2liPji ] x( t) } + γwT ( t) w( t) ． ( 38) 由式( 23) 可知， yT i ( t) yi ( t) ( = ∑ f l = 1 hli ( ξ) Clix( t ) ) T ∑ f l = 1 hli ( ξ)· Clix( t) = ∑ f l = 1 ∑ f k = 1 hli ( ξ) hki ( ξ) xT ( t) CT liCkix( t) = ∑ f l = 1 h2 li ( ξ) xT ( t) CT liClix( t) + ∑ f l = 1 ∑ f k ＜ l hli ( ξ) hki ( ξ) xT ( t) ［CT liCki + CT kiCli］x( t) ． ( 39) 将式( 38) 、式( 39) 带入式( 37) ，整理可得 J ＜ ∑ f j = 1 ∑ f l = 1 hjih2 li [ xT ( t ( ) ∑ f ρ = 1 ρiPρi + HT lliPji + PjiHlli + 1 γ PjiB2liBT 2liPji + 1 γ CT liCli ) x( t ] ) + ∑ f j = 1 ∑ f l = 1 ∑ f k ＜ l hjihlihki { xT ( t [ ) 2 ∑ f ρ = 1 ρiPρi + ( Hlki + Hkli ) T Pji + Pji ( Hlki + Hkli ) + 2 γ PjiB2liBT 2liPji + 1 γ ( CT liCki + CT kiCli ] ) x( t) } ． ( 40) 对式( 33) 、式( 35) 应用 Schur 补定理得 Ψjlli + ∑ f ρ = 1 ρiXjiX － 1 ρi Xji + 1 γ B2liBT 2li + 1 γ XjiCT liCliXji ＜ 0， ( 41) Γjlki + 2 ∑ f ρ = 1 ρiXjiX － 1 ρi Xji + 2 γ B2liBT 2li + 1 γ XjiΞT lkiΞlkiXji ＜ 0． ( 42) 因 ΞT lkiΞlki = CT liCki + CT kiCli，令 Pji分别左乘右乘式( 41) 、 式( 42) 并整理得 ∑ f ρ = 1 ρiPρi + HT lliPji + PjiHlli + 1 γ PjiB2liBT 2liPji + 1 γ CT liCli ＜ 0， ( 43) 2 ∑ f ρ = 1 ρiPρi + ( Hlki + Hkli ) T Pji + Pji ( Hlki + Hkli ) + 2 γ PjiB2liBT 2liPji + 1 γ ( CT liCki + CT kiCli ) ＜ 0． ( 44) 结合式( 40) 、式( 43) 和式( 44) 可知，J ＜ 0，即 V · i ( x( t) ) + 1 γ yT i ( t) yi ( t) － γwT ( t) w( t) ＜ 0． ( 45) 将上式两边积分，则 Vi ( x( t) ) + 1 γ ‖yi ( t) ‖2 2 ＜ γ‖w( t) ‖2 2 + Vi ( x( 0) ) ． ( 46) 因为 Vi ( x( 0) ) = 0，Vi ( x( t) ) ＞ 0，所以 1 γ ‖yi ( t) ‖2 2 ＜ γ‖w( t) ‖2 2，即 ‖yi ( t) ‖2 2 ‖w( t) ‖2 2 ＜ γ2 ． ( 47) 所以系统在其各个模糊子区域上满足 H∞ 控制性能指 标． 根据式( 25) ，可知 ‖y( t) ‖2 2 ‖w( t) ‖2 2 ＜ γ2 ，所以闭环系统 式( 24) 在全局上满足 H∞ 控制性能指标． ( 3) 控制约束证明． 根 据 式 ( 46 ) ，Vi ( x ( t ) ) ＜ γ‖w( t) ‖2 2 + Vi ( x( 0) ) ，即 Vi ( x( t) ) ＜ αi，即 xT ( t) Pi αi x( t) ＜ 1． ( 48) 若 Pji和 Kki满足式( 29) ，则 u2 i，s，max αi Xji ( ＞ Mlji + Mkji 槡 ) 2 T eseT s ( Mlji + Mkji 槡 ) 2 ． 整理得 ( Mlji + Mkji ) T eseT s ( Mlji + Mkji ) 2u2 i，s，max ＜ Xji αi ． ( 49) 将 Mlji = KliXji带入式( 49) ，并将不等式左右两边分别 左乘右乘 Pji，整理得 ( Kli + Kki ) T eseT s ( Kli + Kki ) 2u2 i，s，max ＜ Pji αi ． 进一步整理可得 ∑ f l = 1 ∑ f k = 1 ∑ f j = 1 hli ( ξ) hki ( ξ) hji ( ξ) ( Kli + Kki ) T ese T s ( Kli + Kki ) 2u2 i，s，max ＜ ∑ f l = 1 ∑ f k = 1 ∑ f j = 1 hli ( ξ) hki ( ξ) hji ( ξ) Pji αi ， · 069 ·
张佳媛等：基于分段模糊Lyapunov函数的轮式移动机器人轨迹跟踪控制 *961· h(g)h (g)(K +K)'e.e (K +K) 1i立2|≤β242.s+B2|u2|≤ P B2(4+3.033)=0.8115Nm 2uim 对于跟踪误差系统，选取专(t）=,(t)和2(t）= 因为 ω，()为模糊推理的前件，其隶属度函数选取分别如图 名：Eh:()(K+K)eeK+& 3和图4所示. 2 所以 规则 规则2 规则3 吾名，图a因ek 0.20 0.55 0.90 im )/m* 结合式(48)，可得 图3巴，隶属度函数曲线 r'(0. ：ga.因KeeK Fig.3 Membership function of s x(t） B2= 0 0 C:=diag(1,1,1,1,1), 0,,()∈[0.261,0.839]ms,w,(t）∈[-0.729， B: 0 0.729]rad·s,u.(t)∈[-3.603,3.603]N·m, 0 -B. u2(）∈[-3.033,3.033]N·m假设|o.|<1.5,且 0 w.=0e,结合式(11)、式(12)可知， E=ū00]，X=0。-08 00.2 I1I≤B,41,ma+Blu.I+lv,0e|≤ B,(5+3.603)+0.839×1.5=1.59Nm:
张佳媛等: 基于分段模糊 Lyapunov 函数的轮式移动机器人轨迹跟踪控制 ∑ f l = 1 ∑ f k = 1 hli ( ξ) hki ( ξ) ( Kli + Kki ) T eseT s ( Kli + Kki ) 2u2 i，s，max ＜ Pi αi ． 因为 ∑ f l = 1 ∑ f k = 1 hli ( ξ) hki ( ξ) ( Kli + Kki ) T eseT s ( Kli + Kki ) 2 ＞ ∑ f l = 1 ∑ f k = 1 hli ( ξ) hki ( ξ) KT lieseT s Kki， 所以 ∑ f l = 1 ∑ f k = 1 hli ( ξ) hki ( ξ) KT lieseT s Kki u2 i，s，max ＜ Pi αi ． 结合式( 48) ，可得 xT ( t) · ∑ f l = 1∑ f k = 1 hli ( ξ) hki ( ξ) KT kieseT s Kli u2 i，s，max ·x( t) ＜ 1 ． 又因 u2 i，s ( t) [ = ∑ f k = 1 hki ( ξ) eT s Kkix( t ] ) T ∑ f k = 1 hki ( ξ) eT s Kkix( t) = xT ( t) ∑ f l = 1 ∑ f k = 1 hli ( ξ) hki ( ξ) KT kieseT s Klix( t) ， 所以 u2 i，s ( t) ＜ u2 i，s，max，即满足控制约束式( 30) ． 注 : ‖ f ( t ) ‖2 ( = ∫ ∞ 0 ‖ f ( t ) ‖2 d ) t 1 /2 ( = ∫ ∞ 0 f T ( t) f( t) d ) t 1 /2 ． 3 仿真结果 本节利用上述提出的定理进行轮式移动机器人轨 迹跟踪的控制器设计，使其跟踪一个“8”字型轨迹，且 满足 H∞ 约束和控制约束． 机器人各个物理参数选取 为: m = 80 kg，I = 2 kg·m，l = 0. 075 m，b = 0. 325 m， u1，max = 5 N·m，u2，max = 4 N·m． 此时该“8”字型轨迹由可 描述为: xr = 3sin( t /4) ， y{ r = 3sin( t /8) ． ( 50) 则该轨 迹 的 初 始 值 为 vr ( 0 ) = 0. 8385 m·s － 1， ωr ( 0) = 0 rad·s － 1，θr ( 0) = 0. 4636 rad，u1r ( 0) = 0 N·m， u2r( 0) = 0. 1625 N·m． 相应地，可得到线速度 vr ( t) 、角 速度 ωr ( t) 和控制输入轨迹 ur ( t) ，且对于所有的 t ＞ 0，vr ( t) ∈［0. 261，0. 839］m·s － 1，ωr ( t) ∈［－ 0. 729， 0. 729］rad·s － 1，u1r ( t ) ∈［－ 3. 603，3. 603］N·m， u2r ( t) ∈［－ 3. 033，3. 033］N·m． 假设 | ωe | ＜ 1. 5，且 ωe = ωce，结合式( 11) 、式( 12) 可知， | u 槇1 | ≤β1 u1，max + β1 | u1r | + |vrωce | ≤ β1 ( 5 + 3. 603) + 0. 839 × 1. 5 = 1. 59 N·m; | u槇2 | ≤β2 u2，max + β2 | u2r | ≤ β2 ( 4 + 3. 033) = 0. 8115 N·m． 对于跟踪误差系统，选取 ξ1 ( t) = vr ( t) 和 ξ2 ( t) = ωr ( t) 为模糊推理的前件，其隶属度函数选取分别如图 3 和图 4 所示． 图 3 vr 隶属度函数曲线 Fig． 3 Membership function of vr 图 4 ωr 隶属度函数曲线 Fig． 4 Membership function of ωr 该系统可以由以下的 T-S 模型来描述，它包含了 15 条模糊规则: Ｒi : IF vr ( t) is Fj 1 and ωr ( t) is Fj 2 THEN e ·( t) = Ai ( t) e( t) + B1iu槇( t) + B2iw( t) y( t) = Ci ( t) e( t) k = 1，2，3; j = 1，2，…，5; i = 1，2，…，15 ( 51) 各个数矩阵为 Ai ( t) = A 槇i O2 × 1 O3 × 4 槇 E ，B1i = 0 0 0 0 0 0 1 0 0 1 ， B2i = 0 0 0 0 0 0 β3 0 0 － β 4 ，Ci = diag( 1，1，1，1，1) ， E 槇 =［1 0 0］T ，A 槇1 = 0 － 0. 8 0 ( ) 0. 8 0 0. 2 ， A 槇2 = 0 － 0. 4 0 ( ) 0. 4 0 0. 2 ，A 槇3 = 0 0 0 ( ) 0 0 0. 2 ， · 169 ·
·962· 工程科学学报，第37卷，第7期 0 -1.4137 -0.29597 -1.2767 -0.15947T -0.1861 -0.2931 -0.3453 -0.3170 -0.4 0 K1= -0.6640 -0.8921 ,K4 -0.6040 -0.8763 0.55 0 0.55 -1.3277 -0.0689 -1.3253 -0.0618 0 00.401 -0.6093 -1.1736」 -0.6000 -1.1761 A=-0.400.55/ -1.5135 -0.30067Y -1.3753 -0.12337 -0.4702 -0.4409 -0.6471 -0.4543 A。= 0 0.801 -0.800.55/ K2= -0.7068 -0.8839 ,K2= -0.8643 -0.9316 -1.3337 -0.0834 -1.3928 -0.0896 -0.8 01 -0.40 -0.6385 -1.2544 -0.6948 -1.2606 0 0.9 -04 00.9/ -1.4637 -0.3206 -1.3525 -0.14647T A=( 00.401 000\.x.=-0.400.9 -0.2862 -0.4883 -0.5762 -0.5334 000.9 K32= -0.6210 -0.9977 ,K42= -0.5633 -0.9663 00.8 0 -1.2730 -0.0646 -1.3300 -0.0818 -0.6150 -1.2418 -0.7242 -1.2852 由图5所示的前件规则结构图可知，G=8,∫=4， -1.8376 -0.28257Y -1.5931 -0.02721 在S,中激活的规则分别为R、R、R和R,对应的子 -0.8080 -0.8410 -0.6287 -0.8182 系统为AA2A6和A,·以此类推，可得表1. K13= -0.9163 -1.1791 ,K23= -0.8001 -1.1792 0 -1.6344 -0.0894 -1.5461 -0.0676 r() -0.5750 -1.5094」 -0.5627 -1.5141」 -L.7764 -0.24797T -1.7009 0.0047f -0.3465 -0.8836 -0.4571 -0.8541 R K3= -0.5839 -1.3318 ,K42= -0.4580 -1.2811 -1.2612 -0.0206 -1.2616 -0.0273 -0.5576 -1.4910」 -0.5323 -1.5133 -2.3554 -0.2040寸 -2.2049 0.0734下 图5模糊系统前件规则结构 -0.4331 -1.0268 -0.2932 -1.0259 Fig.5 Premise rule structure of the fuzzy system K14= -0.5228 -1.3889 K24= -0.3321 -1.3918 -1.8557 -0.0341 -L.8210 -0.0259 表1A的值 -0.1636 -1.6892 Table 1 An values -0.1487 -1.6997 -2.1157 -0.16567 -2.1174 0.12441 i=1i=2i=3i=4i=5i=6i=7i=8 -0.3099 -1.1310 -0.4131 -1.0732 l=1 A A2 A3 AsAs A As A9 K4= -0.3818 -1.6119 ,K44= -0.2559 -1.5582 1=2 A2 A3 A As A As Ag A0 -1.3131 -0.0083 -1.2929 -0.0092 l=3 A2A13 A -0.3835 -1.6924 -0.3357 -1.7064 l=4 A AgA。 Au -1.3989 -0.25797T -1.2771 -0.1595 -0.1874 -0.2251 -0.3919 -0.2470 令中a=1,y=2,a,=l,利用Matlab的线性矩阵不 -0.6315 -0.8381 ,K2s= -0.6099 -0.8512 等式工具箱求解式(27)~式(29)，可得控制器的反馈 -1.3110 -0.0785 -1.3190 -0.0685 增益矩阵Kr -0.5433 -1.1890」 -0.5568 -1.1860 -1.4229 -0.26887 -1.2907-0.14297 -1.3919 -0.27147Y -1.2621 -0.18307 -0.2055 -0.2268 -0.3969 -0.2385 -0.1757 -0.2949 -0.3228 -0.2805 K1= -0.6211 -0.7883 -0.5571 -0.7679 K35= -0.6872 -0.9381 ,K45= -0.6409 -0.9182 -1.3275 -0.0730 -1.3288 -0.0652 -1.3137 -0.0771 -1.3107 -0.0636 -0.5771 -1.1723 -0.5680-1.1721 -0.5866 -1.1935 -0.5694 -1.1873
工程科学学报，第 37 卷，第 7 期 A 槇4 = 0 0. 4 0 ( ) － 0. 4 0 0. 2 ，A 槇5 = 0 0. 8 0 ( ) － 0. 8 0 0. 2 ， A 槇6 = 0 － 0. 8 0 ( ) 0. 8 0 0. 55 ，A 槇7 = 0 － 0. 4 0 ( ) 0. 4 0 0. 55 ， A 槇8 = 0 0 0 ( ) 0 0 0. 55 ，A 槇9 = 0 0. 4 0 ( ) － 0. 4 0 0. 55 ， A 槇10 = 0 0. 8 0 ( ) － 0. 8 0 0. 55 ， A 槇11 = 0 － 0. 8 0 ( ) 0. 8 0 0. 9 ，A 槇12 = 0 － 0. 4 0 ( ) 0. 4 0 0. 9 ， A 槇13 = 0 0 0 ( ) 0 0 0. 9 ，A 槇14 = 0 0. 4 0 ( ) － 0. 4 0 0. 9 ， A 槇15 = 0 0. 8 0 ( ) － 0. 8 0 0. 9 ． 由图 5 所示的前件规则结构图可知，G = 8，f = 4， 在 S1 中激活的规则分别为 Ｒ1 、Ｒ2 、Ｒ6 和 Ｒ7 ，对应的子 系统为 A1、A2、A6 和 A7 ． 以此类推，可得表 1． 图 5 模糊系统前件规则结构 Fig． 5 Premise rule structure of the fuzzy system 表 1 Ali的值 Table 1 Ali values i = 1 i = 2 i = 3 i = 4 i = 5 i = 6 i = 7 i = 8 l = 1 A1 A2 A3 A4 A6 A7 A8 A9 l = 2 A2 A3 A4 A5 A7 A8 A9 A10 l = 3 A6 A7 A8 A9 A11 A12 A13 A14 l = 4 A7 A8 A9 A10 A12 A13 A14 A15 令 ρi = 1，γ = 2，αi = 1，利用 Matlab 的线性矩阵不 等式工具箱求解式( 27) ～ 式( 29) ，可得控制器的反馈 增益矩阵 Kli ． K11 = － 1. 4229 － 0. 2688 － 0. 2055 － 0. 2268 － 0. 6211 － 0. 7883 － 1. 3275 － 0. 0730 － 0. 5771 － 1. 1723 T ，K21 = － 1. 2907 － 0. 1429 － 0. 3969 － 0. 2385 － 0. 5571 － 0. 7679 － 1. 3288 － 0. 0652 － 0. 5680 － 1. 1721 T ， K31 = － 1. 4137 － 0. 2959 － 0. 1861 － 0. 2931 － 0. 6640 － 0. 8921 － 1. 3277 － 0. 0689 － 0. 6093 － 1. 1736 T ，K41 = － 1. 2767 － 0. 1594 － 0. 3453 － 0. 3170 － 0. 6040 － 0. 8763 － 1. 3253 － 0. 0618 － 0. 6000 － 1. 1761 T ， K12 = － 1. 5135 － 0. 3006 － 0. 4702 － 0. 4409 － 0. 7068 － 0. 8839 － 1. 3337 － 0. 0834 － 0. 6385 － 1. 2544 T ，K22 = － 1. 3753 － 0. 1233 － 0. 6471 － 0. 4543 － 0. 8643 － 0. 9316 － 1. 3928 － 0. 0896 － 0. 6948 － 1. 2606 T ， K32 = － 1. 4637 － 0. 3206 － 0. 2862 － 0. 4883 － 0. 6210 － 0. 9977 － 1. 2730 － 0. 0646 － 0. 6150 － 1. 2418 T ，K42 = － 1. 3525 － 0. 1464 － 0. 5762 － 0. 5334 － 0. 5633 － 0. 9663 － 1. 3300 － 0. 0818 － 0. 7242 － 1. 2852 T ， K13 = － 1. 8376 － 0. 2825 － 0. 8080 － 0. 8410 － 0. 9163 － 1. 1791 － 1. 6344 － 0. 0894 － 0. 5750 － 1. 5094 T ，K23 = － 1. 5931 － 0. 0272 － 0. 6287 － 0. 8182 － 0. 8001 － 1. 1792 － 1. 5461 － 0. 0676 － 0. 5627 － 1. 5141 T ， K33 = － 1. 7764 － 0. 2479 － 0. 3465 － 0. 8836 － 0. 5839 － 1. 3318 － 1. 2612 － 0. 0206 － 0. 5576 － 1. 4910 T ，K42 = － 1. 7009 0. 0047 － 0. 4571 － 0. 8541 － 0. 4580 － 1. 2811 － 1. 2616 － 0. 0273 － 0. 5323 － 1. 5133 T ， K14 = － 2. 3554 － 0. 2040 － 0. 4331 － 1. 0268 － 0. 5228 － 1. 3889 － 1. 8557 － 0. 0341 － 0. 1636 － 1. 6892 T ，K24 = － 2. 2049 0. 0734 － 0. 2932 － 1. 0259 － 0. 3321 － 1. 3918 － 1. 8210 － 0. 0259 － 0. 1487 － 1. 6997 T ， K34 = － 2. 1157 － 0. 1656 － 0. 3099 － 1. 1310 － 0. 3818 － 1. 6119 － 1. 3131 － 0. 0083 － 0. 3835 － 1. 6924 T ，K44 = － 2. 1174 0. 1244 － 0. 4131 － 1. 0732 － 0. 2559 － 1. 5582 － 1. 2929 － 0. 0092 － 0. 3357 － 1. 7064 T ， K15 = － 1. 3989 － 0. 2579 － 0. 1874 － 0. 2251 － 0. 6315 － 0. 8381 － 1. 3110 － 0. 0785 － 0. 5433 － 1. 1890 T ，K25 = － 1. 2771 － 0. 1595 － 0. 3919 － 0. 2470 － 0. 6099 － 0. 8512 － 1. 3190 － 0. 0685 － 0. 5568 － 1. 1860 T ， K35 = － 1. 3919 － 0. 2714 － 0. 1757 － 0. 2949 － 0. 6872 － 0. 9381 － 1. 3137 － 0. 0771 － 0. 5866 － 1. 1935 T ，K45 = － 1. 2621 － 0. 1830 － 0. 3228 － 0. 2805 － 0. 6409 － 0. 9182 － 1. 3107 － 0. 0636 － 0. 5694 － 1. 1873 T ， · 269 ·
张佳媛等：基于分段模糊Lyapunov函数的轮式移动机器人轨迹跟踪控制 963· -1.3548 -0.27237 -1.2648 -0.1276 -0.1976 -0.4267 -0.5167 -0.4649 K16= -0.5545 -1.0590 ,K6= -0.8248 -1.1459 -1.3111 -0.0816 -1.3630 -0.0866 -0.5703 -1.3931 -0.6611 -L.4077」 -1.3459 -0.27567 -1.2588 -0.13287 -0.1855 -0.4790 -0.5123 -0.5062 K36=l -0.5628 -1.1781 ,K62 -0.7082 -1.2026 -1.3055 -0.0788 -1.3548 -0.0844 期望轨迹 -0.6197 -1.4014 -0.7216 -1.4259 一一一…跟踪轨迹 -1.5836 -0.10867Y -1.32260.1074 0 2 x/m 0.3912 -0.5623 0.0251 -0.6851 图6期望轨迹与跟踪轨迹 K17= 0.2099 -1.3295 ,K2= -0.0120 -1.5087 Fig.6 Desired trajectory and tracking trajectory -1.36940.0499 -1.3795 0.0437 L0.0915 -1.7375 -0.0656 -1.8451 -1.5547 -0.09327f -1.2939 0.1475 0.3857 -0.6895 0.0604 -0.8427 00 K7= 0.1177 -1.5398 Ka= -0.0974 -L.7555 0.5 -1.3704 0.0552 -1.3779 0.0471 0 L0.0285 -1.7983」 -0.1206 -1.9266 -0.13337F 50 100 50 -2.0510 -1.8497 0.0880 -0.6063 -0.7260 -0.5551 -0.7654 K18= -0.4622 -1.3633 ,K8= -0.7465 -1.4074 -1.6794 -0.0448 -1.6262 -0.0316 10 -0.2697 -1.6250 -0.3539 -1.6502 图7误差变化 -1.8124 -0.09937Y -1.4573 -0.0867 Fig.7 Change of errors -0.3689 -0.8088 -0.0389 -0.6947 K38= -0.2713 -1.5090 ,K48= -0.1165 -1.3110 -1.3033 -0.0079 -1.2080 -0.0121 -0.5551-1.6363 -0.2622 -1.5786 令初始值为e=0.5,-0.35,-0.6,0.2,0.3]T, 时刻t=30s时加入长度为5s,幅值为0.4N·m的干扰 0 102030405060708090100 s 0,时刻t=70s时加入长为0.3N·m的干扰w2,轨迹 跟踪仿真曲线和误差变化如图6和图7.系统的控制 变量正=（心立，）T和机器人实际的控制变量u= (w142)'的仿真曲线如图8和图9所示 0 根据仿真曲线图可知，利用本文提出的方法实现 0 10 2030405060708090100 了轨迹的理想跟踪，不仅克服了初始误差和外部干扰 图8控制变量 的影响，而且在跟踪过程中得到的控制输入量均在允 Fig.8 Control variables 许范围内 段模糊Lyapunov函数方法和并行分布补偿原理设计 4结论 了具有控制约束的H控制器，给出了新的线性矩阵不 本文采用分段模糊Lyapunov函数方法，研究了具 等式形式的稳定条件和控制器设计方法.以“8”字型 有控制约束和外部干扰条件的轮式移动机器人的轨迹 轨迹跟踪为例给出了应用仿真结果.仿真结果表明所 跟踪问题.将轮式移动机器人采用位姿误差的动力学 提出方法的有效性.利用分段模糊Lyapunov方法解决 误差模型进行转换并利用T$模型进行描述，利用分 T$模糊系统稳定性的相关研究存在“维数灾”、线性
张佳媛等: 基于分段模糊 Lyapunov 函数的轮式移动机器人轨迹跟踪控制 K16 = － 1. 3548 － 0. 2723 － 0. 1976 － 0. 4267 － 0. 5545 － 1. 0590 － 1. 3111 － 0. 0816 － 0. 5703 － 1. 3931 T ，K26 = － 1. 2648 － 0. 1276 － 0. 5167 － 0. 4649 － 0. 8248 － 1. 1459 － 1. 3630 － 0. 0866 － 0. 6611 － 1. 4077 T ， K36 = － 1. 3459 － 0. 2756 － 0. 1855 － 0. 4790 － 0. 5628 － 1. 1781 － 1. 3055 － 0. 0788 － 0. 6197 － 1. 4014 T ，K46 = － 1. 2588 － 0. 1328 － 0. 5123 － 0. 5062 － 0. 7082 － 1. 2026 － 1. 3548 － 0. 0844 － 0. 7216 － 1. 4259 T ， K17 = － 1. 5836 － 0. 1086 0. 3912 － 0. 5623 0. 2099 － 1. 3295 － 1. 3694 0. 0499 0. 0915 － 1. 7375 T ，K22 = － 1. 3226 0. 1074 0. 0251 － 0. 6851 － 0. 0120 － 1. 5087 － 1. 3795 0. 0437 － 0. 0656 － 1. 8451 T ， K37 = － 1. 5547 － 0. 0932 0. 3857 － 0. 6895 0. 1177 － 1. 5398 － 1. 3704 0. 0552 0. 0285 － 1. 7983 T ，K47 = － 1. 2939 0. 1475 0. 0604 － 0. 8427 － 0. 0974 － 1. 7555 － 1. 3779 0. 0471 － 0. 1206 － 1. 9266 T ， K18 = － 2. 0510 － 0. 1333 － 0. 6063 － 0. 7260 － 0. 4622 － 1. 3633 － 1. 6794 － 0. 0448 － 0. 2697 － 1. 6250 T ，K28 = － 1. 8497 0. 0880 － 0. 5551 － 0. 7654 － 0. 7465 － 1. 4074 － 1. 6262 － 0. 0316 － 0. 3539 － 1. 6502 T ， K38 = － 1. 8124 － 0. 0993 － 0. 3689 － 0. 8088 － 0. 2713 － 1. 5090 － 1. 3033 － 0. 0079 － 0. 5551 － 1. 6363 T ，K48 = － 1. 4573 － 0. 0867 － 0. 0389 － 0. 6947 － 0. 1165 － 1. 3110 － 1. 2080 － 0. 0121 － 0. 2622 － 1. 5786 T ． 令初始值为 e =［0. 5，－ 0. 35，－ 0. 6，0. 2，0. 3］T ， 时刻 t = 30 s 时加入长度为 5 s，幅值为 0. 4 N·m 的干扰 w1，时刻 t = 70 s 时加入长为 0. 3 N·m 的干扰 w2，轨迹 跟踪仿真曲线和误差变化如图 6 和图 7． 系统的控制 变量 u槇 = ( u槇1 u槇2 ) T 和机器人实际的控制变量 u = ( u1 u2 ) T 的仿真曲线如图 8 和图 9 所示． 根据仿真曲线图可知，利用本文提出的方法实现 了轨迹的理想跟踪，不仅克服了初始误差和外部干扰 的影响，而且在跟踪过程中得到的控制输入量均在允 许范围内． 4 结论 本文采用分段模糊 Lyapunov 函数方法，研究了具 有控制约束和外部干扰条件的轮式移动机器人的轨迹 跟踪问题． 将轮式移动机器人采用位姿误差的动力学 误差模型进行转换并利用 T-S 模型进行描述，利用分 图 6 期望轨迹与跟踪轨迹 Fig． 6 Desired trajectory and tracking trajectory 图 7 误差变化 Fig． 7 Change of errors 图 8 控制变量 Fig． 8 Control variables 段模糊 Lyapunov 函数方法和并行分布补偿原理设计 了具有控制约束的 H∞ 控制器，给出了新的线性矩阵不 等式形式的稳定条件和控制器设计方法． 以“8”字型 轨迹跟踪为例给出了应用仿真结果． 仿真结果表明所 提出方法的有效性． 利用分段模糊 Lyapunov 方法解决 T-S 模糊系统稳定性的相关研究存在“维数灾”、线性 · 369 ·
·964· 工程科学学报，第37卷，第7期 [12]Chen C,Li T S,Yeh Y.EP-based kinematic control and adap- tive fuzzy sliding-mode dynamic control for wheeled mobile ro- M hots.Inf Sci,2009,179(1-2):180 [13]Khooban M H,Alfi A,Abadi D N M.Teaching-earning-based optimal interval type2 fuzzy PID controller design:a nonholo- 30405060708090100 nomic wheeled mobile robots.Robotica,2013,31(7):1059 [14]Cui M Y,Sun D H.Li Y F,et al.Adaptive tracking control of 1) wheeled mobile robots in presence of longitudinal slipping.Con- trol Decis,2013,28(5):664 (崔明月，孙棣华，李永福，等.轮子纵向打滑条件下的移动 WP个 机器人自适应跟踪控制.控制与决策，2013,28(5)：664) [15]Gonzalez R,Fiacchini M,Alamo T,et al.Adaptive control for a -50102030405060708090100 mobile robot under slip conditions using an LMI-based approach. Eur J Control,2010,16(2):144 图9轮式移动机器人的实际控制变量 [16]Chwa D.Fuzzy adaptive tracking control of wheeled mobile ro- Fig.9 Actual control input of WMR bots with state-dependent kinematic and dynamic disturbances. IEEE Trans Fuzzy Syst,2012,20(3):587 矩阵不等式数目多等问题，如何降低相关方法的线性 [17]TakagiT,Sugeno M.Fuzzy identification of systems and its ap- 矩阵不等式数目是一个值得深入研究的问题，此方向 plication to modeling and control.IEEE Trans Syst,1985,SMC- 15(1):116 将是进一步研究的重点. 18] Feng G.Cao S G.Rees N W,et al.Design of fuzzy control sys- 参考文献 tems with guaranteed stability.Fuzzy Sets Syst,1997,85(1):1 1]Chen C.LiTS,Yeh Y,et al.Design and implementation of an 09] Tanaka K,Wang H O.Fuzzy Control Systems Design and Analysis: adaptive sliding-mode dynamic controller for wheeled mobile ro- a Linear Matrix Inequality Approach.New York:Wiley,2001 bots.Mechatronics,2009,19(2):156 [20] Gao XQ,Chen H.Tracking control for wheeled mobile robot via 2]Cao Z C,Zhao YT,Fu YL Trajectory tracking control approach T-$fuzzy model.Control Theory Appl,2007,24(6):873 of a car-ike mobile robot.Acta Electron Sin,2012,40(4):632 (高兴泉，陈虹.基于T6模型的轮式移动机器人轨迹限踪 (曹政才，赵应祷，付宜利.车式移动机器人轨迹跟踪控制方 控制.控制理论与应用，2007,24(6)：873) 法.电子学报，2012,40(4)：632) 21]Tanaka K,Hori H,Wang H O.A multiple Lyapunov function B]Chwa D.Tracking control of differential-drive wheeled mobile ro- approach to stabilization of fuzzy control systems.IEEE Trans bots using a backstepping-ike feedback linearization.IEEE Trans Fuzzy Syst,2003,11(4):582 Sxt,2010,40(6):1285 2]Ji Z C,Zhou Y H,Shen Y X.Stabilization of a class of fuzzy 4]Kumar U,Sukavanam N.Backstepping based trajectory tracking control systems via piecewise fuzzy Lyapunov function approach control of a four wheeled mobile robot.Int J Ade Rob Syst,2008, /Proceedings of 2007 American Control Conference.New York, 5(4):403 2007:4065 [5]Martins F N,Celeste W C,Carelli R,et al.An adaptive dynamic [23]Ji Z C,Zhu Y,Wang Y.H control for T-$fuzzy system based controller for autonomous mobile robot trajectory tracking.Control on piecewise fuzzy Lyapunov approach.Control Decis,2007,22 Eng Pract,2008,16(11):1354 (12):1357 [6]Canigur E,Ozkan M.Model reference adaptive control of a non- (纪志成，朱芸，王艳.基于分段模糊Ly即unov函数方法的 holonomie wheeled mobile robot for trajectory tracking//Proceed- T6模糊系统H.控制.控制与决策，2007,22(12)：1357) ings of INISTA 2012-International Symposium on Innovations in 4]Ji Z C,Zhou Y H,Shen Y X.Stability analysis and guaranteed Intelligent Systems and Applications.Turkey,2012:1 cost design of fuzzy systems via piecewise fuzzy Lyapunov function 7]Tabibian B,Shojaei K,Shahri A M,et al.Adaptive trajectory approach.Acta Autom Sin,2008,34(6):721 tracking control of a differential drive wheeled mobile robot.Ro- (纪志成，周英焕，沈艳霞.基于分段模糊Lyapunov函数的 botica,2011,29(3):391 模糊系统稳定性分析和保性能设计.自动化学报，2008,34 [8]HoangTT,Hiep DT,Duong B G,et al.Trajectory tracking con- (6):721) trol of the nonholonomic mobile robot using torque method and 25] Corradini M L,Orlando G.Control of mobile robots with uncer- neural network /Proceedings of 2013 IEEE 8th Conference on In- tainties in the dynamical model:a discrete time sliding mode ap- dustrial Electronics and Applications.Melboumne,2013:1798 proach with experimental results.Control Eng Pract,2002,10 9]Fengchun Z,Ju D.An optimized fuzzy trajectory tracking control (1):23 of mobile robots /Proceedings of Chinese Control and Decision 26 Kanayama Y,Kimura Y,Miyazaki F,et al.A stable tracking Conference 2008.Yantai,2008:2156 control method for an autonomous mobile robot /Proceedings of [10]Park B S,Yoo S J,Park J B,et al.Adaptive neural sliding mode the 1990 IEEE International Conference on Robotics and Automa- control of nonholonomic wheeled mobile robots with model uncertain- tion.Cincinnati,1990:384 ty.IEEE Trans Control Syst Technol,2009,17(1):207 [27] Guechi E,Lauber J,Dambrine M,et al.Tracking-error model- [11]Martinez R,Castillo O,Aguilar LT.Optimization of interval type2 based PDC control for mobile robots with acceleration limits// fuzzy logic controllers for a perturbed autonomous wheeled mobile ro- Proceedings of 009 IEEE International Conference on Fuzzy Sys- bot using genetic algorithms.Inf Sci,2009,179(13):2158 tems.Jeju Island,2009:197
工程科学学报，第 37 卷，第 7 期 图 9 轮式移动机器人的实际控制变量 Fig． 9 Actual control input of WMＲ 矩阵不等式数目多等问题，如何降低相关方法的线性 矩阵不等式数目是一个值得深入研究的问题，此方向 将是进一步研究的重点． 参 考 文 献 ［1］ Chen C，Li T S，Yeh Y，et al． Design and implementation of an adaptive sliding-mode dynamic controller for wheeled mobile robots． Mechatronics，2009，19( 2) : 156 ［2］ Cao Z C，Zhao Y T，Fu Y L． Trajectory tracking control approach of a car-like mobile robot． Acta Electron Sin，2012，40( 4) : 632 ( 曹政才，赵应涛，付宜利． 车式移动机器人轨迹跟踪控制方 法． 电子学报，2012，40( 4) : 632) ［3］ Chwa D． Tracking control of differential-drive wheeled mobile robots using a backstepping-like feedback linearization． IEEE Trans Syst，2010，40( 6) : 1285 ［4］ Kumar U，Sukavanam N． Backstepping based trajectory tracking control of a four wheeled mobile robot． Int J Adv Ｒob Syst，2008， 5( 4) : 403 ［5］ Martins F N，Celeste W C，Carelli Ｒ，et al． An adaptive dynamic controller for autonomous mobile robot trajectory tracking． Control Eng Pract，2008，16( 11) : 1354 ［6］ Canigur E，Ozkan M． Model reference adaptive control of a nonholonomic wheeled mobile robot for trajectory tracking / / Proceedings of INISTA 2012—International Symposium on Innovations in Intelligent Systems and Applications． Turkey，2012: 1 ［7］ Tabibian B，Shojaei K，Shahri A M，et al． Adaptive trajectory tracking control of a differential drive wheeled mobile robot． Ｒobotica，2011，29( 3) : 391 ［8］ Hoang T T，Hiep D T，Duong B G，et al． Trajectory tracking control of the nonholonomic mobile robot using torque method and neural network / / Proceedings of 2013 IEEE 8th Conference on Industrial Electronics and Applications． Melbourne，2013: 1798 ［9］ Fengchun Z，Ju D． An optimized fuzzy trajectory tracking control of mobile robots / / Proceedings of Chinese Control and Decision Conference 2008． Yantai，2008: 2156 ［10］ Park B S，Yoo S J，Park J B，et al． Adaptive neural sliding mode control of nonholonomic wheeled mobile robots with model uncertainty． IEEE Trans Control Syst Technol，2009，17( 1) : 207 ［11］ Martínez Ｒ，Castillo O，Aguilar L T． Optimization of interval type-2 fuzzy logic controllers for a perturbed autonomous wheeled mobile robot using genetic algorithms． Inf Sci，2009，179( 13) : 2158 ［12］ Chen C，Li T S，Yeh Y． EP-based kinematic control and adaptive fuzzy sliding-mode dynamic control for wheeled mobile robots． Inf Sci，2009，179( 1--2) : 180 ［13］ Khooban M H，Alfi A，Abadi D N M． Teaching-learning-based optimal interval type-2 fuzzy PID controller design: a nonholonomic wheeled mobile robots． Ｒobotica，2013，31( 7) : 1059 ［14］ Cui M Y，Sun D H，Li Y F，et al． Adaptive tracking control of wheeled mobile robots in presence of longitudinal slipping． Control Decis，2013，28( 5) : 664 ( 崔明月，孙棣华，李永福，等． 轮子纵向打滑条件下的移动 机器人自适应跟踪控制． 控制与决策，2013，28( 5) : 664) ［15］ Gonzalez Ｒ，Fiacchini M，Alamo T，et al． Adaptive control for a mobile robot under slip conditions using an LMI-based approach． Eur J Control，2010，16( 2) : 144 ［16］ Chwa D． Fuzzy adaptive tracking control of wheeled mobile robots with state-dependent kinematic and dynamic disturbances． IEEE Trans Fuzzy Syst，2012，20( 3) : 587 ［17］ Takagi T，Sugeno M． Fuzzy identification of systems and its application to modeling and control． IEEE Trans Syst，1985，SMC- 15( 1) : 116 ［18］ Feng G，Cao S G，Ｒees N W，et al． Design of fuzzy control systems with guaranteed stability． Fuzzy Sets Syst，1997，85( 1) : 1 ［19］ Tanaka K，Wang H O． Fuzzy Control Systems Design and Analysis: a Linear Matrix Inequality Approach． New York: Wiley，2001 ［20］ Gao X Q，Chen H． Tracking control for wheeled mobile robot via T-S fuzzy model． Control Theory Appl，2007，24( 6) : 873 ( 高兴泉，陈虹． 基于 T-S 模型的轮式移动机器人轨迹跟踪 控制． 控制理论与应用，2007，24( 6) : 873) ［21］ Tanaka K，Hori H，Wang H O． A multiple Lyapunov function approach to stabilization of fuzzy control systems． IEEE Trans Fuzzy Syst，2003，11( 4) : 582 ［22］ Ji Z C，Zhou Y H，Shen Y X． Stabilization of a class of fuzzy control systems via piecewise fuzzy Lyapunov function approach / / Proceedings of 2007 American Control Conference． New York， 2007: 4065 ［23］ Ji Z C，Zhu Y，Wang Y． H∞ control for T-S fuzzy system based on piecewise fuzzy Lyapunov approach． Control Decis，2007，22 ( 12) : 1357 ( 纪志成，朱芸，王艳． 基于分段模糊 Lyapunov 函数方法的 T-S 模糊系统 H∞ 控制． 控制与决策，2007，22( 12) : 1357) ［24］ Ji Z C，Zhou Y H，Shen Y X． Stability analysis and guaranteed cost design of fuzzy systems via piecewise fuzzy Lyapunov function approach． Acta Autom Sin，2008，34( 6) : 721 ( 纪志成，周英焕，沈艳霞． 基于分段模糊 Lyapunov 函数的 模糊系统稳定性分析和保性能设计． 自动化学报，2008，34 ( 6) : 721) ［25］ Corradini M L，Orlando G． Control of mobile robots with uncertainties in the dynamical model: a discrete time sliding mode approach with experimental results． Control Eng Pract，2002，10 ( 1) : 23 ［26］ Kanayama Y，Kimura Y，Miyazaki F，et al． A stable tracking control method for an autonomous mobile robot / / Proceedings of the 1990 IEEE International Conference on Ｒobotics and Automation． Cincinnati，1990: 384 ［27］ Guechi E，Lauber J，Dambrine M，et al． Tracking-error modelbased PDC control for mobile robots with acceleration limits / / Proceedings of 2009 IEEE International Conference on Fuzzy Systems． Jeju Island，2009: 197 · 469 ·
