CN104316059A - 由里程计获得车辆经纬度的航位推算导航定位方法及系统 - Google Patents

Abstract

本发明提供一种由里程计获得车辆经纬度的航位推算导航定位方法，包括以下步骤：(1)差分里程计获取的行驶距离，获得车辆的行驶速度与航向角；(2)根据行驶速度与航向角推算车辆的经纬度；(3)输出行驶速度、航向角以及经纬度。本发明提供的由里程计获得车辆经纬度的航位推算导航定位方法，仅由车载里程计作为数据源，获得车辆经纬度，结合当前时刻的行驶速度与航向角，作为航位推算系统的输出，不仅仅是在平面直角坐标系下的坐标，从而实现直接给出车辆经纬度的航位推算导航定位系统；无需使用陀螺仪、加速度计等惯性器件，使得实现的直接给出车辆经纬度的航位推算导航定位系统成本较低。本发明还提供一种航位推算导航定位系统。

Description

由里程计获得车辆经纬度的航位推算导航定位方法及系统

技术领域

本发明属于航位推算导航定位领域，具体涉及一种由里程计获得车辆经纬度的航位推算导航定位方法及航位推算导航定位系统。

背景技术

目前，通常的车载航位推算导航定位方法有一个里程计加一个单轴陀螺仪，一个单轴陀螺仪加一个单轴加速度计，两个里程计差分三种方案。其中，前两种方案都涉及到惯性传感器，而目前可用于车辆导航的惯性传感器价格昂贵，且相应数据处理方法复杂，不适用于车载航位推算导航定位系统。另外，不论哪一种航位推算导航定位系统方案，现有的航位推算导航定位方法都只能给出平面直角坐标系下的车辆坐标，无法直接提供经纬度信息。

发明内容

本发明的目的在于解决现有技术中的不足，提供一种由里程计获得车辆经纬度的航位推算导航定位方法，仅由车载里程计作为数据源，获得车辆经纬度，从而实现直接给出车辆经纬度的航位推算导航定位系统。

本发明还提供一种采用由里程计获得车辆经纬度的航位推算导航定位方法的航位推算导航定位系统。

本发明提供一种由里程计获得车辆经纬度的航位推算导航定位方法，包括以下步骤：

(1)差分里程计获取的行驶距离，获得车辆的行驶速度与航向角；

(2)根据行驶速度与航向角推算车辆的经纬度；

(3)输出行驶速度、航向角以及经纬度。

本发明提供一种由里程计获得车辆经纬度的航位推算导航定位方法，仅由车载里程计作为数据源，获得车辆经纬度，结合当前时刻的行驶速度与航向角，作为航位推算系统的输出，从而实现直接给出车辆经纬度的航位推算导航定位系统。

进一步地，步骤(1)差分里程计获取的行驶距离，获得车辆的行驶速度与偏航角度变化包括以下步骤：

(11)获取一个计算周期内车辆的左后轮的行驶距离与右后轮的行驶距离；

(12)差分左后轮的行驶距离与右后轮的行驶距离，计算车辆在当前计算周期内的行驶速度；

(13)计算当前计算周期的偏航角度变化，并计算当前时刻的航向角。

进一步地，步骤(11)获取一个计算周期内车辆的左后轮的行驶距离与右后轮的行驶距离的方法为：

ΔL＝TicL×d，

ΔR＝TicR×d，

其中，ΔL为车辆的左后轮在一个计算周期内的行驶距离，ΔR为车辆的右后轮在一个计算周期内的行驶距离，TicL为一个计算周期内车辆的左后轮里程计输出的脉冲数，TicR为一个计算周期内车辆的右后轮里程计输出的脉冲数，d为一个脉冲数对应的行驶距离。

进一步地，步骤(12)差分左后轮的行驶距离与右后轮的行驶距离，计算车辆在当前计算周期内的行驶速度的方法为：

(121)计算在当前计算周期内车辆的行驶距离ΔD：

ΔD＝(ΔL+ΔR)÷2

(122)计算车辆在当前计算周期内的行驶速度v：

v＝ΔD÷Δt

其中，Δt是计算周期的时间间隔。

进一步地，(13)计算当前计算周期的偏航角度变化，并计算当前时刻的航向角的方法为：

(131)计算当前计算周期的偏航角度变化ω：

ω＝(ΔR-ΔL)/lenth

其中，lenth是车辆左后轮与右后轮的间距；

