发明名称 一种面向高速公路的车道级增强型矢量数字地图制作方法
摘要 本发明公开了一种面向高速公路的车道级增强型矢量数字地图制作方法。本发明通过以下技术方案实现:首先在需要测绘的道路上选择一条车道,确定车道的起点和终点;利用信息采集车辆采集车道的位置信息,根据所采信息选取车道的节点;通过高斯‑克吕格投影对节点进行大地坐标系到高斯平面直角坐标系的转换;利用最小二乘法对节点进行筛选得到车道的最终矢量数据;最后利用上述方法得到需要测绘的道路上其它车道的最终矢量数据,并借助相关数字地图制作软件将最终矢量数据制作生成面向高速公路的车道级增强型矢量数字地图。本发明制作出的数字地图包含道路的车道信息,相对于一般的数字地图精度更高。
申请公布号 CN106156267A 申请公布日期 2016.11.23
申请号 CN201610078232.8 申请日期 2016.02.04
申请人 东南大学 发明人 李旭;蔡志祥;徐启敏
分类号 G06F17/30(2006.01)I;G01C21/32(2006.01)I 主分类号 G06F17/30(2006.01)I
代理机构 南京苏高专利商标事务所(普通合伙) 32204 代理人 柏尚春
主权项 一种面向高速公路的车道级增强型矢量数字地图制作方法,其特征在于,包含如下步骤:步骤一:选择需要测绘的路段并将其定义为目标道路,确定目标道路的起点和终点;目标道路的选取范围为我国的高速公路,并且目标道路应光滑连续、不包含交叉路口;鉴于步骤二中所采用的高斯‑克吕格投影在小范围内精度较高,且误差会随着投影范围的增大而不断变大,故本发明中所选目标道路的长度不超过5km。步骤二:在目标道路上选择一条车道并将其定义为目标车道,确定目标车道的起点和终点,利用信息采集车辆采集目标车道的位置信息;所述信息采集车辆搭载了组合导航系统,水平定位精度的圆概率误差小于0.02m,输出频率为20Hz,可以实时输出车辆所在位置的经纬度信息P<sub>i</sub>(L<sub>i</sub>,B<sub>i</sub>),其中L<sub>i</sub>表示信息采集车辆在目标车道上采集到的第i组车道位置信息中的经度信息,B<sub>i</sub>表示信息采集车辆在目标车道上采集到的第i组车道位置信息中的纬度信息,i=1,2,3…。车道位置信息采集过程中为了使信息采集点尽可能的分布均匀,将车速控制在60‑70km/h(16.67‑19.44m/s),并保持在目标车道的中心匀速行驶。步骤三:将目标车道上的车道位置信息采集点P<sub>i</sub>(L<sub>i</sub>,B<sub>i</sub>)定义为车道的节点,假设从目标车道起点到目标车道终点之间有m个节点。通过3度带高斯‑克吕格投影对上述m个节点的经纬度坐标进行大地坐标系到高斯平面直角坐标系的转换;本发明根据起始节点P<sub>1</sub>(L<sub>1</sub>,B<sub>1</sub>)选定P<sub>0</sub>(L<sub>0</sub>,B<sub>0</sub>)作为高斯‑克吕格投影的原点,其中L<sub>0</sub>=3A,A为(L<sub>1</sub>/3)四舍五入取整的值,B<sub>0</sub>=0°;坐标转换公式如下:<maths num="0001"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msub><mi>x</mi><mi>i</mi></msub><mo>=</mo><msub><mi>X</mi><msub><mi>B</mi><mi>i</mi></msub></msub><mo>+</mo><mfrac><mn>1</mn><mn>2</mn></mfrac><msup><mi>Ntl</mi><mn>2</mn></msup><msup><mi>cos</mi><mn>2</mn></msup><msub><mi>B</mi><mi>i</mi></msub><mo>+</mo><mfrac><mn>1</mn><mn>24</mn></mfrac><mi>N</mi><mi>t</mi><mrow><mo>(</mo><mn>5</mn><mo>-</mo><msup><mi>t</mi><mn>2</mn></msup><mo>+</mo><mn>9</mn><msup><mi>&eta;</mi><mn>2</mn></msup><mo>+</mo><mn>4</mn><msup><mi>&eta;</mi><mn>4</mn></msup><mo>)</mo></mrow><msup><mi>l</mi><mn>4</mn></msup><msub><mi>B</mi><mi>i</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><mo>+</mo><mfrac><mn>1</mn><mn>720</mn></mfrac><mi>N</mi><mi>t</mi><mrow><mo>(</mo><mn>61</mn><mo>-</mo><mn>58</mn><msup><mi>t</mi><mn>2</mn></msup><mo>+</mo><msup><mi>t</mi><mn>4</mn></msup><mo>+</mo><mn>270</mn><msup><mi>&eta;</mi><mn>2</mn></msup><mo>-</mo><mn>330</mn><msup><mi>&eta;</mi><mn>2</mn></msup><msup><mi>t</mi><mn>2</mn></msup><mo>)</mo></mrow><msup><mi>l</mi><mn>6</mn></msup><msup><mi>cos</mi><mn>6</mn></msup><msub><mi>B</mi><mi>i</mi></msub><mo>+</mo><mo>...</mo></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>y</mi><mi>i</mi></msub><mo>=</mo><mi>N</mi><mi>l</mi><mi> </mi><mi>cos</mi><mi> </mi><msub><mi>B</mi><mi>i</mi></msub><mo>+</mo><mfrac><mn>1</mn><mn>6</mn></mfrac><mi>N</mi><mrow><mo>(</mo><mn>1</mn><mo>-</mo><msup><mi>t</mi><mn>2</mn></msup><mo>+</mo><msup><mi>&eta;</mi><mn>2</mn></msup><mo>)</mo></mrow><msup><mi>l</mi><mn>3</mn></msup><msup><mi>cos</mi><mn>3</mn></msup><msub><mi>B</mi><mi>i</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><mo>+</mo><mfrac><mn>1</mn><mn>120</mn></mfrac><mi>N</mi><mrow><mo>(</mo><mn>5</mn><mo>-</mo><mn>18</mn><msup><mi>t</mi><mn>2</mn></msup><mo>+</mo><msup><mi>t</mi><mn>4</mn></msup><mo>+</mo><mn>14</mn><msup><mi>&eta;</mi><mn>4</mn></msup><mo>-</mo><mn>58</mn><msup><mi>&eta;</mi><mn>2</mn></msup><msup><mi>t</mi><mn>2</mn></msup><mo>)</mo></mrow><msup><mi>l</mi><mn>5</mn></msup><msup><mi>cos</mi><mn>5</mn></msup><msub><mi>B</mi><mi>i</mi></msub><mo>+</mo><mo>...</mo></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000922129770000021.GIF" wi="1464" he="544" /></maths>其中,x<sub>i</sub>为第i个节点在高斯平面直角坐标系下的纵坐标(北向位置),y<sub>i</sub>为第i个节点在高斯平面直角坐标系下的横坐标(东向位置),l为所求点的经度L<sub>i</sub>与L<sub>0</sub>之差,t=tanB<sub>i</sub>,η=e'cosB<sub>i</sub>,e'为椭球第二偏心率,N为通过所求点的卯酉圈曲率半径,<img file="FDA0000922129770000022.GIF" wi="91" he="80" />为赤道至纬度B<sub>i</sub>的子午线弧长,且<img file="FDA0000922129770000023.GIF" wi="1314" he="86" />其中C<sub>0</sub>,C<sub>1</sub>,C<sub>2</sub>,C<sub>3</sub>,C<sub>4</sub>为与点位无关的系数,仅有椭球体长半轴、短半轴、第一偏心率等参数确定;步骤四:利用最小二乘直线分段拟合目标车道的平面线形,并根据拟合结果对上述目标车道的节点进行筛选;具体筛选流程如下:①、定义经筛选后剩余的节点个数为R,R的初始值为m,即R=m;设定阈值D<sub>THR</sub>;本发明中阈值D<sub>THR</sub>取0.00256;目标车道的节点在未经筛选的情况下相邻的节点处车道行进方向的角度差远小于0.1°,然而经过本筛选流程后将达到相邻的节点处车道行进方向的角度相差约0.1°的效果,能较好的实现在道路弯曲程度较大的地方节点较密集、在道路弯曲程度较小的地方节点较稀疏的要求。②、从目标车道的第1个节点开始将每10个相邻的节点(不考虑已经被删除的节点)分为一个节点集Q,定义节点集序列指针j,假设经筛选后剩余的R个节点{P<sub>1</sub>,P<sub>2</sub>,P<sub>3</sub>,…,P<sub>i</sub>,…,P<sub>R</sub>},(1≤i≤R)以每10个为一组的方式共被分成了n个节点集{Q<sub>1</sub>,Q<sub>2</sub>,Q<sub>3</sub>,…,Q<sub>j</sub>,…,Q<sub>n</sub>},(1≤j≤n),则n为(R/10)向下取整的值,其中Q<sub>j</sub>={P<sub>10j‑9</sub>,P<sub>10j‑8</sub>,P<sub>10j‑7</sub>,…,P<sub>10j</sub>};③、将j赋值为1,即j=1;④、用最小二乘法求取第j个节点集中10个节点的拟合直线,并计算拟合误差;设第j个节点集的最小二乘拟合直线的函数表达式为:y=a<sub>j</sub>+b<sub>j</sub>x   (2)其中,a<sub>j</sub>和b<sub>j</sub>为待定常数;则拟合误差D<sub>j</sub>可由下式获得:<maths num="0002"><math><![CDATA[<mrow><msub><mi>D</mi><mi>j</mi></msub><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>10</mn><mi>j</mi><mo>-</mo><mn>9</mn></mrow><mrow><mn>10</mn><mi>j</mi></mrow></munderover><msup><mrow><mo>(</mo><mrow><msub><mi>y</mi><mi>i</mi></msub><mo>-</mo><msub><mi>Y</mi><mi>j</mi></msub><mo>+</mo><mfrac><mrow><msub><mi>S</mi><mi>j</mi></msub><mo>-</mo><msub><mi>X</mi><mi>j</mi></msub><msub><mi>Y</mi><mi>j</mi></msub></mrow><mrow><msub><mi>T</mi><mi>j</mi></msub><mo>-</mo><msubsup><mi>X</mi><mi>j</mi><mn>2</mn></msubsup></mrow></mfrac><msub><mi>X</mi><mi>j</mi></msub><mo>-</mo><mfrac><mrow><msub><mi>S</mi><mi>j</mi></msub><mo>-</mo><msub><mi>X</mi><mi>j</mi></msub><msub><mi>Y</mi><mi>j</mi></msub></mrow><mrow><msub><mi>T</mi><mi>j</mi></msub><mo>-</mo><msubsup><mi>X</mi><mi>j</mi><mn>2</mn></msubsup></mrow></mfrac><msub><mi>x</mi><mi>i</mi></msub></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000922129770000031.GIF" wi="1274" he="155" /></maths>其中,Y<sub>j</sub>为第j个节点集内节点纵坐标的均值,X<sub>j</sub>为第j个节点集内节点横坐标的均值,S<sub>j</sub>为第j个节点集内节点横坐标和纵坐标积的均值,T<sub>j</sub>为第j个节点集内节点横坐标平方的均值,<img file="FDA0000922129770000032.GIF" wi="82" he="83" />为X<sub>j</sub>的平方,即:<img file="FDA0000922129770000033.GIF" wi="995" he="939" />⑤、将D<sub>j</sub>与阈值D<sub>THR</sub>进行比较:当D<sub>j</sub>小于阈值D<sub>THR</sub>时删除第j个节点集内下标为偶数的节点,并将R的值减5,即R=R‑5;当D<sub>j</sub>大于或等于阈值D<sub>THR</sub>时不删除节点且R的值不变;⑥、将j的值加一,即j=j+1,若此时j>n则进行⑦,反之则跳转至④;⑦、若n个节点集{Q<sub>1</sub>,Q<sub>2</sub>,Q<sub>3</sub>,…,Q<sub>j</sub>,…,Q<sub>n</sub>},(1≤j≤n)中没有任何一个节点被删除则跳出该筛选流程至步骤五。若n个节点集{Q<sub>1</sub>,Q<sub>2</sub>,Q<sub>3</sub>,…,Q<sub>j</sub>,…,Q<sub>n</sub>},(1≤j≤n)中有节点被删除则跳转至②继续进行检测和筛选。步骤五:按照步骤一至步骤四所述方法得到目标道路上其它车道经筛选后的最终矢量数据,并通过相关数字地图制作软件完成整条道路的车道级增强型矢量数字地图的制作。
地址 210096 江苏省南京市四牌楼2号