CN106643749B - 一种基于智能手机的危险驾驶行为检测方法 - Google Patents
一种基于智能手机的危险驾驶行为检测方法 Download PDFInfo
- Publication number
- CN106643749B CN106643749B CN201610827448.XA CN201610827448A CN106643749B CN 106643749 B CN106643749 B CN 106643749B CN 201610827448 A CN201610827448 A CN 201610827448A CN 106643749 B CN106643749 B CN 106643749B
- Authority
- CN
- China
- Prior art keywords
- automobile
- angle
- roll angle
- mobile phone
- threshold value
- 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.)
- Expired - Fee Related
Links
- 238000001514 detection method Methods 0.000 title claims abstract description 61
- 238000000034 method Methods 0.000 claims abstract description 48
- 230000001133 acceleration Effects 0.000 claims description 59
- 230000006399 behavior Effects 0.000 claims description 42
- 230000003068 static effect Effects 0.000 claims description 24
- 238000004422 calculation algorithm Methods 0.000 claims description 21
- 238000004364 calculation method Methods 0.000 claims description 13
- 238000005259 measurement Methods 0.000 claims description 12
- 239000011159 matrix material Substances 0.000 claims description 7
- 238000009941 weaving Methods 0.000 claims description 4
- 230000003247 decreasing effect Effects 0.000 claims description 3
- 230000010354 integration Effects 0.000 claims description 2
- 238000011895 specific detection Methods 0.000 claims description 2
- 230000001174 ascending effect Effects 0.000 claims 1
- 230000007812 deficiency Effects 0.000 abstract 1
- 244000062793 Sorghum vulgare Species 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 235000019713 millet Nutrition 0.000 description 2
- 238000005070 sampling Methods 0.000 description 2
- 206010034719 Personality change Diseases 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 239000006185 dispersion Substances 0.000 description 1
- 230000008092 positive effect Effects 0.000 description 1
- 238000011897 real-time detection Methods 0.000 description 1
- 238000012216 screening Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Gyroscopes (AREA)
Abstract
本发明公开了一种基于智能手机的危险驾驶行为检测方法,属于智能交通领域。所述方法以智能手机中的加速度计和陀螺仪作为传感器,并进行手机相对于汽车的姿态实时更新,根据行驶过程中汽车相对于水平地面的汽车俯仰角和汽车横滚角判断危险驾驶行为,得到初步检测结果,然后判断上下坡区间段,从初步检测结果中去掉对应该区间段的危险驾驶行为检测结果,得到最终检测结果,达到提高危险驾驶行为检测准确度的目的。本发明在保证检测精度的前提下,弥补现有危险驾驶行为成本高、需要卫星导航或者磁传感器的不足,具有较高的经济价值;手机可以放置在汽车内的任何位置,并且具有检测的实时性,操作简单,易于推广使用。
Description
技术领域
本发明属于智能交通领域,涉及一种基于智能手机的危险驾驶行为检测方法。
背景技术
危险驾驶行为检测技术在智能交通尤其是交通安全领域具有重要意义。现有的危险驾驶行为检测技术普遍存在成本高,需要借助外部设施等问题,如汽车内部的CAN总线信息、卫星导航信息、照相机等,很难满足低成本的要求。
基于智能手机的危险驾驶行为检测可以有效降低检测方法的成本。现有的基于智能手机的危险驾驶行为检测算法需要借助卫星导航信息、内部磁传感器信息、照相机等辅助信息。其中卫星导航信息具有定位精度高,不随时间发散等优点,但是长时间使用功耗大,且在城市地区容易受到多径效应影响造成结果不准确或者不可用。内部磁传感器可以提供汽车的航向信息,操作简单,但是容易受到电磁干扰的影响。使用手机的照相机需要将手机以某一个固定的姿态固定在汽车上,且计算量大,使得该方法的使用受到很大限制。在一些不使用卫星导航、磁传感器和照相机的智能手机解决方案中,对于手机的放置位置以及姿态做出了限定,造成使用不便。
发明内容
针对现有危险驾驶行为检测方法成本高、使用不方便等缺点,本发明提供了一种基于智能手机的危险驾驶行为检测方法。本发明的危险驾驶行为检测方法以智能手机内部的加速度计和陀螺仪作为传感器,通过一定的软件算法,实现对于危险驾驶行为的实时检测,具有成本低、操作简单等优点。
本发明提供了一种基于智能手机的危险驾驶行为检测方法,通过以下步骤实现:
步骤一:以智能手机中的加速度计和陀螺仪作为传感器,判定出汽车和手机均为相对于惯性系静止状态,计算出该静止状态下手机相对于汽车的俯仰角和横滚角。在该俯仰角和横滚角基础上,当汽车有直线加减速运动时,可以根据加速度差值进一步估计出手机相对于汽车的偏航角。
步骤二:基于上述姿态角计算方法,通过实时判定汽车和手机是否处于静止状态,当满足静止状态的条件时,根据倾角仪算法更新手机相对于汽车的俯仰角和横滚角。同时给出一个偏航角的可信度定义及计算方法,该可信度与时间相关,随着时间增长,当前所采用的偏航角可信度降低,当有新的可信度大于当前可信度的偏航角出现,用新的偏航角更新当前使用的偏航角,通过以上步骤实现手机相对于汽车的姿态实时更新。
步骤三:当得到了手机相对于汽车的偏航角、俯仰角和横滚角信息之后,通过计算方向余弦矩阵,将手机直接测得的加速度信息和角速率信息转换为能够直接描述汽车运动的加速度信息和角速率信息。通过对加速度和角速率的进一步计算,可以得到行驶过程中汽车相对于水平地面的汽车俯仰角和汽车横滚角,根据汽车俯仰角和汽车横滚角以及经过进一步计算的加速度和角速率信息,可以得到急加速急减速、急转向、连续变道和驾驶过程中操作手机等危险驾驶行为的实时信息,并实时输出危险驾驶行为初步检测结果。
步骤四:当手机相对于汽车的姿态角计算完成后,通过对已经转换到汽车坐标系的陀螺仪角速率积分,并对所得积分结果进行分段直线拟合,找出上下坡的区间段。
步骤五:如果存在步骤四中所述的上下坡区间段,则从初步检测结果中去掉对应该区间段的危险驾驶行为检测结果,得到最终检测结果,达到提高危险驾驶行为检测准确度的目的。
如果不存在所述的上下坡区间段,直接将步骤三中的初步检测结果作为最终检测结果。
本发明的优点和积极效果在于:
(1)本发明提供了一种简单易行、成本低廉的危险驾驶行为检测方法,在能保证检测精度的前提下,仅使用智能手机内部的加速度计和陀螺仪,弥补现有危险驾驶行为成本高、需要卫星导航或者磁传感器的不足,具有较高的经济价值。
(2)本发明中手机可以放置在汽车内的任何位置,在启动软件之后可以自动计算出手机相对于汽车的姿态角,并且实时更新姿态角,保证了长时间使用的精度,并且具有检测的实时性,操作简单,易于推广使用。
附图说明
图1是本发明的危险驾驶行为检测的流程示意图;
图2是本发明所采用的汽车坐标系;
图3是本发明所采用的手机坐标系;
图4是本发明所采用的从汽车系到手机系的旋转角定义;
图5是本发明里危险驾驶行为中急加速急减速的示意图;
图6是本发明里危险驾驶行为中急转向的示意图;
图7是本发明里危险驾驶行为中连续变道的示意图;
图8是本发明里危险驾驶行为中驾驶过程中操作手机的示意图;
图9是本发明的急加速急减速判定具体实施例;
图10A和图10B是本发明的急转向判定具体实施例;
图11是本发明的连续变道判定具体实施例;
图12A和图12B是本发明的驾驶过程中驾驶过程中操作手机判定具体实施例;
图13是本发明的基于低精度陀螺的上下坡检测具体实施例。
具体实施方式
下面结合附图和实施例来说明本发明的技术方案。
本发明是一种基于智能手机的危险驾驶行为检测方法,流程图如图1所示,包括以下几个步骤:
步骤一:以智能手机中的加速度计和陀螺仪作为传感器,判定出汽车和手机均为相对于惯性系静止状态,计算出该静止状态下手机相对于汽车的俯仰角和横滚角。在该俯仰角和横滚角基础上,当汽车有直线加减速运动时,可以根据加速度差值进一步估计出手机相对于汽车的偏航角。
具体包括:
定义汽车坐标系和手机坐标系分别如图2、图3所示,假定汽车一直在水平面行进,汽车坐标系XVYVZV,具体定义为:坐标系原点为汽车中心点,XV轴正向为垂直于车体方向水平向右,YV轴正向为沿车头方向水平向前,ZV轴正向为垂直于水平面向上。手机坐标系XPYPZP具体定义为:坐标系原点位于手机中心点,XP轴正向沿着手机屏幕所在平面向右,YP轴正向沿着手机屏幕所在平面向前,ZP轴正向垂直于屏幕所在平面向上。从汽车系(V系)到手机系(P系)的坐标旋转可以通过方向余弦矩阵来完成,其中偏航角俯仰角θ、横滚角γ的定义如图4所示,偏航角定义为手机Y轴在水平面投影相对于汽车Y轴的夹角,逆时针为正,俯仰角定义为手机Y轴正向与水平面夹角,高于水平面为正,横滚角定义为手机沿着Y轴所倾斜的角度,角度正负满足右手定则,方向余弦矩阵如下:
当汽车和手机都处于静止状态或者匀速直线运动状态,并且手机和汽车之间没有相对运动,定义该状态为稳定状态,判定汽车为稳定状态的公式为:
kend-kstart≥Nsteady (4)
其中,表示k时刻P系下的三轴陀螺仪测量的xyz三个方向的角速率测量值,表示k时刻P系下的三轴加速计测量的xyz三个方向的加速度测量值。Δωsteady是陀螺仪角速率阈值,通过该角速率阈值可以消除转向运动的影响。Nsteady是检测静止状态的时间阈值。Δa为检测静止状态的加速度阈值,为了消除震动和噪声干扰,加速度阈值Δa一般取0.03g。kstart,kend分别表示稳定状态的开始时刻和结束时刻。
那么稳定状态下可以采用倾角仪算法计算手机的俯仰角和横滚角,计算公式如下:
通过此方法可以有效计算出手机相对于汽车的俯仰角和横滚角。
手机输出的加速度测量值可以通过方向余弦矩阵转换到汽车系下,具体为:
其中,表示手机系下的三轴加速度计输出,表示汽车系下的三轴加速度计值。当汽车处于稳定状态时,所以(8)可以表示为:
其中s表示稳定状态的最后一个时刻。
当汽车在水平面上进行直线加速或者直线减速运动时,所以(8)可以表示为:
结合(9)和(10),可以得到如下公式:
其中k为结束稳定状态后的采样时刻,s为稳定状态时间段内最后一个时刻点。
由式(11)可以得出,即使手机是任意放置的,但是当手机放置之后,只要和汽车之间没有相对滑动,即手机相对于汽车没有姿态改变,即(11)等号右边为一常值向量,那么手机直接测量的加速度改变量具有比值不变性,
根据上述推导,本发明采用如下算法计算手机相对于汽车的偏航角
其中n表示求取偏航角均值所采用的n个时刻,为k时刻的手机相对于汽车的偏航角。i的初值取(k-n+1)。
并且同时满足下式:
其中表示偏航角的标准差,是P系下陀螺仪X轴、Y轴、Z轴测量的角速率,Δω是计算偏航角所用的角速率阈值,通过该角速率阈值可以判断汽车有无转向等动作。是计算偏航角所用的加速度阈值,用来消除测量噪声等的干扰。
当手机启动程序至第一次计算出偏航角、俯仰角和横滚角,定义为初始化完成。
步骤二:基于上述姿态角计算方法,通过实时判定汽车和手机是否处于相对于惯性系静止状态,当满足静止状态的条件时,根据倾角仪算法更新手机相对于汽车的俯仰角和横滚角。同时给出一个偏航角的可信度定义及计算方法,该可信度与时间相关,随着时间增长,当前所采用的偏航角可信度降低,当有新的可信度大于当前可信度的偏航角出现,用新的偏航角更新当前使用的偏航角,通过以上步骤实现手机相对于汽车的姿态实时更新算法。
手机是以任意姿态放置到汽车里的,在汽车行驶过程中,比如缓慢的转弯、上下陡坡会导致手机产生滑动或者姿态改变,为了提高检测精度,手机相对于汽车的姿态需要进行更新。
判断手机和汽车处于静止状态的方法同步骤一,并且根据步骤一中的方法更新俯仰角和横滚角,定义偏航角的可信度如下:
其中,Var_k是当前k时刻计算的偏航角与前面N个时刻计算的偏航角的标准差,N值的大小根据实验数据调整获得。
当前正在使用的偏航角的可信度定义为
其中,t(now)表示当前时刻,t(k)表示该偏航角计算的时刻。t_atten为根据经验值选取的时间常数。
当实时计算的偏航角的可信度fk,now大于正在使用的可信度fk,work时,将当前时刻的偏航角更新为实时计算的偏航角值。
步骤三:当得到了手机相对于汽车的偏航角、俯仰角和横滚角信息之后,通过计算方向余弦矩阵,将手机直接测得的加速度信息和角速率信息转换为能够直接描述汽车运动的加速度信息和角速率信息。通过对加速度和角速率的进一步计算,可以得到行驶过程中汽车相对于水平地面的汽车俯仰角和汽车横滚角,根据汽车俯仰角和汽车横滚角以及经过进一步计算的加速度和角速率信息,可以得到急加速急减速、急转向、连续变道和驾驶过程中操作手机等危险驾驶行为的实时信息,并实时输出危险驾驶行为检测结果。其中急加速急减速、急转向、连续变道和驾驶过程中操作手机的示意图分别如图5、图6、图7和图8所示。具体定义为:急加速急减速定义为短时间内将汽车速度迅速提高或者降低,本发明中定义为车速在10s内变化30km/h;急转向定义为采用30km/h的速度左转或者右转超过0.7rad,转弯半径小于60m;连续变道定义为短时间内频繁更换车道;驾驶过程中操作手机定义为驾驶员在驾驶过程中对手机进行拿起然后进一步操作如接打电话、打字和操作软件等。
定义类似静止状态:
其中Δasimilar是为检测类似静止状态设置的加速度阈值,具体阈值大小根据实验数据由经验选定。
当转换到汽车系下的加速度满足(17)式的时候,认为其符合类似静止条件,然后根据倾角仪算法计算一个汽车相对于水平地面的汽车俯仰角θv和汽车横滚角γv,即:
当不满足(17)式的时候,采用四元数法更新姿态角,计算过程采用四阶龙格库塔法,中间采样数据采用前一时刻的汽车俯仰角和汽车横滚角作为当前时刻的汽车俯仰角和汽车横滚角。
急加速急减速检测算法:
计算出稳定状态下汽车俯仰角θv(s)和汽车横滚角γv(s),当满足条件
θv_th_low≤|θv(k)-θv(s)|≤θv_th_high k∈[kstart,kend] (20)
|γv(k)-γv(s)|≤γv_th k∈[kstart,kend] (21)
kend-kstart>Nspeeding (22)
其中,θv_th_low和θv_th_high分别为汽车俯仰角的低阈值和高阈值,γv_th为横滚角阈值,均根据实验经验选定,Nspeeding是时间阈值,根据θv(k)-θv(s)的正负区分加速还是减速,正为加速,负为减速。
在急转向区间内,V系下X轴加速度和V系下Z轴角速率都会有一个比较大的变化,具体的检测算法如下:
kend-kstart>Nsteering (25)
其中Δasteering和分别为急转向判定条件下的加速度和角速率阈值,Nsteering是急转向判定条件下的时间阈值。
连续变道检测算法为:定义汽车横滚角的正负阈值分别为ΔγWP和ΔγWN,同时定义汽车横滚角越过汽车横滚角正阈值计数器rP,rP只取整数,汽车横滚角越过汽车横滚角负阈值计数器rN,rN只取整数,定义Nweaving为连续变道检测中设置的时间间隔阈值。当汽车横滚角由低于汽车横滚角正阈值ΔγWP变为高于汽车横滚角正阈值ΔγWP或者当汽车横滚角由高于汽车横滚角正阈值ΔγWP变为低于汽车横滚角正阈值ΔγWP,则将汽车横滚角正阈值计数器rP加1。当汽车横滚角由高于汽车横滚角负阈值ΔγWN变为低于汽车横滚角负阈值ΔγWN或者当汽车横滚角由低于汽车横滚角负阈值ΔγWN变为高于汽车横滚角负阈值ΔγWN,则将汽车横滚角负阈值计数器rN加1。在Nweaving时间阈值之内,当满足(rP+rN)≥4的条件时,认为检测出连续变道的驾驶行为。
本发明中采用一个3s的滑动时间窗来检测驾驶过程中操作手机,如果在该时间窗内,加速度计三轴测量中有两轴或者两轴以上有较大变化(超过设定阈值),或者陀螺仪三轴测量中有两轴或者两轴以上较大变化(超过设定阈值),即认为手机被拿起。
因为驾驶过程中操作手机后手机相对于汽车的姿态变化很大,而且此时姿态不易求出,不能准确反应汽车的行驶状态,所以在检测出驾驶过程中操作手机之后要停止急加速急减速,急转向,连续变道的检测,当再一次出现稳定状态,重新计算出手机相对于汽车的俯仰角和横滚角,并且计算出手机与汽车之间的偏航角之后,再开始检测急加速急减速,急转向和连续变道等危险驾驶行为。
本发明还提供了一种基于低精度陀螺的上下坡检测算法。当手机相对于汽车的姿态角计算完成后,通过对已经转换到汽车坐标系的陀螺仪角速率积分,并对所得结果进行分段直线拟合,找出上下坡区间段,并去掉该区间段的危险驾驶行为判定结果,达到提高危险驾驶行为检测准确度的目的。
因为本发明中汽车系的定义是假设汽车行驶在水平面上的,所以在有上下坡的路段,会对检测结果造成干扰。而低精度的陀螺测量数据,即使转换到了汽车系下,也会因为噪声干扰比较大,不能准确识别上下坡路段。为了消除噪声影响,本发明采用最小二乘拟合的方法对(V系下X轴的角速率)的积分值进行处理,即:
其中表示P系下陀螺仪三轴角速率矢量,表示陀螺仪固定零偏矢量,表示陀螺仪三轴随机漂移矢量,表示陀螺仪三轴白噪声矢量,S(n)=[Sx(n),Sy(n),Sz(n)]T表示三轴角速率积分矢量。b0固定不变所以是一个线性改变量,bi在短时间内可以认为不变,所以也是一个线性改变量,在长时间计算后趋近于零。所以S(n)的值将主要体现的一个变化趋势。为了检测上下坡区域,本发明中选取S(n)的X轴分量,即Sx(n)进行后续的计算。
然后筛选出Sx(n)中在3.5s窗口内(该阈值根据实验经验选取,可变)标准差小于0.04(该阈值根据实验经验选取,可变)的区域,采用一个3.5s的滑动窗口进行线性拟合。拟合参数为直线的斜率α和截距β。拟合公式为:
其中
Z=[Sx(1) Sx(2) … Sx(m-1) Sx(m)]T,m是3.5s滑动窗口内的采样个数。
在进行线性拟合的区域,计算拟合直线的斜率α的拟合误差,定义拟合误差小于误差阈值的点定义为稳定点,否则为不稳定点,然后计算不稳定点左右两端第一个稳定点对应的拟合直线斜率对应倾斜角的改变量:
δ(n)=tan-1(αright)-tan-1(αleft) (28)
δ(n)≥Δδ (29)
其中αright和αleft分别是不稳定点右侧和左侧第一个稳定点对应拟合曲线的斜率,Δδ是直线斜率对应倾角改变量的阈值。
检测出上下坡区域后,因为上下坡区域的姿态角是不准确的,所以在此区域附近不进行载体运动状态判别,直到上下坡区域结束之后再进行运动状态检测。
如果存在上述的上下坡区域段,需要从步骤三的检测结果中去掉所述的上下坡区域段,得到最终的检测结果。
实施例中:
采用小米2s、华为荣耀6、魅族3和小米3放置在同一辆出租车上,如果手机是固定放置的,计算的姿态角误差在3度以内。
依据本发明提供的方法,本实例中急加速急减速、急转向、连续变道、驾驶过程中操作手机的总检测精度可以达到90%以上。
急加速急减速、急转向、连续变道、驾驶过程中操作手机的一个具体的判断实施例分别如图9、图10、图11和图12所示。如图9所示,图中汽车俯仰角和汽车横滚角是根据本发明中具体实施方式所介绍的步骤计算出的结果,在虚线框所示时间区域内,汽车俯仰角有一个很大的变化,同时汽车横滚角变化很小,可以通过步骤三中的急加速急减速检测算法有效检测出来。如图10A所示,图中汽车坐标系下加速度差值曲线是根据本发明中具体实施方式所介绍的步骤计算出的结果,在虚线框所示时间区域内,汽车坐标系下X轴加速度差值曲线有一个很大的变化,如图10B所示,图中汽车坐标系下角速率差值曲线是根据本发明中具体实施方式所介绍的步骤计算出的结果,在虚线框所示时间区域内,汽车坐标系下Z轴角速率差值曲线有一个很大变化,则通过本发明具体实施方式中步骤三所述的急转向检测算法可以有效检测出一个急转向动作。如图11所示,图中汽车俯仰角和汽车横滚角是根据本发明中具体实施方式所介绍的步骤计算出的结果,在虚线框所示时间区域内,汽车横滚角在给定的时间阈值内越过正阈值和越过负阈值的次数大于4,所以该连续变道驾驶行为可以被本发明提出的连续变道检测算法有效检测出。如图12A所示是手机坐标系下的加速度值,图12B所示是手机系下陀螺仪角速率值,可以看出加速度计和陀螺仪均至少有两个轴发生较大变化,根据本发明所提出的驾驶过程中操作手机检测算法,可以有效检测该驾驶过程中操作手机动作。
上下坡检测的一个具体实施例如图13所示,图中实线曲线是汽车坐标系下X轴角速率的积分值,其中点画线区域表示实际的下坡区域,虚线区域表示实际的上坡区域,点线区域是根据本发明中提出的基于低精度陀螺的上下坡检测算法识别出的上下坡区域,由图中可以看出,本发明提出的基于低精度陀螺的上下坡检测算法可以有效检测出上下坡区域。
本发明以智能手机内部的加速度计和陀螺仪为基础,无需外界辅助测量,对于手机放置姿态无要求,可以对四种危险驾驶行为进行有效检测,操作简单,成本低廉,为危险驾驶行为检测提供了一种有效的解决方案。
Claims (4)
1.一种基于智能手机的危险驾驶行为检测方法,其特征在于,实现方法如下:
步骤一:以智能手机中的加速度计和陀螺仪作为传感器,计算汽车和手机均处于静止状态下手机相对于汽车的俯仰角和横滚角;在该俯仰角和横滚角基础上,当汽车有直线加减速运动时,根据加速度差值进一步估计出手机相对于汽车的偏航角;所述的静止状态是指汽车与手机在惯性系内静止;手机相对于汽车的偏航角计算如下:
在汽车处于直线加减速状态下,采用加速度差值的比值来计算手机相对于汽车的偏航角,偏航角的获取方法如下:
并且同时满足下式,才能计算偏航角:
其中,n表示求取偏航角均值所采用的n个时刻,为k时刻的手机相对于汽车的偏航角,i的初值取(k-n+1);表示偏航角的标准差,是P系下陀螺仪X轴、Y轴、Z轴测量的角速率,Δω是计算偏航角所用的角速率阈值,是计算偏航角所用的加速度阈值;分别表示k时刻P系下的三轴加速计测量的x、y方向的加速度测量值;分别表示s时刻P系下的三轴加速计测量的x、y方向的加速度测量值;
步骤二:当满足静止状态的条件时,根据倾角仪算法更新手机相对于汽车的俯仰角和横滚角,同时给出偏航角可信度,该偏航角可信度与时间相关,随着时间增长,当前所采用的偏航角可信度降低,当有新的可信度大于当前可信度的偏航角出现,用新的偏航角更新当前使用的偏航角,实现手机相对于汽车的偏航角、俯仰角和横滚角实时更新;偏航角可信度fk定义如下:
其中,Var_k是当前k时刻计算的偏航角与前面N个时刻计算的偏航角的标准差;
当前正在使用的偏航角的可信度定义为
其中,t(now)表示当前时刻,t(k)表示该偏航角计算的时刻,t_atten为根据经验值选取的时间常数;
当实时计算的偏航角的可信度fk,now大于正在使用的偏航角的可信度fk,work时,将当前时刻的偏航角更新为实时计算的偏航角值;
步骤三:将手机直接测得的加速度信息和角速率信息转换为能够直接描述汽车运动的加速度信息和角速率信息,通过对加速度和角速率的进一步计算,得到行驶过程中汽车相对于水平地面的汽车俯仰角和汽车横滚角,根据汽车俯仰角和汽车横滚角以及经过进一步计算的加速度和角速率信息,得到危险驾驶行为的实时信息,并实时输出危险驾驶行为初步检测结果;
步骤四:对已经转换到汽车坐标系的陀螺仪角速率积分,并对所得积分结果进行分段直线拟合,找出上下坡区间段;
步骤五:如果存在步骤四中的上下坡区间段,则从初步检测结果中去掉所述上下坡的区间段的危险驾驶行为判定结果,得到最终的检测结果。
2.根据权利要求1所述的基于智能手机的危险驾驶行为检测方法,其特征在于:步骤三中汽车相对于水平地面的汽车俯仰角和汽车横滚角计算方法如下:
通过转换到汽车系下的加速度和角速率信息,设定类似静止状态阈值,当小于该类似静止状态阈值时采用倾角仪算法计算汽车相对于水平地面的汽车俯仰角和汽车横滚角,当大于该类似静止状态阈值时,采用四元数法,通过四阶龙格库塔算法计算汽车俯仰角和汽车横滚角;
类似静止状态的判定方法如下:
处于类似静止状态的当前时刻汽车俯仰角θv和汽车横滚角γv的计算方法如下:
其中,表示k时刻V系下的三轴加速计测量的xyz三个方向的加速度测量值;Δasimilar是为检测类似静止状态设置的加速度阈值。
3.根据权利要求1所述的基于智能手机的危险驾驶行为检测方法,其特征在于:步骤三中危险驾驶行为包括急加速急减速、急转向、连续变道、驾驶过程中操作手机;
如果是急加速急减速,则判定方法如下:
如果当前时刻汽车俯仰角与稳定状态汽车俯仰角的差值的绝对值大于给定的低阈值并且小于给定的高阈值,且汽车横滚角小于给定的横滚角阈值,则认为有急加速急减速危险动作,并通过当前时刻汽车俯仰角与稳定状态汽车俯仰角的差值的符号判定加速还是减速,符号为正表示加速,符号为负表示减速;
基于汽车俯仰角的急加速急减速危险动作判定方法如下:
其中,θv_th_low和θv_th_high分别为汽车俯仰角的低阈值和高阈值,γv_th为汽车横滚角阈值,Nspeeding是时间阈值;
如果是急转向,具体的检测算法如下:
kend-kstart>Nsteering
其中Δasteering和分别为急转向判定条件下的加速度和角速率阈值,Nsteering是急转向判定条件下的时间阈值;kstart,kend分别表示稳定状态的开始时刻和结束时刻;别表示k、s时刻V系下的三轴加速计测量的x方向的加速度测量值;
连续变道检测算法为:定义汽车横滚角的正负阈值分别为ΔγWP和ΔγWN,同时定义汽车横滚角越过汽车横滚角正阈值计数器rP,rP只取整数,汽车横滚角越过汽车横滚角负阈值计数器rN,rN只取整数,定义Nweaving为连续变道检测中设置的时间间隔阈值;当汽车横滚角由低于汽车横滚角正阈值ΔγWP变为高于汽车横滚角正阈值ΔγWP或者当汽车横滚角由高于汽车横滚角正阈值ΔγWP变为低于汽车横滚角正阈值ΔγWP,则将汽车横滚角正阈值计数器rP加1;当汽车横滚角由高于汽车横滚角负阈值ΔγWN变为低于汽车横滚角负阈值ΔγWN或者当汽车横滚角由低于汽车横滚角负阈值ΔγWN变为高于汽车横滚角负阈值ΔγWN,则将汽车横滚角负阈值计数器rN加1;在Nweaving时间阈值之内,当满足(rP+rN)≥4的条件时,认为检测出连续变道的驾驶行为;
如果是驾驶过程中操作手机,则检测方法如下:
1)采用滑动时间窗方法,当有两轴或者两轴以上加速度计或者陀螺仪的变化大于阈值,判定为有驾驶过程中操作手机动作;
2)当有驾驶过程中操作手机操作时要等到下一个稳定状态更新了手机相对于汽车的俯仰角和横滚角,并且更新了手机相对于汽车的偏航角之后再继续判定危险驾驶行为。
4.根据权利要求1所述的基于智能手机的危险驾驶行为检测方法,其特征在于:步骤四中所述的上下坡的区间段的检测方法如下:
采用最小二乘拟合的方法对V系下X轴的角速率的积分值进行处理,即:
其中,为方向余弦矩阵,表示P系下陀螺仪三轴角速率矢量,表示陀螺仪固定零偏矢量,表示陀螺仪三轴随机漂移矢量,表示陀螺仪三轴白噪声矢量,S(n)=[Sx(n),Sy(n),Sz(n)]T表示三轴角速率积分矢量;
选取S(n)的X轴分量,采用一个时间滑动窗口进行线性拟合,拟合参数为直线的斜率α和截距β,拟合公式为:
其中
Z=[Sx(1) Sx(2) … Sx(m-1) Sx(m)]T,m是时间滑动窗口内的采样个数;
在进行线性拟合的区域,计算拟合直线的斜率α的拟合误差,定义拟合误差小于误差阈值的点为稳定点,否则为不稳定点,然后计算不稳定点左右两端第一个稳定点对应的拟合直线斜率对应倾斜角的改变量:
δ(n)=tan-1(αright)-tan-1(αleft)
δ(n)≥Δδ
其中αright和αleft分别是不稳定点右侧和左侧第一个稳定点对应拟合曲线的斜率,Δδ是直线斜率对应倾角改变量的阈值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610827448.XA CN106643749B (zh) | 2016-09-14 | 2016-09-14 | 一种基于智能手机的危险驾驶行为检测方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610827448.XA CN106643749B (zh) | 2016-09-14 | 2016-09-14 | 一种基于智能手机的危险驾驶行为检测方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106643749A CN106643749A (zh) | 2017-05-10 |
CN106643749B true CN106643749B (zh) | 2019-11-05 |
Family
ID=58851827
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610827448.XA Expired - Fee Related CN106643749B (zh) | 2016-09-14 | 2016-09-14 | 一种基于智能手机的危险驾驶行为检测方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106643749B (zh) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113793509B (zh) * | 2018-03-12 | 2024-04-16 | 深圳鼎然信息科技有限公司 | 基于运动传感器的路况分析方法、装置、设备及介质 |
CN108694756A (zh) * | 2018-05-09 | 2018-10-23 | 北京九五智驾信息技术股份有限公司 | 对驾驶行为进行分析的方法 |
CN108674351B (zh) * | 2018-05-22 | 2020-11-13 | 郑州光之源电子科技有限公司 | 基于传感技术分析危险驾驶的安全报警方法 |
CN109708634A (zh) * | 2018-12-12 | 2019-05-03 | 平安科技(深圳)有限公司 | 自动判断驾驶行为的方法、装置、存储介质及电子设备 |
CN110307843B (zh) * | 2019-07-10 | 2022-07-29 | 武汉大学 | 利用惯导设备判断列车变道的方法 |
CN113635907B (zh) * | 2020-04-24 | 2023-03-14 | 丰图科技(深圳)有限公司 | 一种驾驶行为的检测方法、装置、电子设备及其存储介质 |
CN111833598B (zh) * | 2020-05-14 | 2022-07-05 | 山东科技大学 | 一种高速公路无人机交通事件自动监测方法及系统 |
CN112945230B (zh) * | 2021-01-26 | 2022-03-25 | 腾讯科技(深圳)有限公司 | 车辆行车状态的识别方法、装置、计算机设备和存储介质 |
CN113085872B (zh) * | 2021-04-23 | 2023-04-11 | 平安科技(深圳)有限公司 | 驾驶行为评估方法、装置、设备及存储介质 |
US20240182039A1 (en) * | 2021-06-22 | 2024-06-06 | Grabtaxi Holdings Pte. Ltd. | Method and system for monitoring operation of a vehicle |
CN116087869A (zh) * | 2022-12-30 | 2023-05-09 | 泰斗微电子科技有限公司 | 一种基于加速度计的卫星定向方法、设备及可读存储介质 |
CN116311596B (zh) * | 2023-05-18 | 2023-08-15 | 浙江口碑网络技术有限公司 | 危险行为检测方法及装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103434512A (zh) * | 2013-09-18 | 2013-12-11 | 武汉理工大学 | 基于智能手机的横向驾驶状态检测系统与方法 |
CN105270411A (zh) * | 2015-08-25 | 2016-01-27 | 南京联创科技集团股份有限公司 | 一种驾驶行为的分析方法及装置 |
CN105599773A (zh) * | 2015-12-29 | 2016-05-25 | 山东科技大学 | 一种基于车辆运动姿态的驾驶员状态提示装置及其方法 |
CN105912818A (zh) * | 2016-05-06 | 2016-08-31 | 深圳市安智车米汽车信息化有限公司 | 消除上下坡时影响车辆行驶方向加速度的方法及装置 |
CN105973234A (zh) * | 2014-10-10 | 2016-09-28 | 北京三驰科技发展有限公司 | 一种汽车行驶状态预警方法 |
-
2016
- 2016-09-14 CN CN201610827448.XA patent/CN106643749B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103434512A (zh) * | 2013-09-18 | 2013-12-11 | 武汉理工大学 | 基于智能手机的横向驾驶状态检测系统与方法 |
CN105973234A (zh) * | 2014-10-10 | 2016-09-28 | 北京三驰科技发展有限公司 | 一种汽车行驶状态预警方法 |
CN105270411A (zh) * | 2015-08-25 | 2016-01-27 | 南京联创科技集团股份有限公司 | 一种驾驶行为的分析方法及装置 |
CN105599773A (zh) * | 2015-12-29 | 2016-05-25 | 山东科技大学 | 一种基于车辆运动姿态的驾驶员状态提示装置及其方法 |
CN105912818A (zh) * | 2016-05-06 | 2016-08-31 | 深圳市安智车米汽车信息化有限公司 | 消除上下坡时影响车辆行驶方向加速度的方法及装置 |
Non-Patent Citations (2)
Title |
---|
Measuring Driving Behaviors from Live Video;Kunfeng Wang etc.;《IEEE Intelligent Systems》;20121231;第27卷(第5期);第75-80页 * |
基于Android传感器的驾驶事件识别关键技术研究;宋雅清;《万方数据》;20150401;正文第29-45页 * |
Also Published As
Publication number | Publication date |
---|---|
CN106643749A (zh) | 2017-05-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106643749B (zh) | 一种基于智能手机的危险驾驶行为检测方法 | |
US10247830B2 (en) | Vehicle position determination device, vehicle control system, vehicle position determination method, and vehicle position determination program product | |
US9645250B2 (en) | Fail operational vehicle speed estimation through data fusion of 6-DOF IMU, GPS, and radar | |
EP3029538B1 (en) | Vehicle position/bearing estimation device and vehicle position/bearing estimation method | |
EP2517941B1 (en) | Roll angle estimation device and transport equipment | |
US7477760B2 (en) | Vehicle state sensing system and vehicle state sensing method | |
US9963007B2 (en) | Method for compensating for an inclination | |
US8649978B2 (en) | Velocity calculating device, velocity calculation method, and navigation device | |
JP4831442B2 (ja) | 衝突判定装置 | |
CN104296722B (zh) | 车辆侧倾状态检测方法 | |
US20090138232A1 (en) | Moving body with tilt angle estimating mechanism | |
CN105946866B (zh) | 一种汽车行驶状态预警方法 | |
US11186287B2 (en) | Cant estimating method, cant estimating apparatus, and non-transitory computer-readable storage medium storing program | |
CN109143255B (zh) | 一种铰接轮式装载机姿态预测方法 | |
CN109085381A (zh) | 车载加速度传感器方向校准方法 | |
CN211956223U (zh) | 一种车道变更轨迹规划系统 | |
CN104949646A (zh) | 车体的侧摆角推定装置 | |
CN106886217A (zh) | 自主导航控制方法和装置 | |
JP2016206976A (ja) | 車両の運転支援制御のための先行車軌跡算出装置 | |
CN105953793A (zh) | 一种车辆急转弯的识别方法以及装置 | |
JP2013186718A (ja) | 移動物体位置姿勢推定装置及び方法 | |
WO2014171227A1 (ja) | 姿勢角推定装置およびそれを備える移動状態検出装置 | |
CN110104102A (zh) | 自平衡自行车驱动车轮纵向滑移状态的估计方法 | |
US20220212742A1 (en) | Body posture detection device and straddle type vehicle | |
JP2011055342A (ja) | 車両用撮像装置 |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20191105 Termination date: 20200914 |