基于干扰观测器的球形移动机器人直线运动控制

于涛 王益博 孙汉旭 赵伟

摘要：针对受扰球形移动机器人的直线运动控制问题，提出一种基于滑模干扰观测器和双幂次趋近律的分层滑模控制方法。该控制方法利用滑模干扰观测器对未知扰动进行在线估计，并且采用基于滑模干扰观测器的分层滑模控制器实现被控机器人系统的连续鲁棒控制。首先设计被控系统的第一层和第二层滑动变量，然后基于第一层滑动变量定义系统的辅助滑动变量。基于所定义的辅助滑动变量设计滑模干扰观测器，然后基于所设计的滑模干扰观测器和第二层滑动变量，采用改进的双幂次趋近律设计分层滑模控制器。从理论上分析所设计的分层滑模控制器作用下闭环系统的稳定性，并通过仿真实验验证所提控制方法的有效性。

关键词：球形机器人;直线运动;分层滑模控制;干扰观测器;双幂次趋近律

中图分类号：TP273 文献标志码：A 文章编号：1674-5124（2019）09-0123-07

收稿日期：2018-10-10;收到修改稿日期：2018-11-23

基金項目：辽宁省自然科学基金指导计划项目（201602379）;辽宁省教育厅科学技术研究一般项目（L2015241）

作者简介：于涛（1980-），男，天津市人，讲师，博士，研究方向为机器人运动分析与控制、滑模控制理论与应用。

0 引言

随着科技发展，移动机器人在不同的应用领域中发挥着日益重要的作用。球形移动机器人是一种具有球形外壳，并且通过滚动方式穿越地表环境的移动机器人。球形机器人移动时不需要借助任何可见的外部驱动，而且在工作空间中滚动时必须服从球——平面非完整约束。因此，球形移动机器人需要采用相对新颖的运动机构、巧妙复杂的动态分析方法和先进的控制算法[1-3]。球形外壳赋予球形移动机器人耐用、不会倾倒、与外界环境完全隔离的优点，在巡逻监视[4]、外星探测[5]、环境监测[6]、水下作业[7]，甚至儿童教育[8]等方面球形移动机器人都有着广泛的应用。

球形移动机器人在工作空间内的滚动模式可以分为二维平面滚动模式和三维空间滚动模式。在二维平面滚动模式下，球形移动机器人进行典型的直线运动。从球形移动机器人直线运动控制方法的研究现状[9-14]来看，大部分现有方法[9-13]采用被控对象的标称模型[9-11]或标称模型的线性化模型[12-13]来设计控制器;但由于实际对象中不可避免地存在着很多无法用数学模型精确描述的不确定性，并且在设计控制系统时忽略了这些不确定性对控制性能的不良影响，导致基于上述方法[9-13]的控制器在实际中很难实现预期的性能品质。由此可知，球形移动机器人直线运动的鲁棒控制问题是目前该领域中亟待解决的重要问题之一。

针对球形移动机器人直线运动的鲁棒控制问题，本文设计一种基于滑模干扰观测器和双幂次趋近律的分层滑模控制器。具体而言，首先基于第一层滑动变量设计球壳和单摆子系统的滑模干扰观测器，然后提出一种改进的双幂次趋近律以使第二层滑动变量快速收敛于零，最后基于改进的双幂次趋近律和滑模干扰观测器设计连续的分层滑模控制器。并通过理论分析与仿真实验验证本文所设计的分层滑模控制器确保闭环控制系统的鲁棒稳定性。I球形机器人直线运动的动力学模型

LGQ-I型三驱动球形机器人的三维模型如图1所示，其本体结构主要包括球壳、内框、单摆和直流电机。与BYQ-XII型三驱动球形机器人[14]相比，LGQ-I型三驱动球形机器人内框的尺寸和质量较小，而单摆的质量和摆杆的长度较大。因此，LGQ-I型三驱动球形机器人的单摆质量相对总体质量的占比很高，因而能够提供较大的偏心力矩，可以实现更迅速、更灵活的滚动运动。

