CN109307782A - 车速估算装置、车速估算方法、及计算器可读介质 - Google Patents
车速估算装置、车速估算方法、及计算器可读介质 Download PDFInfo
- Publication number
- CN109307782A CN109307782A CN201710630710.6A CN201710630710A CN109307782A CN 109307782 A CN109307782 A CN 109307782A CN 201710630710 A CN201710630710 A CN 201710630710A CN 109307782 A CN109307782 A CN 109307782A
- Authority
- CN
- China
- Prior art keywords
- value
- speed
- wheel speed
- acc
- acceleration
- 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.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P3/00—Measuring linear or angular speed; Measuring differences of linear or angular speeds
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明提供一种车速估算装置、车速估算方法、及计算器可读介质,其中该车速估算装置,乘载于车辆上,车速估算装置包含记忆单元及微处理器,记忆单元储存有计算机程序,微处理器电连接于记忆单元并能读取计算机程序以执行车速估计方法。车速估计方法滑差值计算步骤、轮速权重值计算步骤、加速度权重值计算步骤、以及车速估计值计算步骤,通过计算滑差值、排除过大滑差值的轮胎、并赋予轮速感测值及加速度感测值权重,而能更精确地估算车速。从而,估计的车速能符合各种行驶情境,并能提供给自动驾驶,以防止因为车速估计的误差造成的伤害。
Description
技术领域
本发明涉及车辆领域,尤其是一种车速估算装置、车速估算方法、及其计算器可读介质。
背景技术
目前车辆仪表板的车速表,通常是引用多个车轮轮速的平均值来计算当时的车速,以提供驾驶人加速、剎车、转弯的判断。然而,实际上这样计算车速的方式并不够准确,例如,在碎石或是含沙量较高的路面,全体轮胎会有不同程度的些微打滑,平均轮速将比实际的车速快。或者于一般路面行驶时,各轮胎因路面跳动不均,当某一轮胎因特别跳动而产生打滑时,打滑的轮胎的轮速很快,导致以轮速的平均值计算出的车速受其影响而不准确。车上需要较高精度车速计算结果的车载装置,例如安全气囊引爆器等,为能正确运作就无法直接采用上述轮速平均值以粗略计算出的车速。
此外,随着自动驾驶汽车的发展,自动驾驶系统依据前方对象、道路周遭状况来对加减速或转弯做出适当的判断时,对于精确计算车速的依赖越来越高,上述现有技术以多个轮胎转速平均值仅提供以粗略计算车速的计算方式,逐渐不敷使用。尤其是,自动驾驶车将无驾驶者的人为判断,若因车速的估计判断错误,容易造成冲撞,而导致乘客的伤亡。因此,对于车速的精密估算,更有赖新的计算车速技术的改良。
车速的估算方法,目前也发展出以加速度规来计算车速,然而,目前的加速度规限于直线行驶方向,且其计算方式通过积分,微量的误差都可能导致车速的计算随着时间累加而产生显著的误差。另外,亦有通过GPS的方式来进行车速的量测。唯,一般型GPS导航装置的定位精度有其先天性的误差限制,导致计算车速误差仍然很大,而高精度GPS的设备,其价格可能超出车辆的价格,不符配置成本,且仍然可能受到天气、或是隧道等地形的影响而有失能或不准确的时候。
发明内容
为了解决现有技术上面临的技术问题,本发明在此提供一种车速估算装置及车速估计方法、以及其计算器可读介质。本发明的车速估算装置乘载于车辆上,车辆包含多个轮胎,车速估算装置包含微处理器。微处理器能执行车速估计方法;亦可于记忆单元内储存有计算机程序,微处理器电连接于记忆单元并能读取计算机程序以执行车速估计方法。本发明的车速估计方法包含滑差值计算步骤、轮速权重值计算步骤、加速度权重值计算步骤、以及车速估计值计算步骤。
本发明的滑差值计算步骤,是根据多个轮速感测值、以及前次车速估计值分别计算对应于该些轮胎的多个滑差值,其中,各轮速感测值是指其对应轮胎的当时轮胎转速。轮速权重值计算步骤,是依据该些滑差值、以及滑差平均值计算对应各该轮胎的一轮速权重值,其中,滑差平均值是指该些滑差值的平均值。加速度权重值计算步骤,是根据加速度感测值计算加速度权重值,其中,加速度感测值是指车辆当时直行方向加速度值。车速估计值计算步骤,是根据该些轮速感测值、前次车速估计值、加速度感测值、该些轮速权重值、加速度权重值、以及时间差以计算出当时车速估计值。
本发明的上述步骤所组成的车速估计方法可以将之撰写成计算器程序并储存于储存媒介、或是通过网络平台提供下载,作为计算器可读介质以利销售。本发明的计算器可读介质能被计算机装置加载以执行并计算车辆的当时车速估计值。计算器可读介质至少包含第一计算器程序、第二计算器程序、第三计算器程序、以及第四计算器程序,以分别执行滑差值计算步骤、轮速权重值计算步骤、加速度权重值计算步骤、以及车速估计值计算步骤。
本发明藉由滑差值计算步骤及轮速权重值计算步骤以筛除滑差值过大的轮胎,以及藉由轮速权重值计算步骤及加速度权重值计算步骤,以分别通过赋予轮速权重值以及加速度权重值的技术方法,以更精确地估算车辆当时的车速,更能适用于各种情境模式下估算出精确车速的需要。因而,车速估算装置以及车速估计方法能提供自动驾驶车辆的定车距、定车速、自动剎车、情境判断上达到更精确车速的需要,避免因为车速粗略估计的误差产生的伤亡。因此,本发明只采用车辆现有配备所提供的轮速感测值、加速度感测值、角速度感测值,就能进行精确的估算,无须再另行加装其他特殊的量测组件或高精度GPS设备,故无须额外添置的设备成本。
附图说明
通过参照附图进一步详细描述本发明的示例性实施例,本发明的上述和其
他示例性实施例,优点和特征将变得更加清楚,其中:
图1为本发明一实施例的车速估算装置的单元方块示意图;
图2为本发明一实施例的车速估算方法的流程图;
图3(a)及图3(b)分别为第一情境下的量测曲线比较图及差值比较图;
图4(a)及图4(b)分别为第二情境下的量测曲线比较图及差值比较图;
图5(a)及图5(b)分别为第三情境下的量测曲线比较图及差值比较图;
图6(a)及图6(b)分别为第四情境下的量测曲线比较图及差值比较图。
其中附图标记为:
1 车辆 10LB 左后轮胎
10LF 左前轮胎 10RB 右后轮胎
10RF 右前轮胎 20 车辆信号总线
21 轮速接收单元 23 加速度规
25 偏航角速度仪 100 车速估计装置
110 微处理器 120 记忆单元
121 计算机程序 acc(t) 加速度感测值
Kacc(t) 加速度权重值 Kij(t) 轮速权重值
S1 车速估计方法 S10 滑差值计算步骤
S20 轮速权重值计算步骤 S30 加速度权重值计算步骤
S40 车速估计值计算步骤 S50 模式判断步骤
Sij(t) 滑差值 Smean(t) 滑差平均值
VCG(t) 当时车速估计值 VCG(t-1) 前次车速估计值
Vij(t) 轮速感测值 Vmean(t) 轮速平均值
X 前进方向 Y(t) 偏航角速度
具体实施方式
图1为本发明一实施例的车速估算装置的单元方块示意图。本实施例的车速估算装置100系乘载于车辆1上,并与车辆1的车辆信号总线20电连接或是通讯连接。如图1所示,本实施例的车速估算装置100包含微处理器110及记忆单元120,记忆单元120储存有计算机程序121。微处理器110电性连接于记忆单元120,并能读取及执行其中的计算机程序121。在此仅为示例,并不限于此,例如,计算机程序121也可以储存于微处理器110中,由微处理器110直接执行车速估算方法S1。
在此实施例中,车辆1以四轮的车辆为示例,车辆1包含多个轮胎,具体而言是左前轮10LF、左后轮10LB、右前轮10RF、右后轮10RB。然而此仅为示例,实际上车辆1可以为包含更多轮胎,例如六个、八个、或十二个。此外,车辆1上配备的车辆信号总线20电连接有各种车装电子装置,例如,轮速接收单元21、加速度规23、以及偏航角速度仪25。轮速接收单元21接收各轮胎上当时的轮速感测值Vij(t),其中,Vij(t)中的i表示左、右的轮胎代号,而j表示前、后的轮胎代号,亦即Vij(t)可代表为左前轮胎转速VLF(t)、左后轮胎转速VLB(t)、右前轮胎转速VRF(t)、或右后轮胎转速VRB(t)。在此仅为示例,而不限于此,具有更多轮胎的车辆亦可依其他方式编排。
本实施例的加速度规23量测加速度感测值acc(t)并输出至车辆信号总线20,加速度感测值acc(t)是指于车辆1当时直行方向,例如,前进方向X的加速度值。本实施例的偏航角速度仪25量测偏航角速度Y(t)并输出至车辆信号总线20,偏航角速度Y(t)是指对应于车辆1在前进方向X的偏航角速度(Yaw Rate)。
本实施例的车速估算装置100与车辆信号总线20进行通讯,以接收轮速感测值Vij(t)、加速度感测值acc(t)、以及偏航角速度Y(t)。微处理器110电连接于记忆单元120并能读取计算机程序121进而执行下列车速估算方法S1的各个步骤。
图2为本发明一实施例的车速估算方法的流程图。如图2所示,本实施例的车速估算方法S1至少包含下列步骤:滑差值计算步骤S10、轮速权重值计算步骤S20、加速度权重值计算步骤S30、以及车速估计值计算步骤S40。
在本实施例中,滑差值计算步骤S10是根据多个轮速感测值Vij(t)、以及一前次车速估计值VCG(t-1)以分别计算对应于各轮胎的多个滑差值Sij(t)。在此,滑差值Sij(t)的物理意义是代表该轮胎当时的打滑程度,当轮胎打滑越严重,则滑差值Sij(t)越大。在滑差值计算步骤S10中,本实施例的滑差值Sij(t)是依下列算式计算:
当Vij(t)≥VCG(t-1),以及
当Vij(t)<VCG(t-1),
在本实施例中,轮速权重值计算步骤S20是根据前述滑差值计算步骤S10中计算出的该些滑差值Sij(t)、以及该些滑差值Sij(t)的平均值,即滑差平均值Smean(t),来计算各轮胎的轮速权重值Kij(t)。在本实施例的轮速权重值计算步骤S20中,轮速权重值Kij(t)是依下列算式计算:
当Sij(t)≥Smean(t),Kij(t)=0………(算式3);以及
当Sij(t)<Smean(t),Kij(t)=a*Sij(t)+b………(算式4),
其中-2.5≤a≤-0.5,0.5≤b≤2;较佳地,a、b的数值条件为-2≤a≤-1,0.8≤b≤1.8。
上述算式3的物理意义是在通过轮速权重值计算步骤S20,先筛除滑差值Sij(t)大于滑差平均值Smean(t)的轮胎,而能让后续的车速估算不会受到打滑过大的轮胎影响而产生过大的偏差。此外,上述算式4的物理意义是依据滑差值Sij(t)小于滑差平均值Smean(t)的轮胎,依据其轮速感测值Vij(t)对于整体车速的贡献赋予权重值Kij(t)。
在本实施例中,加速度权重值计算步骤S30根据加速度感测值acc(t)计算加速度权重值Kacc(t)。在本实施例的加速度权重值计算步骤S30中,加速度权重值Kacc(t)是依下列算式计算:
Kacc(t)=c*|acc(t)|+1………(算式5),
其中3≤c≤50,较佳地,c的数值条件为15≤c≤30。
上述算式5的物理意义是在通过加速度权重值计算步骤S30,对于车辆1在前进方向X的加速度,对于整体车速的贡献赋予权重值Kacc(t)。
在本实施例中,车速估计值计算步骤S40根据该些轮速感测值Vij(t)、前次车速估计值VCG(t-1)、加速度感测值acc(t)、该些轮速权重值Kij(t)、加速度权重值Kacc(t)、以及时间差T以计算出当时车速估计值VCG(t)。本实施例的车速估算是每隔一固定的时间间隔(interval)作为时间差T以量测并计算一次,前次车速估计值VCG(t-1)是指前一次所计算出的车速估计值。在车速估计值计算步骤S40中,本实施例的当时车速估计值VCG(t)是依下列算式计算:
上述算式6的物理意义是将每一轮速感测值Vij(t)藉由其轮速权重值Kij(t)分别调整之,并将前次车速估计值VCG(t-1)藉由加速度权重值Kacc(t)调整之,并再加上当时加速度感测值acc(t)所造成的车速增减之后,除以上述全部权重值,藉以排除了各种极端的状况。例如,在碎石路面急加速的情况滑差值过大的轮胎能被排除,并降低了轮速权重值Kij(t)、增加了加速度权重值Kacc(t),从而以加速度感测值acc(t)作为整体车速估计的主要贡献、但也不忽略轮速感测值Vij(t)对于车速的贡献。从而,本实施例的车速估计装置所估算出来的当时车速估计值VCG(t)能更接近实际的车速。又例如,在坡道上加减速的情况,加速度感测值acc(t)易受到影响,因而可以增加轮速权重值Kij(t)、降低加速度权重值Kacc(t),从而以轮速感测值Vij(t)作为整体车速估计的主要贡献、但也不忽略加速度速感测acc(t)对于车速的贡献。从而,本实施例的车速估计装置所估算出来的当时车速估计值VCG(t)能更接近实际的车速。
由于本实施例所采用的车速估算方法S1也能估算出较精确的车速,故可适用于自动驾驶车的定车距、定车速、自动剎车等精确车速的需要场合。解决了现有技术上粗略以轮速平均值或加速度值计算的偏差。
进一步地,在另一些实施例中,车速估算方法S1其更包含一模式判断步骤S50,其可早于前述各步骤以预先决定究以何模式进行车速估算。在此图2的实施例中,模式判断步骤S50是根据轮速感测值Vij(t)、轮速阀值Vth、前次车速估计值VCG(t-1)、以及车速阀值VCGth进行比对。当比对所有的轮速感测值Vij(t)皆小于轮速阀值Vth、并且比对前次车速估计值VCG(t-1)小于车速阀值VCGth时,则判断车辆1处于一起步模式,并将加速度权重值计算步骤中的加速度权重值Kacc(t)依下列算式计算:
Kacc(t)=0………(算式7)。
上述算式7的物理意义是当轮速感测值Vij(t)及前次车速估计值VCG(t-1)都低于阀值时,判定车辆1在刚起步的状态,因此,赋予加速度感测值acc(t)的权重为零,表示于此状态下可忽略不计算加速度感测值acc(t)的影响。由于排除了加速度感测值acc(t)所造成的起步状态的车速偏差,车速估算方法S1能避免随时间而使得车速估计的偏差值增加,并使得车速的估算更为精确。
在一些实施例中,轮速阀值Vth可介于0至5千米/小时之间。较佳地,轮速阀值Vth为设定0.05至3千米/小时之间。由于一般轮速判断上可能有侦测的误差,以此区间能更为精确。更加地,轮速阀值Vth设定为0.1至1千米/小时之间,以此区间更能排除误差所造成的问题。
车速阀值VCGth介于1至10千米/小时之间。较佳地,车速阀值VCGth为2至6千米/小时之间,以此区间更能排除车速在低速状态的误差,更加地,车速阀值VCGth为3至5千米/小时之间。以此区间更能排除车速在低速状态的误差。
另外,当处于起步模式中有任一轮胎的轮速感测值Vij(t)大于一轮速启动值Vst时,则判断车辆1离开起步模式,并将加速度权重值计算步骤中的加速度权重值Kacc(t)回到前述算式5进行计算:
Kacc(t)=c*|acc(t)|+1,其中3≤c≤50………(算式5)。
上述所表示的物理意义是当车辆1离开起步模式后,则回归先前加速度权重值计算步骤S30的方式计算,在一些实施例中,轮速启动值Vst介建议设定于0至5千米/小时之间。
在另一些实施例中,模式判断步骤S50可更比对车辆1当时的偏航角速度Y(t)以及预定的偏航角速度阀值Yth,当偏航角速度Y(t)大于偏航角速度阀值Yth时,判断车辆1处于弯道模式,并将滑差值计算步骤S20中的滑差值Sij(t)依下列算式计算:
当Vij(t)≥Vmean(t),以及
当Vij(t)<Vmean(t),
其中轮速平均值Vmean(t)是指当时轮速感测值Vij(t)的平均值。
上述算式8、9的物理意义是当车辆1处于转弯状态时,若以直线前进方向X行驶的前次车速估计值VCG(t-1)可能会造成失准,因此,以轮速平均值Vmean(t)作为判断的基础,其计算能更为精确。在一些实施例中,偏航角速度阀值Yth建议设定介于2至8度/秒之间。
在另一些实施例中,判断车辆1是否处于转弯状态也可以根据方向盘的产生的转弯信号是否持续一特定时间,例如,10秒来做为判断的基础。而当方向盘回正,即转弯信号停止时,滑差值计算步骤S20则回到一般计算滑差值Sij(t)的算式1、2进行计算。
在判断步骤S50中,当模式判断步骤S10判断车辆1非处于起步模式、亦非弯道模式的其他状态,则称为一般模式。一般模式下,依循前述滑差值计算步骤S10、轮速权重值计算步骤S20、加速度权重值计算步骤S30、以及车速估计值计算步骤S40的方式,以算式1至6进行车速估计。
在一些实施例中,记忆单元120可以为内存或硬盘等,计算机程序121可以通过储存媒介,例如,硬盘、光盘片、记忆卡、随身碟等而转存至记忆单元120中。在另一些实施例中,计算机程序121亦可以通过因特网或无线网络下载而储存于记忆单元120中。微处理器110电连接于记忆单元120并能读取计算机程序121以进行上述车速估算方法S1的各个步骤。
在一些实施例中,前述的滑差值计算步骤S10、轮速权重值计算步骤S20、加速度权重值计算步骤S30、以及车速估计值计算步骤S40,甚或再加上模式判断步骤S50,皆可以整合为一或一种以上的车速估算方法以利实行。该些车速估算方法可由一般车载的行车计算机或如上述车速估计装置10来实施以估算车速,亦可利用智能型手机、平板计算机、车用导航装置等便携设备带上车后,通过有线或无线通信与车辆上的车辆信号总线20连接以取得轮速、加速度等数据后据以实施以估算车速。
上述车速估算方法可以将之撰写成计算器程序,并储存于储存媒介、或是通过网络平台提供下载,而作为计算器可读介质以供销售。储存媒介可以是前述车载装置的记忆单元120、或其他硬盘机、光盘片、记忆卡、随身碟等。计算器可读介质亦可以寄存于云端服务器,或网络平台,系可供网络联机以无线或有线方式下载封包。本发明的计算器可读介质可以被计算器装置加载而执行。
在一实施例中,计算器可读介质包含了第一计算器程序、第二计算器程序、第三计算器程序、第四计算器程序。第一计算器程序执行上述的滑差值计算步骤S10。第二计算器程序执行上述的轮速权重值计算步骤S20。第三计算器程序执行上述的加速度权重值计算步骤S30。第四计算器程序执行上述的车速估计值计算步骤S40。
在另一些实施例中,计算器可读介质更包含了第五计算器程序,第五计算器程序执行模式判断步骤S50中比对轮速感测值Vij(t)与轮速阀值(Vth)、以及比对前次车速估计值VCG(t-1)于与车速阀值(VCGth)。当比对符合起步模式时,对第三计算器程序要求加速度权重值Kacc(t)依下列算式计算:
Kacc(t)=0。
另一些实施例中,计算器可读介质更包含了第六计算器程序,第六计算器程序执行模式判断步骤S50中,比对偏航角速度Y(t)与偏航角速度阀值Yth,当比对符合弯道模式时,要求第一计算器程序中计算滑差值Sij(t)依前述的算式8、9进行计算:
当Vij(t)≥Vmean(t),
当Vij(t)<Vmean(t),
以下将通过实际的实验,来验证前述车速估算方法。图3(a)及图3(b)分别为第一情境下的量测曲线比较图及差值比较图;图4(a)及图4(b)分别为第二情境下的量测曲线比较图及差值比较图;图5(a)及图5(b)分别为第三情境下的量测曲线比较图及差值比较图;以及图6(a)及图6(b)分别为第四情境下的量测曲线比较图及差值比较图。在此,图3(a)、图4(a)、图5(a)及图6(a)中,虚线的曲线是表示用以现有技术以轮速平均值所计算出的车速对应时间的曲线、直线是以VBOX高精密GPS装置量测出的参考车速对应时间的曲线、圆点曲线是表示现有技术以加速度规推算出来的车速对应时间的曲线、米字曲线为以前述车速估算方法所估计的车速对应时间的曲线。另外,图3(b)、图4(b)、图5(b)及图6(b)中,虚线的曲线是表示用以现有技术以轮速平均值所计算出的车速与VBOX高精密GPS装置量测出的参考车速的差值对应时间的曲线。圆点曲线是表示现有技术以加速度规推算出来的车速与VBOX高精密GPS装置量测出的参考车速的差值对应时间的曲线。米字曲线为以前述车速估算方法所估计的车速与VBOX高精密GPS装置量测出的参考车速的差值对应时间的曲线。
如图3(a)及图3(b)所示,第一情境是指在碎石路面急加速的情境。可以理解的是,碎石路面加速会造成轮胎打滑,因此轮胎的滑差值较大,因此,以现有技术的轮速平均值所计算出的车速对应时间的曲线与VBOX高精密GPS装置量测出的实际车速的曲线,有明显的差异,尤其是在4至7秒期间。在此情境下,现有技术以加速度规推算出来的车速相较下与VBOX高精密GPS装置量测出的参考车速较为接近,但在较长时间下,由于误差的逐渐累积,以加速度规推算出来的车速逐渐与VBOX高精密GPS装置量测出的参考车速偏离。前述车速估算方法S1所估计的车速通过权重的分配,在整个时间区间所估计的车速都接近于VBOX高精密GPS装置量测出的参考车速。
如图4(a)及图4(b)所示,第二情境是指平地直线加减速情境。由此情境可见现有技术以加速度规推算出来的车速对应时间的曲线,随着时间积分会造成误差累积,因而在一定时间后,误差会逐渐升高。现有技术以轮速平均值所计算出的车速对应时间的曲线,在此状态下较与VBOX高精密GPS装置量测出的参考车速较为接近,但是在高速时亦有约2千米/小时误差。前述车速估算方法所估计的车速通过权重的分配,在整个时间区间所估计的车速都接近于VBOX高精密GPS装置量测出的参考车速。
如图5(a)及图5(b)所示,第三情境是平地弯道加减速的情境。由于在弯道行驶时,车辆的加速度包含了纵向(前进方向X)及横向加速度,由于并非每个车辆都配有横向的加速度规,因此,现有技术以纵向加速度规推算出来的车速对应时间的曲线,与VBOX高精密GPS装置量测出的参考车速具有明显的偏差,且随着时间累积,偏差量会随时间逐步增加。在此情境下,现有技术以轮速平均值所计算出的车速对应时间的曲线,在此状态下较与VBOX高精密GPS装置量测出的参考车速较为接近,但仍维持着一定的偏差量。前述车速估算方法所估计的车速通过权重的分配,在整个时间区间所估计的车速都接近于VBOX高精密GPS装置量测出的参考车速。
如图6(a)及图6(b)所示,第四情境是在坡度约30%的下坡加速情境的情境。由于加速度感测值acc(t)受坡度影响,因此,现有技术以加速度规推算出来的车速对应时间的曲线,与VBOX高精密GPS装置量测出的参考车速有明显的偏差,且随着时间累积,偏差量随着时间逐步增加。此情境下,现有技术以轮速平均值所计算出的车速对应时间的曲线,在此状态下较与VBOX高精密GPS装置量测出的参考车速较为接近,但仍维持着一定的偏差量。前述车速估算方法所估计的车速通过权重的分配,在整个时间区间所估计的车速都接近于VBOX高精密GPS装置量测出的参考车速。
在上述实验中证实车速估算方法通过滑差值计算步骤及轮速权重值计算步骤筛除滑差值Sij(t)过大的轮胎,并通过轮速权重值计算步骤及加速度权重值计算步骤,赋予轮速权重值Kij(t)以及加速度权重值Kacc(t),此技术手段能精确地估计车辆当时的车速,更能适用于各种情境下。因而,车速估算装置所执行的车速估计方法提供自动驾驶的定车距、定车速、自动剎车等精确的车速的需要,能达到更精确的车速估计,以避免因为车速估计的误差产生的伤亡。此外,车速估算方法采用车辆现有的设备所感测的轮速感测值、加速度感测值、角速度感测值,就能进行精确的估计、无须加装其他特殊的量测组件,不须增加额外的设备成本。
虽然已经结合目前被认为是实用的示例性实施例描述了本发明,但是应当理解,本发明不限于所公开的实施例,而是相反,旨在适用于各种修改和等同布置包括在所附权利要求的精神和范围内。
Claims (33)
1.一种车速估算方法,用于计算一车辆的一当时车速估计值,该车辆包含多个轮胎;其中,上述方法包含以下步骤:
一滑差值计算步骤,根据多个轮速感测值(Vij(t))、以及一前次车速估计值(VCG(t-1))分别计算对应于该些轮胎的多个滑差值(Sij(t)),其中,各该轮速感测值(Vij(t))是指其对应轮胎的当时轮胎转速;
一轮速权重值计算步骤,根据该些滑差值(Sij(t))、以及一滑差平均值(Smean(t)),计算对应各该轮胎的一轮速权重值(Kij(t)),其中,该滑差平均值(Smean(t))是指该些滑差值(Sij(t))的平均值;
一加速度权重值计算步骤,根据一加速度感测值(acc(t))计算一加速度权重值(Kacc(t)),其中,该加速度感测值(acc(t))是指该车辆当时直行方向加速度值;以及
一车速估计值计算步骤,根据该些轮速感测值(Vij(t))、该前次车速估计值(VCG(t-1))、该加速度感测值(acc(t))、该些轮速权重值(Kij(t))、该加速度权重值(Kacc(t))、以及一时间差(T)计算出一当时车速估计值(VCG(t))。
2.如权利要求1所述的车速估算方法,其特征在于,在该滑差值计算步骤中,该些滑差值(Sij(t))是依下列算式计算:
当Vij(t)≥VCG(t-1),以及
当Vij(t)<VCG(t-1),
3.如权利要求2所述的车速估算方法,其特征在于,在该轮速权重值计算步骤中,该些轮速权重值(Kij(t))是依下列算式计算:
当Sij(t)≥Smean(t),Kij(t)=0;以及
当Sij(t)<Smean(t),Kij(t)=a*Sij(t)+b,其中-2.5≤a≤-0.5,0.5≤b≤2。
4.如权利要求1所述的车速估算方法,其特征在于,在该加速度权重值计算步骤中,该加速度权重值(Kacc(t))是依下列算式计算:
Kacc(t)=c*|acc(t)|+1,其中3≤c≤50。
5.如权利要求1的所述的车速估算方法,其特征在于,在该车速估计值计算步骤中,该当时车速估计值(VCG(t))是依下列算式计算:
6.如权利要求1所述的车速估算方法,其特征在于,更包含一模式判断步骤,当比对该些轮速感测值(Vij(t))皆小于一轮速阀值(Vth)、并且比对该前次车速估计值(VCG(t-1))小于一车速阀值(VCGth)时,则判断该车辆处于一起步模式,并将该加速度权重值计算步骤中的该加速度权重值(Kacc(t))依下列算式计算:
Kacc(t)=0。
7.如权利要求6所述的车速估算方法,其特征在于,该轮速阀值(Vth)介于0至5千米/小时之间,该车速阀值(VCGth)介于1至10千米/小时之间。
8.如权利要求6所述的车速估算方法,其特征在于,当处于该起步模式中有任一轮胎的轮速感测值(Vij(t))大于一轮速启动值(Vst)时,则判断该车辆离开该起步模式,并将该加速度权重值计算步骤中的该加速度权重值(Kacc(t))依下列算式计算:
Kacc(t)=c*|acc(t)|+1,其中3≤c≤50。
9.如权利要求8所述的车速估算方法,其特征在于,该轮速启动值(Vst)介于0至5千米/小时之间。
10.如权利要求1所述的车速估算方法,其特征在于,更包含一模式判断步骤,当比对该车辆的一偏航角速度(Y(t))大于一偏航角速度阀值(Yth)时,则判断该车辆处于一弯道模式,并将该滑差值计算步骤中的该些滑差值(Sij(t))依下列算式计算,其中一轮速平均值(Vmean(t))是指当时该些轮速感测值(Vij(t))的平均值:
当Vij(t)≥Vmean(t),以及
当Vij(t)<Vmean(t),
11.如权利要求10所述的车速估算方法,其特征在于,该偏航角速度阀值(Yth)介于2至8度之间。
12.一种车速估算装置,乘载于一车辆上,其特征在于,该车辆包含多个轮胎,该车速估算装置包含一记忆单元及一微处理器,该记忆单元储存有一计算机程序,该微处理器电连接于该记忆单元并能读取该计算机程序以执行以下步骤:
一滑差值计算步骤,根据多个轮速感测值(Vij(t))、以及一前次车速估计值(VCG(t-1))分别计算对应于该些轮胎的多个滑差值(Sij(t)),其中,各该轮速感测值(Vij(t))是指其对应轮胎的当时轮胎转速;
一轮速权重值计算步骤,依据该些滑差值(Sij(t))、以及一滑差平均值(Smean(t)),计算对应各该轮胎的一轮速权重值(Kij(t)),其中,该滑差平均值(Smean(t))是指该些滑差值(Sij(t))的平均值;
一加速度权重值计算步骤,根据一加速度感测值(acc(t))计算一加速度权重值(Kacc(t)),其中,该加速度感测值(acc(t))是指该车辆当时直行方向加速度值;以及
一车速估计值计算步骤,根据该些轮速感测值(Vij(t))、该前次车速估计值(VCG(t-1))、该加速度感测值(acc(t))、该些轮速权重值(Kij(t))、该加速度权重值(Kacc(t))、以及一时间差(T)计算出一当时车速估计值(VCG(t))。
13.如权利要求12所述的车速估算装置,其特征在于,在该滑差值计算步骤中,该些滑差值(Sij(t))是依下列算式计算:
当Vij(t)≥VCG(t-1),以及
当Vij(t)<VCG(t-1),
14.如权利要求13所述的车速估算装置,其特征在于,在该轮速权重值计算步骤中,该些轮速权重值(Kij(t))是依下列算式计算:
当Sij(t)≥Smean(t),Kij(t)=0;以及
当Sij(t)<Smean(t),Kij(t)=a*Sij(t)+b,其中-2.5≤a≤-0.5,0.5≤b≤2。
15.如权利要求12所述的车速估算装置,其特征在于,在该加速度权重值计算步骤中,该加速度权重值(Kacc(t))是依下列算式计算:
Kacc(t)=c*|acc(t)|+1,3≤c≤50。
16.如权利要求12的所述的车速估算装置,其特征在于,在该车速估计值计算步骤中,该当时车速估计值(VCG(t))是依下列算式计算:
17.如权利要求12所述的车速估算装置,其更包含一模式判断步骤,当比对该些轮速感测值(Vij(t))皆小于一轮速阀值(Vth)、并且比对该前次车速估计值(VCG(t-1)小于一车速阀值(VCGth)时,则判断该车辆处于一起步模式,并将该加速度权重值计算步骤的该加速度权重值(Kacc(t))依下列算式计算:
Kacc(t)=0。
18.如权利要求17所述的车速估算装置,其特征在于,该轮速阀值(Vth)介于0至5千米/小时之间,该车速阀值(VCGth)介于1至10千米/小时之间。
19.如权利要求17所述的车速估算装置,其特征在于,当处于该起步模式中有任一轮胎的轮速感测值(Vij(t))大于一轮速启动值(Vst)时,则判断该车辆离开该起步模式,并将该加速度权重值计算步骤中的该加速度权重值(Kacc(t))依下列算式计算:
Kacc(t)=c*|acc(t)|+1,其中3≤c≤50。
20.如权利要求19所述的车速估算装置,其特征在于,该轮速启动值(Vst)介于0至5千米/小时之间。
21.如权利要求12所述的车速估算装置,其特征在于,更包含一模式判断步骤,当比对该车辆的一偏航角速度(Y(t))大于一偏航角速度阀值(Yth)时,则判断该车辆处于一弯道模式,并将该滑差值计算步骤中的该些滑差值(Sij(t))依下列算式计算,其中一轮速平均值(Vmean(t))是指当时该些轮速感测值(Vij(t))的平均值:
当Vij(t)≥Vmean(t),以及
当Vij(t)<Vmean(t),
22.如权利要求21所述的车速估算装置,其特征在于,该偏航角速度阀值(Yth)介于2至8度之间。
23.一种计算器可读介质,其特征在于,其上储存有多个计算器程序,该些计算器程序能被一电子装置加载以执行并计算一车辆的一当时车速估计值,该车辆包含多个轮胎;其中,上述计算器可读介质包含:
一第一计算器程序,能根据多个轮速感测值(Vij(t))、以及一前次车速估计值(VCG(t-1))分别计算对应于该些轮胎的多个滑差值(Sij(t)),其中,各该轮速感测值(Vij(t))是指其对应轮胎的当时轮胎转速;
一第二计算器程序,能根据该些滑差值(Sij(t))、以及一滑差平均值(Smean(t)),计算对应各该轮胎的一轮速权重值(Kij(t)),其中,该滑差平均值(Smean(t))是指该些滑差值(Sij(t))的平均值;
一第三计算器程序,能根据一加速度感测值(acc(t))计算一加速度权重值(Kacc(t)),其中,该加速度感测值(acc(t))是指该车辆当时直行方向加速度值;以及
一第四计算器程序,能根据该些轮速感测值(Vij(t))、该前次车速估计值(VCG(t-1))、该加速度感测值(acc(t))、该些轮速权重值(Kij(t))、该加速度权重值(Kacc(t))、以及一时间差(T)计算出该当时车速估计值(VCG(t))。
24.如权利要求23所述的计算器可读介质,其特征在于,在该第一计算器程序中,该些滑差值(Sij(t))是依下列算式计算:
当Vij(t)≥VCG(t-1),以及
当Vij(t)<VCG(t-1),
25.如权利要求24所述的计算器可读介质,其特征在于,在该第二计算器程序中,该些轮速权重值(Kij(t))是依下列算式计算:
当Sij(t)≥Smean(t),Kij(t)=0;以及
当Sij(t)<Smean(t),Kij(t)=a*Sij(t)+b,其中-2.5≤a≤-0.5,0.5≤b≤2。
26.如权利要求23所述的计算器可读介质,其特征在于,在该第三计算器程序中,该加速度权重值(Kacc(t))是依下列算式计算:
Kacc(t)=c*|acc(t)|+1,其中3≤c≤50。
27.如权利要求23的所述的计算器可读介质,其特征在于,在该第四计算器程序中,该当时车速估计值(VCG(t))是依下列算式计算:
28.如权利要求23所述的计算器可读介质,其特征在于,更包含一第五计算器程序,该第五计算器程序能根据该些轮速感测值(Vij(t))、一轮速阀值(Vth)、该前次车速估计值(VCG(t-1)、以及一车速阀值(VCGth)进行比对,当比对该些轮速感测值(Vij(t))皆小于一轮速阀值(Vth)、并且比对该前次车速估计值(VCG(t-1)小于该车速阀值(VCGth)时,则判断该车辆处于一起步模式,并将该第三计算器程序中该加速度权重值(Kacc(t))依下列算式计算:
Kacc(t)=0。
29.如权利要求28所述的计算器可读介质,其特征在于,该轮速阀值(Vth)介于0至5千米/小时之间,该车速阀值(VCGth)介于1至10千米/小时之间。
30.如权利要求29所述的计算器可读介质,其特征在于,在该第五计算器程序比对处于起步模式中有任一轮胎的轮速感测值(Vij(t))大于一轮速启动值(Vst)时,则判断该车辆离开该起步模式,在该加速度权重值计算的该加速度权重值(Kacc(t))依下列算式计算:
Kacc(t)=c*|acc(t)|+1,其中3≤c≤50。
31.如权利要求30所述的计算器可读介质,其特征在于,该轮速启动值(Vst)介于0至5千米/小时之间。
32.如权利要求23所述的计算器可读介质,其特征在于,更包含一第六计算器程序,该第六计算器程序能根据该车辆的一偏航角速度(Y(t))及一偏航角速度阀值(Yth)进行比对,当比对该车辆的该偏航角速度(Y(t))大于该偏航角速度阀值(Yth)时,则判断该车辆处于一弯道模式,并在该第一计算器程序中的该些滑差值(Sij(t))依下列算式计算,其中一轮速平均值(Vmean(t))是指当时该些轮速感测值(Vij(t))的平均值:
当Vij(t)≥Vmean(t),以及
当Vij(t)<Vmean(t),
33.如权利要求32所述的计算器可读介质,其特征在于,该偏航角速度阀值(Yth)介于2至8度之间。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710630710.6A CN109307782B (zh) | 2017-07-28 | 2017-07-28 | 车速估算装置、车速估算方法、及计算器可读介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710630710.6A CN109307782B (zh) | 2017-07-28 | 2017-07-28 | 车速估算装置、车速估算方法、及计算器可读介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109307782A true CN109307782A (zh) | 2019-02-05 |
CN109307782B CN109307782B (zh) | 2020-10-27 |
Family
ID=65205229
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710630710.6A Active CN109307782B (zh) | 2017-07-28 | 2017-07-28 | 车速估算装置、车速估算方法、及计算器可读介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109307782B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109866770A (zh) * | 2019-02-28 | 2019-06-11 | 重庆长安汽车股份有限公司 | 一种车辆自适应巡航控制方法、装置、系统及汽车 |
CN110031646A (zh) * | 2019-05-10 | 2019-07-19 | 北京工业大学 | 一种利用行车方向振动加速度修正行车速度方法 |
CN115097156A (zh) * | 2020-05-15 | 2022-09-23 | 北京百度网讯科技有限公司 | 一种自动驾驶中障碍物的速度估计方法、装置和电子设备 |
Citations (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4818037A (en) * | 1988-05-16 | 1989-04-04 | Hughes Aircraft Company | Method for estimating reference speed and acceleration for traction and anti-skid braking control |
JPH07218520A (ja) * | 1994-01-28 | 1995-08-18 | Toshiba Corp | 車両速度演算装置およびそれを用いた車両走行距離演算装置 |
CN1160851A (zh) * | 1995-07-04 | 1997-10-01 | 丰田自动车株式会社 | 在测得的车轮速度基础上测算机动车速度的装置 |
JPH10175528A (ja) * | 1996-12-20 | 1998-06-30 | Aisin Seiki Co Ltd | 車両旋回状態量推定装置 |
JP2001347937A (ja) * | 2000-06-05 | 2001-12-18 | Nisshinbo Ind Inc | 車輪速の補正方法 |
US20050182550A1 (en) * | 2004-02-12 | 2005-08-18 | Masahiro Matsuura | Braking force distribution control apparatus and method |
CN101509936A (zh) * | 2008-02-16 | 2009-08-19 | 威伯科有限公司 | 用于校准车轮速度的方法 |
CN101655504A (zh) * | 2009-09-09 | 2010-02-24 | 中国科学院电工研究所 | 一种机动车辆自适应巡航系统的车速估计方法 |
CN102171085A (zh) * | 2009-01-08 | 2011-08-31 | 株式会社小松制作所 | 车辆速度推算装置及牵引控制装置 |
KR20120071460A (ko) * | 2010-12-23 | 2012-07-03 | 한국건설기술연구원 | 차륜 회전속도 및 차량 속도를 이용한 노면 미끄럼 판단 장치 및 그 방법 |
JP2014010142A (ja) * | 2012-07-03 | 2014-01-20 | Kubota Corp | 車速検出装置及び車速検出装置のプログラム |
CN103523022A (zh) * | 2013-10-30 | 2014-01-22 | 吉林大学 | 混合动力汽车车速估计方法 |
CN104973067A (zh) * | 2014-04-10 | 2015-10-14 | 现代自动车株式会社 | 用于估算车速的装置和方法 |
CN105673830A (zh) * | 2016-01-15 | 2016-06-15 | 上海汽车变速器有限公司 | 自动变速器道路坡度识别方法及系统 |
CN106394561A (zh) * | 2015-11-10 | 2017-02-15 | 北京中科易电信息科技股份有限公司 | 一种车辆的纵向车速的估计方法和装置 |
-
2017
- 2017-07-28 CN CN201710630710.6A patent/CN109307782B/zh active Active
Patent Citations (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4818037A (en) * | 1988-05-16 | 1989-04-04 | Hughes Aircraft Company | Method for estimating reference speed and acceleration for traction and anti-skid braking control |
JPH07218520A (ja) * | 1994-01-28 | 1995-08-18 | Toshiba Corp | 車両速度演算装置およびそれを用いた車両走行距離演算装置 |
CN1160851A (zh) * | 1995-07-04 | 1997-10-01 | 丰田自动车株式会社 | 在测得的车轮速度基础上测算机动车速度的装置 |
JPH10175528A (ja) * | 1996-12-20 | 1998-06-30 | Aisin Seiki Co Ltd | 車両旋回状態量推定装置 |
JP2001347937A (ja) * | 2000-06-05 | 2001-12-18 | Nisshinbo Ind Inc | 車輪速の補正方法 |
US20050182550A1 (en) * | 2004-02-12 | 2005-08-18 | Masahiro Matsuura | Braking force distribution control apparatus and method |
CN101509936A (zh) * | 2008-02-16 | 2009-08-19 | 威伯科有限公司 | 用于校准车轮速度的方法 |
CN102171085A (zh) * | 2009-01-08 | 2011-08-31 | 株式会社小松制作所 | 车辆速度推算装置及牵引控制装置 |
CN103342127A (zh) * | 2009-01-08 | 2013-10-09 | 株式会社小松制作所 | 车辆速度推算装置及牵引控制装置 |
CN101655504A (zh) * | 2009-09-09 | 2010-02-24 | 中国科学院电工研究所 | 一种机动车辆自适应巡航系统的车速估计方法 |
KR20120071460A (ko) * | 2010-12-23 | 2012-07-03 | 한국건설기술연구원 | 차륜 회전속도 및 차량 속도를 이용한 노면 미끄럼 판단 장치 및 그 방법 |
JP2014010142A (ja) * | 2012-07-03 | 2014-01-20 | Kubota Corp | 車速検出装置及び車速検出装置のプログラム |
CN103523022A (zh) * | 2013-10-30 | 2014-01-22 | 吉林大学 | 混合动力汽车车速估计方法 |
CN104973067A (zh) * | 2014-04-10 | 2015-10-14 | 现代自动车株式会社 | 用于估算车速的装置和方法 |
CN106394561A (zh) * | 2015-11-10 | 2017-02-15 | 北京中科易电信息科技股份有限公司 | 一种车辆的纵向车速的估计方法和装置 |
CN105673830A (zh) * | 2016-01-15 | 2016-06-15 | 上海汽车变速器有限公司 | 自动变速器道路坡度识别方法及系统 |
Non-Patent Citations (5)
Title |
---|
CHUL KI SONG等: "《Vehicle Speed Estimation Using Accelerometer and Wheel Measurements》", 《SAE》 * |
HWANG J K等: "《Fuzzy Estimation of Vehicle Speed Using an Accelerometer and Wheel Sensors》", 《INTERNATIONAL JOURNAL OF AUTOMOTIVE TECHNOLOGY》 * |
刘国福: "《基于滑移率的车辆防抱死制动系统的研究》", 《中国博士学位论文全文数据库 工程科技Ⅱ辑》 * |
吴利军等: "《一种基于加速度及轮速信息的参考车速估计方法》", 《汽车技术》 * |
徐倜凡等: "《车辆纵向速度估算算法发展现状综述》", 《上海汽车》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109866770A (zh) * | 2019-02-28 | 2019-06-11 | 重庆长安汽车股份有限公司 | 一种车辆自适应巡航控制方法、装置、系统及汽车 |
CN110031646A (zh) * | 2019-05-10 | 2019-07-19 | 北京工业大学 | 一种利用行车方向振动加速度修正行车速度方法 |
CN115097156A (zh) * | 2020-05-15 | 2022-09-23 | 北京百度网讯科技有限公司 | 一种自动驾驶中障碍物的速度估计方法、装置和电子设备 |
CN115097156B (zh) * | 2020-05-15 | 2024-06-04 | 北京百度网讯科技有限公司 | 一种自动驾驶中障碍物的速度估计方法、装置和电子设备 |
Also Published As
Publication number | Publication date |
---|---|
CN109307782B (zh) | 2020-10-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112292271B (zh) | 胎面磨损监视方法、系统、电子控制单元和存储介质 | |
US10414405B2 (en) | Method for determining a limit speed for driving | |
CN112533775B (zh) | 胎面磨损监测系统和方法 | |
CN106347256B (zh) | 路面水淹推定装置 | |
US9821815B2 (en) | Estimating adhesion potential by assessing rolling radius | |
CN107933563B (zh) | 用于确定地面与车辆轮胎之间摩擦的方法和系统 | |
CN101405176B (zh) | 对驾驶方式敏感的车辆子系统控制方法和装置 | |
CN111868479B (zh) | 基于车辆测量数据处理的车辆操作 | |
CN103407451A (zh) | 一种道路纵向附着系数估计方法 | |
CN103661377A (zh) | 用于自动控制车辆速度的系统和方法 | |
CN109307782A (zh) | 车速估算装置、车速估算方法、及计算器可读介质 | |
CN113165614A (zh) | 轮胎刚度估计和道路摩擦力估计 | |
CN113044041A (zh) | 基于轮速及整车加速度的汽车车速及轮胎滑移率估计方法 | |
US11390292B2 (en) | Method for proposing a driving speed | |
CN107600074B (zh) | 车速测量方法和装置 | |
JP5002203B2 (ja) | タイヤ動荷重半径の基準値初期化方法 | |
CN101448660B (zh) | 轮胎气压下降警报方法 | |
TWI655435B (zh) | 車速估算裝置、車速估算方法、及其電腦程式產品 | |
CN118618395A (zh) | 轮胎侧偏刚度估算方法及装置、路面状态检测方法 | |
CN115092173A (zh) | 车辆间距安全预警方法、系统、电子设备及可读存储介质 | |
CN112345264A (zh) | 用于检查车辆动态模型的方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |