CN106915348B - 一种用于车道偏离预警的驾驶辅助系统 - Google Patents
一种用于车道偏离预警的驾驶辅助系统 Download PDFInfo
- Publication number
- CN106915348B CN106915348B CN201710084214.5A CN201710084214A CN106915348B CN 106915348 B CN106915348 B CN 106915348B CN 201710084214 A CN201710084214 A CN 201710084214A CN 106915348 B CN106915348 B CN 106915348B
- Authority
- CN
- China
- Prior art keywords
- driving lever
- acceleration
- state
- automobile
- rotation direction
- 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
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
- B60W30/10—Path keeping
- B60W30/12—Lane keeping
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/107—Longitudinal acceleration
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/109—Lateral acceleration
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/0097—Predicting future conditions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/10—Longitudinal speed
- B60W2520/105—Longitudinal acceleration
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/12—Lateral speed
- B60W2520/125—Lateral acceleration
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2710/00—Output or target parameters relating to a particular sub-units
- B60W2710/20—Steering systems
Abstract
本发明涉及一种用于车道偏离预警的驾驶辅助系统,包括:稳像架、用于获得车辆转向状态的转向传感器、安装在稳像架上的驾驶辅助装置;所述转向传感器固定设置在转向拨杆前端,所述驾驶辅助装置包括GSP传感器、摄像头、蓝牙数据收发模块;所述转向传感器与驾驶辅助装置通过蓝牙通信,向驾驶辅助装置发送转向传感器获得的转向状态。本发明驾驶辅助系统不需要对汽车部件拆卸、破线等处理,对汽车转向状态判断通过使用加速度计方案检测汽车转向拨杆的状态;本发明驾驶辅助系统成本低、安装方便,即用即装。
Description
技术领域
本发明涉及车辆辅助驾驶技术,尤其涉及一种用于车道偏离预警的驾驶辅助系统。
背景技术
目前实现专业辅助驾驶的方向主要有以下2种:
1、前装高端车辆,像奔驰、沃尔沃、宝马等,出厂自带高级辅助驾驶功能。
2、后装产品,像专业的Mobileye560车祸防御主动安全驾驶辅助智能防撞系统,以及国内的初创公司中科慧眼、地平线等。
以上两种方案开发成本高、安装维护成本高,平民车主是无法体验和了解辅助驾驶系统。所以,提供一种简单方便低成本解决方案非常有必要。
发明内容
本发明要解决的技术问题在于针对现有技术中的缺陷,提供一种用于车道偏离预警的驾驶辅助系统。
本发明解决其技术问题所采用的技术方案是:
一种用于车道偏离预警的驾驶辅助系统,包括:用于检测汽车拨杆位置的转向传感器装置和驾驶辅助装置;所述转向传感器装置固定设置在转向拨杆前端;所述转向传感器装置与驾驶辅助装置无线通信,转向传感器装置向驾驶辅助装置发送转向传感器获得的转向状态。
按上述方案,所述驾驶辅助装置包括GSP传感器、摄像头、无线数据收发模块。
按上述方案,所述用于检测汽车拨杆位置的转向传感器装置,包括:
加速度传感器,用于检测并采集汽车拨动转向拨杆时产生的加速度;所述加速度传感器为安装在汽车转向拨杆上的三轴加速度计;
标定单元,用于加速度传感器安装完成后,通过标定步骤,记录拨杆处于上、中、下三个位置时对应的三轴加速度数据;
标定单元工作步骤如下:
标定时,汽车在平直路面上处于静止状态,打开标定采集开关后等待设定时间,保存此时汽车拨杆的位置,加速度计的加速度值;
改变汽车拨杆的位置,打开标定采集开关后等待1s,保存此时汽车拨杆的位置和加速度计的加速度值,完成全部位置的加速度数据采集;
汽车转向状态判断单元,用于根据姿态角判断汽车拨杆的状态,进而判断出汽车转向状态;所述姿态角为三轴加速度传感器的笛卡尔坐标系与大地笛卡尔坐标系的角度值;
具体步骤如下:
1)运动姿态角初始化:根据标定单元的结果计算拨杆各位置间运动姿态角,即旋转矩阵;
其中,
和为拨杆两个相邻位置的标定的三轴加速度值矩阵,采用的是标定数据;M为一3×3阶旋转矩阵,其中包含拨杆两位置间运动信息;
初始化计算后,将得到拨杆各位置间运动的一系列旋转矩阵;
3)计算并判别:将上一步骤计算得出的一系列旋转矩阵依次与前一拨杆状态时记录的加速度数据矩阵点乘;得到的结果依次与当前拨杆状态的加速度矩阵进行对比,计算两矩阵空间夹角,将空间夹角最小者所对应的旋转矩阵作为车辆转向状态判断依据;
4)保存数据:将当前拨杆位置的加速度数据存储,作为下次计算的前一拨杆位置加速度数据。
上述步骤中,标定和初始化步骤在车辆静态时,一次完成;车辆运动时,反复进行步骤3)和步骤4)运算,以判断车辆转向意图。
按上述方案,所述标定单元中标定时,汽车在平直路面上处于静止状态,打开标定采集开关后等待设定时间为1s。
按上述方案,所述转向传感器装置还包括预处理单元,所述预处理单元用于处理加速度传感器中采集的原始数据,消除汽车震动对加速度计的干扰。
按上述方案,所述所述预处理单元数据处理的具体步骤如下:
定时采样三个轴的加速度值,采集到一个长度为M的序列后,开始判断静态点;其中M为大于3的整数;判断找到静态点的条件如下:
1、M序列中,X轴任意两点的差值小于设定阈值;
2、M序列中,Y轴任意两点的差值小于设定阈值;
3、M序列中,Z轴任意两点的差值小于设定阈值;
然后将每个轴中的M个点取平均值,就得到了当前的加速度值,然后利用该值去判断汽车拨杆状态。
本发明产生的有益效果是:
1.目前业界关于汽车转向状态判断主要通过破线接入汽车CAN总线提取转向状态,该方案通过使用加速度计方案检测汽车转向拨杆的状态。
2、本方案不需要对汽车部件拆卸、破线等处理。
3、本方案成本低、安装快,即用即装。
4、本方案可以废旧立新,让大量旧手机变废为宝。
5、本方案可以教育更多用户去了解辅助驾驶系统的作用。
6、本方案结合图像、加速度、陀螺仪、GPS多传感器实现驾驶辅助,比现有单一图像传感器更好的辅助决策。
附图说明
下面将结合附图及实施例对本发明作进一步说明,附图中:
图1是本发明实施例的结构示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。
如图1所示,一种用于车道偏离预警的驾驶辅助系统,包括用于检测汽车拨杆位置的转向传感器装置3和安装在稳像架1上的驾驶辅助装置2;所述转向传感器装置固定设置在转向拨杆前端;所述转向传感器装置与驾驶辅助装置无线通信,转向传感器装置向驾驶辅助装置发送转向传感器获得的转向状态。
转向传感器主要作用是用于辅助决策车道偏离功能是否报警,正常转向的车道偏离驾驶辅助装置不报警,反之驾驶辅助装置报警。
其中,转向传感器,包括:
加速度传感器,用于检测并采集汽车拨动转向拨杆时产生的加速度;所述加速度传感器为安装在汽车转向拨杆上的三轴加速度计;
标定单元,用于加速度传感器安装完成后,通过标定步骤,记录拨杆处于上、中、下三个位置时对应的三轴加速度数据;
标定单元工作步骤如下:
标定时,汽车在平直路面上处于静止状态,打开标定采集开关后等待1s,保存此时汽车拨杆的位置,加速度计的加速度值;
改变汽车拨杆的位置,打开标定采集开关后等待1s,保存此时汽车拨杆的位置和加速度计的加速度值,完成全部位置的加速度数据采集;
汽车转向状态判断单元,用于根据姿态角判断汽车拨杆的状态,进而判断出汽车转向状态;所述姿态角为三轴加速度传感器的笛卡尔坐标系与大地笛卡尔坐标系的角度值;
具体步骤如下:
1)运动姿态角初始化:根据标定单元的结果计算拨杆各位置间运动姿态角(旋转矩阵)
其中,
和为拨杆两个位置的标定的三轴加速度值矩阵,M为一3X3阶矩阵(旋转矩阵),其中包含拨杆两位置间运动信息;
初始化计算后,将得到拨杆各位置间运动的一系列旋转矩阵;
3)计算并判别:将上一步骤计算得出的一系列旋转矩阵依次与前一拨杆状态时记录的加速度数据矩阵点乘;得到的结果依次与当前拨杆状态的加速度矩阵进行对比,计算两矩阵空间夹角,将空间夹角最小者所对应的旋转矩阵作为车辆转向状态判断依据;
4)保存数据:将当前拨杆位置的加速度数据存储,作为下次计算的前一拨杆位置加速度数据。
算法流程如上,标定和初始化步骤在车辆静态时,一次完成。车辆运动时,反复进行步骤3)和步骤4)运算,以判断车辆转向意图。
为了优化传感器的结果准确度,转向传感器还包括预处理单元,所述预处理单元用于处理加速度传感器中采集的原始数据,消除汽车震动对加速度计的干扰。
预处理单元数据处理的具体步骤如下:
定时采样三个轴的加速度值,采集到一个长度为M的序列后,开始判断静态点;判断找到静态点的条件如下:
1、M序列中,X轴任意两点的差值小于设定阈值;
2、M序列中,Y轴任意两点的差值小于设定阈值;
3、M序列中,Z轴任意两点的差值小于设定阈值;
然后将每个轴中的M个点取平均值,就得到了当前的加速度值,然后利用该值去判断汽车拨杆状态。
该算法得出的静态点比较可靠,判断汽车拨杆状态的准确率最高,但是查找静态点的速度比较慢,还有其他找静态点的算法,可以并行运行,加快查找速度。
应当理解的是,对本领域普通技术人员来说,可以根据上述说明加以改进或变换,而所有这些改进和变换都应属于本发明所附权利要求的保护范围。
Claims (6)
1.一种用于车道偏离预警的驾驶辅助系统,包括:用于检测汽车拨杆位置的转向传感器装置和驾驶辅助装置;所述转向传感器装置固定设置在转向拨杆前端;所述转向传感器装置与驾驶辅助装置无线通信,转向传感器装置向驾驶辅助装置发送转向传感器获得的转向状态;
所述用于检测汽车拨杆位置的转向传感器装置,包括:
加速度传感器,用于检测并采集汽车拨动转向拨杆时产生的加速度;所述加速度传感器为安装在汽车转向拨杆上的三轴加速度计;
标定单元,用于加速度传感器安装完成后,通过标定步骤,记录拨杆处于上、中、下三个位置时对应的三轴加速度数据;
标定单元工作步骤如下:
标定时,汽车在平直路面上处于静止状态,打开标定采集开关后等待设定时间,保存此时汽车拨杆的位置,加速度计的加速度值;
改变汽车拨杆的位置,打开标定采集开关后等待设定时间,保存此时汽车拨杆的位置和加速度计的加速度值,完成全部位置的加速度数据采集。
2.根据权利要求1所述的用于车道偏离预警的驾驶辅助系统,其特征在于,所述驾驶辅助装置包括GSP传感器、摄像头、无线数据收发模块。
3.根据权利要求1所述的用于车道偏离预警的驾驶辅助系统,其特征在于,所述标定单元中标定时,汽车在平直路面上处于静止状态,打开标定采集开关后等待设定时间为1s。
4.根据权利要求1所述的用于车道偏离预警的驾驶辅助系统,其特征在于,所述汽车转向状态判断单元,用于根据姿态角判断汽车拨杆的状态,进而判断出汽车转向状态;所述姿态角为三轴加速度传感器的笛卡尔坐标系与大地笛卡尔坐标系的角度值;
具体步骤如下:
1)运动姿态角初始化:根据标定单元的结果计算拨杆各位置间运动姿态角,即旋转矩阵;
其中,
和为拨杆两个相邻位置的标定的三轴加速度值矩阵,采用的是标定数据;M为一3×3阶旋转矩阵,其中包含拨杆两位置间运动信息;
2)初始化计算后,将得到拨杆各位置间运动的一系列旋转矩阵;
3)计算并判别:将上一步骤计算得出的一系列旋转矩阵依次与前一拨杆状态时记录的加速度数据矩阵点乘;得到的结果依次与当前拨杆状态的加速度矩阵进行对比,计算两矩阵空间夹角,将空间夹角最小者所对应的旋转矩阵作为车辆转向状态判断依据;
4)保存数据:将当前拨杆位置的加速度数据存储,作为下次计算的前一拨杆位置加速度数据。
5.根据权利要求1所述的用于车道偏离预警的驾驶辅助系统,其特征在于,所述转向传感器装置还包括预处理单元,所述预处理单元用于处理加速度传感器中采集的原始数据,消除汽车震动对加速度计的干扰。
6.根据权利要求5所述的用于车道偏离预警的驾驶辅助系统,其特征在于,所述预处理单元数据处理的具体步骤如下:
定时采样三个轴的加速度值,采集到一个长度为M的序列后,开始判断静态点;其中M为大于3的整数;判断找到静态点的条件如下:
1、M序列中,X轴任意两点的差值小于设定阈值;
2、M序列中,Y轴任意两点的差值小于设定阈值;
3、M序列中,Z轴任意两点的差值小于设定阈值;
然后将每个轴中的M个点取平均值,就得到了当前的加速度值,然后利用该平均值去判断汽车拨杆状态。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710084214.5A CN106915348B (zh) | 2017-02-16 | 2017-02-16 | 一种用于车道偏离预警的驾驶辅助系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710084214.5A CN106915348B (zh) | 2017-02-16 | 2017-02-16 | 一种用于车道偏离预警的驾驶辅助系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106915348A CN106915348A (zh) | 2017-07-04 |
CN106915348B true CN106915348B (zh) | 2019-06-28 |
Family
ID=59453816
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710084214.5A Active CN106915348B (zh) | 2017-02-16 | 2017-02-16 | 一种用于车道偏离预警的驾驶辅助系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106915348B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110509995B (zh) * | 2019-09-12 | 2021-10-15 | 武汉极目智能技术有限公司 | 一种车辆转向拨杆状态判断装置及方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102008046866A1 (de) * | 2008-09-12 | 2010-03-18 | Hella Kgaa Hueck & Co. | Verfahren zur Einstellung eines Zusatzlenkmoments in einer Lenkeinrichtung eines Kraftfahrzeugs zur Erzeugung einer haptischen Lenkradwarnung beim Spurverlassen |
CN104015725A (zh) * | 2014-06-11 | 2014-09-03 | 吉林大学 | 一种基于多参数决策的车道偏离预警方法 |
CN106043282A (zh) * | 2016-07-26 | 2016-10-26 | 浙江吉利控股集团有限公司 | 一种用于车辆的全自动泊车系统及其控制方法 |
CN106314277A (zh) * | 2015-07-06 | 2017-01-11 | 武汉极目信息技术有限公司 | 一种汽车转向灯状态检测装置 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4887849B2 (ja) * | 2006-03-16 | 2012-02-29 | 日産自動車株式会社 | 車両用路上障害物検出装置、路上障害物検出方法および路上障害物検出装置付き車両 |
-
2017
- 2017-02-16 CN CN201710084214.5A patent/CN106915348B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102008046866A1 (de) * | 2008-09-12 | 2010-03-18 | Hella Kgaa Hueck & Co. | Verfahren zur Einstellung eines Zusatzlenkmoments in einer Lenkeinrichtung eines Kraftfahrzeugs zur Erzeugung einer haptischen Lenkradwarnung beim Spurverlassen |
CN104015725A (zh) * | 2014-06-11 | 2014-09-03 | 吉林大学 | 一种基于多参数决策的车道偏离预警方法 |
CN106314277A (zh) * | 2015-07-06 | 2017-01-11 | 武汉极目信息技术有限公司 | 一种汽车转向灯状态检测装置 |
CN106043282A (zh) * | 2016-07-26 | 2016-10-26 | 浙江吉利控股集团有限公司 | 一种用于车辆的全自动泊车系统及其控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106915348A (zh) | 2017-07-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US20180126937A1 (en) | Automatic Detection and Assessment of Low-Speed Crashes | |
CN105922990B (zh) | 一种基于云端机器学习的车辆环境感知和控制方法 | |
CN109789777B (zh) | 非预期脉冲变化碰撞检测器 | |
CN105818813B (zh) | 基于车辆间通信的车距控制系统及其控制方法 | |
CN101681562B (zh) | 车辆行驶轨迹推定装置 | |
US20130060400A1 (en) | Detection apparatus and method for detecting a carrier of a transceiver, motor vehicle | |
CN108263379A (zh) | 基于姿势信息的行人检测和行人碰撞预防装置和方法 | |
CN107526431B (zh) | 用于预测视觉注意力的目标的设备及方法 | |
US20150012170A1 (en) | Processing of automobile data on a smartphone | |
EP3336488B1 (en) | Method of verification of the installation of an apparatus mounted on board a vehicle, and related system | |
CN105493165A (zh) | 车辆驾驶情况判定装置和车辆驾驶情况判定方法 | |
KR20170079096A (ko) | 지능형 차량용 블랙박스 | |
JP6160201B2 (ja) | 乗員検出装置 | |
CN106915348B (zh) | 一种用于车道偏离预警的驾驶辅助系统 | |
CN105599767A (zh) | 环形道探测装置 | |
CN104192063A (zh) | 车辆安全行驶警示系统及相应的警示方法 | |
CN109910809A (zh) | 一种汽车防泡水预警处理系统及预警处理方法 | |
US10000153B1 (en) | System for object indication on a vehicle display and method thereof | |
CN106004794A (zh) | 一种车载诊断系统及车载诊断设备 | |
JPWO2017156295A5 (zh) | ||
CN114613194A (zh) | 弯道会车的预警方法、装置和车辆 | |
CN106672075B (zh) | 一种用于检测汽车拨杆位置的转向传感器系统及控制方法 | |
CN112272630B (zh) | 探测碰撞事件 | |
CN215436215U (zh) | 一种基于机器视觉的汽车盲区检测报警系统 | |
CN110858966A (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 |