基于传感技术分析危险驾驶的安全报警方法
技术领域
本发明属于安全报警处理技术领域,特别涉及基于传感技术分析危险驾驶的安全报警方法。
背景技术
随着社会经济的发展,道路基础设施建设越来越完备,人们生活水平逐渐提高,汽车的保有量也越来越大,汽车保有量增大的同时,交通事故的发生频次也越来越高,在人流车流较少的区域发生的事故,往往由于不能及时发现,而导致车辆驾驶人员或乘坐人员耽误最佳救治时间,伴随着智能手机的普及和应用,手机已经成为人们形影不离的伙伴,通信网络的发展使得手机的功能越来越强大,在给汽车提供导航的同时,利用手机来进行危险情况或者事故的报警将会有较大的市场前景;因此,提供一种结构合理、使用方便、适用范围广、市场前景大的基于传感技术分析危险驾驶的安全报警方法是非常有必要的。
发明内容
本发明的目的是为了克服现有技术的不足,而提供一种结构合理、使用方便、适用范围广、市场前景大的基于传感技术分析危险驾驶的安全报警方法。
本发明的目的是这样实现的:基于传感技术分析危险驾驶的安全报警方法,所述方法包括以下步骤:
步骤1):进入导航模式;直接用手机地图进行导航,或手机通过蓝牙连接车载GPS导航仪进行导航;
步骤2):获取加速度计和陀螺仪数据,并进行融合计算,得到RT;
步骤3):判断RT是否超过阈值;如果超过阈值则进入步骤4),如果没有超过阈值,则循环步骤2);
步骤4):继续获取加速度计和陀螺仪数据并融合计算,得到RTN;如果RTN为0,则报警模块启动,若RTN为正常值,则提示选择模块启动。
所述的步骤2)中获取加速度计和陀螺仪数据,并进行融合计算,采用以下步骤:
步骤21):加速度计获取到矢量R=[Rx,Ry,Rz]及矢量R与X、Y、Z三个轴的夹角值Axr、Ayr、Azr;加速度计还获取到测量值Racc=[RxAcc,RyAcc,RzAcc];陀螺仪获取到角速度变化率Rate:假设设备水平放置在XY平面,则惯性力矢量R在XZ平面和YZ平面的投影为分别为Rxz和Ryz,定义Z轴与Rxz向量和Ryz所成的夹角为Axz和Ayz,陀螺仪测量的是角度的变化率,先假设在t0时刻,已测得绕Y轴旋转的角度(也就是Axz),定义为Axz0,之后在t1时刻我们再次测量这个角度,得到Axz1;角度变化率按下面方法计算:RateAxz=(Axz1–Axz0)/(t1–t0);
步骤22):融合计算加速度计和陀螺仪数据;引入一个新的向量Rest=[RxEst,RyEst,RzEst],令Rest(0)=Racc(0),则
RxEst(0)=RxAcc(0) RyEst(0)=RyAcc(0) RzEst(0)=RzAcc(0)
令每个等时间间隔T做一次测量,时间间隔T的取值范围为10ms-100ms,得到新的测量值Racc(1),Racc(2),Racc(3),……Racc(n),在每个时间间隔计算新的估算值Rest(1),Rest(2),Rest(3),……Rest(n);
假设在第n步,有两列已知的值Rest(n-1),Racc(n)
根据陀螺仪向量图由Rz和Rxz组成的直角三角形可得出: tan(Axz)=Rx/Rz=>Axz=atan2(Rx,Rz),
在已经知道估算值RxEst(n-1)和RzEst(n-1)的前提下,可得出: Axz(n-1)=atan2(RxEst(n-1),RzEst(n-1)), 陀螺仪测量的是Axz角度变化率,因此,可以按如下方法估算新的角度Axz(n):Axz(n)=Axz(n-1)+RateAxz(n)*T, 同理可得: Ayz(n)=Ayz(n-1)+RateAyz(n)*T,
由于RateAxz可由陀螺仪直接读取得到,通过使用平均转速RateAxzAvg可得到下列公式: RateAxzAvg=(RateAxz(N)+RateAxz(N-1))/2; Axz(n)=Axz(n-1)+RateAxzAvg*T; 同理可得: Ayz(n)=Ayz(n-1)+RateAyz(n)*T;
在此引入向量Rgyro=[RxGyro,RyGyro,RzGyro],有上述公式可得:
RxGyro=sin(Axz(n))/SQRT(1+cos(Axz(n))^2*tan(Ayz(n))^2); 同理可得: RyGyro=sin(Ayz(n))/SQRT(1+cos(Ayz(n))^2*tan(Axz(n))^2);
则Rest(n)=(Racc*w1+Rgyro*w2)/(w1+w2),分子分母同除以w1,公式可简化为:Rest(n)=(Racc*w1/w1+Rgyro*w2/w1)/(w1/w1+w2/w1); 令w2=w1=wGyro,可得: Rest(n)=(Racc+Rgyro*wGyro)/(1+wGyro),用RT来表示Rest(n),则RT=(Racc+Rgyro*wGyro)/(1+wGyro),将wGyro表示对加速度计和陀螺仪的相信程度,其取值范围为5-20。
所述的步骤4)中的报警模块包括短信告警模块、位置发送模块、语音电话模块,所述的报警模块分别连接有服务器和紧急联系人,所述的服务器连接有110报警和120报警;所述的报警模块连接手机的处理器,所述的处理器连接加速度计和陀螺仪;
所述的步骤4)中的提示选择模块包括以下步骤,当RT超过阈值后,再继续获得的RTN恢复正常值后,提示选择模块启动,提示使用者是否报警及确定使用者是否安全,其主要采用以下方法:文字信息提醒或语音信息提醒。
所述的步骤4)中的RTN的计算方法与所述的RT的计算方法一致,所述的RTN为测得超过阈值之后的RT之后的测得计算值,RTN为RT之后每隔一段时间的测得值,其间隔时间为2S、4S、6S、8S……,直到测得的RTN值在阈值之内时,再重复检测RT的数值。
所述的方法采用以下硬件设备,包括:
一个手机;所述的手机包括一个或多个处理器,所述的手机至少包括陀螺仪、加速度计、存储器、GPS接收器、显示屏、通讯模块;所述的手机内设置有导航地图,所述的通讯模块为以太网、4G模块、ZigBee通讯模块、WiFi通讯模块、蓝牙模块中的一种或多种的组合。
本发明的有益效果:本发明采用加速度计和陀螺仪,通过加速度计和陀螺仪的数据进行计算,根据得到的计算结果RT进行判断,当超过阈值时,继续获取加速度计和陀螺仪数据进行计算,得到RTN,若RTN出现数值为0的情况,即车辆出现了非常大的加速度变化后突然静止,可以判定为发生事故,阈值的设置可以综合参考交通事故发生时的车辆的RT值,在报警后,可以及时通知紧急联系人、110或120,避免因为交通事故发生后,车上乘客受伤过重,无法及时对外联系,从而耽误最佳抢救时间,若出现RT值超过阈值,之后RTN值正常的情况下,可以启动提示选择模块,由乘客或驾驶员手动确认是否安全,是否需要报警,其选择的选项和提示时间的设置,可以由使用者自助选择设置,提示选择模块可以采用文字信息提醒或语音信息提醒;本发明具有结构合理、使用方便、适用范围广、市场前景大的优点。
附图说明
图1是本发明基于传感技术分析危险驾驶的安全报警方法的流程图。
图2是本发明基于传感技术分析危险驾驶的安全报警方法所采用的报警模块的结构示意图。
图3是本发明基于传感技术分析危险驾驶的安全报警方法的加速度计向量关系模型图的结构示意图。
图4是本发明基于传感技术分析危险驾驶的安全报警方法的陀螺仪向量关系模型图的结构示意图。
具体实施方式
下面结合附图对本发明做进一步的说明。
实施例1
如图1-4所示,基于传感技术分析危险驾驶的安全报警方法,所述方法包括以下步骤:
步骤1):进入导航模式;直接用手机地图进行导航,或手机通过蓝牙连接车载GPS导航仪进行导航;
步骤2):获取加速度计和陀螺仪数据,并进行融合计算,得到RT;
步骤3):判断RT是否超过阈值;如果超过阈值则进入步骤4),如果没有超过阈值,则循环步骤2);
步骤4):继续获取加速度计和陀螺仪数据并融合计算,得到RTN;如果RTN为0,则报警模块启动,若RTN为正常值,则提示选择模块启动。
所述的步骤2)中获取加速度计和陀螺仪数据,并进行融合计算,采用以下步骤:
步骤21):加速度计获取到矢量R=[Rx,Ry,Rz]及矢量R与X、Y、Z三个轴的夹角值Axr、Ayr、Azr;加速度计还获取到测量值Racc=[RxAcc,RyAcc,RzAcc];陀螺仪获取到角速度变化率Rate:假设设备水平放置在XY平面,则惯性力矢量R在XZ平面和YZ平面的投影为分别为Rxz和Ryz,定义Z轴与Rxz向量和Ryz所成的夹角为Axz和Ayz,陀螺仪测量的是角度的变化率,先假设在t0时刻,已测得绕Y轴旋转的角度(也就是Axz),定义为Axz0,之后在t1时刻我们再次测量这个角度,得到Axz1;角度变化率按下面方法计算:RateAxz=(Axz1–Axz0)/(t1–t0);
步骤22):融合计算加速度计和陀螺仪数据;引入一个新的向量Rest=[RxEst,RyEst,RzEst],令Rest(0)=Racc(0),则
RxEst(0)=RxAcc(0) RyEst(0)=RyAcc(0) RzEst(0)=RzAcc(0)
令每个等时间间隔T做一次测量,时间间隔T的取值范围为10ms-100ms,得到新的测量值Racc(1),Racc(2),Racc(3),……Racc(n),在每个时间间隔计算新的估算值Rest(1),Rest(2),Rest(3),……Rest(n);
假设在第n步,有两列已知的值Rest(n-1),Racc(n)
根据陀螺仪向量图由Rz和Rxz组成的直角三角形可得出: tan(Axz)=Rx/Rz=>Axz=atan2(Rx,Rz),
在已经知道估算值RxEst(n-1)和RzEst(n-1)的前提下,可得出: Axz(n-1)=atan2(RxEst(n-1),RzEst(n-1)), 陀螺仪测量的是Axz角度变化率,因此,可以按如下方法估算新的角度Axz(n):Axz(n)=Axz(n-1)+RateAxz(n)*T, 同理可得: Ayz(n)=Ayz(n-1)+RateAyz(n)*T,
由于RateAxz可由陀螺仪直接读取得到,通过使用平均转速RateAxzAvg可得到下列公式: RateAxzAvg=(RateAxz(N)+RateAxz(N-1))/2; Axz(n)=Axz(n-1)+RateAxzAvg*T; 同理可得: Ayz(n)=Ayz(n-1)+RateAyz(n)*T;
在此引入向量Rgyro=[RxGyro,RyGyro,RzGyro],有上述公式可得:
RxGyro=sin(Axz(n))/SQRT(1+cos(Axz(n))^2*tan(Ayz(n))^2); 同理可得: RyGyro=sin(Ayz(n))/SQRT(1+cos(Ayz(n))^2*tan(Axz(n))^2);
则Rest(n)=(Racc*w1+Rgyro*w2)/(w1+w2),分子分母同除以w1,公式可简化为:Rest(n)=(Racc*w1/w1+Rgyro*w2/w1)/(w1/w1+w2/w1); 令w2=w1=wGyro,可得: Rest(n)=(Racc+Rgyro*wGyro)/(1+wGyro),用RT来表示Rest(n),则RT=(Racc+Rgyro*wGyro)/(1+wGyro),将wGyro表示对加速度计和陀螺仪的相信程度,其取值范围为5-20。
所述的步骤4)中的报警模块包括短信告警模块、位置发送模块、语音电话模块,所述的报警模块分别连接有服务器和紧急联系人,所述的服务器连接有110报警和120报警;所述的报警模块连接手机的处理器,所述的处理器连接加速度计和陀螺仪;
所述的步骤4)中的提示选择模块包括以下步骤,当RT超过阈值后,再继续获得的RTN恢复正常值后,提示选择模块启动,提示使用者是否报警及确定使用者是否安全,其主要采用以下方法:文字信息提醒或语音信息提醒。
所述的步骤4)中的RTN的计算方法与所述的RT的计算方法一致,所述的RTN为测得超过阈值之后的RT之后的测得计算值,RTN为RT之后每隔一段时间的测得值,其间隔时间为2S、4S、6S、8S……,直到测得的RTN值在阈值之内时,再重复检测RT的数值。
本发明采用加速度计和陀螺仪,通过加速度计和陀螺仪的数据进行计算,根据得到的计算结果RT进行判断,当超过阈值时,继续获取加速度计和陀螺仪数据进行计算,得到RTN,若RTN出现数值为0的情况,即车辆出现了非常大的加速度变化后突然静止,可以判定为发生事故,阈值的设置可以综合参考交通事故发生时的车辆的RT值,在报警后,可以及时通知紧急联系人、110或120,避免因为交通事故发生后,车上乘客受伤过重,无法及时对外联系,从而耽误最佳抢救时间,若出现RT值超过阈值,之后RTN值正常的情况下,可以启动提示选择模块,由乘客或驾驶员手动确认是否安全,是否需要报警,其选择的选项和提示时间的设置,可以由使用者自助选择设置,提示选择模块可以采用文字信息提醒或语音信息提醒;本发明具有结构合理、使用方便、适用范围广、市场前景大的优点。
实施例2
如图1-4所示,基于传感技术分析危险驾驶的安全报警方法,所述方法包括以下步骤:
步骤1):进入导航模式;直接用手机地图进行导航,或手机通过蓝牙连接车载GPS导航仪进行导航;
步骤2):获取加速度计和陀螺仪数据,并进行融合计算,得到RT;
步骤3):判断RT是否超过阈值;如果超过阈值则进入步骤4),如果没有超过阈值,则循环步骤2);
步骤4):继续获取加速度计和陀螺仪数据并融合计算,得到RTN;如果RTN为0,则报警模块启动,若RTN为正常值,则提示选择模块启动。
所述的步骤2)中获取加速度计和陀螺仪数据,并进行融合计算,采用以下步骤:
步骤21):加速度计获取到矢量R=[Rx,Ry,Rz]及矢量R与X、Y、Z三个轴的夹角值Axr、Ayr、Azr;加速度计还获取到测量值Racc=[RxAcc,RyAcc,RzAcc];陀螺仪获取到角速度变化率Rate:假设设备水平放置在XY平面,则惯性力矢量R在XZ平面和YZ平面的投影为分别为Rxz和Ryz,定义Z轴与Rxz向量和Ryz所成的夹角为Axz和Ayz,陀螺仪测量的是角度的变化率,先假设在t0时刻,已测得绕Y轴旋转的角度(也就是Axz),定义为Axz0,之后在t1时刻我们再次测量这个角度,得到Axz1;角度变化率按下面方法计算:RateAxz=(Axz1–Axz0)/(t1–t0);
步骤22):融合计算加速度计和陀螺仪数据;引入一个新的向量Rest=[RxEst,RyEst,RzEst],令Rest(0)=Racc(0),则
RxEst(0)=RxAcc(0) RyEst(0)=RyAcc(0) RzEst(0)=RzAcc(0)
令每个等时间间隔T做一次测量,时间间隔T的取值范围为10ms-100ms,得到新的测量值Racc(1),Racc(2),Racc(3),……Racc(n),在每个时间间隔计算新的估算值Rest(1),Rest(2),Rest(3),……Rest(n);
假设在第n步,有两列已知的值Rest(n-1),Racc(n)
根据陀螺仪向量图由Rz和Rxz组成的直角三角形可得出: tan(Axz)=Rx/Rz=>Axz=atan2(Rx,Rz),
在已经知道估算值RxEst(n-1)和RzEst(n-1)的前提下,可得出: Axz(n-1)=atan2(RxEst(n-1),RzEst(n-1)), 陀螺仪测量的是Axz角度变化率,因此,可以按如下方法估算新的角度Axz(n):Axz(n)=Axz(n-1)+RateAxz(n)*T, 同理可得: Ayz(n)=Ayz(n-1)+RateAyz(n)*T,
由于RateAxz可由陀螺仪直接读取得到,通过使用平均转速RateAxzAvg可得到下列公式: RateAxzAvg=(RateAxz(N)+RateAxz(N-1))/2; Axz(n)=Axz(n-1)+RateAxzAvg*T; 同理可得: Ayz(n)=Ayz(n-1)+RateAyz(n)*T;
在此引入向量Rgyro=[RxGyro,RyGyro,RzGyro],有上述公式可得:
RxGyro=sin(Axz(n))/SQRT(1+cos(Axz(n))^2*tan(Ayz(n))^2); 同理可得: RyGyro=sin(Ayz(n))/SQRT(1+cos(Ayz(n))^2*tan(Axz(n))^2);
则Rest(n)=(Racc*w1+Rgyro*w2)/(w1+w2),分子分母同除以w1,公式可简化为:Rest(n)=(Racc*w1/w1+Rgyro*w2/w1)/(w1/w1+w2/w1); 令w2=w1=wGyro,可得: Rest(n)=(Racc+Rgyro*wGyro)/(1+wGyro),用RT来表示Rest(n),则RT=(Racc+Rgyro*wGyro)/(1+wGyro),将wGyro表示对加速度计和陀螺仪的相信程度,其取值范围为5-20。
所述的步骤4)中的报警模块包括短信告警模块、位置发送模块、语音电话模块,所述的报警模块分别连接有服务器和紧急联系人,所述的服务器连接有110报警和120报警;所述的报警模块连接手机的处理器,所述的处理器连接加速度计和陀螺仪;
所述的步骤4)中的提示选择模块包括以下步骤,当RT超过阈值后,再继续获得的RTN恢复正常值后,提示选择模块启动,提示使用者是否报警及确定使用者是否安全,其主要采用以下方法:文字信息提醒或语音信息提醒。
所述的步骤4)中的RTN的计算方法与所述的RT的计算方法一致,所述的RTN为测得超过阈值之后的RT之后的测得计算值,RTN为RT之后每隔一段时间的测得值,其间隔时间为2S、4S、6S、8S……,直到测得的RTN值在阈值之内时,再重复检测RT的数值。
所述的方法采用以下硬件设备,包括:
一个手机;所述的手机包括一个或多个处理器,所述的手机至少包括陀螺仪、加速度计、存储器、GPS接收器、显示屏、通讯模块;所述的手机内设置有导航地图,所述的通讯模块为以太网、4G模块、ZigBee通讯模块、WiFi通讯模块、蓝牙模块中的一种或多种的组合。
本发明采用加速度计和陀螺仪,通过加速度计和陀螺仪的数据进行计算,根据得到的计算结果RT进行判断,当超过阈值时,继续获取加速度计和陀螺仪数据进行计算,得到RTN,若RTN出现数值为0的情况,即车辆出现了非常大的加速度变化后突然静止,可以判定为发生事故,阈值的设置可以综合参考交通事故发生时的车辆的RT值,在报警后,可以及时通知紧急联系人、110或120,避免因为交通事故发生后,车上乘客受伤过重,无法及时对外联系,从而耽误最佳抢救时间,若出现RT值超过阈值,之后RTN值正常的情况下,可以启动提示选择模块,由乘客或驾驶员手动确认是否安全,是否需要报警,其选择的选项和提示时间的设置,可以由使用者自助选择设置,提示选择模块可以采用文字信息提醒或语音信息提醒;本发明的方法可以设计在手机地图软件内,经常使用手机导航的用户可以使用带有本方法的手机地图,紧急联系人及报警的选择可以由用户自行设定,对于经常驾驶的用户可以提供良好的安全报警需求,避免事故发生不能及时报警带来救助时间的延误,本发明具有结构合理、使用方便、适用范围广、市场前景大的优点。