CN1760692B - 导航装置 - Google Patents
导航装置 Download PDFInfo
- Publication number
- CN1760692B CN1760692B CN200510113506.4A CN200510113506A CN1760692B CN 1760692 B CN1760692 B CN 1760692B CN 200510113506 A CN200510113506 A CN 200510113506A CN 1760692 B CN1760692 B CN 1760692B
- Authority
- CN
- China
- Prior art keywords
- location position
- predicated error
- travel
- error scope
- angle
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
- 238000005259 measurement Methods 0.000 claims description 49
- 230000001133 acceleration Effects 0.000 description 15
- 238000000034 method Methods 0.000 description 7
- 238000010586 diagram Methods 0.000 description 5
- 230000008878 coupling Effects 0.000 description 3
- 238000010168 coupling process Methods 0.000 description 3
- 238000005859 coupling reaction Methods 0.000 description 3
- 230000001186 cumulative effect Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明所要解决的问题是提供一种可以提高测位误差的修正精度的导航装置。导航装置包括:GPS接收机(2),接收从多个GPS卫星发送的电波并输出测位位置;误差范围设置部(12),设置包含GPS接收机(2)进行的本次的位置测量定时的测位位置的预测误差范围;相对位置判断部(14)和位置修正部(16),当在本次的位置测量定时中从GPS接收机(2)输出的实际的测位位置包含在预测误差范围内时,使用实际的测位位置,当实际的测位位置不包含在预测误差范围内时,根据实际的测位位置和预测误差范围之间的相对的位置关系来进行测位位置的修正。
Description
技术领域
本发明涉及修正用GPS接收机得到的测位位置来使用的导航装置。
背景技术
现有技术中,已知有使用GPS接收得到的测位位置因多路径等误差原因而有偏差的情况,已知有为了降低由该误差造成的影响而修正测位位置的导航装置(例如,参照专利文献1)。在该导航装置中,从上次的测位位置来预测本次的测位位置,并且设置预测误差范围,在本次的实际测位位置包含在该预测误差范围的情况下,采用实际的测位位置,在预测误差范围外的情况下,采用所预测的测位位置。由此,在使用了GPS卫星的测位位置的误差大的情况下,可以减少其影响。
【专利文献1】日本专利特开平8-313278号公报(第5-8页,图1-3)
但是,在上述的专利文献1中,在本次的测位位置在预测误差范围外的情况下,使用所预测的测位位置,但是,由于以所预测的测位位置为中心来设置预测误差范围,该预测后的测位位置当然设置在预测误差范围的中心。因此,即使例如在所预测的测位位置稍微在预测误差范围外的情况下,也不考虑该稍微的差,而采用所预测的测位位置,所以相反有存在误差扩大的危险的问题。另外,在专利文献1中还公开了通过进行预定的加权来相加所预测的测位位置和实际的测位位置的测位位置修正方法,但是在该方法中,即使在期待测位位置包含在预测误差范围内的情况下,也存在所修正的测位位置不包含在预测误差范围内的情况(尤其在实际的测位位置大大脱离预测误差范围的情况下),因此有误差扩大了的危险的问题。例如,由于认为使用GPS接收机检测出的速度和行进方向的精度较高,所以若假定为当前的测位位置正确,则在预测误差范围内包含没有误差的测位位置的可能性非常高。
发明内容
本发明鉴于这些问题而做出,其目的是提供一种可以提高位置测量误差的修正精度的导航装置。
为了解决上述问题,本发明的导航装置包括:GPS接收机,接收从多个GPS卫星发送的电波来输出测位位置;误差范围设置部,设置包含GPS接收机进行的本次的位置测量定时的测位位置的预测误差范围;位置修正部,当在本次的位置测量定时中从GPS接收机输出的实际的测位位置包含在预测误差范围内时,使用实际的测位位置,在实际的测位位置不包含在预测误差范围内时,根据实际的测位位置和预测误差范围的相对的位置关系来进行测位位置的修正。由此,在实际的测位位置在预测误差范围之外的情况下,进行考虑了与预测误差范围的相对的位置关系的测位位置的修正,所以可以提高测位位置的修正精度。
另外,上述位置修正部最好进行测位位置的修正,使得修正后的测位位置位于包含在预测误差范围中的位置上。由此,即使在实际的测位位置在预测误差范围外的情况下,也可在考虑与预测误差范围的相对位置关系的同时,进行测位位置的修正,使修正后的测位位置包含在预测误差范围内,所以与无条件地将测位位置修正到预测误差范围的中心位置的情况相比,可以提高位置测量误差的精度。
另外,上述位置修正部最好进行测位位置的修正,使得修正后的测位位置在所述预测误差范围内、偏位到实际的测位位置测的位置上。由此,可以使实际的测位位置可靠地反映至修正后的测位位置,可以防止误差的扩大。
另外,上述的位置修正部最好进行测位位置的修正,使得修正后的测位位置位于预测误差范围的外缘上。由此,在实际的测位位置在预测误差范围之外的情况下,可以考虑与预测误差范围的相对的位置关系的同时,进行测位位置的修正,使修正后的测位位置重合到预测误差范围的外缘上,所以与无条件地将测位位置修正到预测误差范围的中心位置的情况相比,可以提高位置测量误差的精度。
另外,上述的位置修正部最好进行测位位置的修正,使得修正后的测位位置在预测误差范围的外缘上、偏位到实际的测位位置测的位置上。由此,可以使实际的测位位置可靠地反映至修正后的测位位置,可以防止误差的扩大。
另外,最好是,上述的GPS接收机输出测位位置并且还输出该测位位置移动的速度和行进角,误差范围设置部根据速度和行进角来设置预测误差范围。一般,GPS接收机输出的速度和行进角的精度比测位位置精度高,所以通过使用该速度和行进角来设置预测误差范围,可以准确设置要包含本次测位位置的预测误差范围。
另外,上述预测误差范围最好是,以上次的测位位置为中心的圆周方向的宽度通过相对从所述GPS接收机输出的上次的行进角、再加进根据上次的速度设置的行进角的可变范围来设置。一般,在速度大的情况下,认为本次的位置测量定时中行进角的变化的偏差程度小,在速度小的情况下,速度的变化的偏差程度大。因此,通过加进根据速度设置的行进角的可变范围,可以高精度地设置预测误差范围的圆周方向的宽度。
另外,上述的预测误差范围最好是,以上次的测位位置为中心的径向的宽度通过相对从GPS接收机输出的上次的速度、再加进根据上次的速度设置的速度的可变范围来设置。一般,在速度大的情况下,认为本次的位置测量定时中速度的变化的偏差程度小,在速度小的情况下,速度的变化的偏差程度大。因此,通过加进根据速度设置的速度的可变范围,可以高精度地设置预测误差范围的半径方向的宽度。
另外,上述的行进角的可变范围最好根据实际使用车辆测量从GPS接收机输出的速度和行进角的变动范围的关系而得到的结果来设置。或者,上述的速度的可变范围最好根据实际使用车辆测量从GPS接收机输出的速度和速度的变动范围的关系而得到的结果来设置。由此,由于可以使用准确的行进角或速度的可变范围,所以可以提高预测误差范围的精度,可以进一步提高测位位置的修正精度。
另外,上述的预测误差范围的大小最好根据位置测量环境来可变设置。由此,由于可以设置对应于位置测量环境的预测误差范围,所以可以进行对应于位置测量环境的测位位置的适当的修正。
另外,在上述的位置测量环境良好时,最好较大地设置预测误差范围。由此,在位置测量环境良好且GPS测位位置的精度高的情况下,不进行修正而使用GPS测位位置的机会增加,可以减少累计误差。
另外,最好进一步具有预测误差范围修正部,根据所述测位位置移动的行进角的上次之前的多次的值,来修正通过误差范围设置部设置的预测误差范围的方向。由此,在如曲折的道路那样,车辆的行进方向大大变化的场所行驶的情况下,可以考虑其行进方向的变化部分来进行测位位置的修正,所以可以进一步提高测位位置的修正精度。
另外,所述的预测误差范围修正部最好根据测位位置移动的行进角的上次和上上次的值来进行预测误差范围的方向的修正。通过根据行进角的上次和上上次的值来进行预测误差范围的修正,可以用少的运算量来进行修正,可以减轻处理的负担。
另外,上述的预测误差范围修正部最好根据测位位置移动的行进角的上次和上上次的值,在测量定时从上次推移到本次时,计算测位位置移动的方向,并进行预测误差范围的方向的修正,使得该计算出的方向位于中央。由此,预测要进行测位位置的修正的定时上的车辆的行进方向,并与该预测出的行进方向匹配地调整预测误差范围的配置,可以进行更符合实际情况的测位位置的修正。
另外,上述的预测误差范围修正部最好考虑行进角的变化量来进行预测误差范围的方向的修正。由此,在行进角的变化大的情况下,可以较大地设置预测误差范围的配置的调整量,相反在行进角的变化小的情况下可以较小设置预测误差范围的配置的调整量,所以可以进行与道路形状匹配的测位位置的修正。
另外,上述的预测误差范围修正部最好在测位位置移动的行进角的变化比基准值大时,进行预测误差范围的方向的修正。由此,可以减轻行进角的变化小的情况下的处理负担。
附图说明
图1是表示第一实施方式的导航装置的结构的图;
图2是在本实施方式中设置的预测误差范围的说明图;
图3是在本实施方式中设定的预测误差范围的说明图;
图4是表示预测加速度的实验结果的图;
图5是表示预测角速度的实验结果的图;
图6是表示通过位置修正部进行的测位位置的修正处理的具体例的图;
图7是表示第二实施方式的导航装置的结构的图;
图8是使用上次和上上次的测量定时中的行进角来修正预测误差范围的方向的情况下的修正量的说明图。
具体实施方式
下面,参照附图来说明使用了本发明的一实施方式的导航装置。
[第一实施方式]
图1是表示第一实施方式的导航装置的结构的图。图1所示的导航装置构成为包含导航控制器1、GPS接收机2、自主导航传感器3、显示装置4。
导航控制器1控制导航装置的整体。该导航控制器1通过使用CPU、ROM、RAM等执行预定的动作程序来实现其功能。
GPS接收机2接收从多个GPS卫星发送的电波,进行三维位置测量处理或二维位置测量处理来输出车辆的绝对位置(测位位置)和速度及方位(行进角(travel angle))。自主导航传感器3包括将车辆转角作为相对方位检测的陀螺仪等的角度传感器和以每预定距离输出脉冲的距离传感器,并检测出车辆的相对位置和方位。显示装置4根据从导航控制器1输出的描绘数据,显示自身车辆位置周围的地图图像等的各种图像。
另外,如图1所示,上述导航控制器1构成为包含GPS处理部10、车辆位置计算部20、地图DB(数据库)30、地图匹配处理部40、描绘部50和显示处理部60。GPS处理部10输入从GPS接收机2输出的测位位置、速度、行进角,并根据这些来进行测位位置的修正。GPS处理部10具有误差范围设置部12、相对位置判断部14、位置修正部16。误差范围设置部12根据从GPS接收机2输出的某个时刻的位置测量定时中的速度和行进角,设置在本次的位置测量定时中有测位位置存在可能的预测误差范围。相对位置判断部14判断通过误差范围设置部12设置的预测误差范围和在本次的位置测量定时中从GPS接收机2输出的测位位置之间的相对位置关系。位置修正部16根据通过误差范围设置部12设置的预测误差范围和通过相对位置判断部14判断的相对位置关系,在需要进行修正的情况下,进行测位位置的修正。另外,在不需要进行修正的情况下(在从GPS接收机2输出的测位位置包含在预测误差范围(后文描述)的情况下),不修正从GPS接收机2输出的测位位置而进行输出。另外,也可通过该位置修正部16来进行判断预测误差范围和使用了GPS接收机2的测位位置之间的相对位置关系的相对位置判断部14的动作。将从位置修正部16输出的测位位置输入到车辆位置计算部20中。
车辆位置计算部20根据从GPS处理部10内的位置修正部16输出的测位位置和由自主导航传感器3输出的相对位置和方位得到的车辆位置来计算车辆位置。例如,假定了以测位位置为中心的预定的误差圆,在根据自主导航传感器3的输出计算出的车辆位置包含在该误差圆内的情况下,采用根据自主导航传感器3的输出得到的车辆位置,在其不包含在误差圆内的情况下,将从GPS处理部10输出的测位位置用作车辆位置。
地图DB 30将表示道路的路段(link)和节点的详细数据和地图显示所需的图像数据、进行路径搜索和行驶引导等的各种导航动作所需的数据作为地图数据来进行存储。地图匹配处理部40进行地图匹配处理,该处理通过比较车辆的行驶轨迹与地图上的道路形状来修正从车辆位置计算部20输出的车辆位置。通过进行地图匹配处理,高精度地修正道路的宽度方向的位置。描绘部50进行描绘从地图匹配处理部40输出的修正后的车辆位置的周围的地图图像的处理。将该描绘数据送到显示处理部60后转换为适于显示的形式的信号,在显示装置4上显示车辆位置周围的地图图像。
上述的误差范围设置部12对应于误差范围设置部,相对位置判断部14、位置修正部16分别对应于位置修正部。
本实施方式的导航装置具有这种结构,下面,说明在GPS处理部10中进行的测位位置的修正动作。
图2和图3是在本实施方式中设置的预测误差范围的说明图。图2表示车辆的速度慢的情况下的预测误差范围,图3表示车辆的速度快的情况下的预测误差范围。如这些图所示,预测误差范围具有由通过有预定中心角的圆心的两条直线将由同心圆包围的区域截出的扇形形状。同心圆的小径部分表示相对上次的测位位置的本次的位置测量定时中的可移动最小距离,同心圆的大径部分表示相对上次的测位位置的本次的测量定时中的可移动最大距离。另外,通过圆心的两条直线中的一条(图2和图3中沿着逆时针旋转方向的上流测)表示对于上次的测位位置的最小行进角,另一条表示对于上次的测位位置的最大行进角。
若列举上述的预测误差范围的特征,则为如下所述。
(1)若速度慢,则最小行进角和最大行进角的差变大(图2),若速度变快,则最小行进角和最大行进角的差变小(图3)。
(2)预测误差范围对从GPS接收机2输出的上次的行进角,加进根据上次的速度设置的行进角的可变范围,设置以上次的测位位置为中心的圆周方向的宽度(最小行进角和最大行进角的角度差)。另外,上述行进角的可变范围使用实际使用车辆测量从GPS接收机2输出的速度和行进角的改变范围的关系而得到的结果来设置。
(3)预测误差范围对从GPS接收机输出的上次的速度,加进根据上次的速度设置的速度的可变范围,并设置以上次的测位位置为中心的径向的宽度(同心圆的小径和大径之间的距离)。另外,上述的速度的可变范围通过实际使用车辆测量从GPS接收机2输出的速度和速度的变动范围的关系而得到的结果来设置。
(4)根据位置测量环境来可变地设置预测误差范围的大小。例如,在位置测量环境良好时,设置较大的预测误差范围。
接着,说明预测误差范围的具体的设置方法。使用从GPS接收机2输出的上次的速度来确定预测误差范围的径向的值(小径和大径的各半径)。通过下面的式子来计算小径的半径R1和大径的半径R2。单位为m。
R1=((上次的速度)+(预测加速度最小值))×1000/3600...(1)
R2=((上次的速度)+(预测加速度最大值))×1000/3600...(2)
这里,((上次速度)+(预测加速度最小值))和((上次速度)+(预测加速度最大值))表示速度的变动范围,其中预测加速度最小值和预测加速度最大值根据实际使用车辆来测量的结果来进行设置。另外,1000/3600用于将单位换算为m。
图4是表示预测加速度的实验结果的图。图4中,横轴表示速度(时速),纵轴表示加速度。若每隔一秒从GPS接收机2输出速度,则通过从本次的速度减去上次的速度来计算该加速度。虽然加速度的实际测量值如图4所示有偏差,但是求出表示其最小值的近似曲线A,并将其作为每一速度的预测加速度最小值来使用。同样,求出表示最大值的近似曲线B,并将其作为每一速度的预测加速度最大值来使用。
另外,使用从GPS接收机2输出的上次的行进角来确定预测误差范围的圆周方向的角度(最小行进角和最大行进角)。通过下面的式子来计算最小行进角θ1和最大行进角θ2。
θ1=(上次的行进角)+(预测角速度最小值) ...(3)
θ2=(上次的行进角)+(预测角速度最大值) ...(4)
这里,((上次行进角)+(预测角速度最小值))和((上次行进角)+(预测角速度最大值))表示行进角的变动范围,其中,根据实际使用车辆来测量的结果来确定预测角最小值和预测角最大值。
图5是表示预测角速度的实验结果。图5中,横轴表示速度(时速)、纵轴表示角速度。若每隔一秒从GPS接收机2中输出行进角,则通过从本次的角速度减去上次的角速度来计算该角速度。角速度的实测值虽然如图5所示有偏差,但是求出表示其最小值的近似曲线C,并将其作为每一速度的预测角速度最小值来使用。同样,求出表示最大值的近似曲线D,并将其作为每一速度的预测角速度最大值来使用。
图6是表示通过位置修正部16进行的测位位置的修正处理的具体例的图。图6(A)是从上次的测位位置P0到本次的测位位置P1的距离比预测误差范围的可移动最大距离大,但是本次的行进角包含在最小行进角和最大行进角之间的情况。通过相对位置判断部14来进行该位置关系的判断。这种情况下,位置修正部16进行使本次的测位位置P1向上次的测位位置P0移动到对应于可移动的最大距离的大径部分d1的测位位置的修正。另外,也可修正测位位置d1’,使其比外缘位于内侧,而不修正测位位置d1,使其位于对应于可移动的最大距离的大径部分(预测误差范围的外缘上)。
图6(B)是上次的测位位置P0到本次的测位位置P1的距离比预测误差范围的可移动最小距离小,但是本次的行进角包含在最小行进角和最大行进角之间的情况。这种情况下,位置修正部16进行将本次的测位位置P1沿与上次的测位位置P0连接的延长线移动到对应于可移动最小距离的小径部分d2的测位位置的修正。另外,也可修正测位位置d2’,使其比外缘位于内侧,而不修正测位位置d2,使其位于对应于可移动最小距离的小径部分(预测误差范围的外缘上)。
图6(C)是预测误差范围的可移动最大距离和可移动最小距离之间包含上次的测位位置P0到本次的测位位置P1的距离,并且,本次的行进方向与配置了预测误差范围的方向一致,但是本次的行进角比最大行进角大的情况。这种情况下,位置修正部16进行使本次的测位位置P1移动到最大行进角和最小行进角朝向中心线与最大行进角相交的位置d3的测位位置的修正。也可修正测位位置d3’,使其比最大行进角(预测误差范围的外缘)位于内侧。另外,在比最小行进角小的情况下也同样进行修正。
图6(D)是预测误差范围的可移动最大距离和可移动最小距离之间包含了从上次的测位位置P0到本次的测位位置P1的距离,但是本次的行进方向朝向与配置了预测误差范围的方向相反的情况。这种情况下,位置修正部16进行使本次的测位位置P1移动到对应于可移动的最小距离的小径的中央部d4的测位位置的修正。另外,也可修正测位位置d4’,使其比外缘位于内侧,而不修正测位位置d4,使其位于对应于可移动最小距离的小径的中央部(预测误差范围的外缘上)。
图6(E)是与预测误差范围的可移动最大距离相比,从上次的测位位置P0到本次的测位位置P1的距离大,并且,本次的行进方向与配置了预测误差范围的方向一致,但是本次的行进角在最小行进角和最大行进角之外的情况。这种情况下,位置修正部16进行使本次的测位位置P1移动到对应于可移动最大距离的大径的中央部d5的测位位置的修正。另外,也可修正测位位置d5’,使其比外缘位于内侧,而不修正测位位置d5,使其位于对应于可移动最大距离的大径的中央部(预测误差范围的外缘上)。
图6(F)是与预测误差范围的可移动最大距离相比,从上次的测位位置P0到本次的测位位置P1的距离大,且本次的行进方向朝向与配置了预测误差范围的方向相反的情况。这种情况下,位置修正部16进行使本次的测位位置P1移动到对应于可移动最小距离的小径的中央部d6的测位位置的修正。另外,也可修正测位位置d6’,使其比外缘位于内侧,而不修正测位位置d6,使其位于对应于可移动最小距离的小径的中央部(预测误差范围的外缘上)。
图6(G)是与预测误差范围的可移动最小距离相比,从上次的测位位置P0到本次的测位位置P1的距离小,且本次的行进角在最小行进角和最大行进角之外,但是本次的行进方向朝向与配置了预测误差范围的方向相同的情况。这种情况下,位置修正部16进行使本次的测位位置P1移动到对应于可移动最小距离的小径的中央部d7的测位位置的修正。另外,也可修正测位位置d7’,使其比外缘位于内侧,而不修正测位位置d7,使其位于对应于可移动最小距离的小径的中央部(预测误差范围的外缘上)。
图6(H)是与预测误差范围的可移动最小距离相比,从上次的测位位置P0到本次的测位位置P1的距离小,且本次的行进角在最小行进角和最大行进角之外,并且本次的行进方向朝向与配置了预测误差范围的方向相反的情况。这种情况下,位置修正部16进行使本次的测位位置P1移动到对应于可移动最小距离的小径的中央部d8的测位位置的修正。另外,也可修正测位位置d8’,使其比外缘位于内侧,而不修正测位位置d8,使其位于对应于可移动最小距离的小径的中央部(预测误差范围的外缘上)。
这样,在本实施方式的导航装置中,由于即使在实际的测位位置在预测误差范围之外的情况下,也进行考虑了与预测误差范围的相对位置关系的测位位置的修正,所以可以提高测位位置的修正精度。另外,由于在考虑与预测误差范围的相对位置关系的同时,进行测位位置的修正,使得修正后的测位位置包含在预测误差范围的外缘上或其内部,所以与无条件地将测位位置修正为预测误差范围的中心位置的情况相比,可以提高位置测量误差的精度。尤其,通过进行测位位置的修正,以位于向实际的测位位置侧偏位的位置上,可以使实际的测位位置可靠地反映至修正后的测位位置,可以防止误差的扩大。
另外,从GPS接收机2中,与测位位置一起输出该测位位置移动的速度和行进角,并根据速度和行进角来设置预测误差范围。一般,由于从GPS接收机2输出的速度和行进角的精度比测位位置精度高,所以通过使用该速度和行进角来设置预测误差范围,从而可以准确设置要包含本次的测位位置的预测误差范围。
另外,预测误差范围是,对从GPS接收机2输出的上次的行进角,加进根据上次的速度设置的行进角的可变范围,来设置以上次的测位位置为中心的圆周方向的宽度。一般在速度大的情况下,认为本次的位置测量定时中的行进角的变化的偏差程度小,在速度小的情况下,认为速度的变化的偏差的程度大。因此,通过加进根据速度设置的行进角的可变范围,可以高精度设置预测误差范围的圆周方向的宽度。
另外,预测误差范围是,通过对从GPS接收机2输出的上次的速度加进根据上次的速度设置的速度的可变范围,来设置以上次的测位位置为中心的径向的宽度。一般在速度大的情况下,认为本次的位置测量定时中的速度的变化的偏差程度小,在速度小的情况下,认为速度的变化的偏差的程度大。因此,通过加进根据速度设置的速度的可变范围,可以高精度设置预测误差范围的半径方向的宽度。
另外,行进角的可变范围根据实际使用车辆测量从GPS接收机2输出的速度和行进角的变动范围的关系而得到的结果来设置,速度的可变范围根据实际使用车辆测量从GPS接收机2输出的速度和速度的变动范围的关系而得到的结果来设置。由此,由于可以使用正确的行进角或速度的可变范围,所以可以提高预测误差范围的精度,可以进一步提高测位位置的修正精度。
另外,本发明并不限于此,可以在本发明的精神的范围内进行各种变形实施。在上述的实施方式中,使用(1)式到(4)式来计算预测误差范围,但是也可根据位置测量环境来可变地设置该预测误差范围的大小。例如,也可将对应于位置测量环境的参数α乘以(1)式等中包含的(预测加速度最小值)、(预测加速度最大值)、(预测角速度最小值)、(预测角速度最大值),并修正这些值。由此,由于可以设置对应于位置测量环境的预测误差范围,所以可以进行对应于位置测量环境的测位位置的适当修正。尤其,在位置测量环境好时,通过较大地设置上述参数α的值,来较大地设置预测误差范围,从而在位置测量环境良好且GPS测位位置的精度高的情况下,不进行修正而使用GPS测位位置的机会增加,可以减小累计误差。
[第二实施方式]
但是,在上述的第一实施方式的导航装置中,根据上次的位置测量定时的车辆的行进方向来设置对应于本次的位置测量定时的预测误差范围的方向(图2和图3所示的中心方向)。但是,在如曲折道路那样,车辆的行进方向的变化大,车辆表现出圆运动的动向的情况下,由于上次的位置测量定时的车辆的行进角和本次的位置测量定时的车辆的行进角不同,所以最好考虑该行进角的变化量来修正预测误差范围的方向。
图7是表示第二实施方式的导航装置的结构的图。图7所示的本实施方式的导航装置相对于图1所示的第一实施方式的导航装置,在导航控制器1A内的GPS处理部10A上追加了作为预测误差范围修正部的误差范围修正部18这一点是不同的。该误差范围修正部18根据上次之前的多次的位置测量定时的行进角的值,来修正对应于本次的位置测量定时而设置的预测误差范围的方向(中心方向)。
图8是使用上次和上上次的位置测量定时的行进角来修正预测误差范围的方向的情况下的修正量的说明图。图8中,若对应于上次的位置测量定时的测位位置为P0(X0,Y0),行进角为θ0、对应于本次的位置测量定时的测位位置为P1(X1,Y1),行进角为θ1,则从测位位置P0到P1车辆行进的情况下的正确的行进角θ可以通过下面的式子来计算。另外,R表示假定为车辆进行半径一定的圆运动时的半径。
θ=tan-1((cosθ0-cosθ1)/(sinθ1-sinθ0)) ...(5)
但是,由于实际上不知道本次的位置测量定时的行进角θ,所以使用上次的位置测量定时的行进角θ0和上上次的位置测量定时的行进角θ-1的差(θ0-θ-1)作为角速度使用,而如下这样来预测本次的位置测量定时的行进角θ1。
θ1=θ0+(θ0-θ-1)
因此,使用该θ1,可以如下面的式子这样来变形(5)式。
θ=tan-1((cosθ0-cos(θ0+(θ0-θ-1)))/(sin(θ0+(θ0-θ-1))-sinθ0))...(6)
这样,根据上次和上上次的行进角,可以预测车辆从上次的测位位置行进到本次的测位位置的情况下的正确的行进角θ。误差范围修正部18进行使图2、图3、图6所示的预测误差范围的中心方向偏移该预测的行进角θ和上次的行进角θ0的差值(θ-θ0)的修正,即,进行使预测误差范围的中心方向与所预测的行进角θ一致的修正。
这样,在第二实施方式的导航装置中,在如曲折道路那样,在车辆的行进方向大大变化的场所行驶的情况下,由于可以进行考虑其行进方向的变化部分来调整预测误差范围的方向来进行测位位置的修正,所以可以进一步提高测位位置的修正精度。尤其,通过根据行进角的上次和上上次的值来进行预测误差范围的修正,可以用少的运算量来进行修正,可以减少处理的负担。
另外,预测要进行测位位置的修正的定时上的车辆的行进方向,并与该所预测出的行进方向匹配来调整预测误差范围的配置,从而可以进行更符合实际情况的测位位置的修正。进一步,在行进角的变化大的情况下,预测误差范围的配置的调整量大,相反在行进角的变化小的情况下,可以较小地设置预测误差范围的配置的调整量,所以可以进行与道路形状匹配的测位位置的修正。
另外,误差范围修正部18也可在测位位置移动的差异的行进角的变化量(θ0-θ-1)比基准值大时进行预测误差范围的方向的修正,在该变化量为基准值以下时不进行预测误差范围的方向的修正。由此,可以减轻行进角的变化小的情况下的负担。
Claims (10)
1.一种导航装置,根据表示使用从GPS卫星发送来的位置测量用信息而在过去测定的移动体的位置的位置信息,测定当前的该位置,其特征在于,包括:
GPS接收机,接收从多个GPS卫星发送的电波并输出测位位置;
误差范围设置单元,设置包含通过所述GPS接收机进行的本次的位置测量定时的测位位置的预测误差范围;
位置修正单元,当在本次位置测量定时中从所述GPS接收机输出的实际的测位位置包含在所述预测误差范围内时,使用所述实际的测位位置,当所述实际的测位位置不包含在所述预测误差范围内时,根据所述实际的测位位置和所述预测误差范围之间的相对的位置关系进行测位位置的修正。
2.根据权利要求1所述的导航装置,其特征在于:
所述位置修正单元进行测位位置的修正,使得修正后的测位位置位于所述预测误差范围中所包含的位置上。
3.根据权利要求2所述的导航装置,其特征在于:
所述位置修正单元进行测位位置的修正,使得修正后的测位位置在所述预测误差范围内、偏位到所述实际的测位位置侧的位置上。
4.根据权利要求1-3中的任何一项所述的导航装置,其特征在于:
所述GPS接收机输出测位位置并且输出该测位位置移动的速度和行进角;
所述误差范围设置单元根据所述速度和所述行进角来设置所述预测误差范围。
5.根据权利要求4所述的导航装置,其特征在于:
所述预测误差范围为,通过相对从所述GPS接收机输出的上次的行进角、再加进根据上次的速度设置的行进角的可变范围来设置以上次的测位位置为中心的圆周方向的宽度。
6.根据权利要求4所述的导航装置,其特征在于:
所述预测误差范围为,通过相对从所述GPS接收机输出的上次的速度、再加进根据上次的速度设置的速度的可变范围来设置以上次的测位位置为中心的径向的宽度。
7.根据权利要求5所述的导航装置,其特征在于:
所述行进角的可变范围为,根据实际使用车辆测定从所述GPS接收机输出的速度和行进角变动范围之间的关系而得到的结果来设置。
8.根据权利要求6所述的导航装置,其特征在于:
所述速度的可变范围为,根据实际使用车辆测定从所述GPS接收机输出的速度和速度变动范围之间的关系而得到的结果来设置。
9.根据权利要求4所述的导航装置,其特征在于:
还具有预测误差范围修正单元,根据所述测位位置移动的行进角的上次之前的多次的值,来修正通过所述误差范围设置单元设置的预测误差范围的方向。
10.根据权利要求9所述的导航装置,其特征在于:
所述预测误差范围修正单元在所述测位位置移动的行进角的变化比基准值大时,进行所述预测误差范围的方向的修正。
Applications Claiming Priority (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP299490/2004 | 2004-10-14 | ||
JP2004299490 | 2004-10-14 | ||
JP2005130834A JP4667951B2 (ja) | 2004-10-14 | 2005-04-28 | ナビゲーション装置 |
JP130834/2005 | 2005-04-28 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN1760692A CN1760692A (zh) | 2006-04-19 |
CN1760692B true CN1760692B (zh) | 2010-10-06 |
Family
ID=35545087
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN200510113506.4A Expired - Fee Related CN1760692B (zh) | 2004-10-14 | 2005-10-14 | 导航装置 |
Country Status (4)
Country | Link |
---|---|
US (1) | US7400969B2 (zh) |
EP (1) | EP1647806B1 (zh) |
JP (1) | JP4667951B2 (zh) |
CN (1) | CN1760692B (zh) |
Families Citing this family (26)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7474961B2 (en) * | 2005-02-04 | 2009-01-06 | Visteon Global Technologies, Inc. | System to determine the path of a vehicle |
JP2008014666A (ja) * | 2006-07-03 | 2008-01-24 | Nec Corp | マップマッチングに適するリンク設定システム、その方法およびプログラム |
JP4840031B2 (ja) * | 2006-08-31 | 2011-12-21 | ソニー株式会社 | ナビゲーション装置、ナビゲーション処理方法及びナビゲーション処理プログラム |
EP2085788B1 (en) * | 2006-10-18 | 2012-01-25 | NEC Corporation | Mobile communication terminal with gps function, positioning system, operation control method, and program |
JP4915343B2 (ja) * | 2007-12-21 | 2012-04-11 | ソニー株式会社 | 電子機器装置及びナビゲーション方法 |
US8140263B2 (en) * | 2008-01-31 | 2012-03-20 | Victor Company Of Japan, Limited | Method for deriving conversion coefficient used for specifying position from value detected by various sensors, and navigation apparatus |
US8442763B2 (en) * | 2010-04-16 | 2013-05-14 | CSR Technology Holdings Inc. | Method and apparatus for geographically aiding navigation satellite system solution |
JP5273188B2 (ja) * | 2011-03-28 | 2013-08-28 | ソニー株式会社 | 位置補正装置、位置補正方法、プログラムおよび位置補正システム |
KR101074638B1 (ko) * | 2011-05-04 | 2011-10-18 | 한국항공우주연구원 | 조향 모델을 이용한 주행차선 판단방법 |
CN103116174B (zh) * | 2012-02-15 | 2014-07-09 | 金三立视频科技(深圳)有限公司 | 基于预测编码修正模式的gps地图定位应用算法 |
JP5928038B2 (ja) * | 2012-03-19 | 2016-06-01 | カシオ計算機株式会社 | 情報処理装置及びプログラム |
JP5693527B2 (ja) * | 2012-06-21 | 2015-04-01 | ヤフー株式会社 | ナビゲーション装置、ナビゲーションシステム、ナビゲーション方法およびナビゲーションプログラム |
JP6079034B2 (ja) * | 2012-08-07 | 2017-02-15 | セイコーエプソン株式会社 | 停止継続判定方法及び停止継続判定装置 |
JP6191103B2 (ja) | 2012-09-03 | 2017-09-06 | セイコーエプソン株式会社 | 移動状態算出方法及び移動状態算出装置 |
JP6236954B2 (ja) * | 2013-07-23 | 2017-11-29 | アイシン・エィ・ダブリュ株式会社 | 運転支援システム、方法およびプログラム |
KR102361641B1 (ko) * | 2014-12-26 | 2022-02-10 | 삼성전자주식회사 | 위치 정보 처리 방법 및 그것을 포함하는 계측 정보 처리 방법 |
KR101756268B1 (ko) * | 2015-05-18 | 2017-07-10 | 순천향대학교 산학협력단 | 차량 애드혹 네트워크에서 측위 정확도 향상을 위한 시스템 및 그 방법 |
JP6463551B2 (ja) * | 2016-03-30 | 2019-02-06 | 三菱電機株式会社 | 進行方向推定装置 |
CN106500696B (zh) * | 2016-09-14 | 2018-03-06 | 中南大学 | 一种实现机器人车载导航装置实测坐标校正与预测的方法 |
JP6794895B2 (ja) | 2017-03-28 | 2020-12-02 | カシオ計算機株式会社 | 電子機器、位置特定システム、位置特定方法及びプログラム |
JP6992360B2 (ja) * | 2017-09-25 | 2022-01-13 | カシオ計算機株式会社 | 位置計測装置、電子時計、位置補正方法及びプログラム |
JP7210874B2 (ja) * | 2017-09-25 | 2023-01-24 | カシオ計算機株式会社 | 衛星電波受信装置、電子時計、測位制御方法及びプログラム |
JP7069624B2 (ja) * | 2017-10-05 | 2022-05-18 | 日産自動車株式会社 | 位置演算方法、車両制御方法及び位置演算装置 |
JP6907952B2 (ja) * | 2018-01-17 | 2021-07-21 | 株式会社デンソー | 自己位置補正装置及び自己位置補正方法 |
DE112019007740T5 (de) * | 2019-09-25 | 2022-06-09 | Mitsubishi Electric Corporation | Reiseroutenerzeugungsvorrichtung, Reiseroutenerzeugungsverfahren, Fahrzeugregelungsvorrichtung, und Fahrzeugregelungsverfahren |
GB2621547A (en) * | 2022-07-26 | 2024-02-21 | Pitpatpet Ltd | Method and device for positional tracking |
Family Cites Families (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0792388B2 (ja) * | 1989-04-17 | 1995-10-09 | 住友電気工業株式会社 | 位置検出装置 |
DE69420418T2 (de) * | 1994-11-29 | 2000-05-25 | Hitachi, Ltd. | Navigationssystem mit Umschaltung, wenn ein Radiosignal nicht empfangen werden kann |
JP3784855B2 (ja) * | 1995-05-19 | 2006-06-14 | パイオニア株式会社 | 測位データ補正装置及び測位データ補正方法 |
JP3410271B2 (ja) * | 1995-12-28 | 2003-05-26 | アルパイン株式会社 | ナビゲーション装置 |
US5948043A (en) * | 1996-11-08 | 1999-09-07 | Etak, Inc. | Navigation system using GPS data |
DE19945124A1 (de) * | 1999-09-21 | 2001-04-26 | Mannesmann Vdo Ag | Verfahren zum Navigieren eines Fahrzeugs |
EP1256813A3 (en) | 2001-05-11 | 2004-01-02 | Pioneer Corporation | Apparatus and method for navigation and positioning |
KR100495635B1 (ko) * | 2002-09-02 | 2005-06-16 | 엘지전자 주식회사 | 네비게이션 시스템의 위치오차 보정방법 |
JP2005017047A (ja) * | 2003-06-24 | 2005-01-20 | Nec Corp | 位置測位機能付き端末 |
JP2005077138A (ja) * | 2003-08-28 | 2005-03-24 | Fujitsu Ltd | 位置測定装置 |
US7242791B2 (en) * | 2005-01-04 | 2007-07-10 | Deere & Company | Method and system for guiding a vehicle with vision enhancement |
-
2005
- 2005-04-28 JP JP2005130834A patent/JP4667951B2/ja active Active
- 2005-09-14 EP EP05255620A patent/EP1647806B1/en not_active Ceased
- 2005-10-11 US US11/249,043 patent/US7400969B2/en active Active
- 2005-10-14 CN CN200510113506.4A patent/CN1760692B/zh not_active Expired - Fee Related
Non-Patent Citations (1)
Title |
---|
JP 2000-2759 A,全文. |
Also Published As
Publication number | Publication date |
---|---|
EP1647806A2 (en) | 2006-04-19 |
US20070239347A1 (en) | 2007-10-11 |
CN1760692A (zh) | 2006-04-19 |
EP1647806A3 (en) | 2010-02-17 |
US7400969B2 (en) | 2008-07-15 |
JP2006138835A (ja) | 2006-06-01 |
EP1647806B1 (en) | 2012-06-06 |
JP4667951B2 (ja) | 2011-04-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN1760692B (zh) | 导航装置 | |
CN101082493B (zh) | 一种农业机械导航的组合定位方法 | |
EP3761065B1 (en) | Apparatus and methods for vehicle steering to follow a curved path | |
US4792907A (en) | Vehicle navigation system | |
JP4716886B2 (ja) | 位置算出装置の進行角決定方法 | |
CN110308717B (zh) | 控制自主式移动机器移动的方法、装置、机器及存储介质 | |
KR101750186B1 (ko) | 차량 위치 추정 기기 및 차량 위치 추정 방법 | |
CA2184549C (en) | Method and apparatus for calibration of a distance sensor in a vehicle navigation system | |
JP3784855B2 (ja) | 測位データ補正装置及び測位データ補正方法 | |
KR101879247B1 (ko) | 자율주행 농업기계의 작업경로 설정방법 | |
US20100082252A1 (en) | Driving support apparatus and driving support system for motor vehicle | |
US20060082495A1 (en) | Navigation apparatus | |
CN101470177B (zh) | 磁数据处理装置、磁数据处理方法 | |
CN107924194A (zh) | 用于自动化车辆的gps数据校正 | |
JP2009074986A (ja) | 自車位置演算装置、自車位置演算方法、および、自車位置演算プログラム | |
US7248967B2 (en) | Autonomous velocity estimation and navigation | |
CN103946722A (zh) | 具有位点感知准确性和/或功率调整的导航系统和方法 | |
WO2020184013A1 (ja) | 車両制御装置 | |
JP2008032632A (ja) | 角速度センサのキャリブレーション装置および角速度値特定装置 | |
KR20230137439A (ko) | 군집 궤적 위치의 정확도를 평가하기 위한 컴퓨터 구현 방법 | |
JP2019066444A (ja) | 位置演算方法、車両制御方法及び位置演算装置 | |
KR20190003918A (ko) | 차량 속도 기반 자이로 센서 캘리브레이션 방법 | |
JPH11190771A (ja) | Gps測定位置補正装置 | |
CN110187712A (zh) | 无人驾驶控制方法、装置和设备 | |
CN112729317B (zh) | 用于定位车辆的方法和车载系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20101006 |