当球壳内的长轴电机带动内框和单摆相对球壳转动时，球形机器人能够进行向前或向后的直线滚动。当轨道电机带动内框和单摆相对球壳转动时，球形机器人能够完成原地转向动作。当短轴电机带动单摆相对内框转动时，球形机器人能够在进行滚动运动时向左或向右转向。由此可见，LGQ-I型三驱动球形机器人具有一定的容错能力。当短轴电机或轨道电机出现故障时，球形机器人仍能实现全方位的滚动运动。

LGQ-I型三驱动球形机器人直线运动的简化模型如图2所示，在长轴电机输出力矩：的作用下，球形机器人在XOZ平面内滚动。其中，球壳的质量为m₁，内框的质量为m₂，单摆的质量为m₃，球壳的半径为r，单摆的摆杆长度为l，内框的转动惯量为I，球壳的滚动角度为θ，球心的水平位移为x，单摆的摆动角度为φ。

基于拉格朗日法建立球形移动机器人直线运动的动力学模型，球形机器人系统的动能U为其中M=m₁+m₂+m₃，J=m₃l²+I。

球形机器人系统的势能V为

V=-m₃9lcosφ（2）

利用含耗散函数的拉格朗日方程，由式（1）和式（2）可得球形移动机器人直线运动的运动方程为其中μ为粘滞摩擦系数;g为重力加速度。

假设球壳在地面滚动时不打滑，则有如下关系式成立：

θ=x/r θ=x/r（4）

将式砰）代入式（3），可得球形移动机器人直线运动的动力学模型为

M（q）q+N（q，q）=Fτ（5）

式中：

由动力学模型式（5），可得直线运动时球形机器人系统的非完整约束条件为

式中：

将球形移动机器人直线运动的动力学模型式（5）表示成如下形式：式中d₁（t）和d₂（t）表示包含外部干扰和模型不确定性的未知扰动。不失一般性，假设未知扰动dl₁t）和d₂（t）有界，即存在正常数L₁和L₂，使得|d₁（t）|≤L₁，|d₂（t）|≤L₂;f₁（x，φ，φ），f₂（x，φ，φ），b₁（φ），b₂（φ）的表达式分别为

2 基于干扰观测器的分层滑模控制

2.1 问题描述

对于球形移动机器人，其直线运动的控制目标是：通过合理地设计控制律τ（t），使球心位置x（t）和单摆摆角φ（t）分别收敛至各自的期望值x_ref（t）和φ_ref（t）。不失一般性，假设球心和单摆摆角的期望轨迹x_ref（t）和φ_ref（t）关于时间t二阶可导。根据被控机器人系统的控制目标，分别设计球壳子系统和单摆子系统的第一层滑动变量s₁（t）和s₂（t）为k2>0。

注1：由于球心的运动轨迹x（t）和单摆摆角的运动轨迹φ（t）满足约束条件式（6），当给定球心的期望轨迹x_ref（t）时，可由式（6）相应地求得单摆摆角的期望轨迹φ_ref（t）。特别地，当球形移动机器人在地面上保持静止或匀速前进时，即在球形移动机器人直线运动的位置控制问题或速度控制问题中，由式（6）可以推得单摆摆角的期望值为_ref=0。

由式（7）和式（8），进一步可得s₁（t）和s₂（t）为

s₁（t）=h₁+b₁τ+d₁s₂（t）=h₂+b₂τ+d₂（9）式中h₁=f₁+k₁ex-x_ref，h₂=f₂+k₂eφ-φ_ref。

基于所设计的第一层各滑动变量s₁（t）和s₂（t），进一步定义第二层滑动变量s₃（t）为

s₃（t）=c₁·s₁（t）+c₂·s₂（t）（10）式中c₁>0，c₂>0。

对式（10）求导并由式（9），可得s₃（t）为

s₃（t）=c₁s₁+c₂s₂=h₃+b₃τ+c₁d₁+c₂d₂（11）式中h₃=c₁h₁+c₂h₂，b₃=c₁b₁+c₂b₂。

至此，球形移动机器人直线运动的控制目标转化为：在被控机器人系统式（7）存在未知扰动d₁（t）和d₂（t）的条件下，通过合理地设计控制τ（t）使式（11）所示的第二层滑动变量s₃（t）→0。

2.2 滑模干扰观测器设计

首先采用滑模干扰观测器对未知扰动dl（t）和d₂（t）进行在线估计，然后在此基础上采用双幂次趋近律设计分层滑模控制器以确保滑动变量s₃（t）快速趋近于零。

