位置校正设备

1.一种位置校正设备(30)，包括：
位置信息获取部件(33)，用于获取全球定位系统接收器测量的位置坐标；
道路数据存储部件(40)，用于存储表示建造的道路的位置坐标的道路数据；
轨迹数据产生部件(35)，用于根据所述位置信息获取部件获取的位置坐标来产生轨迹数据，所述轨迹数据表示在过去的指定时段期间所述全球定位系统接收器的多个位置坐标；
道路估计部件(35)，用于根据所述道路数据存储部件存储的道路数据和所述位置信息获取部件获取的位置坐标，估计所述全球定位系统接收器在过去的指定时段期间行进的路段；
偏移误差估计部件(35)，用于根据在所述道路估计部件估计的路段内的多个点处的位置坐标和所述轨迹数据表示的多个点处的位置坐标，估计所述全球定位系统接收器测量的位置坐标的偏移误差；以及
校正输出部件(37)，用于根据所述偏移误差估计部件估计的偏移误差校正所述全球定位系统接收器测量的位置坐标，并输出校正后的位置坐标。
2.根据权利要求1所述的位置校正设备，
其中，所述道路估计部件使用所述轨迹数据表示的点之间的位置关系，并估计在路段上与所述轨迹数据表示的点的位置坐标中的每一个相对应的位置坐标；以及其中，所述偏移误差估计部件针对所述轨迹数据表示的点的位置坐标中的每一个计算所述轨迹数据表示的位置坐标和与该位置坐标相对应的所估计的路段上的位置坐标之间的误差，并估计所述点处的所计算的误差的平均值作为偏移误差。
3.根据权利要求2所述的位置校正设备，
其中，所述偏移误差估计部件通过向所述全球定位系统接收器最近定位的区域内的点之间的误差分配较大的权重来计算所述点处的误差的加权平均值，并将所述加权平均值估计为偏移误差。
4.根据权利要求1所述的位置校正设备，
其中，所述道路估计部件使用所述偏移误差估计部件已经估计的偏移误差，并估计所述全球定位系统接收器在过去的指定时段期间行进的路段。
5.根据权利要求1所述的位置校正设备，
其中，所述道路估计部件根据所述偏移误差估计部件已经估计的偏移误差校正所述轨迹数据表示的位置坐标，根据校正后的位置坐标检索与所述轨迹数据表示的点的分布高度相关的道路，并估计所述全球定位系统接收器在过去的指定时段期间在检索到的道路上行进的路段。
6.根据权利要求1所述的位置校正设备，
其中，所述道路估计部件根据所述偏移误差估计部件已经估计的偏移误差来校正所述轨迹数据表示的点的位置坐标中特定点的位置坐标，根据校正后的位置坐标检索与校正后的位置坐标最接近的道路，并估计所述全球定位系统接收器在过去的指定时段期间在检索到的最接近的道路上行进的路段。
7.根据权利要求6所述的位置校正设备，
其中，当所述道路估计部件检索到的最接近的道路和特定点处的校正后的位置坐标之间的距离超过指定上限时，所述偏移误差估计部件停止根据所述轨迹数据估计位置坐标；
以及
其中，所述校正输出部件根据在所述偏移误差估计部件未估计偏移误差的第一时段之前所述偏移误差估计部件估计的偏移误差来校正所述全球定位系统接收器在所述第一时段期间测量的第一位置坐标，并且所述校正输出部件输出校正后的第一位置坐标。
8.根据权利要求1-7中的任意一项所述的位置校正设备，
其中，所述全球定位系统接收器安装在车辆中；
其中，所述位置校正设备还包括预处理部件(31，33)，根据来自安装在车辆中的自主导航传感器的输出来计算位移量值，并根据所述位移量值校正所述位置信息获取部件获取的位置坐标；以及
其中，所述轨迹数据产生部件根据所述预处理部件校正后的位置坐标产生轨迹数据，所述轨迹数据表示与所述全球定位系统接收器在过去的指定时段期间的位置坐标相对应的多个点。
9.一种用于校正全球定位系统接收器(10)测量的位置坐标的方法，所述方法包括：
存储表示建造的道路的位置坐标的道路数据；
获取(S110)所述全球定位系统接收器测量的位置坐标；
根据所获取的位置坐标产生(S210-S230)轨迹数据，所述轨迹数据表示在过去的指定时段期间所述全球定位系统接收器的多个位置坐标；
根据存储的道路数据和获取的位置坐标估计(S240-S260)所述全球定位系统接收器在过去的指定时段期间行进的路段；
根据所估计的路段内的多个点处的位置坐标和所述轨迹数据表示的多个点处的位置坐标，估计(S270-S290)所述全球定位系统接收器测量的位置坐标的偏移误差；以及根据所估计的偏移误差校正所述全球定位系统接收器测量的位置坐标，并输出校正后的位置坐标。

