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

龙图腾网恭喜浙江大学申请的专利一种基于自适应预瞄点和投影定位的无人船轨迹跟踪方法获国家发明授权专利权，本发明授权专利权由国家知识产权局授予，授权公告号为：CN114527747B 。

龙图腾网通过国家知识产权局官网在2025-05-30发布的发明授权授权公告中获悉：该发明授权的专利申请号/专利号为：202210049835.0，技术领域涉及：G05D1/43；该发明授权一种基于自适应预瞄点和投影定位的无人船轨迹跟踪方法是由聂勇;张敏捷;吕小文;孙向伟;李贞辉;唐建中;陈正设计研发完成，并于2022-01-17向国家知识产权局提交的专利申请。

本一种基于自适应预瞄点和投影定位的无人船轨迹跟踪方法在说明书摘要公布了：本发明公开了一种基于自适应预瞄点和投影定位的无人船轨迹跟踪方法。方法步骤包括：预设无人船航行的初始路径；控制无人船按照初始路径航行，获取无人船的实时运动状态；根据无人船的实时运动状态，判断无人船真实的航行路径是否偏离初始路径，若航行路径偏离初始路径，则获取初始路径上的目标点；根据目标点获取无人船的偏航距离和偏航角；根据无人船的实时运动状态、偏航距离和偏航角，校正无人船的实时运动状态。本发明方法可以兼顾航向误差和轨迹误差，相比于双闭环控制舵向误差和轨迹误差，具备更好地轨迹流畅性和舵向稳定性；在不同速度和不同轨迹曲率下预瞄点的位置可以自适应调节以兼顾轨迹跟踪精度和航行稳定性。

本发明授权一种基于自适应预瞄点和投影定位的无人船轨迹跟踪方法在权利要求书中公布了：1.一种基于自适应预瞄点和投影定位的无人船轨迹跟踪方法，其特征在于：步骤100，预设无人船航行的初始路径；所述的步骤100中，预设的无人船航行的初始路径为一系列路径点构成的曲线路径，以初始路径中第一个路径点作为坐标原点，纬线为x轴，经线为y轴，初始路径的路径点表示为：Pi＝[pxi,pyi]其中，Pi为初始路径中第i个路径点，pxi为第i个路径点的x轴坐标，pyi为第i个路径点的y轴坐标；步骤200，控制无人船按照初始路径航行，获取无人船的实时运动状态；所述的步骤200中，无人船的实时运动状态包括当前时刻t无人船的航向角、航行速度vt和当前位置[xt，yt]，其中，xt为无人船在当前时刻t的x轴坐标，yt为无人船在当前时刻t的y轴坐标；步骤300，根据无人船的实时运动状态，判断无人船真实的航行路径是否偏离初始路径，若航行路径偏离初始路径，则获取初始路径上的目标点；步骤400，根据目标点获取无人船的偏航距离和偏航角；所述的步骤400中，将目标点在初始路径上的切线作为投影线，获取无人船的当前位置至目标点之间的直线在投影线上的投影长度作为偏航距离D，获取无人船的当前位置在真实的航行路径上的切线与投影线之间的夹角作为偏航角α；步骤500，根据无人船的实时运动状态、偏航距离和偏航角，校正无人船的实时运动状态；所述的步骤500中，预设投影阈值λ和航向角阈值航向角的调整：根据当前无人船的偏航距离F与偏航角α，进行以下判断，调整当前无人船的航向角：若D≤λ或时，则不对当前无人船的航向角进行调整；若Dλ且时，则对当前无人船的航向角进行调整，使得当前无人船的航向朝向目标点；航行速度的调整：根据当前无人船的偏航距离D与偏航角α，同时进行以下判断，调整当前无人船的航行速度：若F≤λ且时，或者F≤λ且时，则在当前无人船前方的初始路径中，从目标点开始，以相同距离d1取两个初始路径上的点作为预瞄点，d1＝vt*Δt，vt为当前无人船的航行速度，Δt为由控制无人船航行时发出的控制信号的控制频率的单位时间；并进行以下判断：若无人船从当前位置沿直线航行到该两个预瞄点时的航向角均小于航向角阈值则控制当前无人船进行加速；若无人船从当前位置沿直线航行到该两个预瞄点时的航向角均不小于航向角阈值或仅有其中一个航向角不小于航向角阈值则保持当前无人船的航行速度vt；若Dλ时，则在当前无人船前方的初始路径中，从目标点开始，按照以下公式以距离dj取第j个预瞄点： 其中，κj为第j个预瞄点在初始路径中的曲率，j＝1、2、3；共取三个预瞄点P1、P2和P3，计算预瞄点距离d，d＝d1+d2+d3；记当前目标点为P0，计算无人船的航向角分别与向量P0P1、P0P2和P0P3的夹角α1、α2和α3，再按照以下公式计算当前无人船的航向转角为： 其中，T0为预设跟随时间常数；根据航向转角进行以下判断：若时，则控制当前无人船进行减速；若时，则保持当前无人船的航行速度vt。

如需购买、转让、实施、许可或投资类似专利技术，可联系本专利的申请人或专利权人浙江大学，其通讯地址为：316021 浙江省舟山市定海区浙大路1号浙江大学舟山校区；或者联系龙图腾网官方客服，联系龙图腾网可拨打电话0551-65771310或微信搜索“龙图腾网”。