(132)计算当前时刻的航向角：

Hd(t)＝Hd(t-1)+ω

其中，Hd(t)为车辆当前时刻的航向角，Hd(t-1)为车辆上一时刻的航向角。

这里上一时刻与当前时刻的时间间隔为一个计算周期。

进一步地，步骤(2)根据行驶速度与偏航角度变化推算车辆的经纬度包括以下步骤：

(21)计算导航坐标系下车辆的速度矢量；

(22)计算导航坐标系相对地球坐标系的旋转矢量在导航坐标系下的表示；

(23)计算导航坐标系到地球坐标系的方向余弦矩阵；

(24)从方向余弦矩阵中提取车辆当前时刻的经纬度。

进一步地，步骤(21)计算导航坐标系下车辆的速度矢量的方法为：

v^N＝[v·cos(Hd) v·sin(Hd) 0]^T

其中，v^N为导航坐标系N下的速度矢量，导航坐标系N采用东北天坐标系，v^N为包含三个元素的列向量，元素分别表示东向速度，北向速度和天向速度，由于车辆只在路面上行驶，天向速度默认为0，v是车辆在当前计算周期内的行驶速度，Hd是车辆当前时刻的航向角。

进一步地，步骤(22)计算导航坐标系相对地球坐标系的旋转矢量在导航坐标系下的表示，包括以下步骤：

(221)计算3*3的地球曲率矩阵

$F_C^N=\left[\begin{array}{ccc}{\mathrm{Fc}}_{11}& {\mathrm{Fc}}_{12}& 0\\ {\mathrm{Fc}}_{21}& {\mathrm{Fc}}_{22}& 0\\ 0& 0& 0\end{array}\right]$

其中，

${\mathrm{Fc}}_{11}=\frac{1}{\mathrm{rl}}(1+{D_{21}}^2\mathrm{feh})$

${\mathrm{Fc}}_{12}=\frac{1}{\mathrm{rl}}{D}_{21}{D}_{22}\mathrm{feh}$

${\mathrm{Fc}}_{21}=\frac{1}{\mathrm{rl}}{D}_{21}{D}_{22}\mathrm{feh}$

${\mathrm{Fc}}_{22}=\frac{1}{\mathrm{rl}}(1+{D_{22}}^2\mathrm{feh})$

其中，rl为车辆所处位置的曲率半径，D_2j为导航坐标系N到地球坐标系E的方向余弦矩阵第二行的对应元素，

feh＝fe·fh，

其中，

$\mathrm{fe}=\frac{{(1-e)}^2-1}{1+{D_{23}}^2[{(1-e)}^2-1]}$

$\mathrm{fh}=\frac{1}{1+h/{\mathrm{Rs}}^{\′}}$

其中，h为海拔高度，e为地球椭圆率，Rs′为从地球中心到车辆所处位置的修正距离。

(222)由v^N计算导航坐标系N相对地球坐标系E的旋转矢量在导航坐标系下的表示

$w_{\mathrm{EN}}^N\left(t\right)=F_C^N(u_{\mathrm{ZN}}^N\×v^N)+w_{\mathrm{EN}3}^N(t-1)\·u_{\mathrm{ZN}}^N$

其中，为上一时刻的第三个元素，为导航坐标系N下天向单位向量，

$u_{\mathrm{ZN}}^N={\left[\begin{array}{ccc}0& 0& 1\end{array}\right]}^T.$

进一步地，步骤(23)计算导航坐标系到地球坐标系的方向余弦矩阵的方法为：

$C_{N_t}^E=C_{N_{t-1}}^E\·C_{N_t}^{N_{t-1}}$

其中，为当前时刻的为上一时刻的为导航坐标系N到地球坐标系E的方向余弦矩阵，为导航坐标系N相对地球坐标系E在两个时刻自身变化的方向余弦矩阵，其计算方法为对的积分进行泰勒展开：

$C_{N_t}^{N_{t-1}}\≈I+({\mathrm{\ξ}}_t\×)+\frac{1}{2}({\mathrm{\ξ}}_t\×)({\mathrm{\ξ}}_t\×)$

其中， ${\mathrm{\ξ}}_t\≈{\∫}_{t_{n-1}}^{t_n}{w}_{\mathrm{EN}}^N\mathrm{dt}.$

进一步地，步骤(24)从方向余弦矩阵中提取车辆当前时刻的经纬度的方法为：