位置校正设备 \n技术领域\n[0001] 本发明涉及一种位置校正设备。 \n背景技术\n[0002] 传统上，已知来自GPS(全球定位系统，Global Positioning System)定位的定位结果包含由于传播延迟导致的偏移误差、由于多路径而导致的定位误差和由于各种因素导致的其它随机误差。 \n[0003] 偏移误差主要是由于当GPS信号通过GPS卫星和地球之间的电离层时的传播延迟而出现。偏移误差总是出现，这是因为主要由电离层引起偏移误差。误差的程度每时每刻随着电离层的状态而改变。 \n[0004] 诸如汽车导航系统的传统设备从FM广播站(所谓的DGPS站)以广播电波的形式接收关于偏移误差的信息。设备按照所接收的偏移误差信息校正GPS接收器测量的位置坐标(例如参见专利文件1)。 \n[0005] -专利文件1：H10-2002-185600A \n[0006] 然而，FM接收器需要安装在设备上，以实现从FM广播站接收偏移误差信息并且校正由GPS接收器测量的位置坐标的方法。因此，产品成本提高。 \n[0007] 当测量点远离FM广播站时，由于周围环境的差别，所述方法在测量点处的偏移误差和FM广播站的偏移误差之间产生差别。即使从FM广播站接收到偏移误差信息，接收目的地设备(导航系统)也无法精确地从来自GPS接收器的定位结果中去除偏移误差。该设备无法精确地检测当前位置的位置坐标。此外，传统方法根据从FM广播站接收的不精确的偏移误差信息来校正来自GPS接收器的定位结果。定位精度可能劣化。 \n发明内容\n[0008] 考虑到上述因素提出本发明。因此，本发明的目的是提供一种位置校 正设备，能够从来自GPS接收器的定位结果中去除偏移误差。 \n[0009] 根据本发明的示例，提供如下的位置校正设备。位置信息获取部件被配置为获取GPS(全球定位系统)接收器测量的位置坐标。道路数据存储部件被配置为存储表示建造的道路的位置坐标的道路数据。轨迹数据产生部件被配置为根据所述位置信息获取部件获取的位置坐标产生轨迹数据，所述轨迹数据表示在过去的指定时段期间所述GPS接收器的多个位置坐标。道路估计部件被配置为根据所述道路数据存储部件存储的道路数据和所述位置信息获取部件获取的位置坐标，估计所述GPS接收器在过去的指定时段期间行进的路段。偏移误差估计部件被配置为根据在所述道路估计部件估计的路段内的多个点处的位置坐标和所述轨迹数据表示的多个点处的位置坐标，估计所述GPS接收器测量的位置坐标的偏移误差。校正输出部件被配置为根据所述偏移误差估计部件估计的偏移误差校正所述GPS接收器测量的位置坐标，并输出校正后的位置坐标。 \n[0010] 根据本发明的另一个示例，提供了一种方法，用于实现上述位置校正设备的功能。 附图说明\n[0011] 从下面参考附图进行的详细说明，本发明的上述和其它目的、特征和优点将变得明显。在附图中： \n[0012] 图1是示出根据本发明的实施例的位置检测设备的结构的方框图； [0013] 图2是示出位置校正部分的结构的方框图； \n[0014] 图3是示出预处理部分执行的定位精度改善处理的流程图； \n[0015] 图4A是示出系数设置图的结构的说明图； \n[0016] 图4B是示出如何定义系数之间的量值关系的说明图； \n[0017] 图5A是示出偏移误差估计部分执行的偏移误差估计处理的流程图； [0018] 图5B是说明划分路径的示例的图； \n[0019] 图6A是示出偏移误差估计部分执行的道路估计处理的流程图； \n[0020] 图6B是说明在道路上查找最近点的示例的图； \n[0021] 图7A是示出坐标之间的位置关系的说明图； \n[0022] 图7B是示出向量间的角度的说明图； \n[0023] 图8是关于如何计算加权平均值的说明图； \n[0024] 图9A是示出根据本发明的实施例的用于校正定位结果的方法的说明图；以及 [0025] 图9B是示出相关技术中用于校正定位结果的方法的说明图。 \n具体实施方式\n[0026] 参考附图进一步详细地说明本发明的实施例。图1是示出安装在主体车辆上的位置检测设备1的结构的说明图。 \n[0027] 如图1所示，根据本发明的实施例的位置检测设备1包括GPS(全球定位系统)接收器10、自主导航传感器组20、位置校正部分30、道路数据库40和接口(I/F)部分50。位置校正部分30也可以称为位置校正设备。 \n[0028] 与已知的GPS接收器类似地构造GPS接收器10。GPS接收器10经由天线11接收从GPS卫星发送的GPS信号，并从GPS信号中提取GPS消息。GPS接收器10执行几何操作以根据关于多个(四个或者更多)GPS卫星的伪距离和卫星轨道信息计算自身设备的位置坐标P。在诸如ENU坐标系或者ECEF坐标系的三维坐标系内计算位置坐标P。 [0029] 根据本实施例的GPS接收器10根据GPS信号的多普勒频移量(Doppler shift quantity)计算自身设备的速度向量V。使用已知方法根据GPS信号的多普勒频移量计算速度向量V。下面简单描述计算速度向量V的方法。当计算速度向量V时，该方法根据接收到的消息计算多个(四个或者更多)GPS卫星的速度向量。该方法还计算从GPS接收器到GPS卫星的单位方向向量。该方法根据这些向量信息、从每个GPS卫星接收到的GPS信号的载波频率和要从每个GPS卫星发送的GPS信号的载波频率计算自身设备的速度向量V。 [0030] GPS接收器10向位置校正部分30输出计算的速度向量V以及自身设备的位置坐标P。GPS接收器10输出测量精度信息以及位置坐标P和速度向量V。测量精度信息表示根据DOP值计算的位置坐标P的测量精度εp和速度向量V的测量精度εv。 \n[0031] 本实施例不需要关于测量精度εp和εv的精确的信息。可以使用任何方法来计算测量精度。例如，可以从DOP值和每个GPS卫星和GPS接收器之间的测量和估计的距离之间的平均差的乘积得到位置坐标P的测 量精度εp。类似地，可以从DOP值和GPS接收器的测量和估计的速度之间的差的乘积得到速度向量V的测量精度εv。 \n[0032] 自主导航传感器组20包括多个自主导航传感器，诸如车轮速度传感器、加速度传感器、偏航(yaw)率传感器。来自属于自主导航传感器组20的传感器的输出输入到位置校正部分30。 \n[0033] 道路数据库40存储表示特定区域(例如全日本)内的道路的位置坐标的道路数据。道路数据可以替换为在已知的汽车导航系统的地图数据库内包含的表示道路位置和道路之间的连接关系的链接数据和节点数据。位置检测设备1可以另外设置路径引导功能，并且可以被构造为汽车导航系统。 \n[0034] 接口部分50与安装在车辆内的各种控制ECU通信。控制ECU包括用于引擎控制的引擎ECU、用于制动控制的制动ECU和用于转向控制的转向ECU。接口部分50向控制ECU提供位置检测设备1检测的车辆的位置坐标Po。接口部分50被构造为串行接口或者LAN(CAN通信)接口。接口部分50向车辆内的控制ECU提供检测到的位置坐标Po。 \n[0035] 位置校正部分30从GPS接收器10测量的GPS接收器10的位置坐标P中去除偏移误差，并经由接口部分50向外部输出校正后的位置坐标Po。如图2所示具体地构造位置校正部分30。图2是示出位置校正部分30的详细结构的方框图。 \n[0036] 如图2所示，位置校正部分30包括自主速度向量计算部分31、预处理部分33、偏移误差估计部分35和偏移误差去除部分37。 \n[0037] 自主速度向量计算部分31连接到包含在自主导航传感器组20内的传感器。根据来自传感器的输出，自主速度向量计算部分31输出车辆的每单位时间的位移量值，即车辆的速度向量Vs。自主速度向量计算部分31向预处理部分33输出计算的车辆的速度向量Vs。 \n[0038] 预处理部分33连接到GPS接收器10和自主速度向量计算部分31。预处理部分\n33根据从GPS接收器10获取的位置坐标P、速度向量V、关于测量精度εp和εv的信息和关于从自主速度向量计算部分31获取的速度向量Vs的信息来校正位置坐标P。预处理部分33向偏移误差估计部分35和偏移误差去除部分37输出校正后的位置坐标Pc。 [0039] 具体地，预处理部分33执行图3的定位精度改善处理以校正位置坐标P。图3是预处理部分33重复执行的定位精度改善处理的流程图。具 体地，预处理部分33以与GPS接收器10的测量周期T和自主速度向量计算部分31的向量计算周期T同步的周期T重复执行定位精度改善处理。 \n[0040] 当开始定位精度改善处理时，预处理部分33从GPS接收器10获取最近测量的位置坐标P(n)和速度向量V(n)与关于测量精度εp(n)和εv(n)的信息(S110)。此外，预处理部分33从自主速度向量计算部分31获取关于最近测量的速度向量Vs(n)的信息(S120)。 \n[0041] 附着到参数P、V、εp、εv和Vs的后缀(n)表示在最近的周期获取参数P、V、εp、εv和Vs的值。后缀(n-1)表示在第二最近周期获取参数P、V、εp、εv和Vs的值。 [0042] 在完成S120中的处理后，预处理部分33处理从GPS接收器10获得的位置坐标P(n)和速度向量V(n)(S130)。具体地，预处理部分33根据位置坐标P(n)的最近获取的值P(n-1)和速度向量V(n)的最近获取的值V(n-1)计算变化δp和δv。 \n[0043] δp＝|P(n)-P(n-1)| \n[0044] δv＝|V(n)-V(n-1)| \n[0045] 在计算变化δp和δv后，预处理部分33将该处理进行到S140，判断变化δp是否大于上限Mp。上限Mp可以在设计阶段被预设为车辆在时间T经过期间行进的理论最大距离。 \n[0046] 当确定变化δp大于上限Mp(S140中的“是”)时，预处理部分33校正从GPS接收器10获取的位置坐标P(n)，以满足δp＝Mp(S145)。具体地，预处理部分33将位置坐标P(n)更新为相加前一个值P(n-1)和向量Mp·(P(n)-P(n-1))/δp所得到的值。然后，预处理部分33进行到S150。 \n[0047] P(n)←P(n-1)+Mp·(P(n)-P(n-1))/δp \n[0048] 当确定变化δp小于或者等于上限Mp时(S140中的“否”)时，预处理部分33跳过S145中的处理，进行到S150。预处理部分33判断变化δv是否大于上限Mv(S150)。可以在设计阶段将上限Mv预设为在时间T的经过期间车辆的理论最大速度。 \n[0049] 当确定变化δv大于上限Mv(S150中的“是”)时，预处理部分33校正从GPS接收器10获取的速度向量V(n)，以满足δv＝Mv(S155)。具体地， 预处理部分33将速度向量V(n)更新为相加前一个值V(n-1)和向量Mv·(V(n)-V(n-1))/δv.所得到的值。然后，预处理部分33进行到S160。 \n[0050] V(n)←V(n-1)+Mv·(V(n)-V(n-1))/δv \n[0051] 当确定变化δv小于或者等于上限Mv(S150中的“否”)时，预处理部分33跳过S155中的处理，进行到S160。 \n[0052] 在S160，预处理部分33按照内置的系数设置图将系数A1、A2和A3设置为对应于测量精度εp(n)和εv(n)的值。然后，预处理部分33根据先前计算的位置坐标Pc(n-1)使用下面的方程计算位置坐标Pc(n)(S170)。 \n[0053] Pc(n)＝A1·P(n)+A2·(Pc(n-1)+V(n)·T)+A3·(Pc(n-1)+Vs(n)·T) \n[0054] 参数T等同于定位精度改善处理的执行周期T。参数Pc(n)表示最近的周期的位置坐标Pc。参数Pc(n-k)表示在最近的周期之前的第k周期计算的位置坐标Pc。 [0055] 在S170，预处理部分33根据系数A1、A2和A3计算位置坐标P(n)、位置坐标P(n-1)+V(n)·T和位置坐标P(n-1)+Vs(n)·T之间的加权平均值。从GPS接收器10获取位置坐标P(n)。根据速度向量V(n)得到位置坐标P(n-1)+V(n)·T。根据来自自主导航传感器组20的输出得到位置坐标P(n-1)+Vs(n)·T。 \n[0056] 在完成计算位置坐标Pc(n)后，预处理部分33向偏移误差估计部分35和偏移误差去除部分37输出位置坐标Pc(n)(S180)。然后，预处理部分33结束定位精度改善处理。 [0057] 在S160，本实施例根据系数设置图动态配置系数A1、A2和A3。另外，可以根据预定方程动态配置系数A1、A2和A3。然而，用于配置这些系数的实际方程依赖于配置测量精度εp和εv的方法，因此在此不进行说明。本实施例使用系数设置图来配置系数A1、A2和A3。参考图4A和4B说明示例。图4A是示出系数设置图的配置的说明图。图4B是示出配置系数A1、A2和A3的方法的说明图，标注有相互之间的量值关系。 \n[0058] 如图4A所示，系数设置图具有用于测量精度εp和εv的预定区域。每个区域包含系数A1、A2和A3以满足条件A1+A2+A3＝1，A1≥0，A2≥0，A3≥0。根据该系数设置图，预处理部分33确定包含从GPS接收器10获得的测量精度信息εp(n)和εv(n)的区域。预处理部分33根据在系数设置图中描述的系数A1、A2和A3的组合与所确定的区域相关联地设定系数A1、A2和A3的值。\n[0059] 具体地，本实施例对测量精度εp和εv分配阈值Th1和Th2，并且对测量精度εp和εv的坐标空间分配四个区域。即，定义第一区域使得满足εp＜Th1且εv＜Th2。\n定义第二区域使得满足εp≥Th1且εv＜Th2。定义第三区域使得满足εp＜Th1且εv≥Th2。定义第四区域使得满足εp≥Th1且εv≥Th2。根据本实施例，减小测量精度εp和εv的值提高了精度。换句话说，测量精度εp和εv的值越大表示GPS接收器\n10测量的位置和速度可能出现的误差越大。 \n[0060] 第一区域定义系数A1、A2和A3，使得系数A3小于系数A1和A2。当从GPS接收器\n10获得的位置坐标P(n)和速度向量V(n)表示高测量精度时，本实施例配置系数A1、A2和A3，使得增大根据从GPS接收器10获得的位置坐标P(n)和速度向量V(n)得到的位置坐标Pc(n-1)+V(n)·T的权重。本实施例校正位置坐标P(n)，并且得到位置坐标Pc(n)。 [0061] 第二区域定义系数A1、A2和A3，使得系数A2大于系数A1和A3。当位置坐标P(n)的测量精度低而速度向量V(n)的测量精度高时，本实施例配置系数A1、A2和A3，使得增大根据速度向量V(n)得到的位置坐标Pc(n-1)+V(n)·T的权重。本实施例校正位置坐标P(n)，并且得到位置坐标Pc(n)。 \n[0062] 第三区域定义系数A1、A2和A3，使得系数A1大于系数A2和A3。当位置坐标P(n)的测量精度高而速度向量V(n)的测量精度低时，本实施例配置系数A1、A2和A3，使得增大从GPS接收器10获取的位置坐标P(n)的权重。本实施例校正位置坐标P(n)，并且得到位置坐标Pc(n)。 \n[0063] 第四区域定义系数A1、A2和A3，使得系数A3大于系数A2和A1。当从GPS接收器\n10获得的位置坐标P(n)和速度向量V(n)表示低测量精 度时，本实施例配置系数A1、A2和A3，使得增大根据来自自主导航传感器组20的输出得到的位置坐标Pc(n-1)+V(n)·T的权重。本实施例校正位置坐标P(n)，并且得到位置坐标Pc(n)。 \n[0064] 以这种方式，预处理部分33校正从GPS接收器10获取的位置坐标P(n)以获取高度精确的位置坐标Pc(n)。然后，预处理部分33向偏移误差估计部分35和偏移误差去除部分37输出位置坐标Pc(n)。 \n[0065] 下面说明偏移误差估计部分35的操作。偏移误差估计部分35获取从预处理部分\n33输出的位置坐标Pc。偏移误差估计部分35使用所获取的信息和存储在道路数据库40内的道路数据估计GPS接收器10行进的路段并估计偏移误差。 \n[0066] 图5A是示出偏移误差估计部分35执行的偏移误差估计处理的流程图。偏移误差估计部分35与预处理部分33互锁，并且以周期T周期性地执行图5A的偏移误差估计处理，以得到偏移误差估计值Y。 \n[0067] 当开始偏移误差估计处理时，偏移误差估计部分35从预处理部分33获取位置坐标Pc(n)，并将其记录在内置缓冲器内(S210)。 \n[0068] 在完成该处理后，偏移误差估计部分35识别在当前点之前的t＝K·T小时期间获取的多个位置坐标{Pc(n-k)|k＝0，1，2，...，K}。根据这些位置坐标，偏移误差估计部分35使用线性插值技术对于在当前点Pc(n)之前的t＝K·T小时测量的点Pc(n-k)中的每个计算当前点Pc(n)和点Pc(n-k)之间的路径长度L(k)，其中k＝0，1，...，K(S220)。 [0069] [方程1] \n[0070] \n[0071] 偏移误差估计部分35根据路径长度L(k)和位置坐标Pc(n-k)之间的关系产生表示GPS接收器10的行进轨迹(或者经过的路线)的轨迹数据D1(S230)。 \n[0072] 例如，如图5B所示，偏移误差估计部分35将当前点Pc(n)和点Pc(n-K)之间的路径划分为M个相等的路径长度间隔dL。偏移误差估计部分35使用线性插值技术来得到划分点处的位置坐标Q(1)，Q(2)，...，Q(M-1)。偏移误差估计部分35描述位置坐标Q(1)，Q(2)，...，Q(M-1)以及两个端点处的位置坐标Q(0)＝Pc(n)和Q(M)＝Pc(n-K)，以产生轨迹数据D1＝{Q(0)，Q(1)，Q(2)，...，Q(M-1)，Q(M)}。位置坐标Q(m)，其中m＝0，1，2，...，M，表示从当前点Q(0)＝Pc(n)开始沿着路径(GPS接收器10的行进轨迹)往回追踪m·dL的长度的点。 \n[0073] 在完成产生轨迹数据D1时，偏移误差估计部分35进行到S240，根据位置坐标Q(0)和存储在道路数据库40中的道路数据估计车辆行进道路。即，偏移误差估计部分35估计GPS接收器10行进的道路。具体地，偏移误差估计部分35执行图6A的道路估计处理，以估计车辆行驶道路。图6A是示出偏移误差估计部分35执行的道路估计处理的流程图。 [0074] 当开始道路轨迹处理时，偏移误差估计部分35使用最后估计的偏移误差估计值Y来校正位置坐标Q(0)，并计算当前估计的位置坐标X(S310)。具体地，偏移误差估计部分35使用下面的方程来计算位置坐标X。 \n[0075] X＝Q(0)-Y \n[0076] 例如，我们假设下面的条件。将ENU坐标系用作位置坐标系。位置坐标Q(0)在ENU坐标系内被表示为向量Q(0)＝(QE(0)，QN(0)，QU(0))。偏移误差估计值Y被表示为Y＝(YE，YN，YU)。然后，偏移误差估计部分35计算X＝(QE(0)-YE，QN(0)-YN，QU(0)-YU)，假定位置坐标X是(XE，XN，XU)。 \n[0077] 偏移误差估计部分35在S290更新偏移误差估计值Y。当第一次执行S240中的处理时，偏移误差估计部分35使用预定初始值Y0作为当前偏移误差估计值Y。 [0078] 在完成该处理后，偏移误差估计部分35在存储在道路数据库40的道路数据中搜索距离位置坐标X最近的道路，即具有与位置坐标X最短的直接距离的道路。偏移误差估计部分35找到在与位置坐标X最近的道路 上的点处的位置坐标R(0)＝(RE(0)，RN(0)，RU(0))(S320)。当已经向道路分配了位置坐标X时，偏移误差估计部分35定义坐标R(0)＝X。 \n[0079] 在找到位置坐标R(0)后，偏移误差估计部分35计算坐标X和坐标R(0)之间的距离δ＝|X-R(0)|，如图6B所示。偏移误差估计部分35判断距离δ是否小于或者等于上限(S330)。当确定距离δ小于或者等于上限(S330中的“是”)时，偏移误差估计部分35进行到S340。当确定距离δ超过上限(S330中的“否”)时，偏移误差估计部分35进行到S360。 \n[0080] 在S340，偏移误差估计部分35判断检索到的与指定位置坐标X最近的道路是否具有与GPS接收器10的轨迹数据D1表示的行进轨迹相关联的平面道路结构(或者从道路的上表面来看的道路形状)。 \n[0081] 具体地，在S340，偏移误差估计部分35找到与在S320中指定的位置坐标X最近的道路上存在的点的位置坐标R(1)，该点沿着道路与坐标R(0)相距等于轨迹数据D1的距离dL。 \n[0082] 当没有到达尽头时，道路从坐标R(0)开始在两个方向上延伸。当指定道路从坐标R(0)开始在两个方向上延伸时，偏移误差估计部分35找到与在每个方向上沿着道路与坐标R(0)相距距离dL的点相对应的位置坐标Ra(1)、Rb(1)处的位置坐标R(1)。图7A是示出位置坐标R(1)和位置坐标R(0)之间的关系的说明图。 \n[0083] 在完成该处理时，偏移误差估计部分35计算向量Z1＝Q(1)-Q(0)和向量Z2＝R(1)-R(0)。当指定道路从坐标R(0)开始在两个方向上延伸时，偏移误差估计部分35计算向量Za＝Ra(1)-R(0)和向量Zb＝Rb(1)-R(0)作为向量Z2。 \n[0084] 在计算向量Z1和Z2后，偏移误差估计部分35计算向量Z1和Z2之间的角度θ。 [0085] θ＝arccos(Z1·Z2/(|Z1|·|Z2|)) \n[0086] 图7B是示出设置向量Z1和Z2以及向量Z1和Z2之间的角度θ的方法的说明图。 \n[0087] 当角度θ小于或者等于阈值θth(θ≤θth)时，假定指定道路的平面结构 类似于GPS接收器10的行进轨迹。偏移误差估计部分35确定该道路与GPS接收器10的行进轨迹相关联(S340中的“是”)。 \n[0088] 当角度θ超过阈值θth(θ＞θth)时，假定指定道路的平面结构不与GPS接收器10的行进轨迹类似。偏移误差估计部分35确定该道路与GPS接收器10的行进轨迹不相关联(S340中的“否”)。 \n[0089] 当计算向量Za和Zb作为向量Z2时，偏移误差估计部分35计算向量Z1和Za之间的角度θa以及向量Z1和Zb之间的角度θb。当角度θa或者θb小于或者等于阈值θth时，偏移误差估计部分35在S340中取判断结果为“是”。仅当角度θa和θb都超过阈值θth时，偏移误差估计部分35在S340中取判断结果为“否”。当角度θa或者θb小于或者等于阈值θth时，偏移误差估计部分35丢弃提供大角度θ的坐标Ra(1)或者Rb(1)。偏移误差估计部分35使用提供小角度θ的坐标Ra(1)或者Rb(1)来确定位置坐标R(1)。 \n[0090] 以这种方式，偏移误差估计部分35判断指定道路是否与GPS接收器10的行进轨迹相关联(S340)。当确定指定道路与GPS接收器10的行进轨迹相关联(S340中的“是”)时，偏移误差估计部分35进行到S350，取指定道路是车辆行进道路。然后，偏移误差估计部分35结束该道路估计处理。 \n[0091] 当确定指定道路与GPS接收器10的行进轨迹不相关联(S340中的“否”)时，偏移误差估计部分35进行到S360，通过确定无法正确地估计任何车辆行进道路来发出错误。然后，偏移误差估计部分35结束该道路估计处理。 \n[0092] 根据本实施例的偏移误差估计处理在假定GPS接收器10与车辆一起在道路上移动的情况下估计车辆行进道路。该处理通过比较车辆行进道路与GPS接收器10的行进轨迹来估计偏移误差。因此，需要在S240正确地估计车辆行进道路。 \n[0093] 因为该原因，需要将阈值θth设置为比例如π/4足够小的值。以这种 方式限定阈值θth可以防止将与车辆实际行进的道路交叉的道路取为车辆行进道路。道路估计处理可以正确地估计车辆行进道路，即GPS接收器10行进的道路。 \n[0094] 当距离δ超过上限时，本实施例通知错误。这是因为指定道路不可能是车辆行进道路。按照本实施例的道路估计处理可以解决无意地将该道路取为车辆行进道路的问题。 [0095] 在完成S240中的道路估计处理时，偏移误差估计部分35进行到S250，判断该道路估计处理是否估计了车辆行进道路。具体地，当道路估计处理发出错误时，偏移误差估计部分35在S250判断为“否”，假定无法估计车辆行进道路。当该道路估计处理没有发出错误并且估计车辆行进道路时，偏移误差估计部分35在S250判断为“是”。 \n[0096] 当无法估计车辆行进道路(S250中的“否”)时，偏移误差估计部分35进行到S295，输出最后更新的偏移误差估计值Y。然后，偏移误差估计部分35结束偏移误差估计处理。当第一次执行S290的处理时，偏移误差估计部分35输出预定初始值Y0。 [0097] 当确定可以估计车辆行进道路(S250中的“是”)时，偏移误差估计部分35进行到S260，产生表示所估计的车辆行进的路段内的多个点的位置坐标的路段数据D2＝{R(0)，R(1)，...，R(M)}。 \n[0098] 包括在路段数据D2内的位置坐标R(0)和R(1)等同于在道路估计处理(S240)得到的那些。位置坐标R(m)(m＝0，1，2，...，M)表示从作为基准点的点R(0)开始沿着道路往回向点R(1)追踪m·dL的长度的位置。 \n[0099] 在S260，类似于轨迹数据D1，偏移误差估计部分35使用点R(0)作为基准点，找到道路上以距离dL为间隔的除了已经得到的位置坐标R(0)和R(1)之外的点的位置坐标R(2)至R(M)。偏移误差估计部分35描述位置坐标R(0)，R(1)，...，R(M)以产生路段数据。 \n[0100] 在完成该处理后，偏移误差估计部分35进行到S270。根据轨迹数据D1和路段数据D2，偏移误差估计部分35计算轨迹数据D1表示的每个 点的位置坐标Q(m)和对应于位置坐标Q(m)的位置坐标R(m)之间的误差Δ(m)＝Q(m)-R(m)，如图8所示。偏移误差估计部分35还计算加权平均值ε。 \n[0101] [方程2] \n[0102] \n[0103] 图8是关于计算加权平均值ε的方法的说明图。上述方程内的参数α＝{α(0)，α(1)，...，α(M)}是满足下面的方程的加权系数。 \n[0104] [方程3] \n[0105] \n[0106] α(0)＞α(1)＞α(2)＞…＞α(m)＞…＞α(M) \n[0107] 本实施例通过向GPS接收器10最近执行定位的区域内的每个点的误差Δ(m)＝Q(m)-R(m)赋予更大的权重来计算加权平均值ε，其中m＝0，1，...，M。如图8所示，A(m)表示位置坐标Q(m)＝(QE(m)，QN(m)，QU(m))和在方向E、N和U上对应于位置坐标Q(m)的道路上的位置坐标R(m)＝(RE(m)，RN(m)，RU(m))之间的误差(Δ(m)＝(QE(m)-RE(m)，QN(m)-RN(m)，QU(m)-RU(m))))。加权平均值ε表示向量形式的方向分量之间的误差的加权平均值。 \n[0108] 在计算加权平均值ε后，偏移误差估计部分35进行到S280，判断计算的加权平均ε是否小于或者等于预定上限。当确定加权平均ε小于或者等于预定上限(S280中的“是”)时，偏移误差估计部分35进行到S290，将偏移误差估计值Y更新为在S270计算的加(Y←ε)\n权平均值ε 。偏移误差估计部分35向偏移误差去除部分37输出更新后的偏移误差估计值Y(S295)。然后，偏移误差估计部分35结束该偏移误差估计处理。 \n[0109] 当确定加权平均值ε超过上限(S280中的“否”)时，偏移误差估计部分35跳过S290，进行到S295，向偏移误差去除部分37输出偏移误差估 计值Y。然后，偏移误差估计部分35结束该偏移误差估计处理。当加权平均值ε大并且所估计的车辆行进道路很可能不正确时，偏移误差估计部分35将最后更新的值作为偏移误差估计值Y输出而不进行更新。 [0110] 根据本实施例，偏移误差去除部分37与预处理部分33和偏移误差估计部分35互锁。偏移误差估计部分35输出偏移误差估计值Y。根据偏移误差估计值Y，偏移误差去除部分37从自预处理部分33输入的定位结果Pc(n)中去除偏移误差。偏移误差去除部分37经由接口部分50向外部输出校正后的位置坐标Po＝Pc(n)-Y。 \n[0111] 已经描述了根据本实施例的位置检测设备1。位置检测设备1根据测量点处的位置坐标Q(0)，Q(1)，...，Q(M)和道路上的点处的位置坐标R(0)，R(1)，...，R(M)计算偏移误差估计值Y。位置检测设备1将GPS接收器10的行进轨迹与全部多个点处的道路配置进行比较以估计偏移误差。 \n[0112] 具体地，本实施例从位置坐标R(0)开始以相等的距离间隔dL定义点，以得到所定义的点的位置坐标R(1)至R(M)。本实施例根据轨迹数据D1表示的点之间的位置关系得到与轨迹数据D1表示的点的位置坐标Q(m)相对应的道路上的位置坐标R(m)。本实施例计算点处的误差A(m)的平均值ε作为偏移误差估计值Y。 \n[0113] 因此，位置检测设备1可以精确地估计偏移误差，并且可以精确地从来自GPS接收器10的定位结果中去除偏移误差分量，以校正位置。 \n[0114] 传统技术根据从FM广播站接收到的偏移误差信息校正定位结果。当FM广播站远离测量点时，接收到的信息表示的偏移误差可能大大偏离测量点处的偏移误差的真实值。\n传统技术不能正确地从定位结果中去除偏移误差，或者不能精确地校正定位结果。根据本实施例，上述方法可以精确地估计测量点处的偏移误差，可以比传统技术更适当地校正来自GPS接收器10的定位结果。另外，位置检测设备1不需要在设备内安装FM接收器，可以降低产品的制造成本。 \n[0115] 相关技术的地图匹配技术将定位结果与道路位置进行比较，并且强制 地将定位结果调整到道路上的位置坐标。如图9B所示，相关技术的地图匹配技术不能相对于道路精确地表示车辆轨迹或者参考道路精确地表示车辆移动。根据上述方法，本实施例可以适当地校正位置坐标，并解决该问题，同时表示实际车辆轨迹或者车辆移动。因此，如图9A所示，可以精确地表示车辆移动。 \n[0116] 此外，本实施例通过向GPS接收器10最近执行定位的区域内的每个点处的误差赋予更大的权重来计算加权平均值ε。根据本实施例的位置检测设备1可以适当地按照电离层的改变精确地估计偏移误差。 \n[0117] 本实施例如下估计车辆行进道路。本实施例根据先前估计的偏移误差校正预处理后的GPS接收器10测量的位置坐标Q(0)＝Pc(n)。校正后的值X ＝Q(0)-Y用于估计与点X最近的道路作为车辆行进道路。此外，根据向量Z1和Z2之间的角度θ，本实施例判断该最近的道路的平面结构是否与测量的位置坐标的轨迹相关联。当其间没有关联时，本实施例停止估计车辆行进道路。因此，根据本实施例的位置检测设备1可以简单并精确地估计车辆行进道路(GPS接收器10行进的道路)。 \n[0118] 当位置坐标X远离最近的道路时，本实施例不根据相应的轨迹数据估计偏移误差(S250中的“否”)。本实施例使用计算的偏移误差估计值Y校正测量的位置坐标Pc(n)，并输出校正后的位置坐标Po。本实施例可以防止由于不正确地估计的车辆行进道路而导致计算并输出不正确的位置坐标Po。 \n[0119] 本实施例根据来自安装在车辆上的自主导航传感器的输出计算车辆的位移量值Vs。本实施例根据位移量值Vs校正GPS接收器10测量的位置坐标P。本实施例根据校正后的位置坐标Pc产生轨迹数据。因此，本实施例可以抑制随机误差的影响，并适当地估计偏移误差。 \n[0120] 道路数据库40作为道路数据存储部件或者装置的示例。预处理部分33执行的处理中的S110作为位置信息获取部件或者控制单元的示例。偏移误差估计部分35执行的处理中的S210到S230作为轨迹数据产生部件或者控制单元的示例。 \n[0121] 偏移误差估计部分35执行的处理中的S240到S260作为道路估计部件或者控制单元的示例。偏移误差估计部分35执行的处理中的S270和S290作为偏移误差估计部件或者控制单元的示例。计算并输出位置坐标Po＝Pc(n)-Y的偏移误差去除部分37的操作作为校正输出部件或者控制单元的示例。自主速度向量计算部分31和预处理部分33执行的处理中的S120到S180作为预处理部件或者控制单元的示例。 \n[0122] 本发明不限于以上上述的实施例，而可以另外以各种方式实现。 [0123] 例如，本实施例计算误差Δ(m)的加权平均值ε作为偏移误差估计值Y。偏移误差估计值Y可以被计算为误差Δ(m)的简单平均值。即，可以通过对于所有的m值设置α(m)＝1/(M+1)来得到偏移误差估计值Y。 \n[0124] 本实施例将GPS接收器10测量的位置坐标P(n)校正为位置坐标Pc(n)，并且向偏移误差估计部分35和偏移误差去除部分37输入具有改善精度的校正后的位置坐标Pc(n)。\n位置检测设备1可以被配置为向偏移误差估计部分35和偏移误差去除部分37按原样输入GPS接收器10测量的位置坐标P(n)，而不是位置坐标Pc(n)。 \n[0125] 根据经由预处理部分33从GPS接收器10获取的位置坐标Pc，本实施例使用线性插值技术产生以相等的距离间隔表示车辆行进轨迹的轨迹数据。本实施例产生以相等的距离间隔表示道路的位置坐标R(m)的路段数据。位置坐标R(m)等同于与轨迹数据表示的每个点的位置坐标Q(m)相对应的道路上的点处的位置坐标。本实施例根据这些数据得到偏移误差。优选地，可以通过使用从预处理部分33获取的位置坐标Pc(n)到Pc(n-K)表示车辆行进轨迹来产生轨迹数据，而不进行线性插值。优选地，可以根据每个点处的轨迹数据表示的位置坐标Pc得到与每个点处的位置坐标Pc相对应的道路上的位置坐标，使得点之间的距离等于轨迹数据表示的点之间的距离。因此，可以产生路段数据。可以根据这些数据得到偏移误差。以这种方式，可以降低算术处理负荷，并减少数据量。 \n[0126] 上面说明的处理、步骤或者部件中的每一个或者任意组合可以作为包括或者不包括相关装置的功能的软件单元(例如子例程)和/或硬件单元(例 如电路或者集成电路)来实现；此外，可以在微计算机内部构造硬件单元。 \n[0127] 此外，软件单元或者多个软件单元的任意组合可以包括在软件程序内，该软件程序可以包含在计算机可读存储介质内，或者可以经由通信网络下载和安装在计算机内。 [0128] 下面给出了在此描述的公开的各方面。 \n[0129] 作为本公开的一个方面，位置校正设备包括偏移误差估计部件。位置校正设备估计GPS接收器测量的位置坐标的偏移误差，并如下根据估计的偏移误差校正GPS接收器测量的位置坐标。 \n[0130] 位置校正设备允许位置信息获取部件获取GPS接收器测量的位置坐标。根据位置信息获取部件获取的位置坐标，位置校正设备允许轨迹数据产生部件产生表示在过去的指定时段期间GPS接收器的多个点的位置坐标的轨迹数据。 \n[0131] 位置校正设备包括道路数据存储部件，其存储表示建造的道路的位置坐标的道路数据。位置校正设备允许道路估计部件根据位置信息获取部件获取的位置坐标和道路数据估计GPS接收器在过去的指定时段期间行进的路段。 \n[0132] 偏移误差估计部件根据道路估计部件估计的路段内的多个点处的位置坐标和GPS接收器的轨迹数据表示的多个点处的位置坐标估计偏移误差。 \n[0133] 位置校正设备根据偏移误差估计部件估计的偏移误差校正GPS接收器测量的位置坐标，并输出校正后的位置坐标(校正输出部件)。 \n[0134] 位置校正设备用于校正来自安装在诸如在道路上移动的车辆的可移动体上的GPS接收器的定位结果。位置校正设备在可移动体沿着道路移动的假设下估计偏移误差。位置校正设备的特征是根据所测量的点处的位置坐标和道路上的点处的位置坐标估计偏移误差。 \n[0135] 位置校正设备可以通过根据所测量的点处的位置坐标和道路上的点处的位置坐标估计偏移误差，来比较GPS接收器的行进轨迹和通过多个 点的道路配置。因此，可以精确地估计偏移误差。 \n[0136] 传统技术根据从FM广播站接收的偏移误差信息校正定位结果。当接收到的信息表示的偏移误差大大偏离测量点处的偏移误差的真实值时，传统技术无法正确地从定位结果中去除偏移误差或者精确地校正定位结果。根据本公开的该方面，上述方法可以在测量点处精确地估计偏移误差。位置校正设备可以比传统技术更适当地从所测量的位置坐标中去除偏移误差，并更精确地校正定位结果。另外，位置检测设备不需要在设备内安装FM接收器，可以降低产品的制造成本。 \n[0137] 相关技术的地图匹配技术根据道路数据校正定位结果。相关技术的地图匹配技术将定位结果与道路位置进行比较，并且强制地将定位结果调整到道路上的位置坐标。因此，这种技术必然使可移动体的位置坐标与表示道路的线重叠，无法相对于道路精确地表示可移动体轨迹或者参考道路精确地表示可移动体移动。 \n[0138] 上述方法可以适当地得到偏移误差，并使用得到的偏移误差适当地校正定位结果。该方法可以精确地表示可移动体的移动，并校正位置坐标。因此，将这种技术应用于车辆控制可以检测车辆相对于道路的移动。这种技术可以在确定危险驾驶并相应地帮助司机进行操作方面提供精确控制。 \n[0139] 当试图校正来自GPS接收器的定位结果并得到例如通过曲线的车辆的精确行进轨迹时，相关技术将定位结果与道路位置进行比较，并且将定位结果调整为道路上的位置坐标。如图9B所示，相关技术无法进行适当的校正。校正消除了相对于道路的移动信息，使得无法精确地表示车辆移动。无法根据来自GPS接收器的定位结果和道路配置在确定危险驾驶并相应地帮助司机进行操作方面适当地提供控制。 \n[0140] 相反，如图9A所示，根据本公开的该方面的位置校正设备可以精确地估计偏移误差并校正定位结果。校正不消除关于位置坐标的连续改变的信息。位置校正设备可以精确地表示车辆移动，并且精确地进行控制以帮助司机进行操作。 \n[0141] 道路估计部件可以使用轨迹数据表示的点之间的位置关系，并且估计在路段上与轨迹数据表示的点的位置坐标相对应的位置坐标。偏移误差估计部件可以针对轨迹数据表示的点的位置坐标中的每一个计算轨迹数据表示的位置坐标和与该位置坐标相对应的所估计的路段上的位置坐标之间的误差。 \n[0142] 按照时间，偏移误差比随机误差更慢地改变。在短时段内，由于偏移误差的影响，测得GPS接收器的位置坐标沿给定方向与真实的位置坐标偏离给定距离。为了精确地估计偏移误差，路段上的点被配置为轨迹数据表示的点之间的位置关系与模式相匹配。根据每个点处的轨迹数据表示的位置坐标和道路上的位置坐标的误差的平均值估计偏移误差。 [0143] 偏移误差估计部件可以计算这些点处的误差的简单平均值作为偏移误差的估计值。偏移误差估计部件还可以计算这些点处的误差的加权平均值作为偏移误差的估计值。 [0144] 为了得到加权平均值作为偏移误差的估计值，偏移误差估计部件可以配置为通过对GPS接收器最近定位的区域内的误差分配更大的权重来计算加权平均值。适当地根据电离层的改变可以精确地估计偏移误差(偏移误差按照时间顺序的改变）。 \n[0145] 道路估计部件可以被配置为使用偏移误差估计部件已经估计的偏移误差，并估计在过去的指定时段期间GPS接收器行进的路段。从GPS接收器获取的位置坐标显然包含偏移误差。通过使用偏移误差估计部件估计的偏移误差校正从GPS接收器获取的位置坐标，位置校正设备可以估计GPS接收器行进的道路。以这种方式，位置校正设备可以更精确地估计GPS接收器行进的路段。其结果是，位置校正设备可以精确地检测偏移误差。 [0146] 道路估计部件可以被配置为根据偏移误差估计部件已经估计的偏移误差校正轨迹数据表示的位置坐标，根据校正后的位置坐标检索与轨迹数据表示的点的分布高度相关的道路，并且估计在过去的指定时段期间GPS接收器在检索到的道路上行进的路段。 [0147] 道路估计部件可以被配置为根据偏移误差估计部件已经估计的偏移误差校正轨迹数据表示的点的位置坐标中特定点的位置坐标，检索最接近校正后的位置坐标的道路，估计检索到的最近的道路作为GPS接收器行进的道路，并且估计在过去的指定时段期间GPS接收器在该道路上行进的路段。 \n[0148] 这种技术可以简单并精确地估计GPS接收器行进的路段。 \n[0149] 可以使用下面估计路段的方法。该方法根据偏移误差估计部件已经估计的偏移误差来校正轨迹数据表示的点的位置坐标中特定点的位置坐标。该方法将与校正后的道路上的位置坐标最接近的点定义为基准点。该方法在每个点处估计与轨迹数据表示的位置坐标相对应的道路上的位置坐标，以便从基准点开始沿着道路的距离(道路长度)与从特定点开始沿着轨迹数据表示的行进轨迹的距离(道路长度)相匹配。该方法估计与轨迹数据表示的位置坐标相对应的道路上的位置坐标。该方法估计所估计的道路两端的位置坐标之间的区段作为路段。 \n[0150] 位置校正设备可以被配置为当道路估计部件检索到的最近的道路和校正后的特定点处的位置坐标之间的距离超过指定上限时，能够允许偏移误差估计部件停止根据轨迹数据估计偏移误差。校正输出部件可以被配置为根据在偏移误差估计部件不估计偏移误差的特定时段之前偏移误差估计部件估计的偏移误差，校正在该特定时段期间GPS接收器测量的特定位置坐标。校正输出部件可以进一步被配置为输出校正后的特定位置坐标。 [0151] 根据这种配置，位置校正设备可以防止将不正确的道路估计为GPS接收器进行的道路，并且防止估计不正确的偏移误差作为结果。 \n[0152] 当GPS接收器安装在车辆内时，位置校正设备可以被配置为包括预处理部件，根据来自安装在车辆内的自主导航传感器的输出计算位移量值，并根据该位移量值校正位置信息获取部件获取的位置坐标。轨迹数据产生部件可以被配置为根据预处理部件校正后的位置坐标产生表示与在过去的指定时段期间GPS接收器的位置坐标相对应的多个点的轨迹数 据。 \n[0153] 根据这种配置，位置校正设备可以更精确地得到偏移误差，并且适当地校正GPS接收器测量的位置坐标。 \n[0154] 对于本领域技术人员很明显，可以在本发明的上述实施例内进行各种改变。然而，本发明的范围应当由所附权利要求来确定。