摘要
本发明公开了一种操舵仪航迹偏差计算方法,当船舶直线航行时,根据计划航线的起点和终点的经纬度信息计算出计划航线的航向角θ1,根据船舶当前位置的经纬度信息和计划航线的起点的经纬度信息计算出恒向线航向角θ1‑θ,根据计划航线的航向角θ1和恒向线航向角θ1‑θ计算得到航迹偏差d;当船舶转弯时,计算相邻计划航线航向角差φ,接着求得转弯圆心O点的坐标,再用圆心O的坐标和船舶实际位置即可求取两点间的距离Dso,再根据转弯半径计算船舶转弯时的航迹偏差d,航迹偏差d可以判断船舶是否偏离计划航线,从而对船舶航迹进行快速控制,避免船舶驶离计划航线。
技术关键词
偏差计算方法
操舵仪
计划
航向控制器
GPS卫星导航系统
终点
两点
航向控制算法
圆心
综合导航系统
船舶运动模型
指令
电子海图
控制船舶
反馈装置
坐标系
直线