首页 / 专利库 / 电信 / 跟踪 / 一种基于反演滑模控制的AGV路径跟踪方法

一种基于反演滑模控制的AGV路径跟踪方法

阅读:557发布:2020-05-11

专利汇可以提供一种基于反演滑模控制的AGV路径跟踪方法专利检索,专利查询,专利分析的服务。并且本 发明 属于AGV运动控制领域,涉及一种基于反演滑模控制的AGV路径 跟踪 方法,包括:通过运动学建模确定AGV系统的控制目标与控制量,对控制量设计反演滑模 控制器 ,并加入等速趋近律,得到显含滑模控制切换项增益的系统控制律;以抖振量为学习 信号 设计RBF神经网络的性能指标函数,对滑模控制切换项增益进行动态调节;使用粒子群 算法 优化RBF神经网络中 迭代 更新的控制参数的初始值。本发明以抖振量作为神经网络的学习信号,更直接和更有效地抑制系统抖振,使用粒子群算法计算得到参数的最优初始值,以 加速 AGV系统的收敛。本发明充分利用了滑模控制的 稳定性 与鲁棒性,直接有效地抑制了AGV系统的抖振,实现了AGV系统精准快速的路径跟踪。,下面是一种基于反演滑模控制的AGV路径跟踪方法专利的具体信息内容。

1.一种基于反演滑模控制的AGV路径跟踪方法,其特征在于,包括:
通过运动学建模确定AGV系统的控制目标与控制量,对控制量设计反演滑模控制器并加入等速趋近律,得到显含滑模控制切换项增益的系统控制律;
以抖振量为学习信号设计RBF神经网络的性能指标函数,对滑模控制切换项增益进行动态调节;
使用粒子群算法优化RBF神经网络中迭代更新的控制参数的初始值。
2.根据权利要求1所述的AGV路径跟踪方法,其特征在于,包括如下步骤:
步骤1:运动学建模:建立AGV车体位姿关于线速度v、转动速度ω的表达式,得到AGV期望位姿与实际位姿之间位姿误差的微分方程组;因此,AGV的路径跟踪问题即转化为设计一个系统控制律u=[u1 u2]T=[v ω]T,使AGV的位姿误差快速趋近于零,其中,u1、u2分别为v、ω的控制律;
步骤2:反演滑模控制器设计:参照非线性系统Back-stepping控制律的设计步骤,利用李雅普诺夫稳定性设计滑模面,即AGV路径跟踪滑模控制的切换面函数s=[s1 s2]T,s1、s2分别是对应于线速度v、转动角速度ω的两个切换面函数;对反演滑模控制器加入等速趋近律:
式中:k1、k2是正常数,为滑模控制切换项增益; 分别为s1、s2的趋近律;
进而得到显含k1、k2的系统控制律u;
步骤3:RBF神经网络设计:RBF神经网络将用于动态调节滑模控制切换项增益,使得AGV系统状态快速到达滑模面,并在滑动的过程中最大程度抑制系统抖振;
步骤4:粒子群算法设计:将RBF神经网络中迭代更新的控制参数组成粒子种群的位置向量,利用适应度函数指标逐代更新种群,确定控制参数的最优初始值。
3.根据权利要求2所述的AGV路径跟踪方法,其特征在于,步骤2中得到的系统控制律u为:
式中, u1、u2分别为v、ω的控制律;xe、ye、θe分别是车
体局部坐标系下,两坐标轴上的坐标值误差以及方向角误差;vr和ωr分别为AGV期望的线速度与转动角速度; 为AGV期望的线速度vr对时间的导数。
4.根据权利要求2所述的AGV路径跟踪方法,其特征在于,步骤3包括:
步骤a:RBF神经网络的结构设计:对AGV系统的线速度v和转动角速度ω的滑模控制切换项增益k1、k2分别设计两个RBF神经网络,两个RBF神经网络的输入层分别为输出层分别为k1、k2,且隐藏层的激活函数为高斯径向基函数,
输出层神经元的激活函数设置为线性函数;
步骤b:RBF神经网络性能指标函数设计:定义AGV线速度v和转动角速度ω的相对变化率为抖振量,将抖振量作为学习信号构建神经网络性能指标函数;
步骤c:RBF神经网络参数的迭代更新:对于RBF神经网络的第j个基函数的中心值,第j个中心点宽度的标准化常数以及隐藏层到输出层的连接权值,利用步骤b中的神经网络性能指标函数进行梯度下降的迭代更新,快速搜索至全局收敛。
5.根据权利要求4所述的AGV路径跟踪方法,其特征在于,RBF神经网络结构为:包含2个输入层神经元、6个隐藏层神经元和1个输出层神经元的前向神经网络。
6.根据权利要求5所述的AGV路径跟踪方法,其特征在于,RBF神经网络的隐藏层的激活函数具体形式为:
式中,h1j、h2j分别为两个RBF神经网络中第j个隐藏层的高斯径向基函数;C1j、C2j分别是两个RBF神经网络的第j个基函数的中心值,与输入向量同维数;b1j、b2j分别为两个RBF神经网络的第j个中心点宽度的标准化常数。
7.根据权利要求6所述的AGV路径跟踪方法,其特征在于,RBF神经网络的输出层神经元的激活函数具体形式为:
式中w1j、w2j表示隐藏层神经元到输出神经元之间连接的权值。
8.根据权利要求4所述的AGV路径跟踪方法,其特征在于,RBF神经网络性能指标函数可设计为如下二次型函数:
其中:v(t)、ω(t)分别为t时刻v和ω的采样值,v(t-1)和ω(t-1)分别为t的前一个采样周期v和ω的采样值。
9.根据权利要求1所述的AGV路径跟踪方法,其特征在于,粒子群算法的适应度函数设计为ITAE,即时间加权的绝对误差积分:
式中:T为控制器仿真的采样周期,m为AGV位姿误差跟随至指定范围时控制器的循环周期数,Pe(t)和Pe(l)分别表示t时刻和第l个循环周期的位姿误差。