定义辅助滑动变量σ₁（t）和σ₂（t）为

σ_i（t）=s_i（t）+z_i（t），z_i（t）=-h_i-b_iτ-u_i，i=1，2

（12）式中z_i为滑模干扰观测器i的内部变量，u_i为待设计的滑模干扰观测器i的注入项。

由式（9）和式（12），可以得到

σ_i（t）=s_i+z_i=d_i-u_i（13）

基于式（13）所示的辅助滑动变量σ_i（t）的动态方程，设计滑模干扰观测器i的注入项u_i（t）为

u_i（t）=ε_isign（σ_i），ε_i=L_i+ρ_i（14）式中ρ_i>0。很容易证明[15]，采用式（14）所示的滑模干扰观测器注入项u_i（t），辅助滑动变量σ_i（t）能够在有限时间t_ri≤|σ_i（0）|/ρ_i内收敛于零。

设滑模干扰观测器i的注入项u_i（t）的等效控制为u_eq，i（t）。由等效控制原理和式（13）可知：在輔助滑动面σ_i（t）=0上，等效控制u_eq，i（t）能够准确估计未知扰动d_i（t），即u_eq，i（t）=d_i（t），■t≥t_r，i。

实际中，采用干扰观测器注入项u_i（t）的一阶低通滤波平均值来计算其等效控制u_eq，i（t），即

γ_iu_eq，i（t）+u_eq，i（t）=u_i（t）（15）式中γ_i>0。

在式（15）中，选取很小的滤波时间常数γ_i，可使实际等效控制u_eq，i（t）足够准确地逼近理想等效控制u_eq，i（t）a因此滑模干扰观测器t可以通过式（15）所示的注入项等效控制u_eq，i（t）对未知扰动d_i（t）进行准确估计，即：

u_eq，i（t）=d_i（t），■t≥t_r，i（16）

2.3 分层滑模控制器设计

记t_r3=max（t_r1，t_r2）。由式（11）和式（16），可以得到：

s₃（t）=h₃+b₃τ+c₁u_eq1+c₂h_eq2，■t≥t_r3（17）

为使第二层滑动变量s₃（t）快速收敛于零，本文提出一种改进的双幂次趋近律，然后基于改进的双幂次趋近律设计分层滑模控制器。

基于文献[16]提出的双幂次趋近律，设计改进的双幂次趋近律为式中λ₁>0，λ₂>0，λ₃>0，α>1，0<β<1。

注2：在改进的双幂次趋近律式（18）中，前2项为幂次趋近项，第3项为指数趋近项。如果不考虑控制增益A_i的影响，当系统状态远离滑动面S3=0（即|s₃|>1）时，第1项起主导作用;当系统状态接近滑动面S3=0（即|s₃|<1）时，第2项起主导作用;在系统状态的趋近过程中，第3项的作用始终介于第1项和第2项之间。由此可见，改进后的双幂次趋近律具有更快的趋近速度。由s₃=|s₃|sign（s₃）可见，指数趋近项-λ₃s₃实际上是幂指数为1的幂次趋近项。由此可知，改进的双幂次趋近律式（18）实际上是一种特殊的三幂次趋近律。

由式（17）和式（1g），可得分层滑模控制器为

2.4 稳定性分析

分析1;对于式（7）所示的球形机器人系统，按式（8）和式（10）设计各层滑动变量，并按式（12）和式（14）设计滑模干扰观测器，如果采用式（19）所示的分层滑模控制器，那么第二层滑动变量s₃（t）及其导数s₃（t）能够在有限时间内收敛于零。

证明：将控制律式（19）代入式（11），可以得到

为便于分析，将第二层滑动变量s₃（t）的收敛过程分为两个阶段。第1阶段为辅助滑动变量σ_i（t）的收敛阶段（0r3

分析2：对于式（7）所示的球形机器人系统，按式（8）和式（10）设计各层滑动变量，并按式（12）和式（14）设计滑模干扰观测器，如果采用式（19）所示的分层滑模控制器，那么第一层滑动变量s₁（t）和s₂（t）渐近收敛于零。

