[发明专利]三维定位仪及方法

摘要

本发明公开一种三维定位仪和方法，该三维定位仪包括电子地图存储部，存储包含多个插值点的二维位置信息和高度信息的电子地图；地图匹配部，选择至少一个候补道路；高度检测部，算出与所述多个插值点单位对应的车辆相对高度；误差修正部，算出与包括之前插值点和当前位置的之后插值点之间地点的当前位置对应的所述至少一个候补道路的高度；三维匹配部，确认车辆相对高度之差距离是否在已设定的临界误差以内，并从所述至少一个候补道路中选择在所述临界误差以内的候补道路对所述当前位置实施地图匹配。本发明提高在高架道路、地下道路、建筑停车场等与平坦道路有高度差的道路上的地图匹配精确度，从而更加准确介绍路径，为驾驶者带来更多便利。

主权项

一种三维定位仪，其特征在于，包括：电子地图存储部，存储包含多个插值点的二维位置信息和高度信息的电子地图；地图匹配部，利用所述电子地图，选择至少一个离根据GPS接收器或者速度传感器和角速度传感器信号确认的车辆当前位置最接近的候补道路；高度检测部，利用所述角速度传感器或者G传感器的信号，算出与所述多个插值点的单位对应的车辆相对高度；误差修正部，利用所述当前位置的之前插值点行驶的距离和连接所述之前插值点和所述当前位置的直线与水平线的倾斜度，算出与包括所述之前插值点和所述当前位置的之后插值点之间地点的所述当前位置对应的所述至少一个候补道路的高度；三维匹配部，确认与所述当前位置对应的所述候补道路的高度和与所述当前位置对应的所述车辆相对高度之差距离是否在已设定的临界误差以内，并从所述至少一个候补道路中选择在所述临界误差以内的候补道路对所述当前位置实施地图匹配，所述误差修正部利用来自所述G传感器或陀螺仪传感器的信号，确认车辆在水平线上的倾斜度，利用从之前插值点开始行驶的距离、车辆倾斜度和已设定的车辆传感器的误差率算出临界误差。