说明书全文

一种基于反演滑模控制的AGV路径跟踪方法

技术领域

[0001] 本发明涉及AGV运动控制领域,特别涉及一种基于反演滑模控制的AGV路径跟踪方法。

背景技术

[0002] AGV(Automated Guided Vehicle)即自动导引运输车,也称移动机器人,是一种借助导引装置实现自动行驶的搬运设备。AGV的关键技术包括导引技术、定位技术和运动控制技术,根据不同原理,导引方式大致可分为电磁或磁带导引、光学导引、激光导引、视觉导引和惯性导引等,定位技术则是使用各类传感设备获取AGV在运行环境中的实时位姿数据。
[0003] AGV的运动控制技术将直接决定其能否准确运行在规定路径上,是AGV系统的核心技术。AGV的运动控制算法从经典控制算法、现代控制算法发展到如今的智能控制算法,可以不依赖于数学模型对复杂系统进行智能控制。用于AGV运动控制常见的智能算法包括神经网络控制、自适应控制、模糊控制和滑模控制等。
[0004] 滑模控制也称滑模变结构控制,该算法根据系统所期望的动态特性设计一个滑模面,通过滑动模态控制器使系统状态向滑模面快速移动。系统状态到达滑模面后,将继续沿着滑模面滑动至系统平衡点,即完成预期的控制目标。滑模控制算法物理实现简单,对参数变化和扰动不灵敏,因此具有很强的稳定性和鲁棒性,适合应用于非线性系统。但是,实际系统在各方面的非理想性使得变结构控制的切换出现延迟,系统状态难以严格地沿着滑模面滑动,而是在滑模面两侧来回穿越,导致系统发生抖振,这种抖振不可能完全消除,只能尽量抑制。

发明内容

[0005] 本发明的目的在于充分利用滑模控制算法在AGV运动控制领域的优势,同时有效抑制系统的抖振,实现AGV精准快速的路径跟踪。
[0006] 本发明采用如下技术方案实现:
[0007] 一种基于反演滑模控制的AGV路径跟踪方法,包括:
[0008] 通过运动学建模确定AGV系统的控制目标与控制量,对控制量设计反演滑模控制器并加入等速趋近律,得到显含滑模控制切换项增益的系统控制律;
[0009] 以抖振量为学习信号设计RBF神经网络的性能指标函数,对滑模控制切换项增益进行动态调节;
[0010] 使用粒子群算法优化RBF神经网络中迭代更新的控制参数的初始值。
[0011] 具体地,一种基于反演滑模控制的AGV路径跟踪方法,包括如下步骤:
[0012] 步骤1:运动学建模:建立AGV车体位姿关于线速度v、转动速度ω的表达式,得到AGV期望位姿与实际位姿之间位姿误差的微分方程组;因此,AGV的路径跟踪问题即转化为T T设计一个系统控制律u=[u1 u2]=[v ω] ,使AGV的位姿误差快速趋近于零,其中,u1、u2分别为v、ω的控制律;
[0013] 步骤2:反演滑模控制器设计:参照非线性系统Back-stepping控制律的设计步骤,利用李雅普诺夫稳定性设计滑模面,即AGV路径跟踪滑模控制的切换面函数s=[s1 s2]T,s1、s2分别是对应于线速度v、转动角速度ω的两个切换面函数;对反演滑模控制器加入等速趋近律:
[0014]
[0015] 式中:k1、k2是正常数,为滑模控制切换项增益; 分别为s1、s2的趋近律;
[0016] 进而得到显含k1、k2的系统控制律u;
[0017] 步骤3:RBF神经网络设计:RBF神经网络将用于动态调节滑模控制切换项增益,使得AGV系统状态快速到达滑模面,并在滑动的过程中最大程度抑制系统抖振;
[0018] 步骤4:粒子群算法设计:将RBF神经网络中迭代更新的控制参数组成粒子种群的位置向量,利用适应度函数指标逐代更新种群,确定控制参数的最优初始值。
[0019] 优选地,步骤2中得到的系统控制律u为:
[0020]
[0021] 式中, u1、u2分别为v、ω的控制律;xe、ye、θe分别是车体局部坐标系下,两坐标轴上的坐标值误差以及方向角误差;vr和ωr分别为AGV期望的线速度与转动角速度; 为AGV期望的线速度vr对时间的导数。
[0022] 优选地,步骤3包括:
[0023] 步骤a:RBF神经网络的结构设计:对AGV系统的线速度v和转动角速度ω的滑模控制切换项增益k1、k2分别设计两个RBF神经网络,两个RBF神经网络的输入层分别为输出层分别为k1、k2,且隐藏层的激活函数为高斯径向基函数,输出层神经元的激活函数设置为线性函数;
[0024] 步骤b:RBF神经网络性能指标函数设计:定义AGV线速度v和转动角速度ω的相对变化率为抖振量,将抖振量作为学习信号构建神经网络性能指标函数;
[0025] 步骤c:RBF神经网络参数的迭代更新:对于RBF神经网络的第j个基函数的中心值,第j个中心点宽度的标准化常数以及隐藏层到输出层的连接权值,利用步骤b中的神经网络性能指标函数进行梯度下降的迭代更新,快速搜索至全局收敛。
[0026] 优选地,RBF神经网络结构为:包含2个输入层神经元、6个隐藏层神经元和1个输出层神经元的前向神经网络。
[0027] 优选地,RBF神经网络的隐藏层的激活函数具体形式为:
[0028]
[0029] 式中,h1j、h2j分别为两个RBF神经网络中第j个隐藏层的高斯径向基函数;C1j、C2j分别是两个RBF神经网络的第j个基函数的中心值,与输入向量同维数;b1j、b2j分别为两个RBF神经网络的第j个中心点宽度的标准化常数。
[0030] 优选地,RBF神经网络的输出层神经元的激活函数具体形式为:
[0031]
[0032] 式中w1j、w2j表示隐藏层神经元到输出神经元之间连接的权值。
[0033] 优选地,RBF神经网络性能指标函数可设计为如下二次型函数:
[0034]
[0035] 其中:v(t)、ω(t)分别为t时刻v和ω的采样值,v(t-1)和ω(t-1)分别为t的前一个采样周期v和ω的采样值。
[0036] 优选地,粒子群算法的适应度函数设计为ITAE,即时间加权的绝对误差积分:
[0037]
[0038] 式中:T为控制器仿真的采样周期,m为AGV位姿误差跟随至指定范围时控制器的循环周期数,Pe(t)和Pe(l)分别表示t时刻和第l个循环周期的位姿误差。
[0039] 与现有技术相比,本发明包括以下优点及有益效果:
[0040] (1)通过运动学建模确定AGV系统的控制目标与控制量,对控制量设计反演滑模控制器并加入等速趋近律,进而将反演滑模控制算法与RBF神经网络算法结合应用于AGV运动控制领域,实现滑模控制切换项增益的自动调整,避免因使用准滑模控制算法改变滑模控制器的本质结构而带来不良影响。
[0041] (2)针对反演滑模控制器中的切换项增益,设计以抖振量为学习信号的RBF神经网络进行动态调节。具体地,以AGV系统的抖振量作为RBF神经网络的学习信号来设计性能指标函数,直接对系统抖振进行抑制。相比采用位姿误差来计算神经网络的性能指标,其效果侧重于快速地减小误差,本发明以抖振量作为学习信号,能更直接和更有效地抑制系统抖振。
[0042] (3)使用粒子群算法优化AGV运动控制器参数的初始值,加速系统的收敛。具体地,对于神经网络中多个迭代更新的控制参数,使用粒子群算法计算得到最优初始值,从而缩短系统收敛的时间。
[0043] (4)本发明充分利用了滑模控制的稳定性与鲁棒性,并直接有效地抑制了AGV系统的抖振,实现了AGV精准快速的路径跟踪。附图说明
[0044] 图1为本发明一个实施例中双轮差速驱动AGV运动简图;
[0045] 图2为本发明一个实施例中基于反演滑模控制的AGV路径跟踪方法流程图
[0046] 图3为本发明一个实施例中AGV位姿误差模型;
[0047] 图4为本发明一个实施例中RBF神经网络结构图;
[0048] 图5为本发明一个实施例中粒子群算法流程图。

