基于RRT和DWA的欠驱动UUV路径规划

严浙平; 黄俊儒; 吴迪; YAN Zheping; HUANG Junru; WU Di

引 en

基于RRT和DWA的欠驱动UUV路径规划

严浙平

机构：

哈尔滨工程大学自动化学院,黑龙江哈尔滨 150001

×
，黄俊儒

机构：

哈尔滨工程大学自动化学院,黑龙江哈尔滨 150001

×
，吴迪

机构：

哈尔滨工程大学自动化学院,黑龙江哈尔滨 150001

×

哈尔滨工程大学自动化学院,黑龙江哈尔滨 150001；

Underactuated UUV Path Planning Based on RRT and DWA

YAN Zheping

Affiliation：

College of Automation,Harbin Engineering University,Harbin 150001 ,China

×
， HUANG Junru

Affiliation：

College of Automation,Harbin Engineering University,Harbin 150001 ,China

×
， WU Di

Affiliation：

College of Automation,Harbin Engineering University,Harbin 150001 ,China

×

College of Automation,Harbin Engineering University,Harbin 150001 ,China；

作者简介:

严浙平(1972-),男,博士,教授,主要从事水下无人潜航器相关研究。

中图分类号:TP301.6︰U661

文献标识码:A

文章编号:2096-5753(2020)03-0258-07

DOI:10.19838/j.issn.2096-5753.2020.03.014

全文
评论
参考文献
出版信息

参考文献 1

丁帅,陈苗苗,王猛,等.基于 RRT*算法的水下机器人全局路径规划方法[J].舰船科学技术,2019,41(17):66-73.

查找原文

参考文献 2

孙波,陈卫东,席裕庚.基于粒子群优化算法的移动机器人全局路径规划[J].控制与决策,2005(9):1052-1055,1060.

查找原文

参考文献 3

严浙平,邓超,迟冬南,等.双种群粒子群算法及其在UUV路径规划中的应用[J].计算机工程与应用,2013,49(15):1-5.

查找原文

参考文献 4

黄辰.基于智能优化算法的移动机器人路径规划与定位方法研究[D].大连:大连交通大学,2018.

查找原文

参考文献 5

何壮壮,丁德锐.基于 D-star 和DWA的改进机器人导航方法[J].电子测量技术,2019,42(12):122-128.

查找原文

参考文献 6

张伟,郁晨曦,滕延斌,等.基于模型预测控制的UUV路径跟踪控制研究[J].仪器仪表学报,2017,38(11):2659-2666.

查找原文

参考文献 7

严浙平,邓超,赵玉飞,等.无人水下航行器近海底空间路径规划方法[J].哈尔滨工程大学学报,2014,35(3):307-312.

查找原文

参考文献 8

李宁.面向家庭环境的移动机器人局部路径规划算法研究[D].哈尔滨:哈尔滨工业大学,2018.

查找原文

参考文献 9

田永永,李梁华.基于速度方向判定的动态窗口法[J].农业装备与车辆工程,2018,56(8):39-42.

查找原文

参考文献 10

THANELLAS G A,MOULIANITIS V C,ASPRAGATHOS N A.A spatially wind aware quadcopter(UAV)path planning approach[J].IFAC PapersOnLine,2019,52(8):283-288.

查找原文

目录contents

摘要Abstract
关键词Keywords
0 引言
1 UUV水平面数学模型
2 路径规划算法
2.1 RRT全局路径规划算法
2.2 DWA局部路径规划算法
3 基于RRT和DWA的改进路径规划算法
4 仿真验证分析
5 结束语
参考文献

摘要

针对无人潜航器（UUV）在未知水下复杂环境的路径规划问题，设计了随机树以及动态窗口的融合算法。该算法基于快速扩展随机树（RRT）以及动态窗口（DWA）两层规划设计，第一层利用随机树算法快速规划出全局路径，在此基础上第二层加载全局路径，针对UUV模型的欠驱动和非线性，利用动态窗口算法完成局部路径规划，保证约束条件下UUV路径的安全性。通过融合参数μ修正内外框架的融合度，有效地弥补了全局路径算法的无法躲避动态障碍物的缺点以及局部路径算法全局能力低下的问题。最后，通过对比仿真验证了融合算法相比于随机树全局算法和动态窗口局部算法的优越性。

