发明名称 陡坡和弯曲道路的安全评估方法
摘要 本发明公开了一种陡坡与弯曲道路的安全评估方法,用于解决现有道路坡度测量中随机误差和累积误差较大以及数据缺失时无法测量的技术问题,属于道路行驶安全领域。本发明中陡坡与弯曲道路的安全评估方法,根据车载GPS的测量信息对检测路段进行分段描述与分段拟合,当GPS记录不足以进行平滑处理或者GPS记录缺失如在山洞中行驶时,结合IMU测量信息对GPS测量记录较少的路段进行样条插值和平滑处理,得到道路的拟合曲面方程,进而计算道路的转弯半径、坡度,然后利用递推估计将道路逐段向前推移,通过限定记忆法消除测量中累积误差的影响,提高对道路坡度、弯度等几何参数的计算精度,解决了现有山路难以测量的技术问题,为交通管理部门进行道路路面监测和检查验收提供依据,同时对车辆在该路段安全行驶给出载重、速度要求。
申请公布号 CN103093088A 申请公布日期 2013.05.08
申请号 CN201310008140.9 申请日期 2013.01.09
申请人 西安费斯达自动化工程有限公司 发明人 史忠科;王慧丽
分类号 G06F19/00(2006.01)I 主分类号 G06F19/00(2006.01)I
代理机构 代理人
主权项 1.一种陡坡和弯曲道路的安全评估方法,其步骤包括以下特点: (a)根据道路的线形特征对道路进行分段描述与建模:以测量的初始点为坐标原点建立地理直角坐标系,并对所建立的直角坐标系的坐标轴方向进行校准,使其与地球坐标系的方向相一致,将传感器记录的测量数据转换为地理直角坐标系下x,y,z的关系,根据所检测路段的曲线变化趋势,按照如下方式对路段进行分段描述与建模: <img file="FDA00002720849700011.GIF" wi="885" he="384" />式中,x,y,z表示以测量初始点为坐标原点的地理直角坐标系下的坐标,x<sub>1</sub>,x<sub>2</sub>,…,x<sub>m</sub>以及y<sub>1</sub>,y<sub>2</sub>,…,y<sub>n</sub>分别为x,y方向上的分段点位置,N=m·n为所分路段的个数,f<sub>k</sub>(x,y)第k个(k=1,2,…,N)路段的函数关系式; 在对所检测路段进行分段时,遵循以下原则:a)每一分段路段上只有一个转弯,并且是相应高度z的单值函数;b)转弯等危险路段分段长度较小,直线路段分段长度可相对较大; (b)建立分段路段GPS表达的直角坐标系状态方程,对于不同的分段路段,由于其长度不同,传感器所得测量值的记录条数也不尽相同,当GPS记录值不足以拟合曲面方程,或者GPS数据缺乏如车辆在山洞中行驶时,利用IMU的测量信息对状态方程进行样条插值和平滑估计,在每一分段路段上得到足够多个组合测量估计值,实现对分段路段的样条平滑处理,选取x,y,z,V<sub>x</sub>,V<sub>y</sub>,V<sub>z</sub>为状态变量,n<sub>x</sub>,n<sub>y</sub>,n<sub>z</sub>,L,λ,H为输入变量,建立分段路段的状态方程: <img file="FDA00002720849700021.GIF" wi="1526" he="1062" />式中,x,y,z为地理直角坐标系下的坐标分量,V<sub>x</sub>,V<sub>y</sub>,V<sub>z</sub>分别为车辆载体坐标系下三个方向的速度,L,λ,H分别为车辆所在位置的经度、纬度和高度,Ω为地球相对惯性空间的旋转角速度Ω=15.04107°/h,R<sub>N</sub>=a/(1-e<sup>2</sup>sin<sup>2</sup>L)<sup>1/2</sup>为卯酉圈平面的曲率半径,R<sub>M</sub>=a(1-e<sup>2</sup>)/(1-e<sup>2</sup>sin<sup>2</sup>L)<sup>3/2</sup>为子午面的曲率半径,<img file="FDA00002720849700022.GIF" wi="367" he="81" />为地球的第一偏心率,a=6378137.000m为长半轴长,b=6356752.314m为短半轴的长,g=9.8kg/m<sup>2</sup>为重力角速度,n<sub>x</sub>,n<sub>y</sub>,n<sub>z</sub>为载体坐标系三个方向的过载,W<sub>x</sub>,W<sub>y</sub>,W<sub>z</sub>,<img file="FDA00002720849700023.GIF" wi="236" he="62" />为系统误差,均值为零,方差分别为<img file="FDA00002720849700024.GIF" wi="484" he="75" />(c)根据拟合最小二乘指标: <img file="FDA00002720849700025.GIF" wi="926" he="138" />对采用GPS/IMU共同得到路段直角坐标系的组合测量估计值按照下式进行分段多项式拟合: f<sub>1</sub>(x,y)=a<sub>11</sub>x<sup>3</sup>+a<sub>12</sub>x<sup>2</sup>y+a<sub>13</sub>xy<sup>2</sup>+a<sub>14</sub>y<sup>3</sup>+a<sub>15</sub>x<sup>2</sup>+a<sub>16</sub>xy+a<sub>17</sub>y<sup>2</sup>+a<sub>18</sub>x+a<sub>19</sub>y+a<sub>110</sub>. . f<sub>k</sub>(x,y)=a<sub>k1</sub>x<sup>3</sup>+a<sub>k2</sub>x<sup>2</sup>y+a<sub>k3</sub>xy<sup>2</sup>+a<sub>k4</sub>y<sup>3</sup>+a<sub>k5</sub>x<sup>2</sup>+a<sub>k6</sub>xy+a<sub>k7</sub>y<sup>2</sup>+a<sub>k8</sub>x+a<sub>k9</sub>y+a<sub>k10</sub>. . . . f<sub>N</sub>(x,y)=a<sub>N1</sub>x<sup>3</sup>+a<sub>N2</sub>x<sup>2</sup>y+a<sub>N3</sub>xy<sup>2</sup>+a<sub>N4</sub>y<sup>3</sup>+a<sub>N5</sub>x<sup>2</sup>+a<sub>N6</sub>xy+a<sub>N7</sub>y<sup>2</sup>+a<sub>N8</sub>x+a<sub>N9</sub>y+a<sub>N10</sub>式中,N<sub>k</sub>(k=2,3,…,N)为前k-1个路段拟合时所采用的组合测量估计值的个数,m<sub>k-1</sub>是为了平滑曲线向后平移的组合测量估计值个数,x<sub>i</sub>,y<sub>i</sub>,z<sub>i</sub>(i=1,2,…,N<sub>N</sub>)为第i个组合测量估计值,f<sub>k</sub>(x<sub>i</sub>,y<sub>i</sub>)为第k路段通过模型得到的估计值,a<sub>ij</sub>(i=1,2,…,N,j=1,2,…,10)为模型的待确定系数; 以第k个分段路段的函数表达式f<sub>k</sub>(x,y)为例说明系数a<sub>k1</sub>,a<sub>k2</sub>,…,a<sub>k9</sub>,a<sub>k10</sub>的确定,设用于拟合该路段的组合测量估计值共有s个,为了表示方便,将其表示为x<sub>k1</sub>,y<sub>k1</sub>,z<sub>k1</sub>,x<sub>k2</sub>,y<sub>k2</sub>,z<sub>k2</sub>,…,x<sub>k,s-1</sub>,y<sub>k,s-1</sub>,z<sub>k,s-1</sub>,x<sub>ks</sub>,y<sub>ks</sub>,z<sub>ks</sub>, <img file="FDA00002720849700031.GIF" wi="345" he="369" /><img file="FDA00002720849700032.GIF" wi="1883" he="376" />式中,v为噪声向量; (d)按照下列公式计算第k个路段的坡度θ以及转弯半径R θ=arctan[(3a<sub>k1</sub>x<sup>2</sup>+2a<sub>k2</sub>xy+a<sub>k3</sub>y<sup>2</sup>+2a<sub>k5</sub>x+a<sub>k6</sub>y+a<sub>k8</sub>)<sup>2</sup>+(a<sub>k2</sub>x<sup>2</sup>+2a<sub>k3</sub>xy+3a<sub>k4</sub>y<sup>2</sup>+a<sub>k6</sub>x+2a<sub>k7</sub>y+a<sub>k9</sub>)<sup>2</sup>] R=2{[(3a<sub>k1</sub>x<sup>2</sup>+2a<sub>k2</sub>xy+a<sub>k3</sub>y<sup>2</sup>+2a<sub>k5</sub>x+a<sub>k6</sub>y+a<sub>k8</sub>)<sup>2</sup>+(a<sub>k2</sub>x<sup>2</sup>+2a<sub>k3</sub>xy+3a<sub>k4</sub>y<sup>2</sup>+a<sub>k6</sub>x+2a<sub>k7</sub>y+a<sub>k9</sub>)<sup>2</sup>+1]<sup>3/2</sup>} /{[1+(a<sub>k2</sub>x<sup>2</sup>+2a<sub>k3</sub>xy+3a<sub>k4</sub>y<sup>2</sup>+a<sub>k6</sub>x+2a<sub>k7</sub>y+a<sub>k9</sub>)<sup>2</sup>](6a<sub>k1</sub>x+2a<sub>k2</sub>x+2a<sub>k5</sub>) -2(3a<sub>k1</sub>x<sup>2</sup>+2a<sub>k2</sub>xy+a<sub>k3</sub>y<sup>2</sup>+2a<sub>k5</sub>x+a<sub>k6</sub>y+a<sub>k8</sub>) (a<sub>k2</sub>x<sup>2</sup>+2a<sub>k3</sub>xy+3a<sub>k4</sub>y<sup>2</sup>+a<sub>k6</sub>x+2a<sub>k7</sub>y+a<sub>k9</sub>) +[1+(a<sub>k2</sub>x<sup>2</sup>+2a<sub>k3</sub>xy+3a<sub>k4</sub>y<sup>2</sup>+a<sub>k6</sub>x+2a<sub>k7</sub>y+a<sub>k9</sub>)<sup>2</sup>](2a<sub>k3</sub>x+6a<sub>k4</sub>y+2a<sub>k7</sub>)} (e)根据道路几何线性的设计标准,对于一定的道路坡度角、转弯半径,给出行驶车辆速度、载重量的限制要求。 
地址 710075 陕西省西安市高新区科技路金桥国际广场12101号