具体实施方式

[0049] 以下结合附图说明本发明的具体实施方式。
[0050] 如图1所示为本发明的其中一个实施例——双轮差速驱动AGV的运动简图,图1中分别建立了全局坐标系XOY及以AGV两驱动轮连线的中点C为坐标原点的局部坐标系X'CY',v、ω为AGV的线速度与转动角速度,ωL、ωR分别为左右驱动轮的角速度,r、L则为两轮的半径与距离,θ为车体运动方向与X轴正方向夹角,x即为AGV沿着期望路径方向的坐标值、y为垂直于期望路径方向的坐标值。对于本发明的一种基于反演滑模控制的AGV路径跟踪方法,算法流程如图2所示,包括如下步骤:
[0051] 步骤S100:记图1中AGV小车的位姿为P=[x y θ]T,为其建立运动学模型,即P对时间的导数 如下:
[0052]
[0053]
[0054]
[0055] 上式中 分别为x、y、θ对时间的导数。
[0056] AGV的位姿误差模型如图3所示,期望位姿为Pr=[xr yr θr]T,其中:xr、yr分别为AGV在X轴、Y轴上的期望坐标值,θr是车体运动方向与X轴正方向期望的夹角。经过坐标变换,可得AGV的位姿误差Pe为:
[0057]
[0058] 其中:xe、ye、θe分别是X'CY'坐标系下,X'轴、Y'轴上的坐标值误差以及方向角误差。
[0059] 进一步求取Pe对时间的导数
[0060]
[0061] 式中: 分别为xe、ye、θe对时间的导数;vr和ωr分别为AGV期望的线速度与转动角速度。
[0062] 在实际应用中,AGV的实际位姿可由磁带导引传感器机器视觉相机等多种方式获取。
[0063] 步骤S200:分析李雅普诺夫函数可得如下结论:当AGV的距离偏差xe收敛于0且位姿角偏差θe收敛于-arctan(vrye)时,AGV的距离偏差ye也将收敛于0。据此可设计AGV路径跟踪滑模控制的切换面函数为:
[0064]
[0065] 其中:s1、s2是对应于两个控制量v、ω的两个切换面函数。
[0066] 引入等速趋近律 式中k1、k2是正常数, 分别为s1、s2的趋近律,即对时间的导数,整理以上各式可得系统的控制律:
[0067]
[0068] 式中, u1、u2分别为v、ω的控制律,为AGV期望的线速度vr对时间的导数。
[0069] 步骤S300:设计RBF神经网络用于动态调节滑模控制切换项增益k1、k2,包含以下几个步骤:
[0070] 步骤S301:对k1、k2设计相同的2-6-1前向神经网络(即包含2个输入层神经元、6个隐藏层神经元和1个输出层神经元),其结构如图4所示。在两个神经网络中,输入层分别为输出层为k1、k2,隐藏层的激活函数为高斯径向基函数,具体形式为:
[0071]
[0072] 式中,h1j、h2j分别为两个RBF神经网络中第j个隐藏层的高斯径向基函数;C1j、C2j分别是两个RBF神经网络的第j个基函数的中心值,与输入向量同维数;b1j、b2j分别为两个RBF神经网络的第j个中心点宽度的标准化常数。
[0073] RBF神经网络输出层神经元的激活函数设置为线性函数,即:
[0074]
[0075] 式中w1j、w2j表示隐藏层神经元到输出神经元之间连接的权值。
[0076] 步骤S302:计算AGV系统相邻两次采样的线速度v、转动角速度ω的相对变化率,定义为抖振量,并将此作为两个神经网络的性能指标J1、J2:
[0077]
[0078] 其中:v(t)、ω(t)分别为t时刻v和ω的采样值,v(t-1)和ω(t-1)即为t的前一个采样周期的采样值。
[0079] 步骤S303:利用性能指标的梯度下降对神经网络的参数C1j、b1j、w1j、C2j、b2j、w2j进行更新:
[0080]
[0081] 式中,η为参数更新的学习率,ΔC1j(t)、Δb1j(t)、Δw1j(t)、ΔC2j(t)、Δb2j(t)、Δw2j(t)依次为C1j、b1j、w1j、C2j、b2j、w2j在t时刻计算得到的增量。
[0082] 因此在t时刻的下一次计算中,更新后的各个参数值为:
[0083]
[0084] 步骤S400:图5为本发明使用粒子群算法初始化神经网络参数的流程,包括如下几个步骤:
[0085] 步骤S401:首先随机产生n个粒子,组成粒子种群X=[X1 X2 … Xn-1 Xn]T,在本发明的RBF神经网络结构中,对k1、w1j、k2、w2j(j=1,2,…,6)总计14个参数进行初始化,将其组合成粒子的位置向量。在第i个粒子中,对这14个参数加入下标i,则第i个粒子可表示为Xi=[Xi1 Xi2 … Xi14]T=[ki1 wi11 … wi16 ki2 wi21 … wi26]T,记该粒子的速度向量为Vi=[Vi1 Vi2 … Vi14]T。
[0086] 步骤S402:对种群中每个粒子,引入ITAE,即时间加权的绝对误差积分作为适应度函数指标f:
[0087]
[0088] 式中,T为控制器仿真的采样周期,m为AGV位姿误差跟随至指定范围时控制器的循环周期数,Pe(t)和Pe(l)分别表示t时刻和第l个循环周期的位姿误差。
[0089] 根据上式的计算结果,记fi为第i个粒子的个体最优适应度,Pi为对应的粒子最优位置向量,另记fg为全局最优适应度,Pg为对应的粒子最优位置向量,在种群的每次迭代中更新上述各值。
[0090] 步骤S403:在达到设定的迭代次数之前,按以下规则不断更新粒子的位置与速度:
[0091]
[0092]
[0093] 式中,ζ是继承上一次迭代速度的惯性系数;d表示向量元素的序数,d=1,2,…,14;k表示种群迭代次数;c1、c2是非负常数的加速因子,通常取c1,c2∈[0,4];r1、r2为随机数,且r1,r2∈[0,1]。
[0094] 当粒子种群的全局最优适应度不再变化且达到迭代次数后,此时的Pg即为各参数的最优初始值。
[0095] 以上所述是本发明的一个具体实例,但本发明并不局限于这种实施方式,在AGV运动控制领域,技术人员在不偏离本发明基本精神的前提下,可以对本发明做出各种修改或变化,但也应落在本发明技术方案的保护范围内。
高效检索全球专利

专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。

我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。

申请试用

分析报告

专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。

申请试用

QQ群二维码
意见反馈