$l={\tan }^{-1}\left(\frac{D_{23}}{\sqrt{{D_{21}}^2+{D_{22}}^2}}\right)$

$L={\tan }^{-1}\left(\frac{D_{13}}{D_{33}}\right)$

其中，l为纬度，L为经度，D_ij为导航坐标系到地球坐标系的方向余弦矩阵的对应元素。

本发明还提供一种采用由里程计获得车辆经纬度的航位推算导航定位方法的航位推算导航定位系统，包括：

左后轮里程计，用于提供车辆的左后轮的行驶距离；

右后轮里程计，用于提供车辆的右后轮的行驶距离；

航位推算导航定位处理模块，用于根据左后轮里程计提供的左后轮的行驶距离以及右后轮里程计提供的右后轮的行驶距离，计算车辆的速度、航向角以及经纬度，并输出速度、航向角以及经纬度；

航位推算导航定位处理模块分别与左后轮里程计、右后轮里程计连接。

与现有技术相比，本发明提供的由里程计获得车辆经纬度的航位推算导航定位方法及航位推算导航定位系统，具有以下有益效果：

(1)仅由车载里程计作为数据源，获得车辆经纬度，结合当前时刻的行驶速度与航向角，作为航位推算导航定位系统的输出，不仅仅是在平面直角坐标系下的坐标，从而实现直接给出车辆经纬度的航位推算导航定位系统；

(2)无需使用陀螺仪、加速度计等惯性器件，使得实现的直接给出车辆经纬度的航位推算导航定位系统成本较低。

附图说明

图1是本发明的一个实施例的由里程计获得车辆经纬度的航位推算导航定位方法的流程图；

图2是采用图1所示的方法实现的航位推算导航定位系统框图；

图3是采用图1所示的方法实现的航位推算导航定位系统的仿真结果。

具体实施方式

图1示出了本发明的一个实施例的由里程计获得车辆经纬度的航位推算导航定位方法的流程图；图2示出了采用图1所示的方法实现的航位推算导航定位系统框图，该系统包括左后轮里程计、右后轮里程计与微处理器，左后轮里程计、右后轮里程计通过外部中断1、外部中断2将左后轮里程计、右后轮里程计的脉冲发给微处理器。

如图1所示，本发明的一个实施例的由里程计获得车辆经纬度的航位推算导航定位方法，包括以下步骤：

步骤一、上一时刻车辆经纬度，航向角和行驶速度；

步骤二、由里程计数据求得当前车辆行驶速度及航向角；

(1)获取一个计算周期内车辆的左后轮的行驶距离与右后轮的行驶距离；

ΔL＝TicL×d，

ΔR＝TicR×d，

其中，ΔL为车辆的左后轮在一个计算周期内的行驶距离，ΔR为车辆的右后轮在一个计算周期内的行驶距离，TicL为一个计算周期内车辆的左后轮里程计输出的脉冲数，TicR为一个计算周期内车辆的右后轮里程计输出的脉冲数，d为一个脉冲数对应的行驶距离。

(2)差分左后轮的行驶距离与右后轮的行驶距离，计算车辆在当前计算周期内的行驶速度；

(a)计算在当前计算周期内车辆的行驶距离ΔD：

ΔD＝(ΔL+ΔR)÷2

(b)计算车辆在当前计算周期内的行驶速度v：

v＝ΔD÷Δt

其中，Δt是计算周期的时间间隔。

(3)计算当前计算周期的偏航角度变化，并计算当前时刻的航向角。

(a)计算当前计算周期的偏航角度变化ω：

ω＝(ΔR-ΔL)/lenth

其中，lenth是车辆左后轮与右后轮的间距；

(a)计算当前时刻的航向角：

Hd(t)＝Hd(t-1)+ω

其中，Hd(t)为车辆当前时刻的航向角，Hd(t-1)为车辆上一时刻的航向角。

这里上一时刻与当前时刻的时间间隔为一个计算周期。

步骤三、计算导航坐标系下车辆的速度矢量

v^N＝[v·cos(Hd) v·sin(Hd) 0]^T

其中，v^N为导航坐标系N下的速度矢量，导航坐标系N采用东北天坐标系，v^N为包含三个元素的列向量，元素分别表示东向速度，北向速度和天向速度，由于车辆只在路面上行驶，天向速度默认为0，v是车辆在当前计算周期内的行驶速度，Hd是车辆当前时刻的航向角。

