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

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

An AGV path tracking method based on inverse sliding mode control

【技术实现步骤摘要】
一种基于反演滑模控制的AGV路径跟踪方法
本专利技术涉及AGV运动控制领域，特别涉及一种基于反演滑模控制的AGV路径跟踪方法。
技术介绍
AGV(AutomatedGuidedVehicle)即自动导引运输车，也称移动机器人，是一种借助导引装置实现自动行驶的搬运设备。AGV的关键技术包括导引技术、定位技术和运动控制技术，根据不同原理，导引方式大致可分为电磁或磁带导引、光学导引、激光导引、视觉导引和惯性导引等，定位技术则是使用各类传感设备获取AGV在运行环境中的实时位姿数据。AGV的运动控制技术将直接决定其能否准确运行在规定路径上，是AGV系统的核心技术。AGV的运动控制算法从经典控制算法、现代控制算法发展到如今的智能控制算法，可以不依赖于数学模型对复杂系统进行智能控制。用于AGV运动控制常见的智能算法包括神经网络控制、自适应控制、模糊控制和滑模控制等。滑模控制也称滑模变结构控制，该算法根据系统所期望的动态特性设计一个滑模面，通过滑动模态控制器使系统状态向滑模面快速移动。系统状态到达滑模面后，将继续沿着滑模面滑动至系统平衡点，即完成预期的控制目标。滑模控制算法物理实现简单，对参数变化和扰动不灵敏，因此具有很强的稳定性和鲁棒性，适合应用于非线性系统。但是，实际系统在各方面的非理想性使得变结构控制的切换出现延迟，系统状态难以严格地沿着滑模面滑动，而是在滑模面两侧来回穿越，导致系统发生抖振，这种抖振不可能完全消除，只能尽量抑制。
技术实现思路
本专利技术的目的在于充分利用滑模控制算法在AGV运动控制领域的优势，同时有效抑制系统的抖振，实现AGV精准快速的路径跟踪。本专利技术采用如下技术方案实现：一种基于反演滑模控制的AGV路径跟踪方法，包括：通过运动学建模确定AGV系统的控制目标与控制量，对控制量设计反演滑模控制器并加入等速趋近律，得到显含滑模控制切换项增益的系统控制律；以抖振量为学习信号设计RBF神经网络的性能指标函数，对滑模控制切换项增益进行动态调节；使用粒子群算法优化RBF神经网络中迭代更新的控制参数的初始值。具体地，一种基于反演滑模控制的AGV路径跟踪方法，包括如下步骤：步骤1：运动学建模：建立AGV车体位姿关于线速度v、转动角速度ω的表达式，得到AGV期望位姿与实际位姿之间位姿误差的微分方程组；因此，AGV的路径跟踪问题即转化为设计一个系统控制律u＝[u1u2]T＝[vω]T，使AGV的位姿误差快速趋近于零，其中，u1、u2分别为v、ω的控制律；步骤2：反演滑模控制器设计：参照非线性系统Back-stepping控制律的设计步骤，利用李雅普诺夫稳定性设计滑模面，即AGV路径跟踪滑模控制的切换面函数s＝[s1s2]T，s1、s2分别是对应于线速度v、转动角速度ω的两个切换面函数；对反演滑模控制器加入等速趋近律：式中：k1、k2是正常数，为滑模控制切换项增益；分别为s1、s2的趋近律；进而得到显含k1、k2的系统控制律u；步骤3：RBF神经网络设计：RBF神经网络将用于动态调节滑模控制切换项增益，使得AGV系统状态快速到达滑模面，并在滑动的过程中最大程度抑制系统抖振；步骤4：粒子群算法设计：将RBF神经网络中迭代更新的控制参数组成粒子种群的位置向量，利用适应度函数指标逐代更新种群，确定控制参数的最优初始值。优选地，步骤2中得到的系统控制律u为：式中，u1、u2分别为v、ω的控制律；xe、ye、θe分别是车体局部坐标系下，两坐标轴上的坐标值误差以及方向角误差；vr和ωr分别为AGV期望的线速度与转动角速度；为AGV期望的线速度vr对时间的导数。优选地，步骤3包括：步骤a：RBF神经网络的结构设计：对AGV系统的线速度v和转动角速度ω的滑模控制切换项增益k1、k2分别设计两个RBF神经网络，两个RBF神经网络的输入层分别为输出层分别为k1、k2，且隐藏层的激活函数为高斯径向基函数，输出层神经元的激活函数设置为线性函数；步骤b：RBF神经网络性能指标函数设计：定义AGV线速度v和转动角速度ω的相对变化率为抖振量，将抖振量作为学习信号构建神经网络性能指标函数；步骤c：RBF神经网络参数的迭代更新：对于RBF神经网络的第j个基函数的中心值，第j个中心点宽度的标准化常数以及隐藏层到输出层的连接权值，利用步骤b中的神经网络性能指标函数进行梯度下降的迭代更新，快速搜索至全局收敛。优选地，RBF神经网络结构为：包含2个输入层神经元、6个隐藏层神经元和1个输出层神经元的前向神经网络。优选地，RBF神经网络的隐藏层的激活函数具体形式为：式中，h1j、h2j分别为两个RBF神经网络中第j个隐藏层的高斯径向基函数；C1j、C2j分别是两个RBF神经网络的第j个基函数的中心值，与输入向量同维数；b1j、b2j分别为两个RBF神经网络的第j个中心点宽度的标准化常数。优选地，RBF神经网络的输出层神经元的激活函数具体形式为：式中w1j、w2j表示隐藏层神经元到输出神经元之间连接的权值。优选地，RBF神经网络性能指标函数可设计为如下二次型函数：其中：v(t)、ω(t)分别为t时刻v和ω的采样值，v(t-1)和ω(t-1)分别为t的前一个采样周期v和ω的采样值。优选地，粒子群算法的适应度函数设计为ITAE，即时间加权的绝对误差积分：式中：T为控制器仿真的采样周期，m为AGV位姿误差跟随至指定范围时控制器的循环周期数，Pe(t)和Pe(l)分别表示t时刻和第l个循环周期的位姿误差。与现有技术相比，本专利技术包括以下优点及有益效果：(1)通过运动学建模确定AGV系统的控制目标与控制量，对控制量设计反演滑模控制器并加入等速趋近律，进而将反演滑模控制算法与RBF神经网络算法结合应用于AGV运动控制领域，实现滑模控制切换项增益的自动调整，避免因使用准滑模控制算法改变滑模控制器的本质结构而带来不良影响。(2)针对反演滑模控制器中的切换项增益，设计以抖振量为学习信号的RBF神经网络进行动态调节。具体地，以AGV系统的抖振量作为RBF神经网络的学习信号来设计性能指标函数，直接对系统抖振进行抑制。相比采用位姿误差来计算神经网络的性能指标，其效果侧重于快速地减小误差，本专利技术以抖振量作为学习信号，能更直接和更有效地抑制系统抖振。(3)使用粒子群算法优化AGV运动控制器参数的初始值，加速系统的收敛。具体地，对于神经网络中多个迭代更新的控制参数，使用粒子群算法计算得到最优初始值，从而缩短系统收敛的时间。(4)本专利技术充分利用了滑模控制的稳定性与鲁棒性，并直接有效地抑制了AGV系统的抖振，实现了AGV精准快速的路径跟踪。附图说明图1为本专利技术一个实施例中双轮差速驱动AGV运动简图；图2为本专利技术一个实施例中基于反演滑模控制的AGV路径跟踪方法流程图；图3为本专利技术本文档来自技高网...

