外文翻译--轮式移动机器人的导航与控制

1、毕业设计(论文)外文资料翻译系部： 机械工程 专 业： 机械工程及自动化 姓 名： 学 号： (用外文写)外文出处： control and robotics(crb) technical report 附 件：1.外文资料翻译译文；2.外文原文。 指导教师评语：译文比较正确地表达了原文的意义、概念描述基本符合汉语的习惯，语句较通畅，层次较清晰。 签名： 年 月 日附件1：外文资料翻译译文 轮式移动机器人的导航与控制摘要：本文研究了把几种具有导航功能的方法运用于不同的控制器开发，以实现在一个已知障碍物前面控制一个开环系统（例如：轮式移动机器人）执行任务。第一种方法是基于三维坐标路径规划的控制方

2、法。具有导航功能的控制器在自由配置的空间中生成一条从初始位置到目标位置的路径。位移控制器控制移动机器人沿设置的路径运动并停止在目标位置。第二种方法是基于二维坐标路径规划的控制方法。在二维平面坐标系中建立导航函数，基于这种导航函数设计的微控制器是渐进收敛控制系统。仿真结果被用来说明第二种控制方法的性能。1介绍很多研究者已经提出不同算法以解决在障碍物杂乱的环境下机器人的运动控制问题。对与建立无碰撞路径和传统的路径规划算法，参考文献19的第一章第九部分中提供了的全面总结。从khatib在参考文献13的开创性工作以来，很显然控制机器人在已知障碍物下执行任务的主流方法之一依然是构建和应用位函数。总之，位

3、函数能够提供机器人工作空间、障碍位置和目标的位场。在参考文献19中提供对于位函数的全面研究。应用位函数的一个问题是局部极小化的情况可能发生以至于机器人无法到达目标位置。不少研究人士提出了解决局部极小化错误的方法（例如参考文献2, 3,5, 14, 25）。其中koditschek在参考文献16中提供了一种解决局部极小化错误的方法，那是通过基于一种特殊的位函数的完整系统构建导航函数，此函数有精确的数学结构，它能够保证存在唯一最小值。在针对标准的 (完整的)系统的先前的结果的影响下, 面对更多的具有挑战性的非完整系统，越来越多的研究集中于位函数方法的发展(例如.,机器人)。例如, laumond

4、等人 18 用几何路线策划器构建了一条忽略机器人非完全约束的无障碍路线, 然后把几何线路分成更短的线路来满足非完全限制,然后应用最佳路线来减少路程。在 10 和 11中, guldner 等人使用间断变化的模式控制器迫使机器人的位置沿着位函数的负倾斜度变动，及其定位与负倾斜度一致。在1, 15, 和 21中,持续的位场控制器也保证了位函数的负倾斜度的位置追踪和定位追踪。在9中，面对目标因为周边的障碍物而不能达到这一情况时，ge和cui 最近提出一种新的排斥的位函数的方法来解决这一问题。 在 23和24中, tanner 等人采用22 中提出的导航函数研究和偶极位场概念为一个不完全移动操纵器建立

5、导航函数控制器。特别是, 23 和 24 中的结果使用了间断控制器来追踪导航函数的负倾斜度, 在此过程中，一个不平坦的偶极位场使得机器人按照预想的定位拐入目标位置。 本文介绍了为不完全系统达到导航目标的两种不同的方法。在第一个方法中, 产生了一个三维空间似导航函数的预想的轨道，它接近于机器人自由配置空间上的唯一最小值的目标位置和定位。然后利用连续控制结构使机器人沿着这条路线走，在目标位置和定位点停下(例如,控制器解决一体化的追踪和调节问题)。这种方法特别的地方是机器人根据预想的定位到达目标位置，而不需要像许多先前的结果中一样转弯。正如 4 和 20中描述的一样, 一些因素如光线降低现象，更有效

6、处罚离开预期周线的机器人的能力，使执行任务速度恒定的能力，以及达到任务协调性和同步性的能力提高等为按照目前位置和定位压缩预期轨道提供动机。至于即时的二维空间问题 设计一个连续控制器，沿着一个导航函数的负倾斜度驾驶机器人到达目标位置。像许多先前的结果一样，在线二维空间方法的定位需要进一步发展 (例如, 一个单独的调节控制器，一个偶极位场方法 23, 24; 或一个有效障碍物9)来使机器人与预期的定位在一条线上。模拟结果阐明了第二种方法的效果。 2 运动学模型本文所讨论的不完全系统的种类可以作为运动转轮的模型 这里定义为在(1)中, 矩阵定义为速度向量 定义为其中vc(t), c(t) r 表示系

