CN107585210A - 一种检测车辆方向盘转角的方法及装置 - Google Patents

Abstract

本发明提出一种检测车辆方向盘转角的方法及装置，采用车载智能终端MCU及其自带的3D加速度传感器，通过实时采集车辆加速度及速度等参数，计算出车轮转角，并间接检测车辆方向盘转角，在此基础上引入了低通数字滤波算法对采集到向心加速度进行滤波，使检测精度得到显著的提高。

Description

一种检测车辆方向盘转角的方法及装置

技术领域

本发明涉及车辆控制技术，具体涉及一种检测车辆方向盘转角的方法及装置。

背景技术

随着国家经济的发展，车辆保有量正以巨大的数字逐年增加，而车辆驾驶安全的问题也越发显得重要。疲劳驾驶是造成车辆行车安全隐患的重要原因之一，因此对疲劳驾驶的检测和预警成为目前各类商用车、乘用车需要扩展甚至标配的功能之一。

目前在一些疲劳驾驶检测方案中，需要采集车辆的方向盘转角数据，进而通过数学建模分析这些数据，从而判断驾驶员的驾驶状态。然而，目前很多商用车，尤其是载货车，绝大部分没有配备ESC(电子车身稳定控制系统)，通常也就无法检测到方向盘转角数据，如果加装方向盘转角传感器，通常成本高且安装十分不方便。

发明内容

为此，本发明提出一种检测车辆方向盘转角的方法及装置，采用车载智能终端及其自带的3D加速度传感器，在不增加硬件成本的前提下，实现了间接检测车辆方向盘转角。

具体方案如下：

一种检测车辆方向盘转角的方法，包括步骤

S1、标定重力影响矢量车辆前进方向矢量以及实际车辆侧向方向矢量并指定车辆左侧方向为负，车辆右侧方向为正：

S11、车辆静止并停在水平路面时，记录加速度传感器的读数，记为重力影响矢量

S12、车辆启动时，每经过时间t₁记录一次车速，并以不大于t₂的间隔记录加速度传感器的读数，记为加速度传感器读数矢量计算并记录水平面投影分量其中

是颠簸影响矢量，

当判断到连续t₃时间内为同向，且车速增加，则取该持续加速时间段中段时刻计算得到的记为车辆前进方向矢量

S13、车辆右拐弯时，以不大于t₂的间隔计算并记录车辆侧向方向矢量当判断到连续t₄时间内保持同向且不为0，则获取该持续转弯时间段t₄中段时刻计算得到的记为实际车辆侧向方向矢量满足关系：

S2、在行车过程中定时采集加速度传感器的数据，并计算

S3、根据公式计算车轮转角绝对值，其中L为车辆轴距，a_ce为在转弯半径方向上的投影，v为车辆速度，设当前转向轮方向上的加速度为a_f，a_f＝v₂-v₁，v₂和v₁为最近的间隔为t₁秒的瞬时车速，确定θ值的正负及转角方向，若则与同向，θ为正值，方向为右侧，若则与反向，θ为负值，方向为左侧；

S4、计算车辆方向盘转角α，其中α＝k·θ，系数k为车辆参数。

进一步的，所述的步骤S3还包括对a_ce值序列进行数字低通滤波的操作，并使用滤波后的a_ce值计算车轮转角绝对值。

一种检测车辆方向盘转角的装置，包括加速度传感器、MCU，所述的加速度传感器采集车辆加速度数据，所述的MCU包括标定模块，用于标定重力影响矢量车辆前进方向矢量以及实际车辆侧向方向矢量并指定车辆左侧方向为负，车辆右侧方向为正：车辆静止并停在水平路面时，记录加速度传感器的读数，记为重力影响矢量车辆启动时，每经过时间t₁记录一次车速，并以不大于t₂的间隔记录加速度传感器的读数，记为加速度传感器读数矢量计算并记录水平面投影分量其中

是颠簸影响矢量，

当判断到连续t₃时间内为同向，且车速增加，则取该持续加速时间段中段时刻计算得到的记为车辆前进方向矢量车辆右拐弯时，以不大于t₂的间隔计算并记录车辆侧向方向矢量当判断到连续t₄时间内保持同向且不为0，则获取该持续转弯时间段t₄中段时刻计算得到的记为实际车辆侧向方向矢量满足关系：

定时采集计算模块，用于在行车过程中定时采集加速度传感器的数据，并计算

车轮转角计算模块，用于根据公式计算车轮转角绝对值，其中L为车辆轴距，a_ce为在转弯半径方向上的投影，v为车辆速度，设当前转向轮方向上的加速度为a_f，a_f＝v₂-v₁，v₂和v₁为最近的间隔为t₁秒的瞬时车速，确定θ值的正负及转角方向，若则与同向，θ为正值，方向为右侧，若则与反向，θ为负值，方向为左侧，

车辆方向盘转角计算模块，用于计算车辆方向盘转角α，其中α＝k·θ，系数k为车辆参数。

进一步的，所述的车轮转角计算模块还包括一数字滤波模块，用于对a_ce值序列进行低通滤波，并使用滤波后的a_ce值计算车轮转角绝对值。

本发明具有如下有益效果：本发明使用车载终端现有的硬件资源，在基本不增加成本的情况下，实现间接检测车辆方向盘转角；引入了低通数字滤波算法对采集到向心加速度进行滤波，使检测精度得到显著的提高。

附图说明

图1为本发明方法的流程图；

图2为本发明车辆加速度矢量关系图；

图3为本发明车辆方向矢量关系图；

图4为本发明车辆前轮转向角和转向半径几何关系图；

图5(a)为本发明一实施例a_ce值序列低通滤波前图像；

图5(b)为本发明一实施例a_ce值序列低通滤波后图像。

具体实施方式

为进一步说明各实施例，本发明提供有附图。这些附图为本发明揭露内容的一部分，其主要用以说明实施例，并可配合说明书的相关描述来解释实施例的运作原理。配合参考这些内容，本领域普通技术人员应能理解其他可能的实施方式以及本发明的优点。现结合附图和具体实施方式对本发明进一步说明。

图1为本发明检测车辆方向盘转角的方法的主要流程，首先标定重力影响矢量车辆前进方向矢量以及实际车辆侧向方向矢量其次定时采集加速度传感器的数据，并计算水平面投影分量然后计算车轮转角计算车轮转角并确定转角方向，最后计算车辆方向盘转角。

参阅图2，其中加速度传感器读数矢量水平面投影分量水平面投影分量颠簸影响矢量重力影响矢量满足如图的关系：即：

参阅图3，水平面投影分量和车辆前进方向矢量车辆侧向方向矢量车辆前进方向矢量分量满足如下图的关系：

标定重力影响矢量和车辆前进方向矢量以及实际车辆侧向方向矢量并指定左侧为负，右侧为正，标定的具体步骤：

1)将车辆静止停在水平路面上，通过串口发送命令触发车载终端记录当前3D加速度传感器的三轴读数，记录为重力影响矢量

2)操纵车辆从静止向正前方加速，车载终端以1秒的间隔记录车速，以不大于0.2s的间隔计算并记录当判断到连续2秒内(即连续采集到10次以上)为同向，且车速增加，则取该持续加速时间段中段时刻计算得到的记为车辆前进方向矢量

3)操纵车辆在行驶中进行右拐弯，车载终端以不大于0.2s的间隔计算并记录当判断到连续2秒内(即连续采集到10次以上)保持同向且不为0，则去该持续转弯时间段中段时刻计算得到的记为车辆侧向方向矢量

本领域的相关技术人员可以知道的是，本实施例中的采集及计算数据的间隔时间经过多次实验得出的较为合理的数据，对于时间的数值可以做适当的微调。

根据阿克曼转向原理，参阅图4，为车辆前轮转向角和转向半径R几何关系，其中L为轴距，d为轮距，则有：

其中a_ce为在转弯半径方向上的投影，设当前转向轮方向上的加速度为a_f，a_f＝v₂-v₁，v₂和v₁为最近的间隔为1秒的瞬时车速，则有：

由上述公式计算得到的θ为车轮转角的绝对值，其符号由与的关系确定，判断规则如下：

1)若则表示与同向，即θ为正值；

2)若则表示与反向，即θ为负值；

车辆方向盘转角α和车轮转向角存在一个近似固定的比例关系：α＝k·θ，系数k可从车辆厂商查询到或直接通过实验测试得到。

由于车辆自身振动或路面颠簸等原因，从传感器读取到的加速度值存在多种频段的干扰因素，为了排除这些干扰因素，提高参与数学建模数据的有效性和数据分析结果的准确性，本发明引入了Butterworth数字低通滤波算法，对计算得到的α_ce值序列进行低通滤波，由于人为操作导致车辆左右波动的频率远小于振动或路面颠簸引起的左右晃动频率，经反复测试验证，优选了滤波算法中rp、rs参数分别为2和8，wp、ws参数分别为0.1和0.2，即通带频率为0～0.5HZ，阻带频率为1HZ以上，使滤波后的曲线最接近于实际波形。

结合图5(a)及图5(b)，给出了一段实际采样数据滤波前后的波形图对比，对比可知，经过滤波后，干扰杂波已基本被滤除，再用滤波后的数据进行分析计算，可大大提高了分析结果的准确性。

基于上述的方法，本发明还提出一种检测车辆方向盘转角的装置，包括加速度传感器、MCU，所述的加速度传感器采集车辆加速度数据，所述的MCU包括标定模块，用于标定重力影响矢量车辆前进方向矢量以及实际车辆侧向方向矢量并指定车辆左侧方向为负，车辆右侧方向为正：车辆静止并停在水平路面时，记录加速度传感器的读数，记为重力影响矢量车辆启动时，每经过时间t₁记录一次车速，并以不大于t₂的间隔记录加速度传感器的读数，记为加速度传感器读数矢量计算并记录水平面投影分量其中