【技术保护点】
1.一种基于反演滑模控制的AGV路径跟踪方法，其特征在于，包括：/n通过运动学建模确定AGV系统的控制目标与控制量，对控制量设计反演滑模控制器并加入等速趋近律，得到显含滑模控制切换项增益的系统控制律；/n以抖振量为学习信号设计RBF神经网络的性能指标函数，对滑模控制切换项增益进行动态调节；/n使用粒子群算法优化RBF神经网络中迭代更新的控制参数的初始值。/n

【技术特征摘要】
1.一种基于反演滑模控制的AGV路径跟踪方法，其特征在于，包括：
通过运动学建模确定AGV系统的控制目标与控制量，对控制量设计反演滑模控制器并加入等速趋近律，得到显含滑模控制切换项增益的系统控制律；
以抖振量为学习信号设计RBF神经网络的性能指标函数，对滑模控制切换项增益进行动态调节；
使用粒子群算法优化RBF神经网络中迭代更新的控制参数的初始值。


2.根据权利要求1所述的AGV路径跟踪方法，其特征在于，包括如下步骤：
步骤1：运动学建模：建立AGV车体位姿关于线速度v、转动角速度ω的表达式，得到AGV期望位姿与实际位姿之间位姿误差的微分方程组；因此，AGV的路径跟踪问题即转化为设计一个系统控制律u＝[u1u2]T＝[vω]T，使AGV的位姿误差快速趋近于零，其中，u1、u2分别为v、ω的控制律；
步骤2：反演滑模控制器设计：参照非线性系统Back-stepping控制律的设计步骤，利用李雅普诺夫稳定性设计滑模面，即AGV路径跟踪滑模控制的切换面函数s＝[s1s2]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...

【专利技术属性】
技术研发人员：文生平，洪培烽，
申请(专利权)人：华南理工大学，
类型：发明
国别省市：广东;44