一种基于卫星定位和激光测距的水面航行器目标定位方法

摘要

本发明公开了一种基于卫星定位和激光测距的水面航行器目标定位方法，应用于由控制端控制水面航行器，所述水面航行器目标定位方法包括以下步骤：分别获取控制端和水面航行器的坐标；操作者采用控制端指示目标点；控制端获取目标点相对于控制端的方向角和水平距离；结合控制端的坐标计算出目标点坐标，并通过数据链传送给水面航行器；水面航行器接收目标点坐标后结合自身坐标计算出目标点相对于自身的方向；水面航行器利用姿态传感器的航向反馈自动转向目标；可以直观地允许操作者指示目标位置，从而水面航行器可自动驶向目标；在目标可见范围内实现水面航行器自动驾驶，提升设备操作体验。