步骤四、计算导航坐标系相对地球坐标系的旋转矢量，在导航坐标系下的表示：

(1)计算3*3的地球曲率矩阵

$F_C^N=\left[\begin{array}{ccc}{\mathrm{Fc}}_{11}& {\mathrm{Fc}}_{12}& 0\\ {\mathrm{Fc}}_{21}& {\mathrm{Fc}}_{22}& 0\\ 0& 0& 0\end{array}\right]$

其中，

${\mathrm{Fc}}_{11}=\frac{1}{\mathrm{rl}}(1+{D_{21}}^2\mathrm{feh})$

${\mathrm{Fc}}_{12}=\frac{1}{\mathrm{rl}}{D}_{21}{D}_{22}\mathrm{feh}$

${\mathrm{Fc}}_{21}=\frac{1}{\mathrm{rl}}{D}_{21}{D}_{22}\mathrm{feh}$

${\mathrm{Fc}}_{22}=\frac{1}{\mathrm{rl}}(1+{D_{22}}^2\mathrm{feh})$

其中，rl为车辆所处位置的曲率半径，D_2j为导航坐标系N到地球坐标系E的方向余弦矩阵第二行的对应元素，

feh＝fe·fh，

其中，

$\mathrm{fe}=\frac{{(1-e)}^2-1}{1+{D_{23}}^2[{(1-e)}^2-1]}$

$\mathrm{fh}=\frac{1}{1+h/{\mathrm{Rs}}^{\′}}$

其中，h为海拔高度，e为地球椭圆率，Rs′为从地球中心到车辆所处位置的修正距离。

(2)由v^N计算导航坐标系N相对地球坐标系E的旋转矢量在导航坐标系下的表示

$w_{\mathrm{EN}}^N\left(t\right)=F_C^N(u_{\mathrm{ZN}}^N\×v^N)+w_{\mathrm{EN}3}^N(t-1)\·u_{\mathrm{ZN}}^N$

其中，为上一时刻的第三个元素，为导航坐标系N下天向单位向量，

$u_{\mathrm{ZN}}^N={\left[\begin{array}{ccc}0& 0& 1\end{array}\right]}^T.$

步骤五、计算由导航坐标系到地球坐标系的方向余弦矩阵：

$C_{N_t}^E=C_{N_{t-1}}^E\·C_{N_t}^{N_{t-1}}$

其中，为当前时刻的为上一时刻的为导航坐标系N到地球坐标系E的方向余弦矩阵，为导航坐标系N相对地球坐标系E在两个时刻自身变化的方向余弦矩阵，其计算方法为对的积分进行泰勒展开：

$C_{N_t}^{N_{t-1}}\≈I+({\mathrm{\ξ}}_t\×)+\frac{1}{2}({\mathrm{\ξ}}_t\×)({\mathrm{\ξ}}_t\×)$

其中， ${\mathrm{\ξ}}_t\≈{\∫}_{t_{n-1}}^{t_n}{w}_{\mathrm{EN}}^N\mathrm{dt}.$

步骤六、从该方向余弦矩阵中提取车辆当前时刻的经纬度：

$l={\tan }^{-1}\left(\frac{D_{23}}{\sqrt{{D_{21}}^2+{D_{22}}^2}}\right)$

$L={\tan }^{-1}\left(\frac{D_{13}}{D_{33}}\right)$

其中，l为纬度，L为经度，D_ij为导航坐标系到地球坐标系的方向余弦矩阵的对应元素。

步骤七、输出当前时刻的行驶速度、航向角以及经纬度。

本发明提供一种由里程计获得车辆经纬度的航位推算导航定位方法，仅由车载里程计作为数据源，获得车辆经纬度，结合当前时刻的行驶速度与航向角，作为航位推算导航定位系统的输出，从而实现直接给出车辆经纬度的航位推算导航定位系统。

以下是采用图1所示的方法实现的航位推算导航定位系统的仿真结果：

使用Spirent公司的模拟器，编辑一段车辆行驶轨迹。将车辆的起始点置于东经40度，0纬度的位置，以三十米每秒匀速向西行驶。

模拟器可以同时输出车辆每一时刻标准的经纬度，同时输出模拟两个里程计的脉冲信号。使用该模拟里程计信号，运行上述步骤的程序，得到车辆每一时刻的经纬度信息。同时将航位推算导航定位信息和标准车辆位置信息绘制与同一张图上，如图3所示，可以看出该方法可以有效计算车辆的经纬度位置信息。