是颠簸影响矢量，当判断到连续t₃时间内为同向，且车速增加，则取该持续加速时间段中段时刻计算得到的记为车辆前进方向矢量车辆右拐弯时，以不大于t₂的间隔计算并记录车辆侧向方向矢量当判断到连续t₄时间内保持同向且不为0，则获取该持续转弯时间段t₄中段时刻计算得到的记为实际车辆侧向方向矢量满足关系：

定时采集计算模块，用于在行车过程中定时采集加速度传感器的数据，并计算

车轮转角计算模块，用于根据公式计算车轮转角绝对值，其中L为车辆轴距，a_ce为在转弯半径方向上的投影，v为车辆速度，设当前转向轮方向上的加速度为a_f，a_f＝v₂-v₁，v₂和v₁为最近的间隔为t₁秒的瞬时车速，确定θ值的正负及转角方向，若则与同向，θ为正值，方向为右侧，若则与反向，θ为负值，方向为左侧，

车辆方向盘转角计算模块，用于计算车辆方向盘转角α，其中α＝k·θ，系数k为车辆参数。

进一步的，所述的车轮转角计算模块还包括一数字滤波模块，用于对a_ce值序列进行低通滤波，并使用滤波后的a_ce值计算车轮转角绝对值。

尽管结合优选实施方案具体展示和介绍了本发明，但所属领域的技术人员应该明白，在不脱离所附权利要求书所限定的本发明的精神和范围内，在形式上和细节上可以对本发明做出各种变化，均为本发明的保护范围。

Claims (4)

1.一种检测车辆方向盘转角的方法，其特征在于：包括步骤

S1、标定重力影响矢量车辆前进方向矢量以及实际车辆侧向方向矢量并指定车辆左侧方向为负，车辆右侧方向为正：

S11、车辆静止并停在水平路面时，记录加速度传感器的读数，记为重力影响矢量

S12、车辆启动时，每经过时间t₁记录一次车速，并以不大于t₂的间隔记录加速度传感器的读数，记为加速度传感器读数矢量计算并记录水平面投影分量其中

是颠簸影响矢量，

当判断到连续t₃时间内为同向，且车速增加，则取该持续加速时间段中段时刻计算得到的记为车辆前进方向矢量

S13、车辆右拐弯时，以不大于t₂的间隔计算并记录车辆侧向方向矢量当判断到连续t₄时间内保持同向且不为0，则获取该持续转弯时间段t₄中段时刻计算得到的记为实际车辆侧向方向矢量满足关系：

S2、在行车过程中定时采集加速度传感器的数据，并计算

S3、根据公式计算车轮转角绝对值，其中L为车辆轴距，a_ce为在转弯半径方向上的投影，v为车辆速度，设当前转向轮方向上的加速度为a_f，a_f＝v₂-v₁，v₂和v₁为最近的间隔为t₁秒的瞬时车速，确定θ值的正负及转角方向，若则与同向，θ为正值，方向为右侧，若则与反向，θ为负值，方向为左侧；

S4、计算车辆方向盘转角α，其中α＝k·θ，系数k为车辆参数。

2.根据权利要求1所述的方法，其特征在于：所述的步骤S3还包括对a_ce值序列进行数字低通滤波的操作，并使用滤波后的a_ce值计算车轮转角绝对值。

3.一种检测车辆方向盘转角的装置，包括加速度传感器、MCU，所述的加速度传感器采集车辆加速度数据，所述的MCU包括标定模块，用于标定重力影响矢量车辆前进方向矢量以及实际车辆侧向方向矢量并指定车辆左侧方向为负，车辆右侧方向为正：车辆静止并停在水平路面时，记录加速度传感器的读数，记为重力影响矢量车辆启动时，每经过时间t₁记录一次车速，并以不大于t₂的间隔记录加速度传感器的读数，记为加速度传感器读数矢量计算并记录水平面投影分量其中

是颠簸影响矢量，

当判断到连续t₃时间内为同向，且车速增加，则取该持续加速时间段中段时刻计算得到的记为车辆前进方向矢量车辆右拐弯时，以不大于t₂的间隔计算并记录车辆侧向方向矢量当判断到连续t₄时间内保持同向且不为0，则获取该持续转弯时间段t₄中段时刻计算得到的记为实际车辆侧向方向矢量满足关系：

定时采集计算模块，用于在行车过程中定时采集加速度传感器的数据，并计算

车轮转角计算模块，用于根据公式计算车轮转角绝对值，其中L为车辆轴距，a_ce为在转弯半径方向上的投影，v为车辆速度，设当前转向轮方向上的加速度为a_f，a_f＝v₂-v₁，v₂和v₁为最近的间隔为t₁秒的瞬时车速，确定θ值的正负及转角方向，若则与同向，θ为正值，方向为右侧，若则与反向，θ为负值，方向为左侧，

车辆方向盘转角计算模块，用于计算车辆方向盘转角α，其中：α＝k·θ系数k为车辆参数。

4.根据权利要求3所述的装置，其特征在于：所述的车轮转角计算模块还包括一数字滤波模块，用于对a_ce值序列进行低通滤波，并使用滤波后的a_ce值计算车轮转角绝对值。