CN104990563B - 车辆行驶里程计算方法 - Google Patents
车辆行驶里程计算方法 Download PDFInfo
- Publication number
- CN104990563B CN104990563B CN201510433551.1A CN201510433551A CN104990563B CN 104990563 B CN104990563 B CN 104990563B CN 201510433551 A CN201510433551 A CN 201510433551A CN 104990563 B CN104990563 B CN 104990563B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- value
- covariance
- mileage value
- mileage
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000205 computational method Methods 0.000 title abstract 2
- 230000001133 acceleration Effects 0.000 claims abstract description 53
- 238000000034 method Methods 0.000 claims abstract description 45
- 238000005259 measurement Methods 0.000 claims abstract description 35
- 239000011159 matrix material Substances 0.000 claims description 25
- 238000004364 calculation method Methods 0.000 claims description 17
- 230000007704 transition Effects 0.000 claims description 7
- 238000001914 filtration Methods 0.000 claims description 6
- 238000012937 correction Methods 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000006073 displacement reaction Methods 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 238000011161 development Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C22/00—Measuring distance traversed on the ground by vehicles, persons, animals or other moving solid bodies, e.g. using odometers, using pedometers
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Navigation (AREA)
Abstract
本发明提供一种车辆行驶里程计算方法,所述方法包括:确定所述车辆从起始位置行驶到第k个位置时的第一里程值和第二里程值,其中k为大于等于0的整数,所述第一里程值为根据车辆轮胎转过的圈数和所述轮胎半径确定的里程值,所述第二里程值为根据车辆前进方向的加速度值确定的里程值;根据所述第一里程值及第二里程值确定车辆从所述起始位置行驶到所述第k个位置时的测量误差;获取所述车辆从起始位置行驶到第k个位置时的第二里程值的协方差;根据所述协方差及测量误差修正所述第二里程值,得到修正里程值,确定所述修正里程值为车辆从所述起始位置行驶到所述第k个位置的行驶里程。所述方法可提高车辆行驶过程中车辆里程计算值的精确性。
Description
技术领域
本发明涉及汽车电子技术领域,尤其涉及一种车辆行驶里程计算方法。
背景技术
随着社会的发展,各种车辆,例如汽车、摩托车、自行车成为人们日常出行的重要交通工具。车辆的寿命和行驶里程密切相关,因此,为了准确检测车辆的行驶状态,保证行驶的安全性,用户需要获知车辆的行驶里程。
现有技术中,汽车中通常都设置有计算汽车行驶距离的里程表。一种计算汽车里程的方法是:测量汽车在行驶过程中的加速度,通过加速度与汽车行驶时间进行二重积分的方式换算出汽车行驶里程。这种通过加速度与时间进行二重积分计算里程的方式,在二重积分的过程中会产生跟随行驶时间变化的直流参考值,使得计算结果偏离真实的里程值。随着行驶时间的延长,所述直流参考值会出现累积。在行驶时间较长的情况下,里程计算值会越来越偏离实际值,使用这种方法计算汽车行驶里程所得的计算结果误差较大。
发明内容
本发明实施例提供一种车辆行驶里程计算方法,用以解决现有技术中车辆行驶里程计算方法计算车辆行驶里程时准确度不高的问题。
本发明实施例提供一种车辆行驶里程计算方法,所述方法包括:
确定所述车辆从起始位置行驶到第k个位置时的第一里程值和第二里程值,其中k为大于等于0的整数,所述第一里程值为根据车辆轮胎转过的圈数和所述轮胎半径确定的里程值,所述第二里程值为根据车辆前进方向的加速度值确定的里程值;
根据所述第一里程值及所述第二里程值确定所述车辆从所述起始位置行驶到所述第k个位置时的测量误差;
获取所述车辆从起始位置行驶到第k个位置时所述第二里程值的协方差;
根据所述协方差及测量误差修正所述第二里程值,得到修正里程值,确定所述修正里程值为车辆从所述起始位置行驶到所述第k个位置的行驶里程。
另一实施例中,所述确定所述车辆从所述起始位置行驶到所述第k个位置的第二里程值,包括:
获取所述车辆从所述起始位置行驶到第k-1个位置的修正里程值;
根据所述车辆从所述起始位置行驶到所述第k-1个位置时的修正里程值及所述车辆从所述起始位置行驶到所述第k个位置时沿所述车辆前进方向的加速度值确定所述车辆从所述起始位置行驶到所述第k个位置时的第二里程值。
另一实施例中,在所述获取所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值的协方差之前还包括:
获取所述车辆从所述起始位置行驶到所述第k-1个位置时的所述修正里程值的协方差;
根据所述修正里程值的协方差确定所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值的协方差。
另一实施例中,所述根据所述车辆从所述起始位置行驶到第k-1个位置时的修正里程值及所述车辆从所述起始位置行驶到所述第k个位置时沿所述车辆前进方向的加速度值确定所述车辆从所述起始位置行驶到所述第k个位置时的第二里程值包括:
根据确定所述车辆从所述起始位置行驶到所述第k个位置时的第二里程值;
其中,表示所述车辆从所述起始位置行驶到所述第k个位置时的第二里程值,表示所述车辆从所述起始位置行驶到所述第k-1个位置时的修正里程值;Fk表示所述车辆从所述起始位置行驶到所述第k个位置时的卡尔曼滤波系统的状态转移矩阵;Bk表示所述车辆从所述起始位置行驶到所述第k个位置时的卡尔曼滤波系统的控制输入模型;ak表示所述车辆从所述起始位置行驶到所述第k个位置时沿所述车辆前进方向的加速度值;
所述根据所述车辆从所述起始位置行驶到所述第k-1个位置时的修正里程值的协方差确定所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值的协方差包括:
根据确定所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值协方差;
其中,Pk|k-1表示所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值的协方差,Pk-1|k-1表示所述车辆从所述起始位置行驶到所述第k-1个位置时所述修正程值的协方差,表示所述状态转移矩阵的转置矩阵,QK表示确定所述第二里程值的过程中过程噪声的协方差阵。
另一实施例中,所述根据所述协方差修正所述第二里程值,得到修正里程值,确定所述修正里程值为车辆从所述起始位置行驶到所述第k个位置的行驶里程包括:
根据所述车辆从所述起始位置行驶到所述第k个位置时的观测噪声协方差及所述第二里程值的协方差确定所述车辆从所述起始位置行驶到所述第k个位置时的测量误差协方差;
根据所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值的协方差、所述测量误差及所述测量误差协方差修正所述第二里程值,得到所述修正里程值。
另一实施例中,所述根据所述第一里程值及所述第二里程值确定所述车辆从所述起始位置行驶到所述第k个位置时的测量误差包括:
根据确定所述车辆从所述起始位置行驶到所述第k个位置时的测量误差;
其中,表示所述车辆从所述起始位置行驶到所述第k个位置时的测量误差,Zk表示所述车辆从所述起始位置行驶到所述第k个位置时的第一里程值;
所述根据所述车辆从所述起始位置行驶到所述第k个位置时所述观测噪声协方差及所述第二里程值的协方差确定所述车辆从所述起始位置行驶到所述第k个位置时的测量误差的协方差包括:
根据确定所述车辆从所述起始位置行驶到所述第k个位置时的测量误差的协方差;其中Hk表示所述车辆从所述起始位置行驶到所述第k个位置时的观测矩阵,表示所述观测矩阵的倒置矩阵;Rk表示观测噪声协方差;
所述根据所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值的协方差、所述测量误差及所述测量误差协方差修正所述第二里程值,得到所述修正里程值包括:
根据确定所述车辆从所述起始位置行驶到所述第k个位置时的所述修正里程值;其中,Kk表示所述车辆从所述起始位置行驶到所述第k个位置时的卡尔曼增益。
另一实施例中,还包括:根据所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值的协方差确定所述车辆从所述起始位置行驶到所述第k个位置时所述修正里程值的协方差。
另一实施例中,所述根据所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值的协方差确定所述车辆从所述起始位置行驶到所述第k个位置时修正里程值的协方差包括:
根据Pk|k=(I-KkHk)Pk|k-1确定所述车辆从所述起始位置行驶到所述第k个位置时所述修正里程值的协方差,其中,I表示单位阵。
另一实施例中,在确定所述车辆从起始位置行驶到第k个位置时的第一里程值之前,还包括:
根据所述车辆轮胎在行驶过程中的切向加速度和/或法向加速度的最大值和最小值的出现次数确定所述车辆从所述起始位置行驶到所述第k个位置时所述车辆轮胎转过的圈数。
本发明实施例所提供的车辆行驶里程计算方法,根据车辆从起始位置行驶到第k个位置时的转过的圈数确定第一里程值,根据所述车辆沿前进方向的加速度及车辆行驶到第k-1个位置对应的修正里程值确定所述第k个位置对应的第二里程值,并根据车辆从起始位置行驶到所述第k个位置对应的所述第一里程值以及所述第二里程值的协方差修正所述第二里程值,从而得到所述车辆从所述起始位置行驶到第k个位置时的修正里程值,并将所述修正里程值作为车辆从所述起始位置行驶到所述第k个位置时的行驶里程值,从而提高了车辆行驶过程中里程计算值的精确性。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图做一简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1为本发明实施例一提供的车辆行驶里程计算方法的流程图;
图2为本发明实施例二提供的车辆行驶里程计算方法的流程图;
图3为本发明实施例二提供的所述车辆行驶里程计算方法确定车辆轮胎转动圈数的方法示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
图1为本发明实施例一提供的一种车辆行驶里程计算方法的流程图。如图1所示,本实施例的车辆行驶里程计算方法,可以包括:
S101:确定所述车辆从起始位置行驶到第k个位置时的第一里程值和第二里程值,其中k为大于等于0的整数,所述第一里程值为根据车辆轮胎转过的圈数和所述轮胎半径确定的里程值,所述第二里程值为根据车辆前进方向的加速度值确定的里程值。
具体地,所述确定所述车辆从所述起始位置行驶到所述第k个位置时的第二里程值,包括:
获取所述车辆从所述起始位置行驶到第k-1个位置时的修正里程值;
根据所述车辆从所述起始位置行驶到所述第k-1个位置时的修正里程值及所述车辆从所述起始位置行驶到所述第k个位置时沿所述车辆前进方向的加速度值确定所述车辆从所述起始位置行驶到所述第k个位置时的第二里程值。
具体地,根据确定所述车辆从所述起始位置行驶到所述第k个位置时的第二里程值;
其中,表示所述车辆从所述起始位置行驶到所述第k个位置时的第二里程值,表示所述车辆从所述起始位置行驶到所述第k-1个位置时的修正里程值;Fk表示所述车辆从所述起始位置行驶到所述第k个位置时的卡尔曼滤波系统的状态转移矩阵;Bk表示所述车辆从所述起始位置行驶到所述第k个位置时的卡尔曼滤波系统的控制输入模型;ak表示所述车辆从所述起始位置行驶到所述第k个位置时沿所述车辆前进方向的加速度值。
具体地,所述车辆行驶里程可以通过以下线性随机微分方程表示:
Xk=FkXk-1+Bkuk+wk
其中,Xk是所述第k个位置对应的车辆行驶里程,Xk-1是所述第k-1个位置对应的车辆行驶里程,Fk表示所述第k个位置对应的车辆行驶里程计算过程中的状态转移矩阵;Bk表示所述第k个位置对应的所述车辆行驶里程计算过程中的控制输入模型;uk是所述第k个位置对应的所述车辆行驶里程计算过程中的控制量,wk是所述第k个位置对应的所述车辆行驶里程计算过程的过程噪声,其满足高斯分布。
具体地,xk可以表示为:
其中,yk表示所述车辆从起始位置行驶到第k个位置对应的车辆行驶里程,表示所述车辆行驶到所述第k个位置时的速度。
具体的,所述车辆行驶到所述第k个位置时的行驶速度与所述车辆沿前进方向的加速度的关系表达公式如下:
表示所述第k个位置对应的车辆行驶速度;表示所述初始位置对应的车辆行驶速度;tk表示所述车辆行驶到所述第k个位置对应的车辆行驶时间;t0表示车辆处于所述初始位置时的时间,t0=0。
所述车辆行驶到所述第k个位置时的行驶里程与所述车辆沿前进方向的加速度的关系表达公式如下:
y(tk)表示所述第k个位置对应的车辆行驶里程;y(t0)表示所述初始位置对应的车辆行驶里程。
S102:根据所述第一里程值及所述第二里程值确定所述车辆从所述起始位置行驶到所述第k个位置时的测量误差;
具体地,根据确定所述车辆从所述起始位置行驶到所述第k个位置时的测量误差;其中,表示所述车辆从所述起始位置行驶到所述第k个位置时的测量误差,Zk表示所述车辆从所述起始位置行驶到所述第k个位置时的第一里程值。
S103:获取所述车辆从起始位置行驶到第k个位置时所述第二里程值的协方差;
S104:根据所述协方差及所述测量误差修正所述第二里程值,得到修正里程值,确定所述修正里程值为所述车辆从所述起始位置行驶到所述第k个位置的行驶里程。
具体地,所述根据所述协方差修正所述第二里程值,得到修正里程值,确定所述修正里程值为车辆从所述起始位置行驶到所述第k个位置的行驶里程包括:
根据所述车辆从所述起始位置行驶到所述第k个位置时的观测噪声协方差及所述第二里程值与所述第一里程值的协方差确定所述车辆从所述起始位置行驶到所述第k个位置时的测量误差协方差;优选地,根据确定所述车辆从所述起始位置行驶到所述第k个位置时的测量误差协方差,其中Hk表示所述车辆从所述起始位置行驶到所述第k个位置时的观测矩阵,优选地,Hk=[1,0]。表示所述观测矩阵的倒置矩阵;Rk表示确定所述第k个位置的第一里程值过程中的观测噪声协方差;所述Rk为高斯分布的方差;
根据所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值的协方差、所述测量误差及所述测量误差协方差修正所述第二里程值,得到所述修正里程值。优选地,根据确定所述车辆从所述起始位置行驶到所述第k个位置时的所述修正里程值;其中,Kk表示所述车辆从所述起始位置行驶到所述第k个位置时的卡尔曼增益。
在上述实施例中,所述Fk可以表示为所述Bk可以表示为其中,tk-1表示车辆从所述第k-1个位置行驶到所述第k个位置时的时间间隔。
实际计算车辆里程的过程中,初始状态下,车辆一开始的速度和位移为0,的初始值可以为当所述确定后,计算下一位置的修正里程值时,所述下一位置为所述第k个位置,所述即作为原公式中的
本发明实施例所提供的车辆里程计算方法,根据车辆从起始位置行驶到第k个位置时的转过的圈数确定第一里程值,根据所述车辆沿前进方向的加速度确定所述第k个位置对应的第二里程值,并根据车辆从起始位置行驶到所述第k个位置对应的所述第二里程值的协方差修正所述第二里程值,从而得到所述车辆从所述起始位置行驶到第k个位置时的修正里程值,并将所述修正里程值作为车辆从所述起始位置行驶到所述第k个位置时的行驶里程值,从而提高了车辆行驶过程中里程计算值的精确性。
图2为本发明实施例二提供的车辆行驶里程计算方法的流程图。
请参阅图2,进一步地,在确定所述车辆从起始位置行驶到第k个位置的第一里程值之前,还包括:
S201:根据所述车辆轮胎在行驶过程中的切向加速度和/或法向加速度的最大值和最小值的出现次数确定所述车辆从所述起始位置行驶到所述第k个位置时所述车辆轮胎转过的圈数。
其中,所述车辆轮胎在行驶过程中的切向加速度及法向加速度是通过固定在所述车辆轮胎上的加速度传感器测量得到的。具体地,所述加速度传感器可以是仅测量所述法向加速度或所述切向加速度的一轴加速度传感器,也可以是可同时测量所述法向加速度和所述切向加速度的二轴加速度传感器。
下面以使用二轴加速度传感器测量所述车辆轮胎固定所述二轴加速度传感器的位置处的切向加速度和法向加速度为例具体说明如何确定所述车辆轮胎在车辆行驶过程中转过的圈数:
图3为本发明实施例一提供的所述车辆行驶里程计算方法确定车辆轮胎转动圈数的方法示意图。如图3所示,设所述车辆车轮的轴心为原点,与地面平行的方向为X轴,所述车辆轮胎固定所述二轴加速度传感器1的位置相对所述X轴绕所述轴心转过的角度为θ,则所述二轴加速度传感器1测量得出的切向加速度ax=at-gcosθ,所述二轴加速度传感器1测量得出的法向加速度ay=ω2r-gsinθ,其中at表示所述车辆轮胎运行的切向加速度,g表示重力加速度,ω表示角速度,r表示轮胎的半径。
根据上述公式可知,当θ为0°时,所述测量所得的切向加速度为最小值ax=at-g;当θ为90°时,所述测量所得的法向加速度为最小值ay=ω2r-g;当θ为180°时,所述测量所得的切向加速度为最大值ax=at+g;当θ为270°时,所述测量所得的法向加速度为最大值ay=ω2r+g。
因此,在车辆行驶过程中,根据所述二轴加速度传感器1测得的所述切向加速度值和法向加速度值的最大值及最小值出现的次数即可判断所述车辆轮胎相对于所述起始位置转过的圈数。优选地,为了能够更加精确地确定所述车辆轮胎转过的圈数,还可以增加所述二轴加速度传感器1的数量。
进一步地,在所述获取所述车辆从起始位置行驶到第k个位置时的所述第二里程值的协方差之前,所述方法还包括:
S301:获取所述车辆从所述起始位置行驶到所述第k-1个位置时的所述修正里程值的协方差,根据所述修正里程值与所述第一里程值的协方差确定所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值的协方差。
优选地,根据确定所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值的协方差;
其中,Pk|k-1表示所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值的协方差,Pk-1|k-1表示所述车辆从所述起始位置行驶到所述第k-1个位置时所述修正程值的协方差,表示所述状态转移矩阵的转置矩阵,QK表示确定所述第二里程值的过程中所述过程噪声wk的协方差阵。所述wk满足高斯分布,所述Qk为高斯分布的方差,具体值由测量中经验估计,不确定时可以定位一个很小的值,比如10-5或更小。
进一步地,在根据所述协方差修正所述第二里程值,得到修正里程值,确定所述修正里程值为车辆从所述起始位置行驶到所述第k个位置的行驶里程之后,所述方法还包括:
S401:根据所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值的协方差确定所述车辆从所述起始位置行驶到所述第k个位置时所述修正里程值的协方差。具体地,根据Pk|k=(I-KkHk)Pk|k-1确定所述车辆从所述起始位置行驶到所述第k个位置时所述修正里程值的协方差,其中,I表示单位矩阵。
实际计算车辆里程的过程中,初始状态下,车辆一开始的速度和位移为0,的初始值可以为Pk|k的初始值可以为P0|0=I2×2。当所述Pk|k确定后,计算下一位置的修正里程值时,所述下一位置为所述第k个位置,所述Pk|k即作为原公式中的及Pk-1|k-1。
本领域普通技术人员可以理解:实现上述各方法实施例的全部或部分步骤可以通过程序指令相关的硬件来完成。前述的程序可以存储于一计算机可读取存储介质中。该程序在执行时,执行包括上述各方法实施例的步骤;而前述的存储介质包括:ROM、RAM、磁碟或者光盘等各种可以存储程序代码的介质。
最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。
Claims (9)
1.一种车辆行驶里程计算方法,其特征在于,包括:
确定所述车辆从起始位置行驶到第k个位置时的第一里程值和第二里程值,其中k为大于等于0的整数,所述第一里程值为根据车辆轮胎转过的圈数和所述轮胎半径确定的里程值,所述第二里程值为根据车辆前进方向的加速度值确定的里程值;
根据所述第一里程值及所述第二里程值确定所述车辆从所述起始位置行驶到所述第k个位置时的测量误差;
获取所述车辆从起始位置行驶到第k个位置时所述第二里程值的协方差;
根据所述协方差及测量误差修正所述第二里程值,得到修正里程值,确定所述修正里程值为车辆从所述起始位置行驶到所述第k个位置的行驶里程。
2.根据权利要求1所述的方法,其特征在于,
所述确定所述车辆从所述起始位置行驶到所述第k个位置的第二里程值,包括:
获取所述车辆从所述起始位置行驶到第k-1个位置的修正里程值;
根据所述车辆从所述起始位置行驶到所述第k-1个位置时的修正里程值及所述车辆从所述起始位置行驶到所述第k个位置时沿所述车辆前进方向的加速度值确定所述车辆从所述起始位置行驶到所述第k个位置时的第二里程值。
3.根据权利要求2所述的方法,其特征在于,在所述获取所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值的协方差之前还包括:
获取所述车辆从所述起始位置行驶到所述第k-1个位置时的所述修正里程值的协方差;
根据所述修正里程值的协方差确定所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值的协方差。
4.根据权利要求3所述的方法,其特征在于,所述根据所述车辆从所述起始位置行驶到第k-1个位置时的修正里程值及所述车辆从所述起始位置行驶到所述第k个位置时沿所述车辆前进方向的加速度值确定所述车辆从所述起始位置行驶到所述第k个位置时的第二里程值包括:
根据确定所述车辆从所述起始位置行驶到所述第k个位置时的第二里程值;
其中,表示所述车辆从所述起始位置行驶到所述第k个位置时的第二里程值,表示所述车辆从所述起始位置行驶到所述第k-1个位置时的修正里程值;Fk表示所述车辆从所述起始位置行驶到所述第k个位置时的卡尔曼滤波系统的状态转移矩阵;Bk表示所述车辆从所述起始位置行驶到所述第k个位置时的卡尔曼滤波系统的控制输入模型;ak表示所述车辆从所述起始位置行驶到所述第k个位置时沿所述车辆前进方向的加速度值;
所述根据所述车辆从所述起始位置行驶到所述第k-1个位置时的修正里程值的协方差确定所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值的协方差包括:
根据确定所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值协方差;
其中,Pk|k-1表示所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值的协方差,Pk-1|k-1表示所述车辆从所述起始位置行驶到所述第k-1个位置时所述修正程值的协方差,表示所述状态转移矩阵的转置矩阵,QK表示确定所述第二里程值的过程中过程噪声的协方差阵。
5.根据权利要求4所述的方法,其特征在于,所述根据所述协方差修正所述第二里程值,得到修正里程值,确定所述修正里程值为车辆从所述起始位置行驶到所述第k个位置的行驶里程包括:
车辆车辆根据所述车辆从所述起始位置行驶到所述第k个位置时的观测噪声协方差及所述第二里程值的协方差确定所述车辆从所述起始位置行驶到所述第k个位置时的测量误差协方差;
根据所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值的协方差、所述测量误差及所述测量误差协方差修正所述第二里程值,得到所述修正里程值。
6.根据权利要求5所述的方法,其特征在于,
所述根据车辆所述第一里程值及所述第二里程值确定所述车辆从所述起始位置行驶到所述第k个位置时的测量误差包括:
根据确定所述车辆从所述起始位置行驶到所述第k个位置时的测量误差;
其中,表示所述车辆从所述起始位置行驶到所述第k个位置时的测量误差,Zk表示所述车辆从所述起始位置行驶到所述第k个位置时的第一里程值;
所述根据所述车辆从所述起始位置行驶到所述第k个位置时所述观测噪声协方差及所述第二里程值的协方差确定所述车辆从所述起始位置行驶到所述第k个位置时的测量误差的协方差包括:
根据确定所述车辆从所述起始位置行驶到所述第k个位置时的测量误差的协方差;其中Hk表示所述车辆从所述起始位置行驶到所述第k个位置时的观测矩阵,表示所述观测矩阵的倒置矩阵;Rk表示观测噪声协方差;
所述根据所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值的协方差、所述测量误差及所述测量误差协方差修正所述第二里程值,得到所述修正里程值包括:
根据及确定所述车辆从所述起始位置行驶到所述第k个位置时的所述修正里程值;其中,Kk表示所述车辆从所述起始位置行驶到所述第k个位置时的卡尔曼增益。
7.根据权利要求1-6任一项所述的方法,其特征在于,还包括:根据所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值的协方差确定所述车辆从所述起始位置行驶到所述第k个位置时所述修正里程值的协方差。
8.根据权利要求7所述的方法,其特征在于,所述根据所述车辆从所述起始位置行驶到所述第k个位置时所述第二里程值的协方差确定所述车辆从所述起始位置行驶到所述第k个位置时修正里程值的协方差包括:
根据Pk|k=(I-KkHk)Pk|k-1确定所述车辆从所述起始位置行驶到所述第k个位置时所述修正里程值的协方差,其中,I表示单位矩阵。
9.根据权利要求1-6任一项所述的方法,其特征在于,在确定所述车辆从起始位置行驶到第k个位置时的第一里程值之前,还包括:
根据所述车辆轮胎在行驶过程中的切向加速度和/或法向加速度的最大值和最小值的出现次数确定所述车辆从所述起始位置行驶到所述第k个位置时所述车辆轮胎转过的圈数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510433551.1A CN104990563B (zh) | 2015-07-22 | 2015-07-22 | 车辆行驶里程计算方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510433551.1A CN104990563B (zh) | 2015-07-22 | 2015-07-22 | 车辆行驶里程计算方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104990563A CN104990563A (zh) | 2015-10-21 |
CN104990563B true CN104990563B (zh) | 2017-12-26 |
Family
ID=54302405
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510433551.1A Active CN104990563B (zh) | 2015-07-22 | 2015-07-22 | 车辆行驶里程计算方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104990563B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110672123A (zh) * | 2019-09-27 | 2020-01-10 | 吉旗(成都)科技有限公司 | 行驶里程纠偏方法及装置 |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106289308A (zh) * | 2016-09-22 | 2017-01-04 | 北京聚利科技股份有限公司 | 车辆轮胎转数的测量方法、系统及出租车计价装置 |
CN106871924B (zh) * | 2017-01-26 | 2019-09-10 | 安徽中科美络信息技术有限公司 | 一种基于卫星定位信号的车辆行驶里程计算方法 |
CN107719033A (zh) * | 2017-09-28 | 2018-02-23 | 网伦天下(北京)智能科技有限公司 | 一种轮胎的计时、计里程系统及装置 |
CN112902982B (zh) * | 2021-01-18 | 2023-11-17 | 惠州市德赛西威汽车电子股份有限公司 | 一种车辆行驶里程精确计算方法、系统及汽车 |
CN114353822B (zh) * | 2022-01-11 | 2024-05-24 | 深圳市几米物联有限公司 | 一种挂车里程的记录方法、挂车及记录系统 |
CN114518125B (zh) * | 2022-01-31 | 2024-06-07 | 深圳市云鼠科技开发有限公司 | 加速度计前进里程获取方法及应用 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2928560B2 (ja) * | 1989-10-17 | 1999-08-03 | パイオニア株式会社 | 車両用走行距離演算装置 |
CN101285686A (zh) * | 2008-05-29 | 2008-10-15 | 中国农业大学 | 一种农业机械导航分级定位的方法和系统 |
CN101592492A (zh) * | 2009-07-06 | 2009-12-02 | 北京航空航天大学 | 车载导航系统误差协方差阵部分参数自适应调节的方法 |
CN102410837A (zh) * | 2011-07-29 | 2012-04-11 | 江苏大学 | 一种车辆组合定位导航系统及方法 |
CN102508278A (zh) * | 2011-11-28 | 2012-06-20 | 北京航空航天大学 | 一种基于观测噪声方差阵估计的自适应滤波方法 |
CN103026176A (zh) * | 2010-07-22 | 2013-04-03 | 高通股份有限公司 | 用于校准车辆导航系统的动态参数的装置及方法 |
CN104316716A (zh) * | 2014-11-20 | 2015-01-28 | 清华大学 | 一种用gps速度信息改进车载速度表的方法 |
CN104515527A (zh) * | 2013-09-27 | 2015-04-15 | 上海置微信息科技有限公司 | 一种无gps信号环境下的抗粗差组合导航方法 |
-
2015
- 2015-07-22 CN CN201510433551.1A patent/CN104990563B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2928560B2 (ja) * | 1989-10-17 | 1999-08-03 | パイオニア株式会社 | 車両用走行距離演算装置 |
CN101285686A (zh) * | 2008-05-29 | 2008-10-15 | 中国农业大学 | 一种农业机械导航分级定位的方法和系统 |
CN101592492A (zh) * | 2009-07-06 | 2009-12-02 | 北京航空航天大学 | 车载导航系统误差协方差阵部分参数自适应调节的方法 |
CN103026176A (zh) * | 2010-07-22 | 2013-04-03 | 高通股份有限公司 | 用于校准车辆导航系统的动态参数的装置及方法 |
CN102410837A (zh) * | 2011-07-29 | 2012-04-11 | 江苏大学 | 一种车辆组合定位导航系统及方法 |
CN102508278A (zh) * | 2011-11-28 | 2012-06-20 | 北京航空航天大学 | 一种基于观测噪声方差阵估计的自适应滤波方法 |
CN104515527A (zh) * | 2013-09-27 | 2015-04-15 | 上海置微信息科技有限公司 | 一种无gps信号环境下的抗粗差组合导航方法 |
CN104316716A (zh) * | 2014-11-20 | 2015-01-28 | 清华大学 | 一种用gps速度信息改进车载速度表的方法 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110672123A (zh) * | 2019-09-27 | 2020-01-10 | 吉旗(成都)科技有限公司 | 行驶里程纠偏方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN104990563A (zh) | 2015-10-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104990563B (zh) | 车辆行驶里程计算方法 | |
CN110171416B (zh) | 车辆行驶控制方法、装置、计算机可读介质及电子设备 | |
US20140163808A1 (en) | System and method of acquiring bias of yaw rate sensor for vehicle | |
US11383727B2 (en) | Vehicle operation based on vehicular measurement data processing | |
JP6282269B2 (ja) | 自動車のステアリングホイールの絶対角度位置を判定するための改良された方法 | |
JP5152778B2 (ja) | 自動二輪車の傾斜角検出装置 | |
JP5955465B2 (ja) | 車両のステアリングコラムの操舵角を求める自動車、システム及び方法 | |
JP4854778B2 (ja) | 車両用推定航法装置、車両用推定航法及び車両用推定航法のプログラム | |
KR20140093961A (ko) | 센서 시스템의 데이터의 정확성을 독립적으로 평가하기 위한 센서 시스템 | |
CN109297486B (zh) | 惯性与多里程计信息辅助的车体运动状态判定方法及系统 | |
US8594887B1 (en) | Method and system for measuring tilt angle during turn of vehicle | |
EP3647148B1 (en) | Vehicular control device | |
JP2015524364A (ja) | 自動車の走行方向を検知するための方法 | |
US20140236412A1 (en) | Apparatus and method for automatically parking vehicle | |
JP2015189300A (ja) | 車体のロール角推定装置 | |
US20140121856A1 (en) | Method and system for measuring tilt angle of vehicle | |
US9605958B2 (en) | Method and device for determining the inclined position of a vehicle | |
JP4960570B2 (ja) | 自動車の右輪及び左輪の自動位置確認のための方法 | |
JP7368181B2 (ja) | 摩耗量推定システムおよび演算モデル生成システム | |
JP2016217065A (ja) | 路面粗さの計測装置 | |
CN116767240A (zh) | 车轮轮速修正方法、装置及电子设备 | |
US6865456B2 (en) | Underinflation detector | |
JP7360976B2 (ja) | センサ誤差補正装置 | |
JP2012163509A (ja) | 車両用推定航法装置、車両用推定航法及び車両用推定航法のプログラム | |
JP2013250167A (ja) | 距離計測装置、距離補正方法、距離補正プログラム、および記録媒体 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant |