图书自动盘点机器人变结构轨迹跟踪方法研究

王 琦

(1.郑州大学 图书馆 河南 郑州 450001; 2.郑州大学 科学技术信息研究所 河南 郑州 450001)

0 引言

随着电子技术、计算机技术、网络技术和智能化技术的不断发展和完善,智慧图书馆的概念被提出。智慧图书馆是通过数字化、智能化的手段服务读者,它是未来图书馆的发展趋势。智能机器人具备感知、思维和动作三要素,是人工智能技术不可或缺的载体。智能机器人又分为工业机器人和服务机器人两种,图书馆使用的主要是服务机器人[1]。图书馆自动盘点机器人可以有效协助馆员进行盘点、排架工作,降低了人工排架的错误率,近几年来在国内外各大图书馆应用广泛。沈奎林等基于超高频射频识别(radio frequency identification,RFID)技术研制了一种图书自动盘点机器人,并在南京大学图书馆成功试运行[2]。随后,该团队又针对自动盘点机器人在图书馆应用的不足之处,讨论了在情景共融需求下盘点机器人的发展趋势[3]。张宣政设计了一种书库自动盘点机器人,并对机器人的软、硬件进行了详细介绍[4]。黄嘉琪对图书盘点机器人的导航方法进行了详细的研究[5]。夏正伟等以武汉大学为例,介绍了盘点机器人在武汉大学图书馆的应用效果[6]。倪劼对图书盘点智能机器人的结构进行了详细的介绍[7]。

图书自动盘点机器人的路径规划和轨迹跟踪控制是自动盘点机器人能够准确工作的关键技术。传统的图书自动盘点机器人的轨迹跟踪控制方法大多采用比例-积分(proportional-integral, PI)控制方法,由于PI控制方法是一种线性的控制方法,在快速性和准确性之间存在矛盾。近年来,越来越多的非线性控制方法被提出[8-10]。变结构控制又被称为滑模控制,由于其较好的鲁棒性,得到国内外学者的广泛关注[11-12]。由于变结构控制器采用符号函数,存在不连续性,因此其滑模轨迹到达滑模面后会产生“抖震”现象[13]。变结构控制方法的“抖震”只能被抑制,不能够被完全消除,较大的“抖震”会影响图书馆自动盘点机器人的轨迹跟踪效果。为了减少传统变结构的“抖震”现象,需要将变结构控制方法的滑模增益设置减小,较小的滑模增益会影响变结构控制器的响应速度和鲁棒性。因此,如何有效抑制“抖震”,又不影响变结构控制器的响应速度是亟须解决的问题。趋近律方法是一种有效的解决方案[14-15]。

本文针对图书自动盘点机器人轨迹跟踪位置和姿态的双目标控制问题,提出了一种基于改进趋近律的图书自动盘点机器人轨迹跟踪变结构非线性控制方法,通过改进的趋近律,可以有效解决传统变结构控制方法快速性和“抖震”之间的矛盾。

1 图书自动盘点机器人数学模型

图书自动盘点机器人融合了物联网技术、计算机图形学、人工智能技术等高新技术,采用RFID技术来实现图书的定位功能。图书自动盘点机器人采用双升降杆,可以实现不同层架的盘点功能。

本文以图书自动盘点机器人的底盘为控制对象,研究图书自动盘点机器人的轨迹跟踪控制方法。通过控制左右两侧车轮的速度差,来实现盘点机器人的转弯功能。图书自动盘点机器人的数学模型可以借鉴四轮轮式机器人的建模方法,如图1所示,图书自动盘点机器人的坐标由机器人底盘驱动轮中点在x轴和y轴坐标系中的位置决定,其姿态由机器人运动方向和x轴的夹角α来表示。

图1 图书自动盘点机器人运动轨迹Figure 1 The trajectory of automatic book inventory robot

由以上描述和图1可以得到图书自动盘点机器人的运动学方程

(1)

其中:x′p、y′p分别为图书自动盘点机器人在x轴和y轴坐标系中的位置;v、w分别为盘点机器人的线速度和角速度。由公式(1)可知,该系统为欠驱动系统,因此,该系统的轨迹跟踪控制问题需要设计控制率实现图书自动盘点机器人的位置跟踪和姿态随动。

2 图书盘点机器人变结构轨迹跟踪及趋近律设计

变结构控制 (variable structure control, VSC)也叫滑模控制 (sliding mode control, SMC),其本质是一种非线性控制方法[16-18]。其原理是通过系统所期望的动态轨迹来设计滑模面,通过控制系统变量最终到达滑模面来实现对期望目标的控制。因此,VSC具有较强的鲁棒性。由于VSC对被控对象的模型误差、被控对象参数的变化和外部干扰不敏感,将该方法应用于图书自动盘点机器人轨迹跟踪控制,具有一定的优越性。然而,由于变结构控制中存在不连续的符号函数,因此变结构控制存在“抖震”现象。较小的滑模增益可以削弱“抖震”,但是其鲁棒性也同样被削弱。因此,变结构控制方法削弱“抖震”和提高鲁棒性是矛盾的。本节内容提出了一种改进的变结构趋近律,可以有效解决传统变结构控制方法快速性和“抖震”之间的矛盾。

2.1 改进变结构趋近律

传统变结构控制方法,大多采用等速趋近律,等速趋近律的定义为

(2)

其中:s为滑模面;Ts为采样时间;k为滑模增益。将采样时间移至方程右边,可以得到

s(t+1)-s(t)=-kTssgn(s(t))。

(3)

系统轨迹从s>0侧到达滑模面后,由公式(3)可以得到,s(t+1)=-kTs;当系统轨迹从s<0侧到达滑模面后,由公式(3)可以得到,s(t+1)=kTs。因此,在系统轨迹到达滑模面后,会发生“抖震”现象,其切换带宽为kTs。k较大时,滑模增益较大,具有更强的鲁棒性,但是其切换带宽也随之增大,“抖震”现象也更强烈。传统等速趋近律的状态轨迹如图2所示。

图2 传统等速趋近律的状态轨迹图Figure 2 The trajectory of traditional constant rate reaching law

为了克服传统等速趋近率切换带宽和趋近速度矛盾的问题,提出了一种改进的变结构趋近率,改进趋近率为

(4)

其中:s1为滑模面;Ts为采样时间;ks为滑模增益;γ为负实数;0<λ<1;β为正整数。当系统轨迹远离滑模面时,通过选取λ,可以得到较大的滑模增益。

当系统轨迹从s1>0侧到达滑模面后,

(5)

当系统轨迹从s1<0侧到达滑模面后,

(6)

因此,基于这种改进的变结构趋近率,系统轨迹到达滑模面后,其切换带宽会随着状态变量x1的绝对值变小而逐渐减小,从而达到对“抖震”的抑制作用。改进变结构趋近率的状态轨迹如图3所示。

图3 改进变结构趋近律的状态轨迹图Figure 3 The trajectory of proposed reaching law

2.2 图书盘点机器人变结构轨迹跟踪控制器

基于改进趋近率的图书盘点机器人变结构轨迹跟踪控制器采用双闭环控制结构,姿态控制器为内环,位置控制器为外环,位置控制器的输出角度αt为内环姿态控制器参考角度。外环位置控制器小于内环姿态控制器的收敛速度,通过盘点机器人实际输出角度α快速跟踪αt,保证闭环系统的稳定性。基于双闭环控制结构的盘点机器人轨迹跟踪控制框图如图4所示。

图4 基于双闭环控制结构的盘点机器人轨迹跟踪 控制框图Figure 4 Control block diagram of inventory robot trajectory tracking based on double closed-loop control structure

2.2.1盘点机器人姿态控制器的设计 根据2.1提出的改进变结构趋近率来设计盘点机器人的姿态控制器,实现角度α跟踪目标角度αt。根据角度的误差e=x1=α-αt,角度误差的导数为e′=x2=w-α′t。

设计变结构滑模面,可以得到

s3=c1x1+x2。

(7)

对公式(7)求导,离散化后可以得到

(8)

通过公式(8),可以得到盘点机器人的姿态控制器为

(9)

2.2.2盘点机器人位置控制器的设计 盘点机器人的外环采用位置控制器,实现机器人的位置跟踪功能。由盘点机器人的运动学方程(1)展开,可以得到

(10)

盘点机器人的位置误差为

(11)

设计盘点机器人位置控制器的变结构滑模面为

(12)

对公式(12)求导,并将本文所提出的变结构趋近率公式(4)代入,离散化后可以得到

(13)

(14)

令u1=vcosα,u2=vsinα,通过式(13)、(14),可以得到盘点机器人的外环变结构位置控制器,

(15)

(16)

由u1=vcosα,u2=vsinα,可得

(17)

