CN107585210B - 一种检测车辆方向盘转角的方法及装置 - Google Patents
一种检测车辆方向盘转角的方法及装置 Download PDFInfo
- Publication number
- CN107585210B CN107585210B CN201610530734.XA CN201610530734A CN107585210B CN 107585210 B CN107585210 B CN 107585210B CN 201610530734 A CN201610530734 A CN 201610530734A CN 107585210 B CN107585210 B CN 107585210B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- vector
- calculating
- time
- recorded
- 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
Images
Landscapes
- Steering Control In Accordance With Driving Conditions (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Abstract
本发明提出一种检测车辆方向盘转角的方法及装置,采用车载智能终端MCU及其自带的3D加速度传感器,通过实时采集车辆加速度及速度等参数,计算出车轮转角,并间接检测车辆方向盘转角,在此基础上引入了低通数字滤波算法对采集到向心加速度进行滤波,使检测精度得到显著的提高。
Description
技术领域
本发明涉及车辆控制技术,具体涉及一种检测车辆方向盘转角的方法及装置。
背景技术
随着国家经济的发展,车辆保有量正以巨大的数字逐年增加,而车辆驾驶安全的问题也越发显得重要。疲劳驾驶是造成车辆行车安全隐患的重要原因之一,因此对疲劳驾驶的检测和预警成为目前各类商用车、乘用车需要扩展甚至标配的功能之一。
目前在一些疲劳驾驶检测方案中,需要采集车辆的方向盘转角数据,进而通过数学建模分析这些数据,从而判断驾驶员的驾驶状态。然而,目前很多商用车,尤其是载货车,绝大部分没有配备ESC(电子车身稳定控制***),通常也就无法检测到方向盘转角数据,如果加装方向盘转角传感器,通常成本高且安装十分不方便。
发明内容
为此,本发明提出一种检测车辆方向盘转角的方法及装置,采用车载智能终端及其自带的3D加速度传感器,在不增加硬件成本的前提下,实现了间接检测车辆方向盘转角。
具体方案如下:
一种检测车辆方向盘转角的方法,包括步骤
S3、根据公式计算车轮转角绝对值,其中L为车辆轴距,ace为在转弯半径方向上的投影,v为车辆速度,设当前转向轮方向上的加速度为af,af=v2-v1,v2和v1为最近的间隔为t1秒的瞬时车速,确定θ值的正负及转角方向,若则与同向,θ为正值,方向为右侧,若则与反向,θ为负值,方向为左侧;
S4、计算车辆方向盘转角α,其中α=k·θ,系数k为车辆参数。
进一步的,所述的步骤S3还包括对ace值序列进行数字低通滤波的操作,并使用滤波后的ace值计算车轮转角绝对值。
一种检测车辆方向盘转角的装置,包括加速度传感器、MCU,所述的加速度传感器采集车辆加速度数据,所述的MCU包括标定模块,用于标定重力影响矢量车辆前进方向矢量以及实际车辆侧向方向矢量并指定车辆左侧方向为负,车辆右侧方向为正:车辆静止并停在水平路面时,记录加速度传感器的读数,记为重力影响矢量车辆启动时,每经过时间t1记录一次车速,并以不大于t2的间隔记录加速度传感器的读数,记为加速度传感器读数矢量计算并记录水平面投影分量其中
当判断到连续t3时间内为同向,且车速增加,则取该持续加速时间段中段时刻计算得到的记为车辆前进方向矢量车辆右拐弯时,以不大于t2的间隔计算并记录车辆侧向方向矢量当判断到连续t4时间内保持同向且不为0,则获取该持续转弯时间段t4中段时刻计算得到的记为实际车辆侧向方向矢量满足关系:
车轮转角计算模块,用于根据公式计算车轮转角绝对值,其中L为车辆轴距,ace为在转弯半径方向上的投影,v为车辆速度,设当前转向轮方向上的加速度为af,af=v2-v1,v2和v1为最近的间隔为t1秒的瞬时车速,确定θ值的正负及转角方向,若则与同向,θ为正值,方向为右侧,若则与反向,θ为负值,方向为左侧,
车辆方向盘转角计算模块,用于计算车辆方向盘转角α,其中α=k·θ,系数k为车辆参数。
进一步的,所述的车轮转角计算模块还包括一数字滤波模块,用于对ace值序列进行低通滤波,并使用滤波后的ace值计算车轮转角绝对值。
本发明具有如下有益效果:本发明使用车载终端现有的硬件资源,在基本不增加成本的情况下,实现间接检测车辆方向盘转角;引入了低通数字滤波算法对采集到向心加速度进行滤波,使检测精度得到显著的提高。
附图说明
图1为本发明方法的流程图;
图2为本发明车辆加速度矢量关系图;
图3为本发明车辆方向矢量关系图;
图4为本发明车辆前轮转向角和转向半径几何关系图;
图5(a)为本发明一实施例ace值序列低通滤波前图像;
图5(b)为本发明一实施例ace值序列低通滤波后图像。
具体实施方式
为进一步说明各实施例,本发明提供有附图。这些附图为本发明揭露内容的一部分,其主要用以说明实施例,并可配合说明书的相关描述来解释实施例的运作原理。配合参考这些内容,本领域普通技术人员应能理解其他可能的实施方式以及本发明的优点。现结合附图和具体实施方式对本发明进一步说明。
图1为本发明检测车辆方向盘转角的方法的主要流程,首先标定重力影响矢量车辆前进方向矢量以及实际车辆侧向方向矢量其次定时采集加速度传感器的数据,并计算水平面投影分量然后计算车轮转角计算车轮转角并确定转角方向,最后计算车辆方向盘转角。
2)操纵车辆从静止向正前方加速,车载终端以1秒的间隔记录车速,以不大于0.2s的间隔计算并记录当判断到连续2秒内(即连续采集到10次以上)为同向,且车速增加,则取该持续加速时间段中段时刻计算得到的记为车辆前进方向矢量
本领域的相关技术人员可以知道的是,本实施例中的采集及计算数据的间隔时间经过多次实验得出的较为合理的数据,对于时间的数值可以做适当的微调。
车辆方向盘转角α和车轮转向角存在一个近似固定的比例关系:α=k·θ,系数k可从车辆厂商查询到或直接通过实验测试得到。
由于车辆自身振动或路面颠簸等原因,从传感器读取到的加速度值存在多种频段的干扰因素,为了排除这些干扰因素,提高参与数学建模数据的有效性和数据分析结果的准确性,本发明引入了Butterworth数字低通滤波算法,对计算得到的αce值序列进行低通滤波,由于人为操作导致车辆左右波动的频率远小于振动或路面颠簸引起的左右晃动频率,经反复测试验证,优选了滤波算法中rp、rs参数分别为2和8,wp、ws参数分别为0.1和0.2,即通带频率为0~0.5HZ,阻带频率为1HZ以上,使滤波后的曲线最接近于实际波形。
结合图5(a)及图5(b),给出了一段实际采样数据滤波前后的波形图对比,对比可知,经过滤波后,干扰杂波已基本被滤除,再用滤波后的数据进行分析计算,可大大提高了分析结果的准确性。
基于上述的方法,本发明还提出一种检测车辆方向盘转角的装置,包括加速度传感器、MCU,所述的加速度传感器采集车辆加速度数据,所述的MCU包括标定模块,用于标定重力影响矢量车辆前进方向矢量以及实际车辆侧向方向矢量并指定车辆左侧方向为负,车辆右侧方向为正:车辆静止并停在水平路面时,记录加速度传感器的读数,记为重力影响矢量车辆启动时,每经过时间t1记录一次车速,并以不大于t2的间隔记录加速度传感器的读数,记为加速度传感器读数矢量计算并记录水平面投影分量其中
是颠簸影响矢量,当判断到连续t3时间内为同向,且车速增加,则取该持续加速时间段中段时刻计算得到的记为车辆前进方向矢量车辆右拐弯时,以不大于t2的间隔计算并记录车辆侧向方向矢量当判断到连续t4时间内保持同向且不为0,则获取该持续转弯时间段t4中段时刻计算得到的记为实际车辆侧向方向矢量满足关系:
车轮转角计算模块,用于根据公式计算车轮转角绝对值,其中L为车辆轴距,ace为在转弯半径方向上的投影,v为车辆速度,设当前转向轮方向上的加速度为af,af=v2-v1,v2和v1为最近的间隔为t1秒的瞬时车速,确定θ值的正负及转角方向,若则与同向,θ为正值,方向为右侧,若则与反向,θ为负值,方向为左侧,
车辆方向盘转角计算模块,用于计算车辆方向盘转角α,其中α=k·θ,系数k为车辆参数。
进一步的,所述的车轮转角计算模块还包括一数字滤波模块,用于对ace值序列进行低通滤波,并使用滤波后的ace值计算车轮转角绝对值。
尽管结合优选实施方案具体展示和介绍了本发明,但所属领域的技术人员应该明白,在不脱离所附权利要求书所限定的本发明的精神和范围内,在形式上和细节上可以对本发明做出各种变化,均为本发明的保护范围。
Claims (4)
1.一种检测车辆方向盘转角的方法,其特征在于:包括步骤
S3、根据公式计算车轮转角绝对值,其中L为车辆轴距,ace为在转弯半径方向上的投影,v为车辆速度,设当前转向轮方向上的加速度为af,af=(v2-v1)/t1,v2和v1为最近的间隔为t1秒的瞬时车速,确定θ值的正负及转角方向,若则与同向,θ为正值,方向为右侧,若则与反向,θ为负值,方向为左侧;
S4、计算车辆方向盘转角α,其中α=k·θ,系数k为车辆参数。
2.根据权利要求1所述的方法,其特征在于:所述的步骤S3还包括对ace值序列进行数字低通滤波的操作,并使用滤波后的ace值计算车轮转角绝对值。
3.一种检测车辆方向盘转角的装置,包括加速度传感器、MCU,所述的加速度传感器采集车辆加速度数据,所述的MCU包括标定模块,用于标定重力影响矢量车辆前进方向矢量以及实际车辆侧向方向矢量并指定车辆左侧方向为负,车辆右侧方向为正:车辆静止并停在水平路面时,记录加速度传感器的读数,记为重力影响矢量车辆启动时,每经过时间t1记录一次车速,并以不大于t2的间隔记录加速度传感器的读数,记为加速度传感器读数矢量计算并记录水平面投影分量其中 是颠簸影响矢量,
当判断到连续t3时间内为同向,且车速增加,则取该持续加速时间段中段时刻计算得到的记为车辆前进方向矢量车辆右拐弯时,以不大于t2的间隔计算并记录车辆侧向方向矢量当判断到连续t4时间内保持同向且不为0,则获取该持续转弯时间段t4中段时刻计算得到的记为实际车辆侧向方向矢量满足关系:
车轮转角计算模块,用于根据公式计算车轮转角绝对值,其中L为车辆轴距,ace为在转弯半径方向上的投影,v为车辆速度,设当前转向轮方向上的加速度为af,af=(v2-v1)/t1,v2和v1为最近的间隔为t1秒的瞬时车速,确定θ值的正负及转角方向,若则与同向,θ为正值,方向为右侧,若则与反向,θ为负值,方向为左侧,
车辆方向盘转角计算模块,用于计算车辆方向盘转角α,其中:α=k·θ,系数k为车辆参数。
4.根据权利要求3所述的装置,其特征在于:所述的车轮转角计算模块还包括一数字滤波模块,用于对ace值序列进行低通滤波,并使用滤波后的ace值计算车轮转角绝对值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610530734.XA CN107585210B (zh) | 2016-07-07 | 2016-07-07 | 一种检测车辆方向盘转角的方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610530734.XA CN107585210B (zh) | 2016-07-07 | 2016-07-07 | 一种检测车辆方向盘转角的方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107585210A CN107585210A (zh) | 2018-01-16 |
CN107585210B true CN107585210B (zh) | 2020-06-19 |
Family
ID=61045583
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610530734.XA Active CN107585210B (zh) | 2016-07-07 | 2016-07-07 | 一种检测车辆方向盘转角的方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107585210B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109552405B (zh) * | 2018-12-19 | 2021-02-05 | 西安科技大学 | 一种汽车全方位自动泊车方法 |
CN109916362B (zh) * | 2019-03-04 | 2021-01-19 | 武汉理工大学 | 一种方向盘转动角度的检测方法及*** |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1568570A3 (de) * | 2004-02-28 | 2006-06-21 | ZF Lenksysteme GmbH | Berechnung eines Radwinkels eines Fahrzeugs |
CN101326094A (zh) * | 2005-10-15 | 2008-12-17 | 天宝导航有限公司 | 基于转向组件角度及角速率传感器的车辆陀螺仪 |
WO2012052688A1 (fr) * | 2010-10-22 | 2012-04-26 | Peugeot Citroën Automobiles SA | Procede et systeme de redondance d'un signal de mesure d'un capteur d'angle du volant |
CN103097213A (zh) * | 2010-09-09 | 2013-05-08 | 大陆-特韦斯贸易合伙股份公司及两合公司 | 机动车辆转向角的确定 |
DE102011087670A1 (de) * | 2011-12-02 | 2013-06-06 | Zf Friedrichshafen Ag | Verfahren und Vorrichtung zum Bestimmen eines Fahrparameters und Verfahren und Vorrichtung zum Steuern eines Antriebsstrangs eines Fahrzeugs |
KR101332651B1 (ko) * | 2011-12-01 | 2013-11-26 | 한국타이어 주식회사 | 스티어링 휠 각도 측정장치 |
CN103632062A (zh) * | 2013-12-06 | 2014-03-12 | 北京乾图方园软件技术有限公司 | 一种利用加速度传感器和陀螺进行车辆行驶上下坡状态判定的方法和装置 |
CN105523084A (zh) * | 2015-12-07 | 2016-04-27 | 厦门雅迅网络股份有限公司 | 一种基于三轴加速度传感器检测车辆转弯角度的方法 |
-
2016
- 2016-07-07 CN CN201610530734.XA patent/CN107585210B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1568570A3 (de) * | 2004-02-28 | 2006-06-21 | ZF Lenksysteme GmbH | Berechnung eines Radwinkels eines Fahrzeugs |
CN101326094A (zh) * | 2005-10-15 | 2008-12-17 | 天宝导航有限公司 | 基于转向组件角度及角速率传感器的车辆陀螺仪 |
CN103097213A (zh) * | 2010-09-09 | 2013-05-08 | 大陆-特韦斯贸易合伙股份公司及两合公司 | 机动车辆转向角的确定 |
WO2012052688A1 (fr) * | 2010-10-22 | 2012-04-26 | Peugeot Citroën Automobiles SA | Procede et systeme de redondance d'un signal de mesure d'un capteur d'angle du volant |
KR101332651B1 (ko) * | 2011-12-01 | 2013-11-26 | 한국타이어 주식회사 | 스티어링 휠 각도 측정장치 |
DE102011087670A1 (de) * | 2011-12-02 | 2013-06-06 | Zf Friedrichshafen Ag | Verfahren und Vorrichtung zum Bestimmen eines Fahrparameters und Verfahren und Vorrichtung zum Steuern eines Antriebsstrangs eines Fahrzeugs |
CN103632062A (zh) * | 2013-12-06 | 2014-03-12 | 北京乾图方园软件技术有限公司 | 一种利用加速度传感器和陀螺进行车辆行驶上下坡状态判定的方法和装置 |
CN105523084A (zh) * | 2015-12-07 | 2016-04-27 | 厦门雅迅网络股份有限公司 | 一种基于三轴加速度传感器检测车辆转弯角度的方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107585210A (zh) | 2018-01-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106875510B (zh) | 一种车辆侧翻预警方法和*** | |
CN106004515B (zh) | 用于电动汽车自动泊车的车速控制方法及*** | |
EP2380766A1 (en) | Impaired Operation Detection Method and Impaired Operation Detection System | |
CN103578227B (zh) | 基于gps定位信息的疲劳驾驶检测方法 | |
CN105181086B (zh) | 一种汽车油量检测方法和装置 | |
RU2679299C2 (ru) | Система и способ для обнаружения опасного вождения и компьютер транспортного средства | |
JPH05133831A (ja) | タイヤ空気圧検知装置 | |
JP4617371B2 (ja) | タイヤ空気圧低下検出装置および方法、ならびにタイヤの空気圧低下検出プログラム | |
CN102700551A (zh) | 一种车辆行驶过程中路面坡度的实时估计方法 | |
CN103786730B (zh) | 测量车辆转弯过程中的倾斜角的方法和*** | |
CN107585210B (zh) | 一种检测车辆方向盘转角的方法及装置 | |
DE102015202628A1 (de) | Vehicle-mounted apparatus for selecting preceding vehicle positioned in the travel path of the host vehicle of the apparatus | |
JP5649625B2 (ja) | タイヤ空気圧低下検出装置、方法及びプログラム | |
JP2017537018A (ja) | グリップ喪失状況の検出方法 | |
US8862311B2 (en) | System and method for measuring inclination of vehicle | |
CN111006884B (zh) | 基于傅立叶变换的车轮车轴侧偏角与侧偏刚度的测量方法 | |
CN109895694B (zh) | 一种车道偏离预警方法、装置及车辆 | |
JP3052013B2 (ja) | ハイドロプレーニング検出装置 | |
CN108122298B (zh) | 提高车辆方向盘转角数据准确度的方法及*** | |
JP4354607B2 (ja) | ドリフト除去装置及びドリフト除去方法、移動体の挙動検出センサ。 | |
Mangan et al. | Measurement of the road gradient using an inclinometer mounted on a moving vehicle | |
CN109624855A (zh) | 自动泊车的停止位置确定方法及装置、电子设备和计算机可读介质 | |
CN113674451B (zh) | 测试自动驾驶车辆感知延时性能的方法与装置 | |
US20230154013A1 (en) | Computer vision system for object tracking and time-to-collision | |
CN112319485B (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 |