Abstract

Aiming at the path planning of unmanned underwater vehicle（UUV）in unknown underwater complex environment，an RRT-DWA fusion algorithm was designed. The algorithm is based on two-layers planning design of rapid expansion random tree（RRT）and dynamic window（DWA）. The first layer uses the RRT algorithm to quickly plan the global path. Based on this and considering the underactuation and non-linearity of the UUV model，the second layer loads the global path，and the DWA algorithm is used to complete the local path planning to ensure the safety of the UUV path under the constraints. The fusion parameters of the inner and outer frames are corrected by the fusion parameters μ，which effectively makes up for the shortcomings of the global path algorithm that cannot avoid dynamic obstacles and improves the low efficiency of the local path algorithm. Finally，the superiority of the RRT-DWA fusion algorithm compared with the RRT global algorithm and the DWA local algorithm is verified through comparative simulation.

关键词

水下无人潜航器；快速扩展随机树；动态窗口；路径规划

Keywords

unmanned underwater vehicle ； RRT ； DWA ； path planning

0 引言
水下无人潜航器（Unmanned Underwater Vehicle，UUV）的运动规划是UUV核心技术之一，本文重点讨论水平面规划。路径规划以功能和侧重点分为全局路径规划和局部路径规划，两者有区别但又可以相互转化。全局路径规划是在已知周围环境的前提下可以快速规划出一条最优路径，但全局路径规划有时不考虑动力学约束，并且水下环境复杂，环境信息获取并不完全，容错率较低；局部路径规划侧重于局部环境规避未知障碍物的能力，但其寻找到最优全局路径的效率低下。如何使UUV快速安全地到达目标点是一个重要的研究方向。
全局路径规划有很多成熟的算法，早在1958年就有了Dijsktra算法，改进后又有了A*和D*算法，以及蚁群算法、贪心算法、粒子群算法等。丁帅以减少水下机器人能量消耗为前提，基于RRT*算法设计了能耗最低的路径规划算法^{^[1]}；孙波针对移动机器人的路径规划提出了粒子群优化算法^{^[2]}；邓超针对UUV三维空间移动提出了双种群粒子群算法^{^[3]}。局部路径规划一般配备了各类传感器以获取局部地图或者探测未知障碍物，其算法也有人工势场法以及动态窗口法。同时也有衍生的改进和结合的算法：黄辰考虑到机器人的尺寸，通过激光雷达获取局部地图，改进了DWA算法^{^[4]}；何壮壮在ROS环境下提出了针对两轮机器人的D*和DWA结合算法等^{^[5]}。
针对欠驱动UUV的研究也比较成熟，张伟针对垂直面的路径跟踪目标设计了基于模型预测连续系统跟踪控制器，避免离散化，提高了控制器的泰勒展开阶次，提高了精度^{^[6]}。赵玉飞针对UUV近海底的路径规划问题，提出了改进粒子群算法^{^[7]}。该算法可以有效规避静态障碍物，但是无法规避动态障碍物，针对这一问题，本文提出了快速扩展随机树以及动态窗口的融合算法框架。该算法一方面继承了RRT算法的全局规划能力，一方面继承了DWA算法的实时避障能力，实现了实时避障的全局路径规划。通过修改外部框架的距离参数可以提高全局路径的精度，同时通过修改内部框架的评价函数参数可以使UUV应对不同的需求和地形，最后设计了融合参数μ，通过修改μ来确定内外框架的融合度。
1 UUV水平面数学模型
欠驱动UUV路径规划为水平面的规划，所以不考虑垂直方向运动，水平面模型由欠驱动UUV六自由度模型在水平面方向解耦得到。
水平面运动学模型：

\begin{matrix} \dot{x} = u c o s ψ - v s i n ψ \\ \dot{y} = u s i n ψ + v c o s ψ \\ \dot{ψ} = r \end{matrix}

(1)

水平面动力学模型：

\begin{matrix} \dot{u} = \frac{m_{2}}{m_{1}} v r - \frac{d_{1}}{m_{1}} u + \frac{1}{m_{1}} X_{PROP} \\ \dot{v} = - \frac{m_{1}}{m_{2}} u r - \frac{d_{2}}{m_{2}} v \\ \dot{r} = \frac{m_{1} - m_{2}}{m_{3}} u v - \frac{d_{3}}{m_{2}} r + \frac{1}{m_{3}} τ_{r} \end{matrix}

