《一种汽车行驶状态预警方法.pdf》由会员分享,可在线阅读,更多相关《一种汽车行驶状态预警方法.pdf(14页珍藏版)》请在专利查询网上搜索。
1、10申请公布号CN104290755A43申请公布日20150121CN104290755A21申请号201410533032822申请日20141010B60W40/105201201B60W40/11201201B60W40/112201201B60W40/114201201B60W30/0220120171申请人北京三驰科技发展有限公司地址100085北京市海淀区上地3街9号嘉华大厦F60472发明人张宪龙74专利代理机构北京华夏正合知识产权代理事务所普通合伙11017代理人韩登营张焕亮54发明名称一种汽车行驶状态预警方法57摘要本发明提供一种汽车行驶状态预警方法,包括步骤依据所接收的传。
2、感器信息预判断汽车行驶状态;依据所述汽车行驶状态修正汽车行驶状态特征值;依据所修正的汽车行驶状态特征值输出预警信息。由上,通过解析传感器在汽车行驶过程中的所有采集的数据,计算出不同汽车在不同状态下的汽车行驶状态特征值,将所述汽车行驶状态特征值作为预警的判据,据此输出预警信息以提示驾驶员汽车的潜在危险。51INTCL权利要求书3页说明书7页附图3页19中华人民共和国国家知识产权局12发明专利申请权利要求书3页说明书7页附图3页10申请公布号CN104290755ACN104290755A1/3页21一种汽车行驶状态预警方法,其特征在于,包括步骤A、依据所接收的传感器信息预判断汽车行驶状态;B、依。
3、据所述汽车行驶状态修正汽车行驶状态特征值;C、依据所修正的汽车行驶状态特征值输出预警信息。2根据权利要求1所述的方法,其特征在于,步骤A中,所述汽车行驶状态包括低速行驶状态、颠簸行驶状态、频繁上下坡行驶状态或频繁加速减速行驶状态。3根据权利要求1所述的方法,其特征在于,步骤B中,所述汽车行驶状态特征值包括航向角、俯仰角、横滚角、左转加速度AXJ和右转加速度AYJ。4根据权利要求3所述的方法,其特征在于,当步骤A预判断为低速行驶状态时,步骤B中修正汽车行驶状态特征值中的俯仰角和横滚角。5根据权利要求4所述的方法,其特征在于,步骤B中,计算所述俯仰角和横滚角采用以下公式EXASINCOSMEYEZ。
4、;EZASINCOSMEYEX;式中EX、EY、EZ分别表示X轴、Y轴、Z轴的磁偏量,A、M分别表示比例系数。6根据权利要求3所述的方法,其特征在于,当步骤A预判断为颠簸行驶状态时,步骤B中修正汽车行驶状态特征值中的航向角、俯仰角和横滚角。7根据权利要求6所述的方法,其特征在于,步骤B中,修正汽车行驶状态特征值中的航向角、俯仰角和横滚角采用以下公式GX1GXLYXGYLZXGZ;GX1GX1CCS00COSNORTH_ANGLEPI/1800COSLATITUDEPI/1800WIE/36000CCS10SINLATITUDEPI/1800WIE/36000CCS20SINNORTH_ANGL。
5、EPI/1800COSLATITUDEPI/1800WIE/36000;GY1GYLXYGXLZYGZ;GY1GY1CCS01COSNORTH_ANGLEPI/1800COSLATITUDEPI/1800WIE/36000CCS11SINLATITUDEPI/1800WIE/36000CCS21SINNORTH_ANGLEPI/1800COSLATITUDEPI/1800WIE/36000;GZ1GZLXZGXLYZGY;GZ1GZ1CCS02COSNORTH_ANGLEPI/1800COSLATITUDEPI/1800WIE/36000CCS12SINLATITUDEPI/1800WIE/3。
6、6000CCS22SINNORTH_ANGLEPI/1800COSLATITUDEPI/1800WIE/36000;式中CCS表示陀螺姿态的方向余弦矩阵;GX1、GY1、GZ1分别表示X轴、Y轴、Z轴的轴向角速率;GX、GY、GZ分别表示X轴、Y轴、Z轴的旋转角速率值;LYXGY表示在机械安装中Y轴对X轴的动态影响、LZXGZ表示在机械安装中Z轴对X轴的动态影响;LXYGX表示在机械安装中X轴对Y轴的动态影响,LZYGZ表示在机械安装中Z轴对Y权利要求书CN104290755A2/3页3轴的动态影响;LXZGX表示在机械安装中X轴对Z轴的动态影响,LZYGZ表示在机械安装中Y轴对Z轴的动态影响。
7、;NORTH_ANGLE表示为对北向的夹角、LATITUDE表示为纬度、WIE表示地球自转角速率、PI表示圆周率。8根据权利要求3所述的方法,其特征在于,当步骤A预判断为频繁上下坡行驶状态或频繁加速减速行驶状态时,步骤B中修正汽车行驶状态特征值中的航向角、俯仰角、横滚角、左转加速度和右转加速度。9根据权利要求8所述的方法,其特征在于,步骤B中,修正汽车行驶状态特征值中的航向角、俯仰角、横滚角、左转加速度AXJ和右转加速度AYJ采用以下公式CXCXAX05FQ2Q2Q3Q3AYQ1Q2Q0Q3AZQ1Q3Q0Q2;CYCYAXQ1Q2Q0Q3AYQ1Q1Q3Q3AZQ2Q3Q0Q1;CZCZAX。
8、Q1Q3Q0Q2AZQ1Q1Q2Q3;式中CCS表示陀螺姿态的方向余弦矩阵;CX、CY、CZ分别表示X轴、Y轴、Z轴的标定系数;AX、AY、AZ分别表示X轴、Y轴和Z轴方向的加速度;F表示计算算法的过程量。10根据权利要求2所述的方法,其特征在于,步骤A包括依据所接收的汽车的对地行驶速度,当所述汽车的对地行驶速度小于汽车的对地行驶速阈值时,判断为低速行驶状态;当所述汽车的对地行驶速度大于汽车的对地行驶速阈值时,依据所接收的X轴、Y轴和Z轴三个方向的加速度值,计算所述三个方向的加速度值均方根,当所述加速度值均方根小于加速度值均方根阈值时,判断为颠簸行驶状态;当所述加速度值均方根小于加速度值均方根。
9、阈值时,依据所接收的俯仰角角速度值和横滚角速度值,计算俯仰角角速度值和横滚角速度值的角速度值均方根,当所述角速度值权利要求书CN104290755A3/3页4均方根小于角速度值均方根阈值时,判断为颠簸行驶状态;当所述角速度值均方根大于角速度值均方根阈值时,判断为频繁上下坡行驶状态或频繁加速减速行驶状态。权利要求书CN104290755A1/7页5一种汽车行驶状态预警方法技术领域0001本发明涉及汽车安全领域,特别涉及一种汽车行驶状态预警方法。背景技术0002对于汽车运动姿态的实时准确测量是进行汽车底盘综合控制和对汽车操纵稳定性与主动安全性进行评价的前提和基础。由于传统的采用机械转子陀螺构成机械。
10、平台来测量汽车姿态的方法具有体积大、质量重、安装繁琐以及使用不便等缺陷,使其在汽车上的应用收到了很大限制。随着汽车电子技术的发展,军用传感器得到了迅猛发展,其中最为典型的就是集成微机电子系统传感器,其具有体积小、质量轻、响应快、灵敏度高、低能高、高功率等优势,在汽车上得到广泛使用。0003而集成微机电子系统传感器大多以重力加速度计做为姿态传感器,测量汽车与水平面的俯仰和横滚角,这样测量汽车静态的夹角比较准确,而汽车载姿态有其特殊性,需要反映汽车运动物体的实时姿态,由于加速度计是敏感物体加速度的传感器,这导致汽车在加速启动或突然刹车时有一个较大的加速度,换算成俯仰角角度大概在10度左右,直接导致。
11、了汽车在启动和刹车时,不能真实的反映汽车姿态。图1和图2即反映了汽车在启动和刹车时俯仰角的瞬时变化。发明内容0004本申请提供一种汽车行驶状态预警方法,通过解析传感器在汽车行驶过程中的所有采集的数据,计算出不同汽车在不同状态下的汽车行驶状态特征值,将所述汽车行驶状态特征值作为预警的判据,据此输出预警信息以提示驾驶员汽车的潜在危险。0005所述汽车行驶状态预警方法包括步骤0006依据所接收的传感器信息预判断汽车行驶状态;0007依据所述汽车行驶状态修正汽车行驶状态特征值;0008依据所修正的汽车行驶状态特征值输出预警信息。0009由上,通过解析传感器在汽车行驶过程中的所有采集的数据,计算出不同汽。
12、车在不同状态下的汽车行驶状态特征值,将所述汽车行驶状态特征值作为预警的判据,据此输出预警信息以提示驾驶员汽车的潜在危险。0010可选的,步骤A中,所述汽车行驶状态包括低速行驶状态、颠簸行驶状态、频繁上下坡行驶状态或频繁加速减速行驶状态。0011可选的,步骤B中,所述汽车行驶状态特征值包括航向角、俯仰角、横滚角、左转加速度AXJ和右转加速度AYJ。0012可选的,当步骤A预判断为低速行驶状态时,0013步骤B中修正汽车行驶状态特征值中的俯仰角和横滚角。0014可选的,步骤B中,计算所述俯仰角和横滚角采用以下公式EXASINCOSMEYEZ;EZASINCOSMEYEX;说明书CN10429075。
13、5A2/7页60015式中EX、EY、EZ分别表示X轴、Y轴、Z轴的磁偏量,A、M分别表示比例系数。0016由上,由于低速行驶,加速度计所测量出的左转加速度和右转加速度有效,需对航向角、俯仰角和横滚角进行修正。进一步的,在低速行驶过程中,航向角为标准值,由此仅需计算俯仰角和横滚角,由于磁的低频率特性,波特率约为10帧/秒,故采信磁偏量计算俯仰角和横滚角。0017可选的,当步骤A预判断为颠簸行驶状态时,0018步骤B中修正汽车行驶状态特征值中的航向角、俯仰角和横滚角。0019可选的,步骤B中,修正汽车行驶状态特征值中的航向角、俯仰角和横滚角采用以下公式00200021GX1GXLYXGYLZXG。
14、Z;0022GX1GX1CCS00COSNORTH_ANGLEPI/1800COSLATITUDEPI/1800WIE/36000CCS10SINLATITUDEPI/1800WIE/36000CCS20SINNORTH_ANGLEPI/1800COSLATITUDEPI/1800WIE/36000;0023GY1GYLXYGXLZYGZ;0024GY1GY1CCS01COSNORTH_ANGLEPI/1800COSLATITUDEPI/1800WIE/36000CCS11SINLATITUDEPI/1800WIE/36000CCS21SINNORTH_ANGLEPI/1800COSLATIT。
15、UDEPI/1800WIE/36000;0025GZ1GZLXZGXLYZGY;0026GZ1GZ1CCS02COSNORTH_ANGLEPI/1800COSLATITUDEPI/1800WIE/36000CCS12SINLATITUDEPI/1800WIE/36000CCS22SINNORTH_ANGLEPI/1800COSLATITUDEPI/1800WIE/36000;0027式中CCS表示陀螺姿态的方向余弦矩阵;0028GX1、GY1、GZ1分别表示X轴、Y轴、Z轴的轴向角速率;0029GX、GY、GZ分别表示X轴、Y轴、Z轴的旋转角速率值;0030LYXGY表示在机械安装中Y轴对X轴。
16、的动态影响、LZXGZ表示在机械安装中Z轴对X轴的动态影响;0031LXYGX表示在机械安装中X轴对Y轴的动态影响,LZYGZ表示在机械安装中Z轴对Y轴的动态影响;0032LXZGX表示在机械安装中X轴对Z轴的动态影响,LZYGZ表示在机械安装中Y轴对Z轴的动态影响;0033NORTH_ANGLE表示为对北向的夹角、LATITUDE表示为纬度、WIE表示地球自转角速率、PI表示圆周率。0034由上,速度较高时,采信陀螺姿态矩阵算法,其波特率更新达100帧/秒。进一步的,去除在机械安装中三轴间的动态影响,提高测量准确性。0035可选的,当步骤A预判断为频繁上下坡行驶状态或频繁加速减速行驶状态时,。
17、说明书CN104290755A3/7页70036步骤B中修正汽车行驶状态特征值中的航向角、俯仰角、横滚角、左转加速度和右转加速度。0037可选的,步骤B中,修正汽车行驶状态特征值中的航向角、俯仰角、横滚角、左转加速度AXJ和右转加速度AYJ采用以下公式003800390040CXCXAX05FQ2Q2Q3Q3AYQ1Q2Q0Q3AZQ1Q3Q0Q2;0041CYCYAXQ1Q2Q0Q3AYQ1Q1Q3Q3AZQ2Q3Q0Q1;0042CZCZAXQ1Q3Q0Q2AZQ1Q1Q2Q3;004300440045式中CCS表示陀螺姿态的方向余弦矩阵;0046CX、CY、CZ分别表示X轴、Y轴、Z轴的。
18、标定系数;0047AX、AY、AZ分别表示X轴、Y轴和Z轴方向的加速度;0048F表示计算算法的过程量。0049由上,当出现汽车是否频繁上下坡行驶或频繁加速减速行驶时,则属于最为复杂的路况,故传感器所采集的数据均无法采信,即对5个输出值分别进行修正。结合上述磁偏量计算公式和陀螺姿态矩阵修正上述5个输出值,由磁偏量计算公式提供初始值,由陀螺姿态矩阵提供积分。0050可选的,步骤A包括0051依据所接收的汽车的对地行驶速度,当所述汽车的对地行驶速度小于汽车的对地行驶速阈值时,判断为低速行驶状态;0052当所述汽车的对地行驶速度大于汽车的对地行驶速阈值时,依据所接收的X轴、Y轴和Z轴三个方向的加速度。
19、值,计算所述三个方向的加速度值均方根,当所述加速度值均方根小于加速度值均方根阈值时,判断为颠簸行驶状态;0053当所述加速度值均方根小于加速度值均方根阈值时,依据所接收的俯仰角角速度值和横滚角速度值,计算俯仰角角速度值和横滚角速度值的角速度值均方根,当所述角速度值均方根小于角速度值均方根阈值时,判断为颠簸行驶状态;说明书CN104290755A4/7页80054当所述角速度值均方根大于角速度值均方根阈值时,判断为频繁上下坡行驶状态或频繁加速减速行驶状态。0055由上,分别通过不同采集量判断汽车的行驶状态,从而分别修正不同汽车行驶状态特征值,已达到最佳预警。附图说明0056图1为未采用本发明方案。
20、时汽车在启动时俯仰角的瞬时变化;0057图2为未采用本发明方案时汽车在刹车时俯仰角的瞬时变化;0058图3为汽车行驶状态预警方法的流程图;0059图4为采用本发明方案后汽车在启动时俯仰角的瞬时变化;0060图5为采用本发明方案后汽车在刹车时俯仰角的瞬时变化。具体实施方式0061本发明所涉及的汽车行驶状态预警方法,通过解析传感器在汽车行驶过程中的所有采集的数据,计算出不同汽车在不同状态下的汽车行驶状态特征值,将所述汽车行驶状态特征值作为预警的判据,据此输出预警信息以提示驾驶员汽车的潜在危险。所述汽车行驶状态特征值包括航向角、俯仰角、横滚角、左转加速度AXJ和右转加速度AYJ。0062本实施例中,。
21、设置于汽车上的各类传感器所采集的数据包括加速度传感器所采集的X轴、Y轴和Z轴方向的加速度AX、AY和AZ;0063陀螺仪所采集的车辆围绕X轴、Y轴和Z轴轴向的旋转角速率值GX、GY和GZ;0064磁阻传感器所采集的车辆与X轴、Y轴和Z轴的磁偏量EX、EY和EZ;0065上述坐标系的原点为汽车重心,X轴指向北,Y轴指向东,Z轴沿地垂线指向地,X轴、Y轴和Z轴构成右手坐标系。0066如图1所述汽车行驶状态预警方法的流程图,具体包括0067步骤S10预判断汽车是否低速行驶,若判断结果为否,则进入步骤S20,否则进入步骤S30。0068当传感器采集到汽车的对地行驶速度是小于48KM/H时,判定汽车为低。
22、速行驶,表明汽车的行驶姿态相对稳定,进入步骤S20。反之三个方向加计均方根是否大于设定值,汽车的对地行驶速度是高于48KM/H时,汽车在较高速度下行驶,进入步骤S30。本步骤中,若以X轴方向的加速度AX为基准值,则X轴方向的加速度AX即为汽车的对地行驶速度。0069步骤S20修正计算俯仰角和横滚角。0070由于速度小于48KM/H时,则认为加速度计所测量出的左转加速度AXJ和右转加速度AYJ有效。由此需对航向角、俯仰角和横滚角进行修正。0071进一步的,在低速行驶过程中,航向角为标准值,由此仅需计算俯仰角和横滚角,由于磁的低频率特性,波特率约为10帧/秒,故采信磁偏量计算俯仰角和横滚角。007。
23、2磁偏量计算公式为EXASINCOSMEYEZ、EZASINCOSMEYEX,式中A、M分别表示比例系数。最终通过上述两计算公式计算出俯仰角和横滚角,结合通过传感器检测到的左转加速度AXJ、右转加速度AYJ和航向说明书CN104290755A5/7页9角一并输出,跳转至步骤S70。0073步骤S30在汽车非低速行驶状态下,预判断汽车行驶是否颠簸。0074判断路面是否颠簸主要依据是X轴、Y轴和Z轴三个方向的加速度计均方根是否大于阈值,若大于阈值,则表示汽车行驶颠簸,进入步骤S50,否则进入步骤S40。0075本步骤所采用的公式为即M大于阈值时,表示路面颠簸。0076步骤S40修正计算航向角、俯仰。
24、角和横滚角。0077车速大于48KM/H时,若仍采用磁偏量计算,则导致其更新数据无法适应高速情况,此时需采信陀螺姿态矩阵算法,其波特率更新达100帧/秒。0078陀螺姿态的方向余弦矩阵表示为007900800081陀螺姿态矩阵算法表示为GX1GXLYXGYLZXGZ,式中GX1表示待求解的X轴向的角速率,GX表示传感器所检测的X旋转角速率值,LYXGY表示在机械安装中Y轴对X轴的动态影响,LZXGZ表示在机械安装中Z轴对X轴的动态影响。0082进一步的,还需去除纬度和北向分量对待求解的X轴向的角速率影响,计算式表示为0083GX1GX1CCS00COSNORTH_ANGLEPI/1800COS。
25、LATITUDEPI/1800WIE/36000CCS10SINLATITUDEPI/1800WIE/36000CCS20SINNORTH_ANGLEPI/1800COSLATITUDEPI/1800WIE/36000,式中NORTH_ANGLE表示为对北向的夹角、LATITUDE表示为纬度、WIE表示地球自转角速率、PI表示圆周率。0084通过上述两组计算式即可求出X轴向的角速率GX1,通过对X轴向的角速率GX1积分,即求得修正后的俯仰角。0085采用公式GY1GYLXYGXLZYGZ,式中GY1表示待求解的Y轴向的角速率,GY表示传感器所检测的Y轴旋转角速率值,LXYGX表示在机械安装中X。
26、轴对Y轴的动态影响,LZYGZ表示在机械安装中Z轴对Y轴的动态影响。0086去除纬度和北向分量对待求解的Y轴向的角速率影响,计算式表示为0087GY1GY1CCS01COSNORTH_ANGLEPI/1800COSLATITUDEPI/1800WIE/36000CCS11SINLATITUDEPI/1800WIE/36000CCS21SINNORTH_ANGLEPI/1800COSLATITUDEPI/1800WIE/36000。通过上述两组计算式即可求出Y轴向的角速率GY1,通过对Y轴向的角速率GY1积分,即求得修正后的横滚角。说明书CN104290755A6/7页100088同理,采用公式。
27、GZ1GZLXZGXLYZGY,式中GZ1表示待求解的Z轴向的角速率,GZ表示传感器所检测的Z轴旋转角速率值,LXZGX表示在机械安装中X轴对Z轴的动态影响,LZYGZ表示在机械安装中Y轴对Z轴的动态影响。0089去除纬度和北向分量对待求解的Z轴向的角速率影响,计算式表示为0090GZ1GZ1CCS02COSNORTH_ANGLEPI/1800COSLATITUDEPI/1800WIE/36000CCS12SINLATITUDEPI/1800WIE/36000CCS22SINNORTH_ANGLEPI/1800COSLATITUDEPI/1800WIE/36000。通过上述两组计算式即可求出Z。
28、轴向的角速率GZ1,通过对Z轴向的角速率GZ1积分,即求得修正后的航向角。0091将所修正后的俯仰角、横滚角和航向角,以及有传感器采集到的左转加速度AXJ、右转加速度AYJ一并输出,跳转至步骤S70。0092步骤S50预判断汽车是否频繁上下坡行驶或频繁加速减速行驶。0093判断频繁上下坡或加速减速主要依据是俯仰角角速度和横滚角速度的均方根是否大于设定值,若是,则表示汽车频繁上下坡或加速减速运行,进入步骤S60;否则返回步骤S40。0094本步骤所采用的公式为即N大于阈值N时,表示汽车是否频繁上下坡行驶或频繁加速减速行驶。0095步骤S60修正计算航向角、俯仰角、横滚角、左转加速度AXJ和右转加。
29、速度AYJ。0096当出现汽车是否频繁上下坡行驶或频繁加速减速行驶时,则属于最为复杂的路况,故传感器所采集的数据均无法采信,即对5个输出值分别进行修正。0097本实施例中,采用结合四元素算法,采用组合姿态矩阵,结合上述磁偏量计算公式和陀螺姿态矩阵修正上述5个输出值,由磁偏量计算公式提供初始值,由陀螺姿态矩阵提供积分,其表达式为0098CXCXAX05FQ2Q2Q3Q3AYQ1Q2Q0Q3AZQ1Q3Q0Q2;0099CYCYAXQ1Q2Q0Q3AYQ1Q1Q3Q3AZQ2Q3Q0Q1;0100CZCZAXQ1Q3Q0Q2AZQ1Q1Q2Q3;0101四元素的求解方程组表示为0102式中F表示计。
30、算算法的过程量,CX、CY、CZ分别表示X轴、Y轴、Z轴的标定系数。0103采用上述计算式分别求得俯仰角、横滚角和航向角,以及X轴、Y轴和Z轴方向的加速度AX、AY和AZ,进一步的,依据上述三个加速度值计算左转加速度AXJ和右转加速度AYJ,01040105最终,将所修正后的俯仰角、横滚角、航向角、左转加速度AXJ和右转加速度AYJ一并输出,跳转至步骤S70。说明书CN104290755A107/7页110106步骤S70依据计算结果输出预警提示信息。0107本步骤接收到步骤S20,步骤S40或步骤S60所输出的俯仰角、横滚角和航向角、左转加速度AXJ和右转加速度AYJ,依据上述五个数据计算出。
31、汽车的实时姿态,并转换为语音信息输出。进一步的,还存储有不同情况下各项数据的标准值,某一数据超出标准值是,通过语音信息进行报警。所述将俯仰角、横滚角和航向角、左转加速度AXJ和右转加速度AYJ计算汽车姿态属于现有技术,本实施例不再对其进行赘述。0108进一步的,还可在驾驶舱内设置有空气质量传感器,以检测驾驶舱的空气质量,并通过语音输出。0109图4和图5所示即为经过本实施例方案修正后的汽车启动时俯仰角的瞬时变化,可见,经过本实施例方案修正后,消除了汽车在加速启动或突然刹车时由于加速度导致的俯仰角角度变化。0110以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,总之凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。说明书CN104290755A111/3页12图1图2说明书附图CN104290755A122/3页13图3图4说明书附图CN104290755A133/3页14图5说明书附图CN104290755A14。