一种具有碰撞风险预测机制的避碰及路径跟踪制导方法

摘要

本发明公开了一种具有碰撞风险预测机制的避碰及路径跟踪制导方法，本制导方法结合DVS制导方法的优势和碰撞风险预测机制，具有实现船舶路径跟踪和自主避碰的能力。在来船未进入DVS探测范围时，执行路径跟踪制导；在来船进入DVS探测范围时，对碰撞风险进行预测，若路径跟踪制导模式存在碰撞风险，则执行避碰操纵制导，选取能够消除碰撞风险的制导信息，并保证对路径跟踪任务的回归趋势；如不存在碰撞风险，则恢复到路径跟踪制导模式。同时DVS当前前进速度和艏向角随时间的变化是光滑的。