对于按式（8）设计的第一层各滑动变量，由文献[18]定理4.2的证明可知，在分层滑模控制器式（19）的作用下，滑动变量s₁（t）和s₂（t）渐近收敛于零，即

3 仿真验证

为验证本文提出的控制方法的有效性，利用Matlab/Simulmk仿真环境进行球形移动机器人直线运动的速度控制实验。LGQ-1型三驱动球形机器人的各参数分别为：m₁=1.45 kg，m₂=0.65kg，m₃=3.5kg，r=0.15m，1=7.63×10^-4kg·m²，l=0.107m，μ=0.02N·m/（rad/s）。

设球形移动机器人的初始状态为：x（0）=0，x（0）=0，φ（0）=0，φ（0）=0。设球形移动机器人的期望速度为x_ref=1m/s，相应地选取球心的期望轨迹为x_ref（t）=t，单摆摆角的期望值为φ_ref=0。仿真实验中，重力加速度取为g=9.81m/s²，长轴电机的最大输出力矩设为|τ|_max=3.7N·m。设仿真时间为T=6s，采样时间为t_s=0.001s。

为检验本文提出的控制方法的控制性能和鲁棒性，假设实际球形机器人带有10%的参数不确定性，在此基础上与文献[14]提出的控制方法进行对比分析。将文献[14]提出的控制方法应用于直线运动的速度控制问题时，需要将球形移动机器人的期望轨迹y_d和滑动面s₁的等效控制τ_eq1相应地修改为

为确保两种控制方法均能提供最优的控制性能，对基于两种控制方法的控制器各参数进行充分整定。在进行仿真对比时，基于本文方法的控制器各参数分别为：k₁=0.64，k₂=5.9，c₁=7.1，c₂=2.6，ε₁=6.5，ε₂=28，λ₁=7.4，λ₂=9.2，λ₃=9.4，α=1.5，β=0.5。基于文献[14]方法的控制器各参数分别为：λ₁=1.1，λ₂=7.5，α₁=7.1，α₂=1.6，ω（0）=2.3，σ=0.4，φ=0.1，k=8.3。

基于本文方法的控制器的控制效果如图3至图5所示。图3为球心速度、单摆摆角和长轴电机输出力矩的变化曲线，可见在基于本文方法的连续分层滑模控制器式（19）作用下，球心速度和单摆摆角分别于3.122s和3.039s收敛至各自的期望值。仿真实验结果表明，本文方法能够有效实现球形移动机器人直线运动的连续鲁棒控制。图4和图5分别为各辅助滑动变量和各层滑动变量的变化曲线，可见各滑动变量均能快速地收敛于零。具体而言，由图4可见辅助滑动变量的整体收敛时间为t_r3=0.149s，進而由式（22）可知第二层滑动变量的收敛时间估计为t_r4<0.637s;又图5可见第二层滑动变量的实际收敛时间为t_r4=0.622s。由此可知，第二层滑动变量的实际收敛时间t_r4与式（23）所示的估算结果是相符的。

基于文献[14]方法的控制器的控制效果如图6所示。可以看出，在基于文献[14]方法的控制器作用下，球心速度和单摆摆角分别于3.48s和2.891s收敛至各自的期望值。需要指出的是，虽然两种控制方法均能实现被控球形机器人系统的连续鲁棒控制，但本文方法采用的是连续的控制律，而文献[14]方法采用的是连续化的控制律，这也是两种控制方法的重要区别之一。此外，由仿真实验结果可见：当球心速度趋于稳定后，长轴电机仍需提供一定的平衡力矩以补偿内框与球壳之间的粘滞摩擦力。由动力学模型式（5）可以推得，长轴电机输出的平衡力矩为τ_SS=μx_ref/r。考虑到参数不确定性的影响，由上式可以求得长轴电机实际输出的平衡力矩为τ_SS=0.133N·m，所得结果与仿真实验结果是一致的。

为评价球形机器人速度控制器的控制性能，分别定义球心速度平均跟踪误差E（x）和单摆摆角平均跟踪误差E（φ）为式中n为采样点个数，t_i为第i个采样时间点。

由式（25）可以分别求得在基于本文方法的控制器作用下和基于文献[14]方法的控制器作用下，球心速度平均跟踪误差E（x）和单摆摆角平均跟踪误差E（φ）。以上两种控制器作用下，各性能指标的计算结果如表1所示。

