专利名称：用于纠正导航偏差的方法、及采用该方法的导航显示器的制作方法
技术领域：
本发明涉及一种显示器，主要用于陆地车辆导航系统中的定位定向，除显示坐标 方位、寻北等功能外还内置电子地图，具有地图匹配功能，可有效提高导航精度。
背景技术：
由于现代战争所要求的机动性、快速性及灵活性，重武器必须要进入阵地就能打， 打完就能撤；同时，对间接瞄准武器而言，进入阵地后要求知道其高精度的自身坐标和方 位。这样，能快速确定自身方位和坐标的自主式陆地车辆导航系统便具有了非同寻常的意 义。陆地车辆导航系统是一种自主式惯性导航系统，它可以不需要任何外界信息，自主地确 定自身的精确位置，以及距各目标点的最佳航线，也可以以此在给定坐标系内将车辆从一 个位置引导至另一个位置，从而实现车辆的安全自主驾驶。于现代战争所要求的机动性、快 速性及灵活性，其配套输出设备亦被提出了小型化，功能化，专用化等特别的要求。导航显示器是车载定位定向导航系统的组成部分之一，其作用是通过串行通信的 方式从方位保持仪中的导航计算机获取导航数据，经适当处理后使之在EL平板显示屏上 显示出来，使战车驾驶员能实时获取车辆的航向、位置坐标(包括M坐标和地心坐标)、 速度、距目标的距离及预定的射向角等导航信息，同时考虑到其特定的使用环境，还要求航 向指示仪具有抗干扰性强、可靠性高、平均无故障间隔时间长、操作简单、维护方便、结构坚 固、环境适应性强等特点。惯性导航会不可避免的产生陀螺的漂移，并且其随机漂移是随着时间累积的，从 而影响惯性系统的工作精度。这就要求对惯性导航系统不停地进行修正，通过电子地图进 行地图匹配纠正导航偏差就是一种很好的解决方案。
发明内容
鉴于上述现有技术的情况，本发明提供一种通过电子地图进行地图匹配纠正导航 偏差的方法、及采用该方法的惯性导航系统、导航显示器。本发明的技术方案为通过车辆 的坐标运动及行驶方向，与已知的电子地图进行匹配，指出当前选择的道路；以候选路段方 向与车辆行驶方向的差Δ θ的值为论域乂，令P1(X)为方向差，χ隶属于模糊子集“路段与 车辆行驶方向一致性好”的隶属度，如果候选路段与车辆行驶方向之差超过μ工(χ)，我们就 认为该路段不可选，则取μ Δ 0 (χ)为如下函数 00 = {。’H>A 以测量点到候选路段的欧氏距离的值为论域Y，令y2(y)为距离，y隶属于模糊子 集“测量点与候选路段接近度好”的隶属度，举例说当测量点距离候选路段超过μ 2(y)就认 为该路段不可选，则取yd(x)为如下函数
r π.、MiiylWMiiy) 结合以上两个隶属度函数，路段的匹配度函数定义为
4
f (Δ θ , d) = ΨΔΘ μ Δ e (x)+wdy d(y)其中w“和Wd为方向夹角和投影距离在匹配度函数中所占的权重，可根据路况或 经验值设定，此计算式可得到候选路段的匹配度，选择匹配度最大的作为匹配路段。优选地，P1(X)是 60°，μ2(γ)是 30 米。优选地，还包括航向位置修正步骤，地图匹配后利用电子地图数据库中道路的方 向来修正惯性导航系统INS的航向和位置信息。优选地，还包括转弯点修正步骤，当惯性导航系统INS测量的车辆角速度大于某 一阈值，并且惯性导航系统INS给出的位置信息接近于道路的节点时，认为汽车处于转弯 行驶状态，此时可根据电子地图的节点信息对惯性导航系统INS进行校正。本发明提供一种惯性导航系统，采用了上述纠正导航偏差的方法。本发明提供一种航迹推算方法，其特征在于，第一步，完成寻北工作，取得最初的 方位信息并把它发送到方位保持仪；第二步，寻北仪传送的数据初始化方位保持仪的方位， 然后从车辆上的两个陀螺和实时更新的方位数据来跟踪车辆行驶轨迹，它们提供给汽车真 正的方位角，里程计提供里程信息的电脉冲，所得脉冲数乘以里程反射系数K得出在一定 时间内行驶的里程，再将这些信息与存储器中的电子地图向匹配，进行上述纠正导航偏差 的方法以修正误差，得出车辆所行驶准确位置方向。本发明提供一种导航显示器，包括嵌入式计算机模块、电子盘、嵌入式电源模块、 显示屏，其中，计算机模块定期地从导航计算机获取导航数据，经处理后以图形的方式通过 其上的平板显示器接口输出到显示屏。优选地，嵌入式计算机模块是PC/104嵌入式计算机模块，其包含了一般PC/AT机 的母板，采用了增强型的80486的处理器作CPU，包含了所有的PC/AT兼容的DMA控制器、中 断控制器及定时器，ROM-BIOS, 16M字节的DRAM及键盘、喇叭接口。优选地，嵌入式电源模块把从外界输入的电压转换为稳定的供给嵌入式计算机模 块和显示屏的电压。优选地，显示屏是场致发光平板显示屏，用于显示导航数据。优选地，电子盘是导航显示器上的存储设备，用于存储操作系统和软件程序。优选地，导航显示器还采取了以下电磁兼容性措施①显示屏防护玻璃由普通有机玻璃更换为导电玻璃，它通过在两层普通玻璃中夹 装金属网的方式制作完成，可有效防止电磁辐射通过；②用带滤波器的电连接器，滤掉电源线中有害且无用的成分；③壳体表面作导电氧化处理；④壳体密封处由普通密封胶条更换为导电胶条。本发明解决了因陀螺的漂移造成的惯性系统的偏差，能实时修正误差，得出车辆 所行驶的准确位置和方向。
图1显示导航显示器的硬件组成。图2是导航显示器显示示例。图3显示道路匹配流程图
具体实施例方式寻北仪在载体静止的工作条件下自动完成北向基准和载体姿态角的测量，为系统 提供初始方位角；方位保持仪完成北向方位基准的记忆，并敏感载体运动时航向角的变化； 里程计敏感载体行驶距离，为导航解算提供里程信息；高程计测量载体的高程信息，使系统 具有三维定位功能；GPS/GL0NASS接收机作为辅助部件，为系统提供参考位置信息，用于提 高系统的导航定位精度；航向指示仪为车辆乘员显示航向、里程、位置等信息；导航控制显 示器完成系统控制管理，实现与外部其它设备的信息交换。显示器硬件外观为合金外壳，上有LED显示屏，两个USB接口和一个7针航空插头 接口，内含PC/104堆栈电路板等元件，结构紧凑，坚固耐用。PC/104计算机模块是显示器的核心部分，由于显示器在检测过程中不但要实时 完成大量数据的收发任务，还要实时对获得的各种数据进行复杂的处理、分析和存储，因此 要求其有尽可能高的性能。其CPU是一片X86兼容的64位第六代处理器，运行速度可达 300MHz，内存支持128M 3. 3V SDRAM，其图形处理器可支持各种IXD及TFT显示屏，2M内置 显存最大支持至1280*1024、16. 7M种颜色，同时支持PS/2等多种接口。其CPU内置有浮点 运算协处理器，串行口为16C550等同高速串行口，能够快速可靠地进行RS-232串行通信， 迅速准确地完成所赋予的各项功能。电源模块采用可直接与PC/104 CPU模块及扩展模块相栈接的型号。其作用是把 外界+6 +40V波动电压转换为稳定的+5V和+12V电源，供PC/104计算机模块、A/D采集 模块和液晶显示屏使用，单元之间的信息通信主要是通过RS232串行端口进行传输的。Windows XP-Embedded (嵌入式)操作系统以及MapX控制安装在PC 104，让地图 匹配算法可以实现，匹配的基本方法是从基准电子地图中提取具有不变特征或明显特征的 子区，或者用已知地面控制点作为模板，在所匹配的图中搜索与模板相似的区域。当匹配相 似性测度达到最大，且超过预先规定的阈值时，即判定为找到了正确的匹配位置。选用了基 于模糊逻辑的地图匹配算法，它由一个模糊的基础道路选择算法和预测算法组成，通过车 辆的坐标运动及行驶方向，与已知的电子地图进行匹配，指出当前选择的道路。以候选路段 方向与车辆行驶方向的差Δ θ的值为论域X，令P1(X)为方向差，χ隶属于模糊子集“路段 与车辆行驶方向一致性好”的隶属度。举例说如果候选路段与车辆行驶方向之差超过60°， 我们就认为该路段不可选，则取μ Δ 0 (X)为如下函数
权利要求
1.一种纠正导航偏差的方法，通过车辆的坐标运动及行驶方向，与已知的电子地图进 行匹配，指出当前选择的道路；以候选路段方向与车辆行驶方向的差Δ θ的值为论域X，令 U1(X)为方向差，X隶属于模糊子集“路段与车辆行驶方向一致性好”的隶属度，如果候选路 段与车辆行驶方向之差超过P1(X),我们就认为该路段不可选，则取μΔ0(χ)为如下函数:以测量点到候选路段的欧氏距离的值为论域Y，令y2(y)为距离，y隶属于模糊子集 “测量点与候选路段接近度好”的隶属度，举例说当测量点距离候选路段超过y2(y)就认为 该路段不可选，则取yd(x)为如下函数结合以上两个隶属度函数，路段的匹配度函数定义为f (Δ θ，d) = Wa e μ Δ e (x)+Wd μ d (y)其中W“和 为方向夹角和投影距离在匹配度函数中所占的权重，可根据路况或经验 值设定，此计算式可得到候选路段的匹配度，选择匹配度最大的作为匹配路段。
2.根据权利要求1所述的方法，其特征在于，P1(X)是60°，y2(y)是30米。
3.根据权利要求1、2所述的方法，还包括航向位置修正步骤，地图匹配后利用电子地 图数据库中道路的方向来修正惯性导航系统INS的航向和位置信息。
4.根据权利要求3所述的方法，还包括转弯点修正步骤，当惯性导航系统INS测量的 车辆角速度大于某一阈值，并且惯性导航系统INS给出的位置信息接近于道路的节点时， 认为汽车处于转弯行驶状态，此时可根据电子地图的节点信息对惯性导航系统INS进行校 正。
5.一种航迹推算方法，其特征在于，第一步，完成寻北工作，取得最初的方位信息并把 它发送到方位保持仪；第二步，寻北仪传送的数据初始化方位保持仪的方位，然后从车辆上 的两个陀螺和实时更新的方位数据来跟踪车辆行驶轨迹，它们提供给汽车真正的方位角， 里程计提供里程信息的电脉冲，所得脉冲数乘以里程反射系数K得出在一定时间内行驶的 里程，再将这些信息与存储器中的电子地图向匹配，进行权利要求1-4纠正导航偏差的方 法以修正误差，得出车辆所行驶准确位置方向。
6.一种导航显示器，包括嵌入式计算机模块、电子盘、嵌入式电源模块、显示屏，其中， 计算机模块定期地从导航计算机获取导航数据，经处理后以图形的方式通过其上的平板显 示器接口输出到显示屏。
7.根据权利要求6所述的导航显示器，其特征在于，嵌入式计算机模块是PC/104嵌入 式计算机模块，其包含了一般PC/AT机的母板，采用了增强型的80486的处理器作CPU，包含 了所有的PC/AT兼容的DMA控制器、中断控制器及定时器，ROM-BIOS，16M字节的DRAM及键 盘、喇叭接口。
8.根据权利要求6所述的导航显示器，其特征在于，电子盘是导航显示器上的存储设 备，用于存储操作系统和软件程序。
9.根据权利要求6-8所述的导航显示器，其特征在于，导航显示器还采取了以下电磁 兼容性措施①显示屏防护玻璃由普通有机玻璃更换为导电玻璃，它通过在两层普通玻璃中夹装金 属网的方式制作完成，可有效防止电磁辐射通过；②用带滤波器的电连接器，滤掉电源线中有害且无用的成分；③壳体表面作导电氧化处理；④壳体密封处由普通密封胶条更换为导电胶条。
全文摘要
本发明提供一种用于纠正导航偏差的方法、及采用该方法的导航显示器。通过车辆的坐标运动及行驶方向，与已知的电子地图进行匹配，指出当前选择的道路，其中路段与车辆行驶方向作为一个参数，测量点到候选路段的欧氏距离作为另一个参数，通过匹配度函数得到候选路段的匹配度，选择匹配度最大的作为匹配路段。本发明解决了因陀螺的漂移造成的惯性系统的偏差，能实时修正误差，得出车辆所行驶的准确位置和方向。
文档编号G01C21/30GK102147262SQ201110004550
公开日2011年8月10日 申请日期2011年1月11日 优先权日2011年1月11日
发明者宋春雷, 李磊磊, 谢玲, 陈家斌, 韩勇强 申请人:北京理工大学