一种移动机器人的目标轨迹跟踪方法技术

本发明专利技术公开了一种移动机器人的目标轨迹跟踪方法，包括以下步骤：1)建立移动机器人的运动方程,2)、建立基于虚拟领队的机器人编队运动学方程，3)、设计误差整形法和控制器控制编队误差。本发明专利技术移动机器人的目标轨迹跟踪方法，能够应用于实际的非完整移动机器人平台，能占用最少的系统资源做出最快的响应，能适用于不同的非完整移动机器人平台，闭环系统在原点平衡状态是全局一致渐进稳定的，能不改变控制器参数的取值而对各种不同的期望值都能够取得满意的跟踪效果，其控制量的变化光滑连续，降低了系统机械和能量损耗，并能延长系统有效工作时间和寿命。

Method for tracking target trajectory of mobile robot

The invention discloses a mobile robot trajectory tracking method, which comprises the following steps: 1) the motion equation of a mobile robot, 2), a robot kinematics equation based on virtual team formation, 3), the design error shaping method and controller for controlling formation error. The target trajectory tracking method of the invention of the mobile robot platform, capable of nonholonomic mobile robot application, can occupy minimal system resources to make the fastest response, suitable for different nonholonomic mobile robot platform, the closed-loop system is globally uniformly asymptotically stable at the origin of the equilibrium value can not change the parameters of the controller the different expectations are able to achieve satisfactory tracking effect, the control variable is smooth and continuous, reduces the system of mechanical and energy consumption, and prolong the life time and effective work system.

