[发明专利]一种导航方法和系统

权利要求书

1.一种导航方法，其特征在于，包括以下步骤：

S1，规划并生成导航路径，存储到存储单元；

S2，位置检测单元周期性地检测位置坐标；

S3，位置预测单元在位置检测单元检测的间隙，预测当前位置坐标；

S4，显示单元显示导航路径、当前位置和/或地图数据；

S5，导航提示单元根据导航路径给予相应提示。

2.根据权利要求1所述导航方法，其特征在于，所述方法还包括步骤：

S6，控制计算单元将导航路径分为若干个区间段，并根据检测或预测的位置坐标，判断是否偏离区间段。

3.根据权利要求2所述导航方法，其特征在于，所述步骤S6中计算公式如下：

(x_c-x₂)²+(y_c-y₂)²≤d∧(x₁-y₂)²+(x₁-y₂)²≥(x_c-x₁)²+(y_c-y₁)²

其中：(xc,yc)为当前经纬度坐标点，(x₁,y₁)为当前区间段的起点经纬度坐标点，(x₂,y₂)为当前区间段的终点经纬度坐标点，d为转弯点坐标范围的最大距离。

4.根据权利要求2所述导航方法，其特征在于，所述d为30米。

5.根据权利要求1-4任一权利要求所述导航方法，其特征在于，所述方法还包括步骤：

S0，在导航开始时，判断是否在起点经纬度坐标的范围。

6.根据权利要求5所述导航方法，其特征在于，所述步骤S0的具体算法如下：

(x_c-x_p)²+(y_c-y_p)²≤dt

其中：(x_c,y_c)为当前点的经纬度坐标，(x_p,y_p)为起点的经纬度坐标，dt为在起点经纬度坐标范围内的设定的最远距离。

7.根据权利要求6所述导航方法，其特征在于，所述dt为25米。

8.根据权利要求1-4、6或7任一权利要求所述导航方法，其特征在于，所述导航方法还包括步骤:

S7,进行实时偏离检测，当超出规定范围时，导航提示单元给予提醒；

所述偏离检测算法如下：

其中：(x₁,y₁)、(x₂,y₂)分别为当前区间段的起点和终点，(x_c,y_c)为行驶在当前路段上的当前经纬度点，Δd为允许偏离轨迹的最大距离，所述Δd为20米。

9.根据权利要求1-4、6或7任一权利要求所述导航方法，其特征在于，所述导航方法还包括步骤:

S8，进行转弯方向检测，根据当前区间段经纬度的角度与下一区间段经纬度的角度的差值以及旋转方向判断转弯模式，并由导航提示单元给出语音提示。