扩展功能
文章信息
- 马荣贵, 马子涵
- MA Rong-gui, MA Zi-han
- 基于多传感器信息融合的里程桩定位技术研究
- Study of Positioning Technology of Mileage Piles Based on Multi-sensor Information Fusion
- 公路交通科技, 2016, Vol. 31 (4): 46-51
- Journal of Highway and Transportation Research and Denelopment, 2016, Vol. 31 (4): 46-51
- 10.3969/j.issn.1002-0268.2016.04.008
-
文章历史
- 收稿日期: 2015-7-28
2. 长安大学 公路学院, 陕西 西安 710064
2. School of Highway, Chang'an University, Xi'an Shaanxi 710064, China
由于公路里程长、构造物较多,公路施工完成后,一般要在道路两旁设置里程桩(包括公里桩和百米桩)作为公路管理系统中信息的定位基准。一般要求道路的累计平均误差每公里不超过3 m[1]。在高速公路检测中,为实现路面破损的精确定位,常采用光电编码器检测道路检测车的行驶里程。该方法目前普遍存在行驶里程和公路里程桩无法对应的难题,上百公里的检测完成后,误差常常在几公里,无法对道路信息进行准确定位,造成路面病害记录不准,工作质量和效率大大降低。同时,由于里程桩是按照道路中心线标定的,在双向多车道高速公路上检测时常常由于道路内外道等原因,无法对公路上的里程桩进行准确定位。
国外发达国家对于高速公路定位技术的研究开始得较早,20世纪60年代末期,美国研制的电子路径导向系统是智能交通定位的雏形;吉林大学从2002年开始研究路面破损检测系统,并开发了路面破损定位子系统;文献[2]中提出了一种基于GPS与距离传感器结合的路面破损定位算法;文献[3]中提出的基于GPS的路面裂缝定位方法,最大误差为5.5 m,这些定位技术只能对道路信息进行大致定位,随着检测里程增加,误差不断累积。文中对里程桩定位误差产生的原因进行了系统的分析,采用基于GPS、视频、文本文档、陀螺仪和光电编码器等多传感器信息融合技术,通过GPS结合道路环境视频的方法实现了对公里桩的精确定位,确保每公里外误差不累积,每公里内采用光电编码器和陀螺仪辅助的方法实现道路内外道和车辆摆动误差的修正,最大限度地减小定位误差,提高定位精度。
1 道路里程桩精密定位模型道路里程桩包括公里桩和百米桩。对于公里桩,它的实施距离为1 km;而对于百米桩,其实施距离为100 m。为了实现里程桩的精确定位,采用GPS结合视频、文本文档以及陀螺仪的方法对公里桩进行融合定位,公里桩内采用陀螺仪以及光电编码器对其进行定位。如图 1所示,为道路里程桩精密定位模型图。
|
| 图 1 道路里程桩精密定位模型 Fig. 1 Precisious positioning model of road mileage piles |
分析可知,里程桩定位误差的产生主要有以下5个方面:
(1)由于施工和测量原因,里程桩设置不准确;(2)由于GPS本身的定位精度产生定位误差;(3)光电编码器由于步长累计误差;(4)行驶时所处的内道和外道造成检测误差;(5)车辆行驶过程中方向盘摆动,造成实施距离加长。
其中,对于里程桩设置误差,只能以里程桩为标准。这种误差只是偶然的,对于光电编码器误差可以采用分段校正方法[4, 5]进行修正;对于车辆行驶中方向的摆动以及内外道原因造成的误差可以采用陀螺仪进行修正[6, 7, 8]。
2.1 里程桩设置误差分析公路里程桩是一种有效的公路定位方法,但由于在道路施工过程中存在的人为因素,造成里程桩号与实际道路距离并不一致,如相邻两个里程桩之间标识为1 000 m,而实际测量值只有990 m,那么在里程定位时就会出现误差。因此,若测量值与所看见的里程桩号值不一致,将以里程桩号为标识基准,即对于里程桩本身的误差,只能以里程桩为标准。
将里程桩本身的误差记为Δ1,则:
GPS定位分为精码和粗码,通常使用的粗码定位精度只有10 m左右。因此,仅用GPS无法实现里程桩的精确定位,但GPS定位的最大特点是全球范围内误差不累计,比较适合用来大致确定公里桩的位置。
将GPS定位误差记为Δ2,则:
GPS只能对公里桩进行大致定位,而对每公里内的里程不能准确定位。因此,采用光电编码器对每公里内百米桩进行定位。但是光电编码器也存在以下两种误差:
(1)光电编码器标定取舍误差
使用光电编码器进行里程定位之前,先计算光电编码器的一个脉冲对应的位移。
首先选取测量长度L=100 m的直线路段,再驾驶装有光电编码器的检测车沿着这段路直线行驶,记录采集到的光电编码器脉冲个数n,则光电编码器一个脉冲对应的位移Δs为:
假设n=90000,经计算得Δs=0.001 111…,这里就会产生一个取舍误差,选取Δs=0.001 1和Δs= 0.001 11对后续计算会产生较大影响。
完成光电编码器一个脉冲对应的位移Δs的计算之后,就可以计算车辆行驶的距离s。如果检测车行驶完某段道路之后采集的脉冲个数为N,则车辆行驶的距离s为:
假设车辆采集1 km长的距离,共采集的脉冲数为900 000,若Δs值取0.001 1,则利用式(4)经计算得到车辆行驶距离s为990 m,若Δs值取0.001 11,则车辆行驶距离s为999 m,误差为9 m。由此可知,由于取舍误差的产生,经累积将会产生较大的计算误差,将取舍误差记为ε1。
(2)车辆胎压造成的误差
车辆轮胎胎压变化是影响光电编码器测距精度的重要因素。将光电编码器安装在检测车车轴位置,车辆行驶过程中,如果相比标定时胎压降低,轮胎与地面接触面积增加,轮胎直径变小,在车速不变的情况下,光电编码器采集的脉冲数变少。因此,胎压的变化也是影响里程桩定位的重要因素之一。
设车轮的直径为D,则车轮周长:
若光电编码器共转了N圈,一般光电编码器转一圈对应2 000个脉冲,则车辆行驶距离:
一般小汽车轮胎直径范围大约为600~800 mm,选取600 mm即0.6 m,利用式(5)计算可得胎压正常情况下,车轮周长为1.884 m。假设采集完某段道路,光电编码器共转了530圈,利用式(6)计算得车辆行驶距离为998.52 m。当汽车胎压减少时,则对应的汽车车轮直径也会相应地减小,假设减少到0.59 m,利用式(5)~(6)计算可得车辆行驶距离为981.88 m,胎压减少引起的误差为:
998.52-981.88=16.64 m。
相应车辆行驶距离1 km时将会产生16.64 m的误差。
将车辆胎压造成的误差记为ε2,经以上分析可知,光电编码器累积产生的误差:
曲线路段的内道里程和外道里程有很大差别。如图 2所示,为曲线路段示意图。
|
| 图 2 曲线路段示意图 Fig. 2 Schematic diagram of curved road section |
在弯道路段,外道路线长,内道路线短。如图 2所示,设弯道的平曲线半径为R,弯道转角为θ,假设车道宽度为4 m,则弯道的标准里程为:
外道里程为:
内道里程为:
由式(8)~(10)可以看出,外道里程比标准里程长8θ m,内道里程比标准里程少8θ m。若一段道路中有多个弯道,则这个误差会产生累加,将弯道误差记为Δ4。
2.5 车辆方向盘摆动误差分析光电编码器安装在车辆的轮轴上,车辆行驶过程中,随着轮轴的转动,通过采集光电编码器脉冲数从而得到里程值。因此,车辆在行驶过程中,方向盘的摆动容易造成实施距离的加长,测得的位移比实际位移要长,由于光电编码器脉冲数会产生累积,经多次累积,误差会变得很大。因此,针对方向盘摆动造成的误差,可以通过陀螺仪进行距离修正,将车辆方向盘摆动误差记为Δ5。
综上分析可得,里程桩定位误差为:
基于多传感器信息融合的里程定位方法采用GPS结合道路环境视频的方法[9, 10, 11]对公里桩进行定位。由于受天桥、隧道、树木、建筑物等遮挡物的影响,在GPS信号缺失的情况下,采用GPS结合陀螺仪的方法保证GPS数据的连续性,从而建立公里桩号与GPS信息对应表,完成公里桩的精确定位。公里桩内采用光电编码器结合陀螺仪的方法,计算公里内实际距离,通过内插法得到百米桩,完成百米桩的精确定位。
如图 3所示,为多传感器信息融合的里程桩定位算法流程图。
|
| 图 3 基于多传感器信息融合的里程桩定位算法流程图 Fig. 3 Flowchart of mileage pile positioning algorithm based on multi-sensor data fusion |
目前,道路管理部门还没有建立里程桩对应的GPS信息数据库。检测时需要把道路两旁里程桩标识牌的GPS数据记录并存储起来,在数据校正时作为标准里程,不能被修改。一般录入有以下两种方法:
(1)人工录入
检测车行驶过程中,道路两旁有里程桩出现时,人工录入当前里程桩号并记录当前GPS信息,将里程桩号与对应的GPS经纬度信息存入.txt文档。当采集完所有的GPS信息,里程桩与对应的GPS经纬度信息对应表也建立完成。为了进一步提高GPS的定位精度,采用了卡尔曼滤波算法[12]。当车辆经过天桥、隧道或者由于道路两旁植物、建筑物遮挡等原因造成GPS信号中断而无法采集GPS数据时,采用GPS结合陀螺仪辅助的方法进行数据推算。如表 1所示。
| 里程桩号 | 经度/(°) | 纬度/(°) |
| K946 | 108.884 5 | 34.189 4 |
(2)动态录入(视频拍摄)
车辆行驶过程中不断地采集GPS信息,当看到路旁出现里程桩时,利用语音标记该里程桩对应的GPS经纬度信息。由于发出语音时存在一定的反应时间,这段时间内车辆可能已经行驶过了几十米,造成标记的GPS信息并不是里程桩实际对应的GPS信息,因此,将通过CCD摄像机拍摄的道路环境视频作为公里桩定位的最终基准。道路环境视频由道路检测车进行采集,车载终端通过GPS接收机接收GPS数据。当车辆经过某一里程桩时,光电编码器开始计数,当光电编码器累计到900 m时,CCD摄像机开始拍摄路边视频,并通过存储设备按顺序存储,由此可以有效减少图像信息的存储容量,提高视频处理速度。
当找到下一个公里桩时,光电编码器自动清零并重新开始计数以减少累积误差。当视频拍摄速率为30帧/s,行驶速度为30 m/s时,里程桩定位精度为1 m。
因此,通过GPS结合视频的方式可以实现对公里桩的精确定位。
3.2 公里桩的误差校正由于道路不同车道只对应一个里程桩,却对应不同的GPS信息,仅仅根据GPS信息无法准确找到里程桩位置。当GPS信息与里程桩对应表建立完成后,首先判断车辆上下行,通过查找表 1得到起始里程桩号对应的GPS信息。在车辆行驶过程中,不断地采集GPS经纬度信息,并计算与表 1 中对应里程桩号的距离,当距离为最小值时,从而确定当前车辆对应的里程桩号以及车辆的准确位置。
下面针对双向4车道的道路,分析基于GPS的里程桩的定位方法,如图 4所示。
|
| 图 4 多车道里程桩计算示意图 Fig. 4 Schematic diagram of multi-lane road mileage pile calculation |
对于1,4车道:如图 4所示,设每车道宽4 m,1,4车道与中心线的距离分别为6 m,即AB线段长为6 m,当速度v为72 km/h时,若设车载终端1 s接收GPS信号次数n为40,则车载终端移动的距离:
车辆行驶过程中,不断计算当前位置和下一个里程桩位置之间的距离,当距离小于6.02 m时,就可确定该位置就是里程桩位置。
对于2,3车道:2,3车道与中心线的距离分别为2 m,即横向车道距离ab线段长为2 m,当速度v为72 km/h时,用式(12)计算得车载终端移动的距离L2结果同样是0.5,即纵向GPS距离为0.5 m,设此时最小距离为D2即图中的ac线段:
以GPS为基础完成公里桩的定位后,可以得到车辆所在当前路段的准确经纬度信息,但是不能对公里内当前所在路段进行精确定位。目前,主要利用光电编码器对每公里内里程进行计算。当车辆在行驶过程中,方向盘的摆动会造成车辆行驶的距离比实际距离要长,长距离检测之后会累积到很大的误差。因此,在定位过程中,每当找到下一个公里桩时,光电编码器自动清零并重新开始计数,以减少光电编码器的累积误差。
此外,内外道原因也会造成车辆采集的距离与实际距离不符,可以用光电编码器采集每两个公里桩之间实际距离,并结合陀螺仪辅助的方法进行误差修正,然后采用内插的方法得到百米桩。内插法具体分为以下两步:
(1)确定道路的起点公里桩号和终点公里桩号;
(2)根据道路实际长度和里程范围,平均内插得到中间各点的百米桩信息;
4 试验结果及分析为了验证基于多传感器信息融合的里程定位技术的定位精度,选取某路段进行测试。试验结果如表 2所示,其中误差1表示光电编码器累积里程和标准里程的误差,误差2是结合多传感器信息融合修正后里程和标准里程的误差。
| 标准里程 | 累积里程 | 误差1 | 修正里程 | 误差2 |
| 100 | 99.49 | 0.51 | 100.57 | 0.57 |
| 200 | 195.25 | 4.75 | 200.72 | 0.72 |
| 300 | 288.66 | 11.34 | 297.48 | -2.52 |
| 400 | 390.16 | 9.84 | 399.47 | -0.53 |
| 500 | 488.89 | 11.11 | 500.96 | 0.96 |
| 600 | 583.63 | 16.37 | 597.54 | -2.46 |
| 700 | 681.52 | 18.48 | 696.84 | -1.16 |
| 800 | 789.07 | 10.93 | 801.91 | 1.91 |
| 900 | 883.04 | 16.96 | 898.49 | -1.51 |
| 1 000 | 984.10 | 15.90 | 999.98 | 0.02 |
由表 2可以看出,在1 km范围内,误差2远小于误差1。百米桩的位置误差最大2.5 m。
因此,采用基于多传感器信息融合的里程定位技术在确定公里桩时,最大误差不超过1 m;在确定百米桩时最大误差不超过2.5 m。
5 结论里程桩定位误差的来源主要有5个方面,分别是里程桩设置的误差、GPS定位误差、光电编码器累积误差、弯道误差以及车辆方向盘摆动误差。为了最大限度地减少公里桩的定位误差,通过GPS结合道路环境视频及文本文档的方法实现对公里桩的精确定位,确保每公里外误差不累积;在GPS缺失的情况下,采用陀螺仪辅助的方法确保GPS信号的连续性,每公里内采用光电编码器结合陀螺仪的方法实现车辆摆动误差的修正。试验结果表明,采用基于GPS、陀螺仪和光电编码器、文本文档、视频多传感器信息融合的定位技术,在确定公里桩时,最大误差不超过1 m,在确定百米桩时最大误差不超过2.5 m,对公路病害的精确定位具有重要的意义。
| [1] | 马京辉,赵鸿铎. GIS-T中的公路里程桩定位参照系统[J]. 山西建筑,2004,30(5):133-134.MA Jing-hui, ZHAO Hong-duo. Positioning Reference System of Highway Mileage Pile in GIS-T[J]. Architecture of Shanxi,2004,30(5):133-134. |
| [2] | 王超, 王荣本, 初秀民, 等. 路面破损检测自动定位技术[J]. 吉林大学学报: 工学版, 2003, 33(3): 19-23.WANG Chao, WANG Rong-ben, CHU Xiu-min, et al. Positioning Method in Pavement Surface Distress Detecting System[J]. Journal of Jilin University: Engineering and Technology Edition, 2003, 33(3): 19-23. |
| [3] | 徐琨,贺昱曜,孙朝云,等.基于GPS的公路路面裂缝定位方法[J].长安大学学报:自然科学版,2008, 28(5):27-30,44.XU Kun, HE Yu-yao, SUN Chao-yun, et al. Pavement Crack Positioning Based on GPS [J]. Journal of Changan University:Natural Science Edition,2008, 28(5): 27-30,44. |
| [4] | 孙莹, 万秋华, 佘容红. 小型光电编码器细分误差补偿法[J]. 电子测量与仪器学报, 2011,25(7):605-611. SUN Ying, WAN Qiu-hua, SHE Rong-hong. Interpolation Error Compensation of the Minitype Photoelectrical Encoder[J]. Journal of Electronic Measurement and Instrument, 2011, 25(7):605-611. |
| [5] | 隋国栋, 李海锋, 许玉德. 轨道几何状态检测数据里程校正算法研究[J]. 交通信息与安全, 2009, 27(6): 18-21. SUI Guo-dong, LI Hai-feng, XU Yu-de. Mileage Calibration Algorithm of Track Geometry Data [J]. Journal of Transport Information and Safety,2009, 27(6):18-21. |
| [6] | 龙达峰, 刘俊, 张晓明, 等.基于椭球拟合的三轴陀螺仪快速标定方法[J].仪器仪表学报, 2013, (6): 100-106.LONG Da-feng, LIU Jun, ZHANG Xiao-ming, et al. Triaxial Gyroscope FAST Calibration Method Based on Ellipsoid Fitting[J]. Chinese Journal of Scientific Instrument, 2013, (6): 100-106. |
| [7] | 徐丽霞. 路产影像管理系统中里程校正方法的研究[J]. 常州工学院学报, 2011,24(5) :31-33. XU Li-xia. A Study of Mileage Calibration in the Road Asset Image Management System[J]. Journal of Changzhou Institute of Technology, 2011,24(5):31-33. |
| [8] | 黄波. 基于多传感器数据融合的三维路面重构[D]. 西安:长安大学,2010.HUANG Bo. Study on Road Three Dimensional Reconstruction Based on Multi-sensor Data Fusion[D]. Xian:Changan University,2010. |
| [9] | NARANJO J E, JIMENEZ F, APARICIO F, et al. GPS and Inertial Systems for High Precision Positioning on Motorways[J]. |
| [10] | 米哈达提切肯. GPS定位技术在公路工程项目的应用实践[J]. 硅谷,2013,6(12):79-82.MIHADATI. Application of GPS Technology in Highway Engineering Project[J]. Silicon Valley, 2013, 6(12):79-82. |
| [11] | 赵祥模,李娜,王国强,等.基于 GPS 的公路视频影像信息系统[J].中国公路学报,2006,19(3):87-91,105. ZHAO Xiang-mo, LI Na, WANG Guo-qiang, et al. Highway Video Image Information System Based on GPS [J]. China Journal of Highway and Transport,2006,19(3) :87-91,105. |
| [12] | 于德新, 杨兆升, 刘雪杰. 基于卡尔曼滤波的 GPS/DR导航信息融合方法[J].交通运输工程学报,2006, 6(2): 65-69.YU De-xin, YANG Zhao-sheng, LIU Xue-jie. GPS/DR Navigation Data Fusion Method Based on Kalman Filter[J]. Journal of Traffic and Transportation Engineering, 2006, 6(2): 65-69. |
2016, Vol. 31