由表可以看出，相较于基于文献[14]方法的控制器，在基于本文方法的控制器作用下，球心速度平均跟踪误差E（t）和单摆摆角平均跟踪误差E（φ）均较小。性能指标E（x）和E（φ）的对比结果表明，基于本文方法的控制器具有较好的控制性能。

4 结束语

本文探讨了带有未知扰动的球形移动机器人的直线运动控制问题，提出一种基于滑模干扰观测器和改进的双幂次趋近律的分层滑模控制方法。本文提出的控制方法利用干扰观测器注入项的等效控制对被控机器人系统的未知扰动进行在线估计，并且采用基于干扰观测器注入项的等效控制和改进的双幂次趋近律的连续分层滑模控制器实现被控机器人系统的快速稳定。从理论上证明了各辅助滑动变量和各层滑动变量的收敛性，仿真实验结果表明本文设计的分层滑模控制器能够提供良好的控制性能和鲁棒性。

参考文献

[1]ARMOUR R H，VINCENT J F V.Rolling in nature androbotics：a review[J].Journal of Bionic Engineering，2006，3（4）：195-208.

[2]CROSSLEY V A.A literature review of the design ofspherical rolling robots[R].Pittsburgh，Camegie MellonUniversity，2006.

[3]CHASE D，PANDYA A.A review of active mechanicaldriving principles of spherical robots[J].Robotics，2012，1（1）：3-23.

[4]WU F，VIBHUTE A，SOH G S，et al.A compact magneticfield-based obstacle detection and avoidance system forminiature spherical robots[J].Sensors，2017，17（6）：1-20.

[5]HOGAN F R，FORBES J R，BARFOOT T D.Rolling stabilityof a power-generating tumbleweed rover[J].Journal ofSpacecraft and Rockets，2015，51（6）：1895-1906.

[6]HERNANDEZ J D，BARRIENTOS J，CERRO J D，et al.Moisture measurement in crops using spherical robots[J].Industrial Robot：An International Journal，2013，40（1）：59-66.

[7]LI Y，YANG M，SUN H，et al.A novel amphibious sphericalrobot equipped with flywheel，pendulum，and propeller[J].Journal of Intelligent and Robotic Systems，2017，2：1-17.

[8]MICHAUD F，LAPLANTE J F，LAROUCHE H，et al.Autonomous spherical mobile robot for child-developmentstudies[J].IEEE Transactions on Systems，Man，andCybernetics，2005，35（4）：1-10.

[9]MADHUSHANI T W U，MAITHRIPALA D H S，BERG J M.Feedback regularization and geometric PHD control fortrajectory tracking of mechanical systems：hoop robots on aninclined plane[C]//American Control Conference，2017.

[10]ZHAN Q，CHI X，XI X.Linear motion control of anunderactuated spherical mobile robot[J].Applied Mechanicsand Materials，2014，644-650：351-355.

[11]IVANOVA T B，PIVOVAROVA E N.Dynamics and controlof a spherical robot with an axisymmetric pendulumactuator[J].Physics，2015，9（3）：507-520.

[12]YE P，SUN H，QIU Z，et al.Design and motion control of aspherical robot with stereovision[C]//IEEE Conference onIndustrial Electronics and Applications，2016.

[13]YUE M，LIU B.Disturbance adaptive control for anunderactuated spherical robot based on hierarchical sliding-mode technology[C]//Chinese Control Conference，2012.

[14]于濤，孙汉旭，赵伟，等.基于自适应分级滑模控制的球形机器人定位控制[J].中国测试，2018，44（5）：97-102.

[15]UTKIN V，GULDNER J，SHI J M.Sliding mode control inelectro-mechanical systems[M].Boca Raton：CRC，2009：216.

[16]梅红，王勇.快速收敛的机器人滑模变结构控制[J].信息与控制，2009，38（5）：552-557.

[17]张合新，范金锁，孟飞，等.一种新型滑模控制双幂次趋近律[J].控制与决策，2013，28（2）：289-293.

[18]QIAN D，YI J.Hierarchical sliding mode control for under-actuated cranes：design，analysis and simulation[M].Berlin：Springer-Verlag，2016：83.

（编辑：莫婕）