【技术实现步骤摘要】
指示牌定位方法及系统
本专利技术涉及通信
,尤其涉及一种指示牌定位方法及系统。
技术介绍
指示牌,比如里程表指示牌、方向指示牌,为人们提供重要的指示距离和/或方向等作用。然而,指示牌一般裸露在室外,尤其是高速公路指示牌,经常会由于各种自然或人为原因,遭到挪动或破坏。比如,遇到飓风天气或雨雪天气,会造成大量指示牌的挪动或损坏。因此,需要经常对指示牌进行排查和定位。目前,对指示牌进行排查和定位主要由大量养路工一段段路去查指示牌情况,从而判断指示牌是否被挪动或损坏,以及确定指示牌的位置信息。然而,靠大量养路工一段段路去对指示牌进行排查和定位,费时较长,效率不高。
技术实现思路
本专利技术提供一种指示牌定位方法及系统,减少了对指示牌定位的时间,提高了对指示牌定位的效率和精度。本专利技术第一方面提供的指示牌定位方法,包括:获取第k时刻测试车的全球定位系统位置数据,得到第k时刻测试车的位置观测值;根据第k-1时刻到第k时刻测试车的惯性导航运动轨迹和第k时刻测试车的位置观测值计算得出第k时刻测试车的最优位置估计值;将第k时刻测试车的最优位置估计值作为第k时刻的指示牌的参考位置数据;根据第k时刻的指示牌的参考位置数据和第k时刻扫描到的指示牌的标签数据计算得出第k时刻的指示牌的位置数据。本专利技术第二专利技术提供的指示牌定位系统,包括:全球定位系统接收模块,用于获取第k时刻测试车的全球定位系统位置数据,得到第k时刻测试车的位置观测值;卡尔曼滤波模块,用于根据第k-1时刻到第k时刻测试车的惯性导航运动轨迹和第k时刻测试车的位置观测值计算得出第k时刻测试车的最优位置估计值;处 ...
【技术保护点】
一种指示牌定位方法,其特征在于,包括:获取第k时刻测试车的全球定位系统GPS位置数据,得到第k时刻所述测试车的位置观测值;根据第k‑1时刻到第k时刻所述测试车的惯性导航运动轨迹和第k时刻所述测试车的位置观测值计算得出第k时刻所述测试车的最优位置估计值;将第k时刻所述测试车的最优位置估计值作为第k时刻的指示牌的参考位置数据;根据第k时刻的指示牌的参考位置数据和第k时刻扫描到的指示牌的标签数据计算得出第k时刻的指示牌的位置数据。
【技术特征摘要】
1.一种指示牌定位方法,其特征在于,包括:获取第k时刻测试车的全球定位系统GPS位置数据,得到第k时刻所述测试车的位置观测值;根据第k-1时刻到第k时刻所述测试车的惯性导航运动轨迹和第k时刻所述测试车的位置观测值计算得出第k时刻所述测试车的最优位置估计值;将第k时刻所述测试车的最优位置估计值作为第k时刻的指示牌的参考位置数据;根据第k时刻的指示牌的参考位置数据和第k时刻扫描到的指示牌的标签数据计算得出第k时刻的指示牌的位置数据;其中,所述根据第k时刻的指示牌的参考位置数据和第k时刻扫描到的指示牌的标签数据计算得出第k时刻的指示牌的位置数据,包括:根据第k时刻的指示牌的参考位置数据计算得出第k时刻的指示牌的参考位置的法线y:根据第k时刻扫描到的指示牌的标签数据计算得出第k时刻的指示牌的位置方程:(x-x0)2+(y-y0)2=R12(2)根据公式(1)和公式(2)计算得出第k时刻的指示牌的位置数据;上述公式中,x0为第k时刻的指示牌的参考位置的横坐标,y0为第k时刻的指示牌的参考位置的纵坐标,f′(x0)为所述测试车的实际运行轨迹在x0处的斜率,R1为第k时刻扫描到的指示牌与所述测试车之间的距离。2.根据权利要求1所述的指示牌定位方法,其特征在于,所述根据第k-1时刻到第k时刻所述测试车的惯性导航运动轨迹和第k时刻所述测试车的位置观测值计算得出第k时刻所述测试车的最优位置估计值,包括:采用公式计算得出第k时刻所述测试车的位置预测值采用公式计算得出第k时刻所述测试车的观测误差采用公式计算得出第k时刻所述测试车的最优位置估计值上述公式中,Δt为第k时刻与第k-1时刻的时间差,为根据第k-1时刻到第k时刻所述测试车的惯性导航运动轨迹得到的第k-1时刻所述测试车的位置预测值,uk为第k时刻的加速度,zk为第k时刻所述测试车的位置观测值,Hk=[10],Kk为卡尔曼滤波增益。3.根据权利要求1所述的指示牌定位方法,其特征在于,所述方法还包括:获取从第k-1时刻到第k时刻所述测试车的惯性导航运动轨迹;所述获取从第k-1时刻到第k时刻所述测试车的惯性导航运动轨迹,包括:获取从第k-1时刻到第k时刻所述测试车的加速度;将所述加速度通过双重积分计算得到从第k-1时刻到第k时刻所述测试车的路径;获取从第k-1时刻到第k时刻所述测试车的方位;根据从第k-1时刻到第k时刻所述测试车的路径和方位计算得到从第k-1时刻到第k时刻所述测试车的惯性导航运动轨迹。4.根据权利要求1-3任一项所述的指示牌定位方法,其特征在于,所述获取第k时刻测试车的全球定位系统GPS位置数据,包括:若第k时刻直接获取到GPS位置数据,则将第k时刻获取到的GPS位置数据直接作为第k时刻所述测试车的全球定位系统GPS位置数据;若第k时刻无法直接获取到GPS位置数据,则确定直接获取到GPS位置数据的距离第k时刻最近的第k-a时刻和第k+b时刻;其中,a,b分别为正整数,且a<b;获取从第k-a时刻到第k时刻所述测试车的里程位置数据;获取第k-a时刻和第k+b时刻所述测试车的GPS位置数据;根据第k-a时刻和第k+b时刻所述测试车的GPS位置数据以及从第k-a时刻到第k时刻所述测试车的里程位置数据计算得到第k时刻所述测试车的全球定位系统GPS位置数据。5.根据权利要求1-3任一项所述的指示牌定位方法,其特征在于,所述方法还包括:预先将所述GPS位置数据存储在指示牌的标签中;获取第k时刻所述测试车扫描到的所述指示牌标签中的GPS位置数据,得到第k时刻所述测试车的位置观测值。6....
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。