[发明专利]定位公交专用道的方法

摘要

本发明公开了一种定位公交专用道的方法，包括读取解析定位信息，处理定位信息，预估定位信息，判断专用道，抓拍图片，黄线识别，获取两条公交专用道黄线的首末坐标点等步骤，本发明能够抑制GPS零速度螺旋漂移现象，改善个别点GPS信号无效、短时间隧道无GPS信号导致的误抓拍及漏抓拍，改善定位模块精度不够引起的无专用道双黄线误抓拍现象，且能将道判断放在前端处理，降低后台工作负荷。

主权项

一种定位公交专用道的方法，其特征在于：包括以下步骤：步骤一：获取以及解析定位装置信息，包括纬度值、速度、角度信息，将其放入缓冲区Xn，Xn={Sn(xn，yn)，vn，θn}，其中n为第n个点，S(x,y)为纬度值，v为速度，θ为角度，角度信息指当前行驶方向与正北方向的角度；步骤二：如果缓冲区中的中连续N个速度值大于阈值VT，则进行下一步，如果缓冲区中连续N个速度值小于阈值VT，则舍去定位值，继续判断，其中，2≤N≤10，0km/h≤VT≤2km/h，Xn={Sn(xn，yn)，vn，θn}(vn＞VT);步骤三：对速度vn求差分，得加速度α，αn=vn‑vn‑1；步骤四：将缓冲区中角度θn求差分，得角速度σ，σn=θn‑θn‑1;步骤五：预判断下一个点的经纬度与当前点偏移，单位为度，△xn为预估点与当前点的纬度偏移度数，△yn为预估点与当前点的经度偏移度数， Δx n = ( v n + α n ) cos ( θ n + σ n ) * ( 400980 360 ) , Δy n = ( v n + α n ) sin ( θ n + σ n ) * ( 400980 360 ) * cos ( x n ) ; 步骤六：根据预估偏移值计算下一个点的经纬度值，Sn+1(xn+1，yn+1)，xn+1=xn+Δxn，yn+1=yn+Δyn；步骤七：如果当前GPS信号无效，或者0速度时，则根据步骤一到步骤六的步骤得出的当前点所在经纬度Sn+1(xn+1，yn+1)，将此定位信息与电子地图遍历比较，否则直接将Sn(xn，yn)与存储器中的电子地图中公交专用道的经纬度遍历比较，判定这个定位值是否在专用道，如果不在专用道，则重复执行步骤一到步骤七，如果在专用道再判断在何路段，并执行步骤八；步骤八：此时通过公交车车头安装的相机抓拍车前道路的图片，将数据给DSP；步骤九：对当前抓拍到的图片中识别区域内的像素值与预设公交车道黄线黄色像素值遍历比较，获得差值在预设范围内的像素点的坐标；步骤十：将坐标中连续点拟合直线，获取两条公交专用道黄线的首末坐标点。