[发明专利]一种面向受限水域的无人艇运动规划方法

摘要

本发明提供一种面向受限水域的无人艇运动规划方法，首先，构建无人艇动力学模型，在无人艇动力学模型和无人艇轨迹离散化规则的基础上，建立32个方向的轨迹单元；其次，提出LAA，并在其中建立16个节点搜索的单元格；此外，根据32个方向的轨迹单元约束，约束LAA的探索空间；调用LAA进行路径搜索，根据搜索得到的路径调用无人艇运动模型产生的轨迹单元；最后，根据追溯表信息不断调用无人艇运动模型产生的轨迹单元，进行路径的拼接，直至目的地。本发明针对现有的运动规划算法不适应受限水域条件限制，从而不能实现有效路径搜索问题，通过算法进行改进，从而在原有的算法基础上增加单元格标签，进而使无人艇在受限水域能实现更好的运动规划。

主权项

1.一种无人艇运动规划方法，其特征在于：它包括以下步骤：/nS1、构建无人艇动力学模型及轨迹单元：/n按照常规方式构建无人艇动力学模型；/n构建无人艇轨迹离散化规则：规则一、在轨迹段初始和结束时刻，无人艇的运动状态保持一致；规则二、每段轨迹单元的转舵次数不超过一次；规则三、轨迹单元分为三类，每种类型的轨迹单元直线距离都相等，这三类轨迹单元的半径长度依次定义为R1、R2和R3；/n在无人艇动力学模型和无人艇轨迹离散化规则的基础上，建立32个方向的轨迹单元；同时在搜索路径时采用16个节点搜索；/nS2、建立标签A*算法(Lable-A*algorithm,LAA)，根据32个方向的轨迹单元约束，约束LAA的探索空间；/nS3、调用LAA进行路径搜索：/n3.1、初始化环境信息，设置起始点SP(x,y,φ)和终点EP(xn,yn,φn)，定义关闭列表CL和开启列表OL，初始化集合CL和OL，并且设置CL和OL为空列表；其中，开启列表OL为储存路径搜索过程中待检索节点的列表，关闭列表CL为储存路径搜索过后不再需要检索的节点列表；/n3.2、将起始点加入CL和追溯表TL，并设置起始点为父节点j(x,y,φ)，将障碍物信息OB添加进OL，并且设置障碍物点处的代价为无穷大；开始探索当前点j(x,y,φ)周围的16个子节点；其中追溯表TL为存储父子节点关系的列表，用于生成搜索得到的路径；/n3.3、把周围的16个子节点加入到OL中，调用评估函数F(j)，对周围的16个子节点进行代价值估计，并且从这16个子节点中选取代价值最小的节点添加进CL中，并且将此点设置为新的父节点j1(x1,y1,φ1)，将新的父节点j1点添加进TL；/n3.4、继续遍历新的父节点j1(x1,y1,φ1)周围的16个子节点中代价值最小的点，如果此时新的父节点j1(x1,y1,φ1)达到下一个子节点j2(x2,y2,φ2)所得路径代价的最小值大于上一个父节点j(x,y,φ)达到同样的子节点j2(x2,y2,φ2)所得路径代价值，则更新父节点，把此时的子节点j2(x2,y2,φ2)设置为节点j1(x1,y1,φ1)的父节点，如果不大于，则j1(x1,y1,φ1)继续为父节点，并把子节点j2(x2,y2,φ2)设置为下一个子节点j3(x3,y3,φ3)的父节点；/n3.5 重复上述的搜索过程，直至搜索到终点EP加入到CL中，并添加进TL中，根据TL打印出路径；/nS4、根据S3搜索得到的路径调用无人艇运动模型产生的轨迹单元；/nS5、根据TL信息不断调用无人艇运动模型产生的轨迹单元，进行路径的拼接，直至目的地。/n