本发明提供的由里程计获得车辆经纬度的航位推算导航定位方法及航位推算导航定位系统，仅由车载里程计作为数据源，获得车辆经纬度，结合当前时刻的行驶速度与航向角，作为航位推算导航定位系统的输出，不仅仅是在平面直角坐标系下的坐标，从而实现直接给出车辆经纬度的航位推算导航定位系统；无需使用陀螺仪、加速度计等惯性器件，使得实现的直接给出车辆经纬度的航位推算导航定位系统成本较低。

以上详细描述了本发明的较佳具体实施例。应当理解，本领域的普通技术人员无需创造性劳动就可以根据本发明的构思做出诸多修改和变化。因此，凡本技术领域的技术人员依本发明的构思在现有技术的基础上通过逻辑分析、推理或者有限的实验可以得到的技术方案，皆应在由权利要求书所确定的保护范围内。

Claims (10)

1.一种由里程计获得车辆经纬度的航位推算导航定位方法，其特征在于，包括以下步骤：

(1)差分里程计获取的行驶距离，获得所述车辆的行驶速度与航向角；

(2)根据所述行驶速度与所述航向角推算所述车辆的经纬度；

(3)输出所述行驶速度、所述航向角以及所述经纬度。

2.如权利要求1所述的由里程计获得车辆经纬度的航位推算导航定位方法，其特征在于，步骤(1)差分里程计获取的行驶距离，获得所述车辆的行驶速度与偏航角度变化包括以下步骤：

(11)获取一个计算周期内所述车辆的左后轮的行驶距离与右后轮的行驶距离；

(12)差分所述左后轮的行驶距离与所述右后轮的行驶距离，计算所述车辆在当前计算周期内的行驶速度；

(13)计算当前计算周期的偏航角度变化，并计算当前时刻的航向角。

3.如权利要求2所述的由里程计获得车辆经纬度的航位推算导航定位方法，其特征在于，步骤(12)差分所述左后轮的行驶距离与所述右后轮的行驶距离，计算所述车辆在当前计算周期内的行驶速度的方法为：

(121)计算在当前计算周期内所述车辆的行驶距离ΔD：

ΔD＝(ΔL+ΔR)÷2

其中，ΔL为所述车辆的左后轮在一个计算周期内的行驶距离，ΔR为所述车辆的右后轮在一个计算周期内的行驶距离；

(122)计算所述车辆在当前计算周期内的行驶速度v：

v＝ΔD÷Δt

其中，Δt是计算周期的时间间隔。

4.如权利要求3所述的由里程计获得车辆经纬度的航位推算导航定位方法，其特征在于，(13)计算当前计算周期的偏航角度变化，并计算当前时刻的航向角的方法为：

(131)计算当前计算周期的偏航角度变化ω：

ω＝(ΔR-ΔL)/lenth

其中，lenth是车辆左后轮与右后轮的间距；

(132)计算当前时刻的航向角：

Hd(t)＝Hd(t-1)+ω

其中，Hd(t)为车辆当前时刻的航向角，Hd(t-1)为车辆上一时刻的航向角。

5.如权利要求1所述的由里程计获得车辆经纬度的航位推算导航定位方法，其特征在于，步骤(2)根据所述行驶速度与所述偏航角度变化推算所述车辆的经纬度包括以下步骤：

(21)计算导航坐标系下所述车辆的速度矢量；

(22)计算所述导航坐标系相对地球坐标系的旋转矢量在所述导航坐标系下的表示；

(23)计算所述导航坐标系到所述地球坐标系的方向余弦矩阵；

(24)从所述方向余弦矩阵中提取所述车辆当前时刻的经纬度。

6.如权利要求5所述的由里程计获得车辆经纬度的航位推算导航定位方法，其特征在于，步骤(21)计算导航坐标系下所述车辆的速度矢量的方法为：

v^N＝[v·cos(Hd) v·sin(Hd) 0]^T

其中，v^N为导航坐标系N下的速度矢量，导航坐标系N采用东北天坐标系，v^N为包含三个元素的列向量，所述元素分别表示东向速度，北向速度和天向速度，由于车辆只在路面上行驶，所述天向速度默认为0，v是车辆在当前计算周期内的行驶速度，Hd是车辆当前时刻的航向角。

7.如权利要求6所述的由里程计获得车辆经纬度的航位推算导航定位方法，其特征在于，步骤(22)计算所述导航坐标系相对地球坐标系的旋转矢量在所述导航坐标系下的表示，包括以下步骤：

