[发明专利]航位推算中初始方向的确定方法

权利要求书

1.一种航位推算中初始方向的确定方法，其特征在于，包括：

步骤1)选取有效的GPS定位点，所述有效的GPS定位点满足定位状态有效， 3D定位模式，卫星数量大于等于卫星数量阈值及水平坐标的精度强弱度小于阈值四 个条件；

步骤2)在有效的GPS定位点中选取两个GPS定位点之间的距离大于等于阈值 且距离偏差在容差范围内的两个GPS定位点以确定初始方向线段；

步骤3)根据所述初始方向线段计算出初始方向。

2.如权利要求1所述的航位推算中初始方向的确定方法，其特征在于，所述 步骤1)还进一步包括：

步骤11)读取GPS定位点并判断其定位状态是否有效，若无效，重复执行步 骤11)；

步骤12)判断所述GPS定位点是否是3D定位模式，若不是，执行步骤11)；

步骤13)判断卫星数量是否大于等于卫星数量阈值，若否，执行步骤11)；

步骤14)判断水平坐标的精度强弱度是否小于阈值，若否，执行步骤11)；

步骤15)所述GPS定位点为有效，重复从步骤11)开始执行，直至选取出若 干有效的GPS定位点。