【技术实现步骤摘要】
一种移动机器人的目标轨迹跟踪方法
本专利技术涉及机器人控制
，特别涉及一种移动机器人目标轨迹跟踪控制方法。
技术介绍
移动机器人是一类高度非线性、强耦合性、时变性的动力学系统，很难建立其准确的动力学模型，对其控制具有相当大的难度。移动机器人的轨迹跟踪问题中，期望值随时间变化是运动控制中的难点所在，针对这一问题，基于各种非线性控制理论的控制方法不断涌现。到目前为止，移动机器人目标轨迹跟踪控制方法主要有：1)非线性状态反馈控制方法；2)滑模控制方法；3)Back-Stepping控制方法；4)计算力矩方法；5)智能控制方法，其中应用最为广泛的智能控制方法是模糊控制和神经网络控制。但以上移动机器人轨迹跟踪控制方法都存在缺点或者局限，具体如下：1)非线性状态反馈控制方法最大的难点就是如何使系统全局渐进稳定在原点平衡状态；2)滑模控制方法主要问题是存在“斗振”，而且是不可避免的，这是由滑模控制方法的特性决定的；3)Back-Stepping方法实际应用起来，其设计过程比较复杂；4)计算力矩方法对于动力学模型要求较高，即便在无任何扰动情况下建立精确数学模型也是很难实现的，故该方法实际意义不大；5)模糊控制的缺点是需要专家经验建立模糊规则，否则控制效果将受到直接影响；神经网络控制则需要在线或离线学习，占用大量系统资源，直接影响系统的实时性。所以智能控制方法在移动机器人控制的应用大都停留在仿真阶段。
技术实现思路
有鉴于此，本专利技术的目的是针对现有移动机器人轨迹跟踪控制方法存在缺点及局限，提供一种兼实时性、通用性、稳定性、鲁棒性、光滑性等优点的移动机器人的目标轨迹跟踪方法。本专利技术移动机器人的目标轨迹跟踪方法，包括以下步骤：1)建立移动机器人的运动方程：式中，u是机器人的运动速度；θ是机器人前行方向角；m代表机器人底盘的质量；J0是机器人底盘相对于机器人两驱动轮轮距中点的转动惯量；Fr和Fl代表作用在机器人两个驱动轮上的驱动力；Fcx与Fcy代表自位轮在xb和yb方向上的地面摩擦力；yb方向即两驱动轮的轴向，xb方向垂直于yb方向；d是两驱动轮的间距；b是自位轮轴线与两驱动轮轴线间的距离；两个驱动轮上的驱动电动机的运动数学模型为：式中，θr和θl是驱动轮的转角；Jw代表驱动轮的转动惯量；r代表驱动轮半径；η为摩擦系数；Kt为驱动电动机转矩常数；Imr与Iml为两驱动电动机的驱动电流，而Icr与Icl为控制电流，控制电流通过放大电路得到实际的电动机驱动电流，因此有Imr＝KamIcr,Iml＝KamIml，Kam为电流放大因数；很显然，u、与θr、θl存在如下的集合关系：式中，θsr、θsl是两电动机的偏离角；所以，从式(1)-(4)得到机器人的运动状态与控制电流间的关系式：其中m1＝(2Jw/r+mr)，m2＝Jwd/r+2J0r/d(8)2)、建立基于虚拟领队的机器人编队运动学方程任意跟随机器人的位置在地面坐标中表示为：式中(xVL，yVL)表示虚拟领队机器人在(x,y)地面坐标系中的绝对位置，(xF,yF)表示跟随机器人在(x,y)地面坐标系中的绝对位置，ρ表示虚拟领队机器人与跟随机器人的相对距离，表示虚拟领队机器人与跟随机器人的相对前行方向角；虚拟领队机器人相对于跟随机器人的前行速度在地面坐标系上的投影为：由此推导出跟随机器人编队误差的变化率为：其中由编队误差变化率公式推导出编队误差变化的二阶方程结合机器人的运动学方程，得到其中3)、设计误差整形法和控制器控制编队误差在移动机器人的编队控制中，误差整形法表述成:其中，α、β为任意正整数，h代表控制器的采样周期；E(h)分别为E.和E的第一采样值，称Sj(t)为整形误差；在移动机器人的编队控制中，其控制器的设计如下：求出整形误差其中编队控制的一阶记忆控制器为通过一阶记忆控制器驱动编队误差最终趋近到零。本专利技术的有益效果：1、本专利技术移动机器人的目标轨迹跟踪方法，其能够应用于实际的非完整移动机器人平台。2、本专利技术移动机器人的目标轨迹跟踪方法，其能占用最少的系统资源做出最快的响应。3、本专利技术移动机器人的目标轨迹跟踪方法，其能适用于不同的非完整移动机器人平台。4、本专利技术移动机器人的目标轨迹跟踪方法，闭环系统在原点平衡状态是全局一致渐进稳定的。5、本专利技术移动机器人的目标轨迹跟踪方法，其能不改变控制器参数的取值而对各种不同的期望值都能够取得满意的跟踪效果。6、本专利技术移动机器人的目标轨迹跟踪方法，控制量的变化光滑连续，降低了系统机械和能量损耗，并能延长有效工作时间和寿命。此外，本专利技术移动机器人的目标轨迹跟踪方法是基于移动机器人的运动学模型的，这与动力学模型相比，除了模型简单通用，不存在不确定项之外，还有一个巨大的优势，即运动学模型本身就符合非完整约束条件。这样，在某些条件下，控制律设计就可以不必再单独考虑非完整约束条件。附图说明图1是移动机器人底盘在直角坐标系中的结构示意图，图中：L-左驱动轮，R-右驱动轮，C-自位轮，u-机器人的运动速度，θ-机器人前行方向角，r-驱动轮半径，d-两驱动轮间距；b-自位轮轴线与两驱动轮轴线间的距离，θr和θl是驱动轮的转角；图2是基于虚拟领队的机器人编队协同运动示意图，图中：(x,y)代表地面坐标系，P表示虚拟零度机器人，(xVL，yVL)和(xF,yF)分别表示虚拟领队机器人和跟随机器人的绝对位置，uVL与uF分别表示虚拟领队机器人和跟随机器人的前行速度，θVL与θF为分别表示虚拟领队机器人和跟随机器人的前行方向角，ρ和分别表示虚拟领队机器人与跟随机器人的相对距离和相对前行方向角，ρd和分别表示虚拟领队机器人与跟随机器人的期望相对距离和期望相对前行方向角；ex表示跟踪目标在x轴的方向，ey表示跟踪目标在y轴上的方向。编队控制的目标是让虚拟领队机器人与跟随机器人之间的相对距离和相对前行方向角趋近于一组期望值，也既是ρ→ρd，具体实施方式下面结合附图和实施例对本专利技术作进一步描述。本实施例移动机器人的目标轨迹跟踪方法，包括以下步骤：1)建立移动机器人的运动方程：式中，u是机器人的运动速度；θ是机器人前行方向角；m代表机器人底盘的质量；J0是机器人底盘相对于机器人两驱动轮轮距中点的转动惯量；Fr和Fl代表作用在机器人两个驱动轮上的驱动力；Fcx与Fcy代表自位轮在xb和yb方向上的地面摩擦力；yb方向即两驱动轮的轴向，xb方向垂直于yb方向；d是两驱动轮的间距；b是自位轮轴线与两驱动轮轴线间的距离；两个驱动轮上的驱动电动机的运动数学模型为：式中，θr和θl是驱动轮的转角；Jw代表驱动轮的转动惯量；r代表驱动轮半径；η为摩擦系数；Kt为驱动电动机转矩常数；Imr与Iml为两驱动电动机的驱动电流，而Icr与Icl为控制电流，控制电流通过放大电路得到实际的电动机驱动电流，因此有Imr＝KamIcr,Iml＝KamIml，Kam为电流放大因数；很显然，u、与θr、θl存在如下的集合关系：式中，θsr、θsl是两电动机的偏离角；所以，从式(1)-(4)得到机器人的运动状态与控制电流间的关系式：其中m1＝(2Jw/r+mr)，m2＝Jwd/r+2J0r/d(8)2)、建立基于虚拟领队的机器人编队运动学方程任意跟随机器人的位置在地面坐标中表示为：式中(xV本文档来自技高网...

【技术保护点】
一种移动机器人的目标轨迹跟踪方法，其特征在于：包括以下步骤：1)建立移动机器人的运动方程：

