CN107085432A - 一种移动机器人的目标轨迹跟踪方法 - Google Patents
一种移动机器人的目标轨迹跟踪方法 Download PDFInfo
- Publication number
- CN107085432A CN107085432A CN201710481270.2A CN201710481270A CN107085432A CN 107085432 A CN107085432 A CN 107085432A CN 201710481270 A CN201710481270 A CN 201710481270A CN 107085432 A CN107085432 A CN 107085432A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- mtd
- mover
- msubsup
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 230000015572 biosynthetic process Effects 0.000 claims abstract description 32
- 238000000034 method Methods 0.000 claims abstract description 27
- 230000008859 change Effects 0.000 claims abstract description 10
- 238000007493 shaping process Methods 0.000 claims abstract description 4
- 238000005070 sampling Methods 0.000 claims description 4
- 230000003321 amplification Effects 0.000 claims description 3
- 238000009795 derivation Methods 0.000 claims description 3
- 238000013178 mathematical model Methods 0.000 claims description 3
- 238000003199 nucleic acid amplification method Methods 0.000 claims description 3
- 230000000694 effects Effects 0.000 abstract description 3
- 230000004044 response Effects 0.000 abstract description 3
- 230000008901 benefit Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000012938 design process Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000009415 formwork Methods 0.000 description 1
- 230000009931 harmful effect Effects 0.000 description 1
- 230000007935 neutral effect Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000005303 weighing Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0287—Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling
- G05D1/0291—Fleet control
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Health & Medical Sciences (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Artificial Intelligence (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Other Investigation Or Analysis Of Materials By Electrical Means (AREA)
- Manipulator (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种移动机器人的目标轨迹跟踪方法，包括以下步骤：1)建立移动机器人的运动方程,2)、建立基于虚拟领队的机器人编队运动学方程，3)、设计误差整形法和控制器控制编队误差。本发明移动机器人的目标轨迹跟踪方法，能够应用于实际的非完整移动机器人平台，能占用最少的系统资源做出最快的响应，能适用于不同的非完整移动机器人平台，闭环系统在原点平衡状态是全局一致渐进稳定的，能不改变控制器参数的取值而对各种不同的期望值都能够取得满意的跟踪效果，其控制量的变化光滑连续，降低了系统机械和能量损耗，并能延长系统有效工作时间和寿命。
Description
技术领域
本发明涉及机器人控制技术领域，特别涉及一种移动机器人目标轨迹跟踪控制方法。
背景技术
移动机器人是一类高度非线性、强耦合性、时变性的动力学系统，很难建立其准确的动力学模型，对其控制具有相当大的难度。移动机器人的轨迹跟踪问题中，期望值随时间变化是运动控制中的难点所在，针对这一问题，基于各种非线性控制理论的控制方法不断涌现。到目前为止，移动机器人目标轨迹跟踪控制方法主要有：
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)、建立基于虚拟领队的机器人编队运动学方程
任意跟随机器人的位置在地面坐标中表示为：
式中(xVL，yVL)表示虚拟领队机器人在(x,y)地面坐标系中的绝对位置，(xF,yF)表示跟随机器人在(x,y)地面坐标系中的绝对位置，ρ表示虚拟领队机器人与跟随机器人的相对距离，表示虚拟领队机器人与跟随机器人的相对前行方向角；
虚拟领队机器人相对于跟随机器人的前行速度在地面坐标系上的投影为：
由此推导出跟随机器人编队误差的变化率为：
其中
由编队误差变化率公式推导出编队误差变化的二阶方程
结合机器人的运动学方程，得到
其中
由式(17)可知，编队的控制目标就变成了设计有效控制电流来驱动编队误差到零；
3)、设计误差整形法和控制器控制编队误差
在移动机器人的编队控制中，误差整形法表述成:
其中，α、β为任意正整数，h代表控制器的采样周期；E(h)分别为E.和E的第一采样值，称Sj(t)为整形误差；误差整形法具有以下3个特点：
1)这意味着S(t)的初始值非常小，因此在它基础上设计的控制器不会出现极大的初始脉冲。
2)Sj(t)→0可保证Ej(t)→Ej(h)exp(-αt)，这表明当整形误差Sj(t)→0时，跟踪误差E和E.将趋近于响应误差Ej(h)exp(-αt)和这也是误差整形法的由来。
3)从Sj(t)→0可以得到因此，Sj(t)→0同时也能确保编队跟踪误差最终趋近零。
也就是说，如果能够基于整形误差法，设计记忆控制器并能够使||Sj(t)||趋近零，那么编队控制的目标就得以实现，同时消除了初始编队跟踪误差对控制器的不良影响。
在移动机器人的编队控制中，其控制器的设计如下：
首先求出整形误差
其中
编队控制的一阶记忆控制器为
通过一阶记忆控制器驱动编队误差最终趋近到零，其控制结果为：
最后说明的是，以上实施例仅用以说明本发明的技术方案而非限制，尽管参照较佳实施例对本发明进行了详细说明，本领域的普通技术人员应当理解，可以对本发明的技术方案进行修改或者等同替换，而不脱离本发明技术方案的宗旨和范围，其均应涵盖在本发明的权利要求范围当中。
Claims (1)
1.一种移动机器人的目标轨迹跟踪方法，其特征在于：包括以下步骤：
1)建立移动机器人的运动方程：
<mrow>
<mi>m</mi>
<mover>
<mi>u</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<msub>
<mi>F</mi>
<mi>r</mi>
</msub>
<mo>+</mo>
<msub>
<mi>F</mi>
<mi>l</mi>
</msub>
<mo>+</mo>
<msub>
<mi>F</mi>
<mrow>
<mi>c</mi>
<mi>x</mi>
</mrow>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>J</mi>
<mn>0</mn>
</msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>=</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>F</mi>
<mi>r</mi>
</msub>
<mo>-</mo>
<msub>
<mi>F</mi>
<mi>l</mi>
</msub>
<mo>)</mo>
</mrow>
<mi>d</mi>
<mo>/</mo>
<mn>2</mn>
<mo>-</mo>
<msub>
<mi>F</mi>
<mrow>
<mi>c</mi>
<mi>y</mi>
</mrow>
</msub>
<mi>b</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
式中，u是机器人的运动速度；θ是机器人前行方向角；m代表机器人底盘的质量；J0是机器人底盘相对于机器人两驱动轮轮距中点的转动惯量；Fr和Fl代表作用在机器人两个驱动轮上的驱动力；Fcx与Fcy代表自位轮在xb和yb方向上的地面摩擦力；yb方向即两驱动轮的轴向，xb方向垂直于yb方向；d是两驱动轮的间距；b是自位轮轴线与两驱动轮轴线间的局离；
两个驱动轮上的驱动电动机的运动数学模型为：
<mrow>
<msub>
<mi>J</mi>
<mi>w</mi>
</msub>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>r</mi>
</msub>
<mo>=</mo>
<msub>
<mi>K</mi>
<mi>t</mi>
</msub>
<msub>
<mi>I</mi>
<mrow>
<mi>m</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>F</mi>
<mi>r</mi>
</msub>
<mi>r</mi>
<mo>-</mo>
<mi>&eta;</mi>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>r</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>J</mi>
<mi>w</mi>
</msub>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>l</mi>
</msub>
<mo>=</mo>
<msub>
<mi>K</mi>
<mi>t</mi>
</msub>
<msub>
<mi>I</mi>
<mrow>
<mi>m</mi>
<mi>l</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>F</mi>
<mi>l</mi>
</msub>
<mi>r</mi>
<mo>-</mo>
<mi>&eta;</mi>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>l</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
式中，θr和θl是驱动轮的转角；Jw代表驱动轮的转动惯量；r代表驱动轮半径；η为摩擦系数；Kt为驱动电动机转矩常数；Imr与Iml为两驱动电动机的驱动电流，而Icr与Icl为控制电流，控制电流通过放大电路得到实际的电动机驱动电流，因此有Imr＝Kam Icr,Iml＝Kam Iml，Kam为电流放大因数；
很显然，u、与θr、θl存在如下的集合关系：
<mrow>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>r</mi>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>l</mi>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>s</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>s</mi>
<mi>l</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mi>r</mi>
<mo>/</mo>
<mn>2</mn>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>u</mi>
<mo>=</mo>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>r</mi>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>l</mi>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>s</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>s</mi>
<mi>l</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mi>r</mi>
<mo>/</mo>
<mi>d</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
式中，θsr、θsl是两电动机的偏离角；
所以，从式(1)-(4)得到机器人的运动状态与控制电流间的关系式：
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mover>
<mi>u</mi>
<mo>&CenterDot;</mo>
</mover>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<msub>
<mi>K</mi>
<mi>t</mi>
</msub>
<msub>
<mi>K</mi>
<mrow>
<mi>a</mi>
<mi>m</mi>
</mrow>
</msub>
<msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>m</mi>
<mn>1</mn>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<msub>
<mi>m</mi>
<mn>2</mn>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mrow>
<mo>-</mo>
<mo>`</mo>
<mn>1</mn>
</mrow>
</msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>I</mi>
<mrow>
<mi>c</mi>
<mi>r</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>I</mi>
<mrow>
<mi>c</mi>
<mi>l</mi>
</mrow>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<mi>Q</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
其中
m1＝(2Jw/r+mr)，m2＝Jwd/r+2J0r/d (8)
<mrow>
<mi>Q</mi>
<mo>=</mo>
<msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>m</mi>
<mn>1</mn>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<msub>
<mi>m</mi>
<mn>2</mn>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>F</mi>
<mrow>
<mi>c</mi>
<mi>x</mi>
</mrow>
</msub>
<mo>-</mo>
<mi>&eta;</mi>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>r</mi>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>l</mi>
<mo>;</mo>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>J</mi>
<mi>w</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mrow>
<mi>s</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mrow>
<mi>s</mi>
<mi>l</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mn>2</mn>
<msub>
<mi>rbF</mi>
<mrow>
<mi>c</mi>
<mi>y</mi>
</mrow>
</msub>
<mo>/</mo>
<mi>d</mi>
<mo>-</mo>
<mi>&eta;</mi>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>r</mi>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>l</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>J</mi>
<mi>w</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mrow>
<mi>s</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mrow>
<mi>s</mi>
<mi>l</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>9</mn>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
2)、建立基于虚拟领队的机器人编队运动学方程
任意跟随机器人的位置在地面坐标中表示为：
式中(xVL，yVL)表示虚拟领队机器人在(x,y)地面坐标系中的绝对位置，(xF,yF)表示跟随机器人在(x,y)地面坐标系中的绝对位置，ρ表示虚拟领队机器人与跟随机器人的相对距离，表示虚拟领队机器人与跟随机器人的相对前行方向角；
虚拟领队机器人相对于跟随机器人的前行速度在地面坐标系上的投影为：
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>V</mi>
<mi>L</mi>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>u</mi>
<mrow>
<mi>V</mi>
<mi>L</mi>
</mrow>
</msub>
<msub>
<mi>cos&theta;</mi>
<mrow>
<mi>V</mi>
<mi>L</mi>
</mrow>
</msub>
<mo>,</mo>
<msub>
<mover>
<mi>y</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>V</mi>
<mi>L</mi>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>u</mi>
<mrow>
<mi>V</mi>
<mi>L</mi>
</mrow>
</msub>
<msub>
<mi>sin&theta;</mi>
<mrow>
<mi>V</mi>
<mi>L</mi>
</mrow>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>12</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msubsup>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>F</mi>
<mi>j</mi>
</msubsup>
<mo>=</mo>
<msubsup>
<mi>u</mi>
<mi>F</mi>
<mi>j</mi>
</msubsup>
<msubsup>
<mi>cos&theta;</mi>
<mi>F</mi>
<mi>j</mi>
</msubsup>
<mo>,</mo>
<msubsup>
<mover>
<mi>y</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>F</mi>
<mi>j</mi>
</msubsup>
<mo>=</mo>
<msubsup>
<mi>u</mi>
<mi>F</mi>
<mi>j</mi>
</msubsup>
<msubsup>
<mi>sin&theta;</mi>
<mi>F</mi>
<mi>j</mi>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>13</mn>
<mo>)</mo>
</mrow>
</mrow>
由此推导出跟随机器人编队误差的变化率为：
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>x</mi>
<mi>j</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>y</mi>
<mi>j</mi>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>u</mi>
<mrow>
<mi>V</mi>
<mi>L</mi>
</mrow>
</msub>
<msub>
<mi>cos&theta;</mi>
<mrow>
<mi>V</mi>
<mi>L</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>u</mi>
<mrow>
<mi>V</mi>
<mi>L</mi>
</mrow>
</msub>
<msub>
<mi>sin&theta;</mi>
<mrow>
<mi>V</mi>
<mi>L</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<msup>
<mi>C</mi>
<mi>j</mi>
</msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>u</mi>
<mi>F</mi>
<mi>j</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>F</mi>
<mi>j</mi>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>14</mn>
<mo>)</mo>
</mrow>
</mrow>
其中
<mrow>
<msup>
<mi>C</mi>
<mi>j</mi>
</msup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msubsup>
<mi>cos&theta;</mi>
<mi>F</mi>
<mi>j</mi>
</msubsup>
</mrow>
</mtd>
<mtd>
<mrow>
<msubsup>
<mi>&rho;</mi>
<mi>d</mi>
<mi>j</mi>
</msubsup>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mrow>
<msubsup>
<mi>&theta;</mi>
<mi>F</mi>
<mi>j</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>&phi;</mi>
<mi>d</mi>
<mi>j</mi>
</msubsup>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msubsup>
<mi>sin&theta;</mi>
<mi>F</mi>
<mi>j</mi>
</msubsup>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msubsup>
<mi>&rho;</mi>
<mi>d</mi>
<mi>j</mi>
</msubsup>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<mrow>
<msubsup>
<mi>&theta;</mi>
<mi>F</mi>
<mi>j</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>&phi;</mi>
<mi>d</mi>
<mi>j</mi>
</msubsup>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>15</mn>
<mo>)</mo>
</mrow>
</mrow>
由编队误差变化率公式推导出编队误差变化的二阶方程
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mover>
<mi>e</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>x</mi>
<mi>j</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mover>
<mi>e</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>y</mi>
<mi>j</mi>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<msup>
<mi>C</mi>
<mi>j</mi>
</msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mover>
<mi>u</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>F</mi>
<mi>j</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>F</mi>
<mi>j</mi>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<msup>
<mover>
<mi>C</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>j</mi>
</msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>u</mi>
<mi>F</mi>
<mi>j</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mover>
<mi>u</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>F</mi>
<mi>j</mi>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<mfrac>
<mi>d</mi>
<mrow>
<mi>d</mi>
<mi>t</mi>
</mrow>
</mfrac>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>u</mi>
<mrow>
<mi>V</mi>
<mi>L</mi>
</mrow>
</msub>
<msub>
<mi>cos&theta;</mi>
<mrow>
<mi>V</mi>
<mi>L</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>u</mi>
<mrow>
<mi>V</mi>
<mi>L</mi>
</mrow>
</msub>
<msub>
<mi>sin&theta;</mi>
<mrow>
<mi>V</mi>
<mi>L</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>16</mn>
<mo>)</mo>
</mrow>
</mrow>
结合机器人的运动学方程，得到
<mrow>
<msup>
<mover>
<mi>E</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>j</mi>
</msup>
<mo>=</mo>
<msup>
<mi>C</mi>
<mi>j</mi>
</msup>
<msup>
<mi>GI</mi>
<mi>j</mi>
</msup>
<mo>+</mo>
<msup>
<mi>H</mi>
<mi>j</mi>
</msup>
<mrow>
<mo>(</mo>
<mo>.</mo>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>17</mn>
<mo>)</mo>
</mrow>
</mrow>
其中
<mrow>
<msup>
<mi>E</mi>
<mi>j</mi>
</msup>
<mo>=</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<msubsup>
<mi>e</mi>
<mi>x</mi>
<mi>j</mi>
</msubsup>
<mo>,</mo>
<msubsup>
<mi>e</mi>
<mi>y</mi>
<mi>j</mi>
</msubsup>
<mo>&rsqb;</mo>
</mrow>
<mi>T</mi>
</msup>
<mo>,</mo>
<msup>
<mi>I</mi>
<mi>j</mi>
</msup>
<mo>=</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<msub>
<mi>I</mi>
<mrow>
<mi>c</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>,</mo>
<msub>
<mi>I</mi>
<mrow>
<mi>c</mi>
<mi>l</mi>
</mrow>
</msub>
<mo>&rsqb;</mo>
</mrow>
<mi>T</mi>
</msup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>18</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>G</mi>
<mo>=</mo>
<msub>
<mi>K</mi>
<mi>t</mi>
</msub>
<msub>
<mi>K</mi>
<mrow>
<mi>a</mi>
<mi>m</mi>
</mrow>
</msub>
<msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>m</mi>
<mn>1</mn>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<msub>
<mi>m</mi>
<mn>2</mn>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>19</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msup>
<mi>H</mi>
<mi>j</mi>
</msup>
<mrow>
<mo>(</mo>
<mo>.</mo>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msup>
<mi>C</mi>
<mi>j</mi>
</msup>
<mi>Q</mi>
<mo>+</mo>
<msup>
<mover>
<mi>C</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>j</mi>
</msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>u</mi>
<mi>F</mi>
<mi>j</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>F</mi>
<mi>j</mi>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<mfrac>
<mi>d</mi>
<mrow>
<mi>d</mi>
<mi>t</mi>
</mrow>
</mfrac>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>u</mi>
<mrow>
<mi>V</mi>
<mi>L</mi>
</mrow>
</msub>
<msub>
<mi>cos&theta;</mi>
<mrow>
<mi>V</mi>
<mi>L</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>u</mi>
<mrow>
<mi>V</mi>
<mi>L</mi>
</mrow>
</msub>
<msub>
<mi>sin&theta;</mi>
<mrow>
<mi>V</mi>
<mi>L</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>20</mn>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
3)、设计误差整形法和控制器控制编队误差
在移动机器人的编队控制中，误差整形法表述成:
<mrow>
<msup>
<mi>S</mi>
<mi>j</mi>
</msup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>E</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>j</mi>
</msup>
<mo>+</mo>
<msup>
<mi>&beta;E</mi>
<mi>j</mi>
</msup>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>&lsqb;</mo>
<msup>
<mover>
<mi>E</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>j</mi>
</msup>
<mo>(</mo>
<mi>h</mi>
<mo>)</mo>
<mo>+</mo>
<msup>
<mi>&beta;E</mi>
<mi>j</mi>
</msup>
<mo>(</mo>
<mi>h</mi>
<mo>)</mo>
<mo>&rsqb;</mo>
<mi>exp</mi>
<mrow>
<mo>(</mo>
<mo>-</mo>
<mi>&alpha;</mi>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>21</mn>
<mo>)</mo>
</mrow>
</mrow>
其中，α、β为任意正整数，h代表控制器的采样周期；E(h)分别为和E的第一采样值，称Sj(t)为整形误差；
在移动机器人的编队控制中，其控制器的设计如下：
首先求出整形误差
<mrow>
<msup>
<mover>
<mi>S</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>j</mi>
</msup>
<mo>=</mo>
<msup>
<mi>C</mi>
<mi>j</mi>
</msup>
<msup>
<mi>GI</mi>
<mi>j</mi>
</msup>
<mo>+</mo>
<msup>
<mi>H</mi>
<mi>j</mi>
</msup>
<mrow>
<mo>(</mo>
<mo>.</mo>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>&zeta;</mi>
<mi>j</mi>
</msup>
<mrow>
<mo>(</mo>
<mo>.</mo>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>22</mn>
<mo>)</mo>
</mrow>
</mrow>
其中
<mrow>
<msup>
<mi>&zeta;</mi>
<mi>j</mi>
</msup>
<mrow>
<mo>(</mo>
<mo>.</mo>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>&beta;</mi>
<msup>
<mover>
<mi>E</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>j</mi>
</msup>
<mo>+</mo>
<mi>&alpha;</mi>
<mo>&lsqb;</mo>
<msup>
<mover>
<mi>E</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>j</mi>
</msup>
<mo>(</mo>
<mi>h</mi>
<mo>)</mo>
<mo>+</mo>
<msup>
<mi>&beta;E</mi>
<mi>j</mi>
</msup>
<mrow>
<mo>(</mo>
<mi>h</mi>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<mi>exp</mi>
<mrow>
<mo>(</mo>
<mo>-</mo>
<mi>&alpha;</mi>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>23</mn>
<mo>)</mo>
</mrow>
</mrow>
编队控制的一阶记忆控制器为
<mrow>
<msubsup>
<mi>I</mi>
<mi>k</mi>
<mi>j</mi>
</msubsup>
<mo>=</mo>
<msup>
<mrow>
<mo>(</mo>
<mrow>
<msubsup>
<mi>G</mi>
<mi>k</mi>
<mi>j</mi>
</msubsup>
<mi>G</mi>
</mrow>
<mo>)</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mrow>
<mo>&lsqb;</mo>
<mrow>
<msubsup>
<mi>C</mi>
<mrow>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mi>j</mi>
</msubsup>
<msubsup>
<mi>GI</mi>
<mrow>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mi>j</mi>
</msubsup>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mrow>
<mn>2</mn>
<mo>/</mo>
<mi>h</mi>
</mrow>
<mo>)</mo>
</mrow>
<msubsup>
<mi>S</mi>
<mi>k</mi>
<mi>j</mi>
</msubsup>
<mo>+</mo>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>/</mo>
<mi>h</mi>
</mrow>
<mo>)</mo>
</mrow>
<msubsup>
<mi>S</mi>
<mrow>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mi>j</mi>
</msubsup>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mrow>
<msubsup>
<mi>&zeta;</mi>
<mi>k</mi>
<mi>j</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>&zeta;</mi>
<mrow>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mi>j</mi>
</msubsup>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
<mo>&rsqb;</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>24</mn>
<mo>)</mo>
</mrow>
</mrow>
通过一阶记忆控制器驱动编队误差最终趋近到零。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710481270.2A CN107085432B (zh) | 2017-06-22 | 2017-06-22 | 一种移动机器人的目标轨迹跟踪方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710481270.2A CN107085432B (zh) | 2017-06-22 | 2017-06-22 | 一种移动机器人的目标轨迹跟踪方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN107085432A true CN107085432A (zh) | 2017-08-22 |
| CN107085432B CN107085432B (zh) | 2020-03-31 |
Family
ID=59605912
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201710481270.2A Active CN107085432B (zh) | 2017-06-22 | 2017-06-22 | 一种移动机器人的目标轨迹跟踪方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN107085432B (zh) |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108062024A (zh) * | 2017-12-15 | 2018-05-22 | 陕西理工大学 | 一种考虑阻力的移动机器人反演滑模控制方法 |
| CN109032128A (zh) * | 2018-06-13 | 2018-12-18 | 江南大学 | 离散多agv非质点系统的三角编队控制方法 |
| CN109491381A (zh) * | 2018-11-06 | 2019-03-19 | 中国科学技术大学 | 基于观测器的多移动机器人自适应编队跟踪控制方法 |
| WO2023103553A1 (zh) * | 2021-12-09 | 2023-06-15 | 灵动科技（北京）有限公司 | 多机器人轨迹规划方法及计算机程序产品 |
Citations (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101436073A (zh) * | 2008-12-03 | 2009-05-20 | 江南大学 | 基于量子行为粒子群算法的轮式移动机器人轨迹跟踪方法 |
| CN101685309A (zh) * | 2008-09-24 | 2010-03-31 | 中国科学院自动化研究所 | 多机器人协调队形控制方法 |
| JP2010124646A (ja) * | 2008-11-21 | 2010-06-03 | Nissan Motor Co Ltd | モータ構造及びモータ製造方法 |
| CN104881044A (zh) * | 2015-06-11 | 2015-09-02 | 北京理工大学 | 一种姿态未知的多移动机器人系统的自适应跟踪控制方法 |
| CN105527960A (zh) * | 2015-12-18 | 2016-04-27 | 燕山大学 | 一种基于领航跟随的移动机器人编队控制方法 |
| CN105607636A (zh) * | 2016-01-21 | 2016-05-25 | 浙江工业大学 | 一种基于积分滑模算法的轮式移动机器人主从式编队控制方法 |
| US20160209849A1 (en) * | 2015-01-15 | 2016-07-21 | William Dale Arbogast | System and method for decentralized, multi-agent unmanned vehicle navigation and formation control |
| CN106054922A (zh) * | 2016-06-22 | 2016-10-26 | 长安大学 | 一种无人机‑无人车联合编队协同控制方法 |
| CN106094835A (zh) * | 2016-08-01 | 2016-11-09 | 西北工业大学 | 前轮驱动车式移动机器人的动态编队控制方法 |
| US20160334787A1 (en) * | 2015-05-14 | 2016-11-17 | King Fahd University Of Petroleum And Minerals | Multi-agent deployment protocol method for coverage of cluttered spaces |
-
2017
- 2017-06-22 CN CN201710481270.2A patent/CN107085432B/zh active Active
Patent Citations (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101685309A (zh) * | 2008-09-24 | 2010-03-31 | 中国科学院自动化研究所 | 多机器人协调队形控制方法 |
| JP2010124646A (ja) * | 2008-11-21 | 2010-06-03 | Nissan Motor Co Ltd | モータ構造及びモータ製造方法 |
| CN101436073A (zh) * | 2008-12-03 | 2009-05-20 | 江南大学 | 基于量子行为粒子群算法的轮式移动机器人轨迹跟踪方法 |
| US20160209849A1 (en) * | 2015-01-15 | 2016-07-21 | William Dale Arbogast | System and method for decentralized, multi-agent unmanned vehicle navigation and formation control |
| US20160334787A1 (en) * | 2015-05-14 | 2016-11-17 | King Fahd University Of Petroleum And Minerals | Multi-agent deployment protocol method for coverage of cluttered spaces |
| CN104881044A (zh) * | 2015-06-11 | 2015-09-02 | 北京理工大学 | 一种姿态未知的多移动机器人系统的自适应跟踪控制方法 |
| CN105527960A (zh) * | 2015-12-18 | 2016-04-27 | 燕山大学 | 一种基于领航跟随的移动机器人编队控制方法 |
| CN105607636A (zh) * | 2016-01-21 | 2016-05-25 | 浙江工业大学 | 一种基于积分滑模算法的轮式移动机器人主从式编队控制方法 |
| CN106054922A (zh) * | 2016-06-22 | 2016-10-26 | 长安大学 | 一种无人机‑无人车联合编队协同控制方法 |
| CN106094835A (zh) * | 2016-08-01 | 2016-11-09 | 西北工业大学 | 前轮驱动车式移动机器人的动态编队控制方法 |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108062024A (zh) * | 2017-12-15 | 2018-05-22 | 陕西理工大学 | 一种考虑阻力的移动机器人反演滑模控制方法 |
| CN109032128A (zh) * | 2018-06-13 | 2018-12-18 | 江南大学 | 离散多agv非质点系统的三角编队控制方法 |
| CN109032128B (zh) * | 2018-06-13 | 2020-04-10 | 江南大学 | 离散多agv非质点系统的三角编队控制方法 |
| CN109491381A (zh) * | 2018-11-06 | 2019-03-19 | 中国科学技术大学 | 基于观测器的多移动机器人自适应编队跟踪控制方法 |
| CN109491381B (zh) * | 2018-11-06 | 2020-10-27 | 中国科学技术大学 | 基于观测器的多移动机器人自适应编队跟踪控制方法 |
| WO2023103553A1 (zh) * | 2021-12-09 | 2023-06-15 | 灵动科技（北京）有限公司 | 多机器人轨迹规划方法及计算机程序产品 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN107085432B (zh) | 2020-03-31 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN105320129B (zh) | 一种无人驾驶自行车轨迹跟踪控制的方法 | |
| CN104932506B (zh) | 基于快速终端滑模的轮式移动机器人轨迹跟踪方法 | |
| CN107085432A (zh) | 一种移动机器人的目标轨迹跟踪方法 | |
| Wang et al. | A hybrid visual servo controller for robust grasping by wheeled mobile robots | |
| CN101825901B (zh) | 基于人工物理法的多智能体机器人协同控制方法 | |
| CN106125728B (zh) | 一种四驱轮式移动机器人轨迹跟踪控制方法 | |
| CN108153309B (zh) | 用于履带机器人的控制方法以及履带机器人 | |
| CN107160398B (zh) | 基于确定学习的全状态受限刚性机械臂安全可靠控制方法 | |
| CN109857100B (zh) | 一种基于反演法和快速终端滑模的复合轨迹跟踪控制算法 | |
| CN107272677A (zh) | 一种移动机器人的变结构自适应轨迹跟踪控制方法 | |
| CN103019239A (zh) | 用于喷药移动机器人的轨迹跟踪滑模控制系统和控制方法 | |
| CN101436073A (zh) | 基于量子行为粒子群算法的轮式移动机器人轨迹跟踪方法 | |
| CN113341728B (zh) | 一种抗噪型归零神经网络的四轮移动机械臂轨迹跟踪控制方法 | |
| US20200206898A1 (en) | Biped robot gait control method and biped robot | |
| CN105652869A (zh) | 一种基于cmac和pid的全向移动机器人及移动控制方法 | |
| CN105607636A (zh) | 一种基于积分滑模算法的轮式移动机器人主从式编队控制方法 | |
| CN106708056A (zh) | 四轮麦克纳姆轮巡检机器人运动控制方法 | |
| CN108469738A (zh) | 一种移动机器人的自适应动力学控制方法 | |
| CN108062024A (zh) | 一种考虑阻力的移动机器人反演滑模控制方法 | |
| Han et al. | Robust optimal control of omni-directional mobile robot using model predictive control method | |
| Zhan et al. | Near-optimal trajectory planning of a spherical mobile robot for environment exploration | |
| US20230409035A1 (en) | Method for building controller for robot, method, device for controlling motion of robot, and robot | |
| Rojas-Moreno et al. | Fractional order tracking control of a wheeled mobile robot | |
| Liikanen et al. | Path-following controller for 4wds hydraulic heavy-duty field robots with nonlinear internal dynamics | |
| CN107807534B (zh) | 一种多轮式机器人自适应协同控制算法及控制系统 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| CB03 | Change of inventor or designer information |
Inventor after: Song Yongduan Inventor after: Liu Xiulan Inventor after: Lai Junfeng Inventor after: Li Panfei Inventor after: Zhang Yunfu Inventor after: Zhang Zitao Inventor after: He Yufeng Inventor after: Li Shuhao Inventor before: Song Yongduan Inventor before: Lai Junfeng Inventor before: Li Panfei Inventor before: Zhang Yunfu Inventor before: Zhang Zitao Inventor before: He Yufeng Inventor before: Li Shuhao |
|
| CB03 | Change of inventor or designer information | ||
| CB03 | Change of inventor or designer information |
Inventor after: Liu Xiulan Inventor after: Song Yongduan Inventor after: Lai Junfeng Inventor after: Li Panfei Inventor after: Zhang Yunfu Inventor after: Zhang Zitao Inventor after: He Yufeng Inventor after: Li Shuhao Inventor before: Song Yongduan Inventor before: Liu Xiulan Inventor before: Lai Junfeng Inventor before: Li Panfei Inventor before: Zhang Yunfu Inventor before: Zhang Zitao Inventor before: He Yufeng Inventor before: Li Shuhao |
|
| CB03 | Change of inventor or designer information | ||
| TA01 | Transfer of patent application right |
Effective date of registration: 20180425 Address after: 401220 Feng Ling Road, Changshou District, Chongqing, No. 29 4-1 Applicant after: Liu Xiulan Address before: 400030 No. 1 Huiquan Road, Shapingba District, Chongqing, 13, attachment 4. Applicant before: Interstellar (Chongqing) Intelligent Equipment Technology Research Institute Co., Ltd. |
|
| TA01 | Transfer of patent application right | ||
| TA01 | Transfer of patent application right |
Effective date of registration: 20200122 Address after: 401220 No. 6 Xinmin Road, Xinshi Street, Changshou District, Chongqing Applicant after: Debbie (Chongqing) Intelligent Science and Technology Research Institute Co., Ltd. Address before: 401220 Feng Ling Road, Changshou District, Chongqing, No. 29 4-1 Applicant before: Liu Xiulan |
|
| TA01 | Transfer of patent application right | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant | ||
| TR01 | Transfer of patent right |
Effective date of registration: 20210609 Address after: Room 731 and 732, 7th floor, 557 Renmin Road, Dongge sub district office, Pingdu City, Qingdao City, Shandong Province 266701 Patentee after: QINGDAO GELAIRUI INTELLIGENT CONTROL TECHNOLOGY Co.,Ltd. Address before: No.6 Xinmin Road, Xinshi street, Changshou District, Chongqing 401220 Patentee before: DIBI (CHONGQING) INTELLIGENT TECHNOLOGY RESEARCH INSTITUTE Co.,Ltd. |
|
| TR01 | Transfer of patent right |