7、统线速度和角速度。在(2)中, xc(t), yc(t),(t) r分别表示位置和定位，xc(t),yc(t) 表示线速度的笛卡尔成分,(t) r 表示角速度。3 控制目标本文的控制目标是在一个有障碍物且混乱的环境下，沿着无碰撞轨道驾驶不完全系统（例如，机器人）到达不变的目标位置和定位，用表示。 特别是从起始位置和定位沿着轨道控制不完全系统，q d, 这里的 d 表示一个自由的配置空间。自由配置空间d是整个配置空间的子集，除去了所有含有障碍物碰撞的配置。使轨道计划控制量化，实际笛卡尔位置和定位与预想的位置和定位之间的差异可表示为 ,定义为 如下这里设计了预想的轨道，因此 qd(t) q.16中

8、，运用导航函数方法, 利用似导航函数生成预期路线qd(t)。在本文中似导航函数有如下定义： 定义1 把d作为连接解析流形和边界的纽带, 把q 当作d内部的目标点. 似导航函数(q) :d 0, 1 是符合下列条件的函数： 1. (q(t) 第一个命令和可辨第二个命令 (例如,存在与d中的和)。2. (q(t) 在d的边界有最大变量。3. (q(t) 在 q (t) = q上有唯一的全局最小值.4. 如果 ，其中z, r r 是正常数。5. 如果(q(t)被限制,那么被r 限制，其中 r是正常数。 4 在线三维空间轨道计划4.1 轨道计划生成的预期的三维空间轨道如下：其中(q) r 表示定义1中

9、定义的似导航函数, 表示(q)的倾斜向量, 是另加的限制条件。假设 定义1中定义的似导航函数，沿着由(6)生成的预期轨道，确保了辅助条件n () r3, 表示为满足了下面的不等式 其中正函数 () 在和 中是不减少的。(8) 中给的不等式将在以后的稳定性分析中用到。4.2 模型转换为了达到控制目标，控制器必须能够追踪预期轨道，停在目标位置q上. 最后, 使用7 中提到的统一追踪和调节控制器。为了改进7中的控制器,必须把 (5)中定义的开路错误系统转换为合适的形式。(5)中定义的位置和定位循迹误差信号通过以下全应可逆转换8和辅助循迹误差变量w(t) r 和有关。 运用 (9)中的时间导数和 (1

10、)-(5)及(9)后, 根据(9)定义的辅助变数，循迹误差可表示为 8 其中表示不相称矩阵，定义为 定义为 (10)中介绍的辅助控制输入 根据和定义如下 .4.3 控制发展 为了促进控制发展, 一个辅助误差信号, 用表示, 是后来设计的动态似振荡器信号 和转换的变量z(t)之间的差别,如下 根据(10)中开路运动系统和后来的稳定性分析, 我们把 u(t)设计为7 其中 k2 r 是正的不变的控制增长率。(15)中介绍的辅助控制条件定义为 其中辅助信号zd(t)由下列微分方程式和初始条件决定 辅助条件1(w, f, t) r and d(t) r 分别为 和 , k1, 0, 1, 1 r是正的

11、不变的控制增长率, 在(12)中有定义。正如 8中描述的一样, (17)和(19)中结构是以以下事实为基础的 根据(9), e (t) f能够用, 和表示出来，如下 其中表示为 在随后的稳定性分析推动下，附加的限制条件vr (t) 表示如下 其中 k3, k4 r 是正的不变的控制增长率, 正函数1 (zd1, z1, qd, e),2 (zd1, z1, qd, e) r 表示为 4.4 闭环误差系统把(15)替换到(10)中后, 得到含有w(t) 如下的公式 这里利用了(14)和(11)中j的属性。第二次出现 ua(t)时把(16)替换到(26)中，利用(20)和(11)中j的属性, 最终

12、得到的w(t)闭环误差系统表达式如下为了确定闭环误差系统, 我们运用(14)中的时间导数，替换 (10) 和(17) 到最终表达式， 达到下面的表达式 替换(15)和(16)到(28), (28) 可以写成第二次出现 1 (t) 时，替换(18)到(29) ，然后删去相同部分，得到表达式： 因为(30)中的相等条件和 (16)中定义的ua (t)是一样的, 得到 闭环误差系统的最终表达式 如下备注1 根据(19)中d (t )接近任意小常量，(16), (17),和(18)中禁止产生位奇点。4.5 稳定性分析 法则1 倘若qd (0) d, (6)中产生的预期轨道连同附加的限制条件vr (t)

13、 保证了 和 ， 其中 r在定义1中有解释。证明: 让v (t) r 表示下面的函数其中 k r 是一个正常数, v1 (t) r 表示下面的函数v2 (qd) : d r 表示下面的一个函数运用(33)中时间导数，替换 (27) 和(31) 到最终的表达式，删去相同部分, 得到下面的表达式 运用(34)中时间导数和(6), 得到下面的表达式 其中 n () 在(7)中有定义。 根据 (8), v2 (t) 是上限，如下 替换 (21)到(37), 得到下面的不等式 其中向量表示如下 正函数 1 (zd1, z1, qd, e) 和2 (zd1, z1, qd, e)在(25)中有所定义。替换

14、 (24)到(38), v2 (t)可以重新写成如下根据 (35) 和 (40), (32)中 v (t)的时间导数可以按下面的不等式得到上限其中正常数 表示如下. 案例 1: 如果,根据定义1中属性4，得到案例 2: 如果 ,根据 (32), (33),(34), 和(41) 得到其中 和 是正常数. 根据 (42), v (t)得到上限如下 因此根据 (32), (34), 和 (44),得到 如果 qd (0)不在d的边界, (qd (0) 1， k 可以符合 根据 (45) 和(46), (qd (t) 1, 因此从定义1得到qd (t) d， 从(43) 可以得出，(qd) 最终被限

15、制。 因此, 如果 , k4 则符合 , 其中 在定义1中有解释，进而在定义1的属性5中得到定义, 最终被r限制。法则2 (15)-(19)中运动学控制法保证全局统一最终限制的(guub) 位置和定位按下面公式追踪其中 1 在(19)中给定, , 3 和 0 是正常数.证明: 根据 (33) 和(35), v1 (t) 得到上限如下 根据 (48), 得到下面的不等式 根据 (33), (49) 可以被写成 其中向量1 (t)在(39)中有定义。根据(33) 和(49), 得到w (t) , l. 根据 (19)和(20), 我们可以得到zd (t) l. 根据(14) 和, zd (t) l

16、, 得到z (t) l.因为w (t) , z (t) l, 根据(9)中的逆转换, e (t) l. 根据法则1中qd (t) l 和 e (t) l,得到q (t) l.由于(22)-(25), qd (t) , zd (t) , z (t) , e (t) l,及定义1中的性质, 我们得到vr (t), qd (t) l. 根据 (12) 和q (t) , z (t) , qd (t) l, f (, z2, qd) l. 然后根据(18)得到 1 (t) l. 根据(15)-(17)得到 u (t) , ua (t) , zd (t) l. 根据 f (, z2, qd) , z (t

17、) , u (t) l, 利用(10) 得到w(t) , z(t) l. 由于z (t) , zd (t) l 得到 l.利用论据的标准信号可以得出控制之下的所有的剩余信号和系统在闭环试验中仍然被限定。 根据 (19), (20), (39), 和(50), 把三元不等式应用到(14)可以证明 利用(50)-(51), 根据(9)中的逆转换得到(47)中的结果。备注2 虽然qd (t) 是无碰撞轨道, 如果只确保实际机器人轨道在预期路线的附近，法则2的稳定性结果保证了轨道的实际追踪。根据 (5) 和(47), 得到下面的限制其中根据法则1的证明，qd (t) d .为了确保q (t) d, 自

18、由配置空间需要处于(52)右边的第二和第三条件共同作用。最后，障碍物的大小可以增加 。其中通过调节控制增加率，31 可以任意小。为了使2的影响最小化, 起始条件w(0)和z(0) (因此, ) 要求足够小来产生可行的路线到达目标。5 在线二维空间导航 先前的方法中，因为似导航函数用预期轨道表示，障碍物的尺寸要求增加。在下面的方法中, 22提出的导航函数是根据现有位置反馈表示出来的,因此, 不需要在起始条件里添加限制，q (t) 就可以证明是d的一部分。 5.1 轨道编制让(xc, yc) r 表示二维空间位置型导航函数, 其中梯度向量(xc, yc)定义如下让d (xc, yc) r 表示预期

19、定位，定义为一个二维空间导航函数的负梯度函数，如下其中 arc tan 2 () : r2 r 表示第四象限逆切线函数 26, 其中 d (t) 在下面的定义域中 按照21规定,通过定义 ，沿着任何到达目标位置的方向d(t) 仍然是连续的。见附录d(t)的表达式， 根据先前的d(t)连续定义。 备注3 正如22中讨论的, 函数 (q(t)的建立, 结合导航函数, 满足定义1的前三个性质 因为排除故障不是简单的问题。事实上, 对与典型的故障排除来说，建立 (q(t)如只有当 q (t) = q时，是不大可能的。 这就是说, 如22所述, 内部承受点的外观(如不稳定平衡 )好像不可避免; 可是,

20、这些不稳定均衡不会真正 造成实践中的困难。这就是说，如22所述可以建立 (q(t)，只有少数起始条件能够真正受不稳定均衡影响。5.2 控制发展 根据(1)-(4)介绍的开路系统和后来的稳定性分析, 线速度控制输入vc (t)表示如下 其中 kv r 表示正的不变的控制增长率, 在(5)中有介绍。替换 (55) 到(1),得到下面的 闭环系统运用(5)中时间导数，得到开路定位追踪误差系统，如下 .利用(1)，根据 (57), 角速度控制输入c (t)表示如下 其中 k r 表示 正的不变的控制增长率,d(t) 表示预期定位的时间导数。见附录d (t)外部表达式。替换 (58)到(57), 通过下

21、面的线性关系，得到闭环定位追踪误差系统 线性分析技巧用来解决(59) 如下替换 (60) 到(56)，得到下面的闭环误差系统 5.3 稳定性分析 法则3 (55)和(58)中的控制输入和导航函数 (xc (t) , yc (t) 在下列条件下保证了渐近导航证明: 让 v3 (xc, yc) : d r 表示下面的非负函数运用(63)时间导数，利用 (1),(53), 和(56),得到下面的表达式 根据附录的说明, 导航函数的梯度可表示为 替换 (65) 到(64), 得到下面的表达式 利用三角恒等式，(66) 可以写成 其中 g(t) r 表示下面的正函数根据 (53)和导航函数的属性(与定义

22、1的属性1相同), 可以得到。因此,根据 (55)可以得出vc (t) l . 附录同样证明了d (t) l on d;因此, 根据(58) 得出c (t)l . 根据vc (t) l , 利用(1)-(4) 可以知道xc (t), yc (t) l .应用(53)的时间导数，得到下面的表达式因为 xc (t), yc (t) l , 也因为黑森矩阵的每个成分被导航函数的属性限制 (与定义1的属性1相同 ), 可以得到g(t) l. 根据 (63), (67), (68), 和g(t) l ,那么辅助定理6中的a.6可以用来证明 在d区域. 根据1 ,那么 (70) 可以用来证明 . 因此根据

23、备注3中的分析，可以得到(62)中的结果。备注4 这部分控制发展是以一个二维空间导航函数为基础的. 为了达到目标, a 预期的定位 d (t) 看作是二维空间导航函数的负梯度函数. 先前的发展可以用来证明(62)的结果。如果一个导航函数 (xc, yc) 能够在d|(xc ,yc ) = 中找到, 那么渐近导航可以通过(55) 和(58)中控制器达到; 否则, 根据d|(xc ,yc ) 一个标准的调节控制器 (如., 见8 中的候选控制器)可能用来调节机器人的定位。作为选择, 偶极位场方法23, 24 或有效障碍物9可以用来使导航函数的梯度场与机器人的目标定位成一行。6 模拟结果为了说明(5

24、5) 和(58)中控制器的成效, 用数值模拟驾驶机器人从q (xc (0) , yc (0) , (0) 到 q (xc , yc , )。因为导航函数的属性是不变的under a diffeomorphism, a diffeomorphism 用来绘制机器人自由配置空间到模型空间 17. 正函数 (xc, yc)如下 其中 是正整数参量, 边界函数 0 (xc, yc) r，障碍函数1 (xc, yc) r 定义如下 在(72)中, (xr0, yr0 ) 和 (xr1, yr1 ) 分别是障碍物和分界线的中心, r0, r1 r 分别是障碍物和界面的半径。根据(71)和(72), 可以看

25、出模型空间是一个排除障碍物函数 1 (xc, yc)形成的圆的单位圆. 如果 更多的障碍物出现, 相应的障碍物函数就能简单的和导航函数 17合成一体. 在17中, koditschek 证明 (xc, yc) in (71) 是关于(xc (t) , yc (t)的导航函数, 假设足够大. 由于模拟, 模型空间配置选择如下其中起始位置和目标配置为 利用(55) 和(58)中定义的控制输入沿着负梯度角驾驶机器人到目标点。控制增长率kv 和 k调整到下面的值来产生最好的效果一旦机器人到达目标位置, 8中的调节控制器按照d|(xc ,yc ) 调节机器人。机器人的实际轨道如图1所示。. 图1中的外圆

26、描述了障碍物自由空间外边界，内部的圆代表了障碍物周围的边界。机器人的最终位置和定位误差如图2所示, 其中转动误差如图2所示是实际定位和目标定位之间的误差。(55)和(58)分别定义的控制输入速度vc(t) 和c(t)如图3所示。值得注意的是角速度输入 在 90deg s1之间人为饱和。7 结论两种方法都把导航函数方法合并到不同的控制器，在已知障碍物面前执行任务。第一种方法利用 以3d 位置和定位信息为基础的似导航函数。似导航函数生成一条轨道从自由配置空间里的初始配置到目标配置. 一个可微的振荡器型控制器使这个移动式遥控装置沿着这条路线走，在目标位置停止.。利用这种方法, 机器人可以用一个任意的

27、目标定位产生统一最终绑定路线和调节目标点(例如., 机器人不需要固定在目标位置旋转来达到预期的定位)。第二种方法使用的是二维空间位置信息建立的导航函数。根据这个导航函数，使用一个可辨的控制器。这个方法的好处是产生了渐近位置收敛; 可是，机器人如果没有附加的条件就不能在任意定位停止。模拟结果用来说明第二种方法的效果。 附录 根据(54)中d (t)的定义, d (t) 可用自然对数表示的表达式如下 26其中 ， 使用下面的恒等式 26 利用(74)得到下面的表达式 利用 (75)和(76), 得到下面的表达式 根据(74)中的表达式，d (t)的时间导数可以写成 其中， 替换 (1), (79)

28、, 和(80)到(78), 得到下面的表达式 替换 (55) 和(77)到(81), 得到下面的表达式 定义1的第一部分限制了黑森矩阵的每个元件，因此根据 (82),直接得到d (t) l.附件2：外文原文（复印件）navigation and control of a wheeled mobile robotabstract: several approaches for incorporating navigation function approach into different controllers are developed in this paper for task exec

29、ution by a nonholonomic system (e.g., a wheeled mobile robot) in the presence of known obstacles. the first approach is a path planning-based control with planning a desired path based on a 3-dimensional position and orientation information. a navigation-like function yields a path from an initial c

30、onfiguration inside the free configuration space of the mobile robot to a goal configuration. a differentiable, oscillator-based controller is then used to enable the mobile robot to follow the path and stop at the goal position. a second approach is developed for a navigation function that is const

31、ructed using 2-dimensional position information. a differentiable controller is proposed based on this navigation function that yields asymptotic convergence. simulation results are provided to illustrate the performance of the second approach.1 introductionnumerous researchers have proposed algorit

32、hms to address the motion control problem associated with robotic task execution in an obstacle cluttered environment. a comprehensive summary of techniques that address the classic geometric problem of constructing a collision-free path and traditional path planning algorithms is provided in sectio

33、n 9, .literature landmarks of chapter 1 of 19. since the pioneering work by khatib in 13, it is clear that the construction and use of potential functions has continued to be one of the mainstream approaches to robotic task execution among known obstacles. in short, potential functions produce a rep

34、ulsive potential field around the robot workspace boundary and obstacles and an attractive potential eld at the goal configuration. a comprehensive overview of research directed at potential functions is provided in 19. one of criticisms of the potential function approach is that local minima can oc

35、cur that can cause the robot to get stuck without reaching the goal position. several researchers have proposed approaches to address the local minima issue (e.g., see 2,3, 5, 14, 25). one approach to address the local minima issue was provided by koditschek in 16 for holonomic systems (see also 17

36、and 22) that is based on a special kind of potential function, coined a navigation function, that has a refined mathematical structure which guarantees a unique minimum exists. by leveraging from previous results directed at classic (holonomic) systems, more recent research has focused on the develo

37、pment of potential function-based approaches for more challenging nonholonomic systems (e.g., wheeled mobile robots (wmrs). for example, laumond et al. 18 used a geometric path planner to generate a collision-free path that ignores the nonholonomic constraints of a wmr, and then divided the geometri

38、c path into smaller paths that satisfy the nonholonomic constraints, and then applied an optimization routine to reduce the path length. in 10 and 11, guldner et al. use discontinuous, sliding mode controllers to force the position of a wmr to track the negative gradient of a potential function and

39、to force the orientation to align with the negative gradient. in 1, 15, and 21, continuous potential field-based controllers are developed to also ensure position tracking of the negative gradient of a potential function, and orientation tracking of the negative gradient. more recently, ge and cui p

40、resent a new repulsive potential function approach in 9 to address the case when the goal is non-reachable with obstacles nearby (gnron). in 23 and 24, tanner et al. exploit the navigation function research of 22 along with a dipolar potential field concept to develop a navigation function-based con

41、troller for a nonholonomic mobile manipulator. specifically, the results in 23 and 24 use a discontinuous controller to track the negative gradient of the navigation function, where a nonsmooth dipolar potential field causes the wmr to turn in place at the goal position to align with a desired orien

42、tation. in this paper, two different methods are proposed to achieve a navigation objective for a nonholonomic system. in the first approach, a 3-dimensional (3d) navigation-like function-based desired trajectory is generated that is proven to ultimately approach to the goal position and orientation

43、 that is a unique minimum over the wmr free configuration space. a continuous control structure is then utilized that enables the wmr to follow the path and stop at the goal position and orientation set point (i.e., the controller solves the unified tracking and regulation problem). the unique aspec

44、t of this approach is that the wmr reaches the goal position with a desired orientation and is not required to turn in place as in many of the previous results. as described in 4 and 20, factors such as the radial reduction phenomena, the ability to more effectively penalize the robot for leaving th

45、e desired contour, the ability to incorporate invariance to the task execution speed, and the improved ability to achieve task coordination and synchronization provide motivation to encapsulate the desired trajectory in terms of the current position and orientation. for the on-line 2d problem, a con

46、tinuous controller is designed to navigate the wmr along the negative gradient of a navigation function to the goal position. as in many of the previous results, the orientation for the on-line 2d approach requires additional development (e.g., a separate regulation controller; a dipolar potential f

47、ield approach 23, 24; or a virtual obstacle 9) to align the wmr with a desired orientation. simulation results are provided to illustrate the performance of the second approach.2 kinematic modelthe class of nonholonomic systems considered in this paper can be modeled as a kinematic wheelwhere are de

48、fined asin (1), the matrixis defined as followsand the velocity vector is defined aswith vc(t), c(t) r denoting the linear and angular velocity of the system. in (2), xc(t), yc(t), and (t) r denote the position and orientation, respectively, xc(t), yc(t) denote the cartesian components of the linear

49、 velocity, and (t) r denotes the angular velocity. 3 control objective the control objective in this paper is to navigate a non-holonomic system (e.g., a wheeled mobile robot) along a collision-free path to a constant, goal position and orientation, denoted by , in an obstacle cluttered environment

50、with known obstacles. specifically, the objective is to control the non-holonomic system along a path from an initial position and orientation to q d, where d denotes a free configuration space. the free configuration space d is a subset of the whole configuration space with all configurations remov

51、ed that involve a collision with an obstacle. to quantify the path planning-based control objective, the difference between the actual cartesian position and orientation and the desired position and orientation, denoted by, is defined as as followswhere the desired trajectory is designed so that qd(

52、t) q. motived by the navigation function approach in 16, a navigation-like function is utilized to generate the desired path qd(t). specifically, the navigation-like function used in this paper is defined as followsdefinition 1 let d be a compact connected analytic manifold with boundary, and let q

53、be a goal point in the interior of d. the navigation-like function (q): d 0, 1, is a function satisfies the following properties:1. (q(t) is first order and second order differentiable (i.e., and exist on d).2. (q(t) obtains its maximum value on the boundary of d.3. (q(t) has unique global minimum a

54、t q (t) = q.4. if with z, r r being known positive constants.5. if (q(t) is ultimately bounded by , then is ultimately bounded by r with r being some known positive constant.4 online 3d path planner4.1 trajectory planningthe 3d desired trajectory can be generated online as follows where (q) r denote

55、s a navigation-like function defined in definition 1, denotes the gradient vector of (q), and is an additional control term to be designed. assumption the navigation-like function defined in definition 1 along with the desired trajectory generated by (6) ensures an auxiliary terms n () r3, defined assatisfy the following inequalitywhere the positive function () i