【技术特征摘要】
1.一种移动机器人的目标轨迹跟踪方法，其特征在于：包括以下步骤：1)建立移动机器人的运动方程：式中，u是机器人的运动速度；θ是机器人前行方向角；m代表机器人底盘的质量；J0是机器人底盘相对于机器人两驱动轮轮距中点的转动惯量；Fr和Fl代表作用在机器人两个驱动轮上的驱动力；Fcx与Fcy代表自位轮在xb和yb方向上的地面摩擦力；yb方向即两驱动轮的轴向，xb方向垂直于yb方向；d是两驱动轮的间距；b是自位轮轴线与两驱动轮轴线间的局离；两个驱动轮上的驱动电动机的运动数学模型为：式中，θr和θl是驱动轮的转角；Jw代表驱动轮的转动惯量；r代表驱动轮半径；η为摩擦系数；Kt为驱动电动机转矩常数；Imr与Iml为两驱动电动机的驱动电流，而Icr与Icl为控制电流，控制电流通过放大电路得到实际的电动机驱动电流，因此有Imr＝KamIcr,Iml＝KamIml，Kam为电流放大因数；很显然，u、与θr、θl存在如下的集合关系：式中，θsr、θsl是两电动机的偏离角；所以，从式(1)-(4)得到机器人的运动状态与控制电流间的关系式：其中m1＝(2Jw/r+mr)，m2＝Jwd/r+2J0r/d(8)2)、建立基于虚拟领队的机器人编队运动学方程任意跟随机器人的位置在地面坐标中表示为：式中(xVL，yVL)表示虚拟领队机器人在(x,y)地面坐标系中的绝对位置，(xF,yF)表示跟随机器人在(x,y)地面坐标系中的绝对位置，ρ表示...

【专利技术属性】
技术研发人员：宋永端，赖俊峰，李攀飞，张云福，张子涛，何昱锋，李书浩，
申请(专利权)人：星际重庆智能装备技术研究院有限公司，
类型：发明
国别省市：重庆,50