(2)

其中

\begin{matrix} m_{1} = m - X_{\dot{u}}, m_{2} = m - Y_{\dot{v}} \\ m_{3} = J_{z} - N_{\dot{r}}, d_{1} = X_{u} + X_{u | u |} | u | \\ d_{2} = Y_{v} + Y_{v | v |} | v |, d_{3} = N_{r} + N_{r | r |} | r | \end{matrix}

(3)

动态窗口算法中UUV未来时域的状态由状态空间模型得到，由式（1）和式（2）转换为UUV的水平面状态空间方程：

\{\begin{matrix} \dot{x} = f (x) + g (x) u \\ y = h (x) \end{matrix}

(4)

$x = [u v r x y ψ]^{T} = [x_{1} x_{2} x_{3} x_{4} x_{5} x_{6}]^{T}$
$f (x) = [\begin{matrix} a_{1} x_{2} x_{3} + a_{2} x_{1} \\ b_{1} x_{1} x_{3} + b_{2} x_{2} \\ c_{1} x_{1} x_{2} + c_{2} x_{3} \\ x_{1} \cos x_{6} - x_{2} \sin x_{6} \\ x_{1} \sin x_{6} + x_{2} \cos x_{6} \\ x_{3} \end{matrix}] g (x) = [g_{1} (x) g_{2} (x)] = [\begin{matrix} a_{3} 0 0 0 0 0 \\ 0 0 c_{3} 0 0 0 \end{matrix}]$
$u = [u_{1} u_{2}]^{T} = [X_{prop} τ_{r}]^{T}, y = [h_{1} h_{2} h_{3}]^{T} = [x_{4} x_{5} x_{6}]^{T}$
$a_{1} = \frac{m_{2}}{m_{1}}, a_{2} = - \frac{d_{1}}{m_{1}}, a_{3} = \frac{1}{m_{1}}, b_{1} = - \frac{m_{1}}{m_{2}}, b_{2} = - \frac{d_{2}}{m_{2}}, c_{1} = \frac{m_{1} - m_{2}}{m_{3}}, c_{2} = - \frac{d_{3}}{m_{3}}, c_{3} = \frac{1}{m_{3}}$
式中： $x \in R^{6} ， u \in R^{2} ， y \in R^{3}$ ，状态空间方程的状态量为UUV的位置姿态，输出量为UUV的实际位置坐标； $x$ ， $y$ 为UUV水平面坐标； $u$ ， $v$ 为横、纵向速度； $ψ$ ， $r$ 为艏向角和角速度； $X_{p r o p}$ 、 $τ_{r}$ 为纵向推力以及转向力矩。
2 路径规划算法
2.1 RRT全局路径规划算法
在全局路径规划的算法中，快速扩展随机树（Rapidly-exploring Random Trees，RRT）算法由LaValle教授在20世纪末提出。RRT算法相对于其他全局算法的优点在于可以更快更灵活地规划出路径，并且不要求障碍物形状的规则性。但是缺点也尤为明显：它的效率并不稳定，由于其迭代过程没有目标性，所以每次的路径选取并不相同。经过类似迷宫的狭窄区域很难找到出口，需要大量反复计算，浪费时间和资源。并且所需路径越平滑，计算量也越大。一些改进的RRT算法弥补了部分缺点，且可通过插值修正曲线。
初始化的地图只包含随机树的根节点也就是起始点Q_int和目标点Q_gol。首先按照策略概率p生成一个随机点Q_rad，p的生成由一个随机数保证。随机树上离该随机点最近的节点Q_near（初始化的情况下为起始点）向Q_rad矢量方向生成一个新节点Q_new。Q_near和Q_new的长度为距离参数q_dist，修改此参数可以修改RRT算法的精度和计算量。之后对随机树上的节点Q_near以及Q_new的路线做障碍物碰撞检测，若发生碰撞则放弃此条路径，若没有发生碰撞则将节点Q_new加入到随机树节点中，Q_near和Q_new加入到路径矩阵。重复以上步骤直到Q_new与Q_gol之间的距离小于设定值Q_set，即说明到达目标点。最后依据贪心算法简化得到的路径，从起点Q_int起依次寻找与Q_gol节点满足碰撞检测函数的节点q*，用此路径替代之前的路径，再以q*为终点依次寻找得到一个最简路径。同时需要注意以下几点。
图1 RRT算法示意图
Fig.1 RRT algorithm diagram
1）策略概率p依据目标点的距离给定，以一个随机数确保概率的有效性。距离目标点越近生成Q_rad的概率越高，否则随机树将聚集在一个区域，不能很好地向目标点方向伸展探索空间。p选取为

p = \{\begin{matrix} p_{1} (D_{d i s t} (Q_{r a d}, Q_{g o l}) < q_{l i t}) \\ 1 - p_{1} (D_{d i s t} (Q_{r a d}, Q_{g o l}) > q_{l i t}) \end{matrix}

(5)

2）为了保证算法的效率和可控性，需要设定每次搜索的循环次数，在给定次数之内完成循环，否则放弃此次搜索。以下为RRT算法的具体步骤：
①加载全局地图（获取障碍物信息，给定全局路径起点Q_int，终点Q_gol），设置距离参数q_dist，范围参数Q_set；
②设置循环；
③随机生成Q_rad，设置全局终点附近生成Q_rad的概率p；
④选取距离Q_rad最近的随机树节点Q_near向Q_rad方向伸展，伸展长度为距离参数q_dist，伸展后得到新节点Q_new；
⑤对Q_near与Q_new之间的路径进行碰撞检测，若此路径与障碍物存在交集则舍弃该节点，若不存在交集则将Q_new加入到随机树节点中；
⑥检测循环次数，若达到循环次数则回到③重新构建随机树，未超出次数则继续扩展随机树；
⑦检测Q_new与Q_gol之间的距离是否小于Q_set，若小于说明到达目标点则跳出循环，并输出随机树节点以及路径，若不小于则回到③；
⑧通过碰撞检测简化输出的随机树节点和路径。从起点依次寻找与终点Q_gol满足未碰撞的节点，找到未碰撞的节点q*后即舍弃该节点之后的节点，简化此节点到终点的路径，以此节点为终点重复以上过程继续向前寻找未碰撞节点得到最简路径。
2.2 DWA局部路径规划算法
相对于全局路径规划来说，局部路径规划并不要求对周围环境百分之百的了解。全局路径规划为移动机器人在已知全局地图的前提下规划出从一个区域到另一个区域的具体路线，而局部路径规划的地图多为临时获取，由获得的局部地图规划出一条临时路线，随着机器人的移动，局部地图实时更新，路线也实时更新。局部路径规划往往和各类传感器协同工作，由传感器获取周围环境的具体信息，进而得到局部地图进行规划^{^[8]}。局部路径规划的缺点是受参数以及位置环境物体影响，随机性较高，无法生成一个固定高效的全局路线^[9-10]。
动态窗口算法（Dynamic Window Approach，DWA）同样是20世纪末提出，其使用的是在线规划的方法：根据机器人本身的运动学模型得到各类约束，利用运动学约束根据当前的状态得出下一拍的动态区域，区域内包括机器人下一拍能实现的全部运动轨迹和状态。常用的移动机器人运动学模型在相邻拍数的轨迹一般用直线代替，用圆弧代替相比于直线更精确一些，而UUV的受力十分复杂，需要UUV专用的模型。之后通过对区域内的所有轨迹进行评价分析，得到一条得分最高的即为最优轨迹。
DWA算法的核心主要有2部分，第1部分为动态窗口的生成，依据以下几点。
1）速度与角速度约束，由UUV本身的性能得到最大与最小速度。

V_{m} = {v \in [{v m a x m i n m a x}_{m i n}

(6)

2）加速度约束，UUV的加速度受螺旋桨的推力以及水流情况的影响，所能达到的最小与最大加速度，在一拍时间内与最大最小速度和角速度共同组成了一个轨迹范围，生成了一拍时间内的动态窗口。

V_{d} = {(v, ω), v \in [v_{c} - v_{b} \cdot Δ t, v_{c} + v_{a} \cdot Δ t],

ω \in [ω_{c} - ω_{b} \cdot Δ t, ω_{c} + ω_{a} \cdot Δ t]}

(7)

3）碰撞检测，为了使UUV避免碰撞到障碍物，相应的距离需要小于对应的速度。

V_{a} = {(v, ω), v \leq \sqrt{2 \cdot D_{d i s t (v, ω)} \cdot v_{b}}, ω \leq \sqrt{2 \cdot D_{d i s t (v, ω)} \cdot ω_{b}}}

(8)

式中： $D_{d i s t (v, ω)}$ 为UUV与障碍物之间的轨迹距离，若在一定距离内小于对应速度则该条轨迹保留，否则去除该条轨迹。
第2部分为轨迹的评分策略函数 $G (v, ω)$ ，根据生成的动态窗口得到若干条轨迹，分析每一条轨迹的效率和安全性，评分主要依据以下几点。
1）艏向 $E_{h e a d i n g (v, ω)}$ 评分，UUV轨迹的实际航向越接近目标方向，则该评分越高。
2）安全系数 $E_{s d i s t}$ 评分，UUV轨迹距离障碍物越远，则评分越高；若该条轨迹距离障碍物小于对应速度的安全距离则直接舍弃；全路路径的安全性首先由此函数检验。
3）效率 $E_{v e l o c i t y (v, ω)}$ 评分，根据UUV轨迹的曲率、角加速度以及效率进行评分，越平滑速度越快，评分越高。
由于三类分属于不同的系统，为了防止某一参数占比过高导致不同路径的评分占比差距过大，将三类评价函数统一可以得到 $E_{e v a l u a t e (i)}$ 。

E_{e v a l u a t e (i)} = \frac{E_{e v a l u a t e (i)}}{\sum_{i = 1}^{n} E_{e v a l u a t e (i)}}

(9)

加入可调整的占比得到最终的评分函数。 $α$ 为艏向评分占比， $β$ 为安全系数评分占比， $γ$ 为效率评分占比。

G (v, ω) = σ (α \cdot N_{h e a d i n g (v, ω)} + β \cdot N_{s d i s t (v, ω)} + γ \cdot N_{v e l o c i t y (v, ω)})

(10)

3 基于RRT和DWA的改进路径规划算法
针对全局算法和局部算法的优缺点以及UUV性能与安全性的需求，提出了RRT和DWA改进的融合算法。该算法主要有两层规划设计，一层外部框架和一层内部框架。外部框架由RRT算法实现，内部框架将由RRT算法得到全局路径分段，再由DWA在线规划。融合算法的框架如图2所示。具体流程如下：
1）首先全局框架加载全局地图，当获取到起始点和目标点信息后规划出一条全局路径。传感器进入待机状态，传感器的范围即是局部框架动态轨迹窗口的范围。
2）将得到的全局路径发送给局部框架，利用DWA算法检验全局路径是否满足UUV的运动学规律，若不满足则重新生成全局路径。此外，当传感器得到的局部地图中有全局地图中未知的障碍物，并且此障碍物不在安全距离之外时则会发生碰撞，发出碰撞警告。
图2 RRT-DWA融合算法框架
Fig.2 RRT-DWA fusion algorithm framework
3）局部框架加载全局路径后，由融合参数μ确定全局路径插值，μ参数即为由RRT算法得到的最终全局路径的分段比例，根据路径的长短以及障碍物的密度进行修改，这里取为0.05。再由DWA算法在线生成局部路径，直到到达目标点完成循环，得到修正后的路径。
4 仿真验证分析
针对以上设计的算法，构建1个1 000 m²的仿真地图，图中黑色区域为障碍物；目标的起始点为原点，终点为地图右上角。首先给定3组参数验证单独使用动态窗口的全局路径规划性能。
图3为利用DWA算法得到的路径，改变DWA算法中评价函数中艏向评分占比，安全系数评分占比以及效率评分占比将得到不同的路径。图中蓝色和绿色两条轨迹的航向角评分分别为0.5和0.45，占比较高，在（300，300）坐标附近时为保证航向角评分路径的生成朝向目标点，UUV从障碍物上方行驶。下方红色轨迹的安全性评分为0.6，占比更高，所以在同一位置为保证安全性的评分，远离障碍物，UUV向下行驶。这就导致了单纯的DWA算法受很多因素影响，很难找到一条简洁的全局轨迹。
表1 动态窗口仿真参数
Table1 Dynamic window simulation parameters
初始状态参数组1 参数组2 参数组3
$u = 0$ $α = 0.5$ $α = 0.45$ $α = 0.1$
$v = 0$ $β = 0.3$ $β = 0.3$ $β = 0.6$
$r = 0 (°) / s ， ψ = 45 °$ $γ = 0.2$ $γ = 0.25$ $γ = 0.3$
图3 基于DWA算法的局部规划
Fig.3 Local planning based on DWA algorithm
图4和图5为利用RRT算法得到的全局路径，两次生成的全局路径并不相同，说明该算法有较高的灵活性。由于RRT算法得到的全局路径未考虑UUV的运动学约束，在图4以及图5中部分路径与障碍物相对较近，小于10 m的安全距离，安全性得不到保证。
图4 基于RRT算法的全局规划（1）
Fig.4 Global planning based on RRT（1）
图5 基于RRT算法的全局规划（2）
Fig.5 Global planning based on RRT（2）
图6和图7为RRT-DWA融合算法生成的路径，其中绿色轨迹为图4和图5中利用RRT得到的全局路径，红色轨迹为RRT-DWA融合算法轨迹。由图可知，该条轨迹由于采用了RRT算法，其轨迹比较灵活，很容易找到一条简洁的全局路径。同时后加入的DWA算法使得该条路径满足UUV的运动学规律，可以时刻与障碍物保持距离，保证了安全，继承了DWA算法的躲避移动或未知障碍物的能力。
图6 基于融合算法的全局规划（1）
Fig.6 Global planning based on RRT-DWA（1）
图7 基于融合算法的全局规划（2）
Fig.7 Global planning based on RRT-DWA（2）
表2中RRT1和RRT-DWA1分别对应图4和图6中一段范围内的最近障碍物的距离，RRT2、RRT-DWA2对应图5和图7中障碍物距离。由表知RRT算法得到的轨迹无法实时保证安全距离；融合算法得到的轨迹可以始终保证10 m的安全距离，说明了融合算法具有良好的避障能力。
表2 最近障碍物距离
Table2 Nearest obstacle distance
全局路径 RRT1 RRT-DWA1 RRT2 RRT-DWA2
最近障碍物距离/m 8.9 18.6 9.7 16.3
5 结束语
为保证UUV水平面规划的效率以及安全性，以UUV水平面状态空间方程为研究对象，针对传统局部路径规划和全局路径规划导航方式的优缺点，提出了RRT-DWA融合算法。融合算法的外部框架不考虑动力学约束，仿真结果显示有较好的全局路径搜索能力和灵活性；内部框架结合UUV的运动模型、动力学模型以及传感器实时获取局部信息，通过评价函数可以实现障碍物的规避。仿真结果显示，融合算法始终可以保持10 m的安全距离，保证了安全，通过内部框架判断全局路径的可行性。同时应对不同的海底区域可以通过调整局部框架的评价函数参数来满足安全性或者效率的需求。综上，RRT-DWA融合算法可以实现以上功能，满足UUV现实需求。
参考文献
- [1] 丁帅,陈苗苗,王猛,等.基于 RRT*算法的水下机器人全局路径规划方法[J].舰船科学技术,2019,41(17):66-73.
- [2] 孙波,陈卫东,席裕庚.基于粒子群优化算法的移动机器人全局路径规划[J].控制与决策,2005(9):1052-1055,1060.
- [3] 严浙平,邓超,迟冬南,等.双种群粒子群算法及其在UUV路径规划中的应用[J].计算机工程与应用,2013,49(15):1-5.
- [4] 黄辰.基于智能优化算法的移动机器人路径规划与定位方法研究[D].大连:大连交通大学,2018.
- [5] 何壮壮,丁德锐.基于 D-star 和DWA的改进机器人导航方法[J].电子测量技术,2019,42(12):122-128.
- [6] 张伟,郁晨曦,滕延斌,等.基于模型预测控制的UUV路径跟踪控制研究[J].仪器仪表学报,2017,38(11):2659-2666.
- [7] 严浙平,邓超,赵玉飞,等.无人水下航行器近海底空间路径规划方法[J].哈尔滨工程大学学报,2014,35(3):307-312.
- [8] 李宁.面向家庭环境的移动机器人局部路径规划算法研究[D].哈尔滨:哈尔滨工业大学,2018.
- [9] 田永永,李梁华.基于速度方向判定的动态窗口法[J].农业装备与车辆工程,2018,56(8):39-42.
- [10] THANELLAS G A,MOULIANITIS V C,ASPRAGATHOS N A.A spatially wind aware quadcopter(UAV)path planning approach[J].IFAC PapersOnLine,2019,52(8):283-288.

基本信息

中图分类号: TP301.6︰U661
文献标识码: A
DOI: 10.19838/j.issn.2096-5753.2020.03.014
文章编号: 2096-5753(2020)03-0258-07

基金信息

引用信息

稿件历史

收稿日期: 2020-04-13

参考文献

[1] 丁帅,陈苗苗,王猛,等.基于 RRT*算法的水下机器人全局路径规划方法[J].舰船科学技术,2019,41(17):66-73.
[2] 孙波,陈卫东,席裕庚.基于粒子群优化算法的移动机器人全局路径规划[J].控制与决策,2005(9):1052-1055,1060.
[3] 严浙平,邓超,迟冬南,等.双种群粒子群算法及其在UUV路径规划中的应用[J].计算机工程与应用,2013,49(15):1-5.
[4] 黄辰.基于智能优化算法的移动机器人路径规划与定位方法研究[D].大连:大连交通大学,2018.
[5] 何壮壮,丁德锐.基于 D-star 和DWA的改进机器人导航方法[J].电子测量技术,2019,42(12):122-128.
[6] 张伟,郁晨曦,滕延斌,等.基于模型预测控制的UUV路径跟踪控制研究[J].仪器仪表学报,2017,38(11):2659-2666.
[7] 严浙平,邓超,赵玉飞,等.无人水下航行器近海底空间路径规划方法[J].哈尔滨工程大学学报,2014,35(3):307-312.
[8] 李宁.面向家庭环境的移动机器人局部路径规划算法研究[D].哈尔滨:哈尔滨工业大学,2018.
[9] 田永永,李梁华.基于速度方向判定的动态窗口法[J].农业装备与车辆工程,2018,56(8):39-42.
[10] THANELLAS G A,MOULIANITIS V C,ASPRAGATHOS N A.A spatially wind aware quadcopter(UAV)path planning approach[J].IFAC PapersOnLine,2019,52(8):283-288.

首页

本刊简介

编委会

收录情况

期刊订阅

征稿简则

联系我们

基于RRT和DWA的欠驱动UUV路径规划

Underactuated UUV Path Planning Based on RRT and DWA

摘要

Abstract

关键词

Keywords

0 引言

1 UUV水平面数学模型

(1)

(2)

(3)

(4)

2 路径规划算法

2.1 RRT全局路径规划算法

(5)

2.2 DWA局部路径规划算法

(6)

(7)

(8)

(9)

(10)

3 基于RRT和DWA的改进路径规划算法

4 仿真验证分析

5 结束语

参考文献

基本信息

基金信息

引用信息

稿件历史

参考文献

初始状态	参数组1	参数组2	参数组3
$u = 0$	$α = 0.5$	$α = 0.45$	$α = 0.1$
$v = 0$	$β = 0.3$	$β = 0.3$	$β = 0.6$
$r = 0 (°) / s ， ψ = 45 °$	$γ = 0.2$	$γ = 0.25$	$γ = 0.3$

全局路径	RRT1	RRT-DWA1	RRT2	RRT-DWA2
最近障碍物距离/m	8.9	18.6	9.7	16.3

首页

本刊简介

编委会

收录情况

期刊订阅

征稿简则

联系我们

分享给微信好友或者朋友圈

使用微信“扫一扫”功能。

基于RRT和DWA的欠驱动UUV路径规划

Underactuated UUV Path Planning Based on RRT and DWA

摘要

Abstract

关键词

Keywords

0 引言

1 UUV水平面数学模型

(1)

(2)

(3)

(4)

2 路径规划算法

2.1 RRT全局路径规划算法

(5)

2.2 DWA局部路径规划算法

(6)

(7)

(8)

(9)

(10)

3 基于RRT和DWA的改进路径规划算法

4 仿真验证分析

5 结束语

参考文献

基本信息

基金信息

引用信息

稿件历史

参考文献