买专利卖专利找龙图腾，真高效！ 查专利查商标用IPTOP,全免费！专利年费监控用IP管家,真方便！

龙图腾网获悉西北工业大学申请的专利一种改进的基于快速随机搜索树的船舶路径规划方法获国家发明授权专利权，本发明授权专利权由国家知识产权局授予，授权公告号为：CN116300854B 。

龙图腾网通过国家知识产权局官网在2025-07-01发布的发明授权授权公告中获悉：该发明授权的专利申请号/专利号为：202211322038.1，技术领域涉及：G05D1/43；该发明授权一种改进的基于快速随机搜索树的船舶路径规划方法是由朱怡安;苏将;张黎翔;李佳钰;李联设计研发完成，并于2022-10-27向国家知识产权局提交的专利申请。

本一种改进的基于快速随机搜索树的船舶路径规划方法在说明书摘要公布了：本发明公开了一种改进的基于快速随机搜索树的船舶路径规划方法，首先引入以目的地中心的引力势场概念，通过随机扩展节点的方向与引力势场方向叠加，确定新的节点扩展方向，以对RRT算法中随机树的扩展方向加以约束，保证树的扩展方向始终向目的地靠拢，进而减少树生长过程中的无效分支；并且在路径树的扩展过程中结合船舶周围障碍物情况，从而可以更快的到达目标点。此外，本方法采用三角形内切圆方法对路径拐点进行平滑处理，使得最终生成的路径更适合实际应用。最后采用相同情况下的模拟数据进行验证了该方法的有效性和一定的先进性，非常适合于动态场景下的路径实时规划，尤其适合航海领域的船舶路径规划。

本发明授权一种改进的基于快速随机搜索树的船舶路径规划方法在权利要求书中公布了：1.一种改进的基于快速随机搜索树的船舶路径规划方法，其特征在于，包括如下步骤： 步骤1：选取海域及船舶数据，进行区域障碍物环境建模； 步骤1-1：获取海域图像数据，并进行二值化处理； 步骤1-2：二值化处理后的海域图像表示为F＝{fij}，fij为像素点i,j的灰度值；使用光栅扫描法扫描图像F，当扫描到像素点i,j的灰度值fij≠0时对fij的连通域进行轮廓提取，最终输出海域障碍物图像轮廓点集； 步骤1-3：使用最小二乘法圆拟合进行海域障碍物填充，建立最小二乘法拟合圆曲线R2＝x-A2+y-B2，其中R为拟合圆半径，A，B为拟合圆圆心坐标，x、y分别为海域障碍物所对应的最小外接圆上各点坐标； 步骤1-4：针对步骤1-2中所获取到的轮廓点集Xi,Yi,i∈{1,2,3,……,N}，各障碍物轮廓对应最小内切圆圆心坐标为Ai,Bi，圆半径为Ri，Xi,Yi到圆心的距离为di，N表示该区域障碍物数量； 令当最小时求解ai、bi、ci，则拟合圆参数为 步骤2：完成节点、单次扩展步长和路径树初始化； 将船舶起始点作为初始点qinit，单次扩展步长的初始化值与船舶速度相等，路径树初始化为 步骤3：进行船舶-障碍物碰撞检测并依据引力势场更新扩展方向； 步骤3-1：将扩展点对目标点的趋向性定义为引力势场，在路径树扩展方向上，采用引力势场和随机方向叠加后的生长方向；引力势场的方向定义为由生长点指向目标点，引力势场的大小其中为引力增益常量，d2q,qgoal为扩展点q和目标点qgoal的距离的平方，S为距离生长点最近的障碍物面积，d*为障碍物影响范围； 步骤3-2：在以单次扩展步长为半径的范围内，进行障碍物存在判断，若不存在则选择目标点作为随机树生长方向，对于新节点扩展方向的计算由公式给出；若存在障碍物，则选择结合引力势场的随机生长方式，对于新节点扩展方向的计算由公式给出，t为单次扩展步长； 步骤3-3：依据步骤3-2的扩展方向选取随机节点qrand； 步骤4：进行随机点选取和路径树填充； 步骤4-1：遍历随机树中的每一个节点，计算每一个节点与该循环生成的随机点之间的距离，找出距离此随机点最近的节点，记为qnear； 步骤4-2：依据步骤2中的单次扩展步长，当找到qnear时，qnear向qrand方向扩展该步长，扩展后产生新的节点qnew；对qnew和障碍物进行碰撞检测，若出现碰撞，则重新产生新的随机点；若不发生碰撞则将qnear,qnew加入路径树； 步骤5：进行到达检测，判断规划方法是否继续； 计算当前点和目标点之间的欧氏距离，若该距离小于单次扩展步长则结束路径规划，输出规划路径集合P；若该距离大于单次扩展步长，则重复步骤3和步骤4； 步骤6：获取规划后路径，进行路径平滑化； 步骤6-1：对规划路径集合pi∈P,i∈{1,2,3,……,n}，并将路径集合进行划分pk＝{pk,pk+1,pk+2}； 步骤6-2：计算pk,pk+1和pk+1,pk+2所构成线段的斜率，若斜率相等，则不进行轨迹平滑；若斜率不相等，则转到步骤6-3； 步骤6-3：计算Pk对应三点所组成的三角形内切圆圆心l1,l2,l3为三点组成三角形的边长；将对应路径段的轨迹替换为内切圆圆弧，完成路径平滑。

如需购买、转让、实施、许可或投资类似专利技术，可联系本专利的申请人或专利权人西北工业大学，其通讯地址为：710072 陕西省西安市友谊西路；或者联系龙图腾网官方客服，联系龙图腾网可拨打电话0551-65771310或微信搜索“龙图腾网”。