α取值(-π/2,π/2),可得

(18)

α为位置控制率所期望的角度,如果α=αt,则式(15)和式(16)等价。但是,实际模型α≠αt,特别是在控制系统初始阶段。因此,需要设定式(18)的角度为理想值,通过内环控制器快速收敛,使角度α快速跟踪αt,保证闭环系统的稳定性[19],

(19)

因此,盘点机器人的外环变结构位置控制器为

(20)

2.3 图书盘点机器人变结构轨迹跟踪控制器稳定性分析

2.3.1姿态控制器稳定性分析 由式(7)可知,定义李雅普诺夫函数

(21)

对式(21)求导,联合式(8),可得

V′1=s3s′3=

(22)

其中:0<λ<1;β为正整数;γ为负实数。因此,由式(22)可得

V′1≤0。

(23)

根据李雅普诺夫稳定性理论可以得知,闭环系统在所设计的盘点机器人姿态控制器下是稳定的。

2.3.2位置控制器稳定性分析 由式(12)可知,定义x轴、y轴控制器的李雅普诺夫函数分别为V2和V3,

(24)

对式(24)求导,联合式(13)、(14),可得

V′2=s4s′4=

(25)

V′3=s5s′5=

(26)

其中:0<λ<1;β为正整数;γ为负实数。因此,由公式可得

(27)

根据李雅普诺夫稳定性理论可以得知,闭环系统在所设计的盘点机器人位置控制器下是稳定的。

3 仿真验证

为了验证所提出算法的控制效果,本文将所提出的改进趋近率变结构双闭环控制算法和传统基于等速趋近率的变结构双闭环控制算法进行对比研究,其中传统基于等速趋近率的变结构双闭环控制算法取不同的增益数值。仿真环境基于MatlabSimulink 2021a。硬件基于联想的工作站Think Center M920t。CPU为酷睿i7-8700,3.2 GHz;硬盘为M.2 PCIe高速SSD;显卡为RX550X 4 GB独显。基于等速趋近率的变结构控制方法,内环滑模增益分别设置为kd1=3和kd1=0.1,外环滑模增益设置为kd2=3,kd3=5。

图5为kd1=3和kd1=0.1时,基于等速趋近率的盘点机器人轨迹跟踪控制结果。从图5(a)中可以看出,基于等速趋近率的变结构控制方法,当kd1=3时,控制方法具有较快的趋近速度,盘点机器人的实际运行轨迹可以快速跟踪理想轨迹。当kd1=0.1时,基于等速趋近率的变结构控制方法趋近速度比kd1=3时的趋近速度慢,图书智能盘点机器人跟踪理想轨迹的响应时间较长。图5(d)为图书智能盘点机器人角速度图。可以看出,当kd1=0.1时,基于等速趋近率的变结构控制方法趋近速度较慢。但是,较小的滑模增益对“抖震”具有较好的抑制作用。因此,基于等速趋近率的变结构控制方法存在快速性和“抖震”之间矛盾的问题。

图6为基于改进趋近率的盘点机器人轨迹跟踪控制的仿真结果图。变结构改进趋近率的参数为γ=-1,λ1=0.2,λ2=0.2,λ3=0.2,β=3,k1=3,

图5 基于等速趋近率的盘点机器人轨迹跟踪控制Figure 5 Trajectory tracking control of inventory robot based on traditional constant rate reaching law

图6 基于改进趋近率的盘点机器人轨迹跟踪控制Figure 6 Trajectory tracking control of inventory robot based on proposed reaching law

k2=1,k3=0.6,δ1=0.01,δ2=0.01,δ3=0.1,c1=0.01,c2=0.01,c3=0.01。从图6可以看出,基于改进趋近率的盘点机器人轨迹跟踪控制方法,不仅有较快的趋近速度,还可以有效抑制“抖震”,具有较好的控制效果。

4 结论

本文针对图书自动盘点机器人轨迹跟踪位置和姿态的双目标控制问题,提出了一种基于改进趋近律的图书自动盘点机器人轨迹跟踪变结构非线性控制方法。本文所提出的改进的趋近率,通过动态调节系统轨迹远离滑模面和到达滑模面之后的增益大小,有效解决传统变结构控制方法快速性和“抖震”之间矛盾的问题,并将本文提出的方法和传统变结构控制方法进行对比验证。结果表明,所提出的方法不仅具有较快的响应速度,还对“抖震”有较好的抑制作用。