(221)计算3*3的地球曲率矩阵

$F_C^N=\left[\begin{array}{ccc}{\mathrm{Fc}}_{11}& {\mathrm{Fc}}_{12}& 0\\ {\mathrm{Fc}}_{21}& {\mathrm{Fc}}_{22}& 0\\ 0& 0& 0\end{array}\right]$

其中，

${\mathrm{Fc}}_{11}=\frac{1}{\mathrm{rl}}(1+{D_{21}}^2\mathrm{feh})$

${\mathrm{Fc}}_{12}=\frac{1}{\mathrm{rl}}{D}_{21}{D}_{22}\mathrm{feh}$

${\mathrm{Fc}}_{21}=\frac{1}{\mathrm{rl}}{D}_{21}{D}_{22}\mathrm{feh}$

${\mathrm{Fc}}_{22}=\frac{1}{\mathrm{rl}}(1+{D_{22}}^2\mathrm{feh})$

其中，rl为车辆所处位置的曲率半径，D_2j为导航坐标系N到地球坐标系E的方向余弦矩阵第二行的对应元素，

feh＝fe·fh，

其中，

$\mathrm{fe}=\frac{{(1-e)}^2-1}{1+{D_{23}}^2[{(1-e)}^2-1]}$

$\mathrm{fh}=\frac{1}{1+h/{\mathrm{Rs}}^{\′}}$

其中，h为海拔高度，e为地球椭圆率，Rs′为从地球中心到车辆所处位置的修正距离。

(222)由v^N计算导航坐标系N相对地球坐标系E的旋转矢量在导航坐标系下的表示

$w_{\mathrm{EN}}^N\left(t\right)=F_C^N(u_{\mathrm{ZN}}^N\×v^N)+w_{\mathrm{EN}3}^N(t-1)\·u_{\mathrm{ZN}}^N$

其中，为上一时刻的第三个元素，为导航坐标系N下天向单位向量，

$u_{\mathrm{ZN}}^N={\left[\begin{array}{ccc}0& 0& 1\end{array}\right]}^T.$

8.如权利要求7所述的由里程计获得车辆经纬度的航位推算导航定位方法，其特征在于，步骤(23)计算所述导航坐标系到所述地球坐标系的方向余弦矩阵的方法为：

$C_{N_t}^E=C_{N_{t-1}}^E\·C_{N_t}^{N_{t-1}}$

其中，为当前时刻的为上一时刻的为导航坐标系N到地球坐标系E的方向余弦矩阵，为导航坐标系N相对地球坐标系E在两个时刻自身变化的方向余弦矩阵，其计算方法为对的积分进行泰勒展开：

$C_{N_t}^{N_{t-1}}\≈I+({\mathrm{\ξ}}_t\×)+\frac{1}{2}({\mathrm{\ξ}}_t\×)({\mathrm{\ξ}}_t\×)$

其中， ${\mathrm{\ξ}}_t={\∫}_{t_{n-1}}^{t_n}{w}_{\mathrm{EN}}^N\mathrm{dt}.$

9.如权利要求8所述的由里程计获得车辆经纬度的航位推算导航定位方法，其特征在于，步骤(24)从所述方向余弦矩阵中提取车辆当前时刻的经纬度的方法为：

$l={\tan }^{-1}\left(\frac{D_{23}}{\sqrt{{D_{21}}^2+{D_{22}}^2}}\right)$

$L={\tan }^{-1}\left(\frac{D_{13}}{D_{33}}\right)$

其中，l为纬度，L为经度，D_ij为导航坐标系到地球坐标系的方向余弦矩阵的对应元素。

10.一种采用如权利要求1-9所述的由里程计获得车辆经纬度的航位推算导航定位方法的航位推算导航定位系统，其特征在于，所述航位推算导航定位系统包括：

左后轮里程计，用于提供车辆的左后轮的行驶距离；

右后轮里程计，用于提供所述车辆的右后轮的行驶距离；

航位推算导航定位处理模块，用于根据所述左后轮里程计提供的左后轮的行驶距离以及所述右后轮里程计提供的右后轮的行驶距离，计算所述车辆的速度、航向角以及经纬度，并输出所述速度、所述航向角以及所述经纬度；

所述航位推算导航定位处理模块分别与所述左后轮里程计、所述右后轮里程计连接。