CN1103910C - 校正参数的确定方法 - Google Patents
校正参数的确定方法 Download PDFInfo
- Publication number
- CN1103910C CN1103910C CN98800118.7A CN98800118A CN1103910C CN 1103910 C CN1103910 C CN 1103910C CN 98800118 A CN98800118 A CN 98800118A CN 1103910 C CN1103910 C CN 1103910C
- Authority
- CN
- China
- Prior art keywords
- vehicles
- test
- terminal point
- centerdot
- coordinate
- 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
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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C17/00—Compasses; Devices for ascertaining true or magnetic north for navigation or surveying purposes
- G01C17/38—Testing, calibrating, or compensating of compasses
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
- Analysing Materials By The Use Of Radiation (AREA)
- Stereophonic System (AREA)
- Gyroscopes (AREA)
- Separation By Low-Temperature Treatments (AREA)
Abstract
确定校正参数的方法,对于装在车辆中供导向目的使用的磁罗盘指示的交通工具的行驶方向的方位角a、坡度仪指示的交通工具行驶方向相对于水平平面的仰角e、以及里程表指示的驶过里程测量值s进行计算所用的校正参数;用来通过两次目视导向的测试行驶,沿不同方向在的规定起点和终点之间进行确定。将测量值a,e,s分别用经过a’=a+A+B·sina+C·cos a,e’=e-A2,s’=ρ·s校正的a’,e’,s’替换;通过将已知的方向值和行程值a’,e’,s’与实测值进行矢量对比,求出供校正方位角的角偏移及罗盘安装误差用的校正参数A,供校正硬磁和软磁的车辆磁性校正参数B、C,供校正仰角用的坡度仪安装误差用的校正参数A2,以及供校正里程表的比例用的校正参数ρ。
Description
本发明涉及一种校正参数的求算方法。
当在车辆导向中利用电子罗盘指示方位角、利用坡度仪指示仰角或标高、以及利用里程表指示距离时,会在计算出的位置上产生误差。其原因在于:-作为导向用的每张地图的北向和磁北之间存在差异,-罗盘和坡度计的安装误差和导向方向之间存在地理差异,-车辆的软磁和硬磁对罗盘产生影响,-利用里程表计量里程时的刻度误差。
在导向时要使用地图北***坐标标注交通工具的行驶方向,这种方向与磁北***相比,还要在水平方向上增加一个偏转量。该偏转量可以从表中查取。但是,还要对此另外叠加一个罗盘坐标***与导向方向之间的偏转量,该偏转量是个未知数。
如果交通工具是一辆车辆,其行驶方向不容易通过几何结构或者光学结构参照事先给定车底架数据或者根据制造数据求出。只能按照实际的、和计算的驾驶方向之间的差异,根据经验确定。
DE 41 25 369 A1发表了一种装在汽车上的导向装置,其中包括一个作为方位角传感器使用的地磁传感器。为了对于该传感器受磁性环境的影响产生的指示误差进行补偿,利用另外获取的GPS导向数据进行比较。然而这仅只能够对于坐标系的零点移位进行校准。
在DE 31 41 439 A1中介绍一种方位角求算装置,用来校准在交通工具上安装的方位角传感器的正北和正东方向。针对测定的方位角传感器双组分检测信号与预先规定的校准值之间的偏差通过校准电路对检测信号进行的调整加以补偿。由于方位角传感器的剩磁产生的伪输出信号也同样通过零点移位加以校准。
通过船舶导向发现了磁罗盘对航向所作的错误校正产生的影响,以及硬磁场和软磁场对于指示误差产生的影响。为了对于罗盘误差进行补偿,定义了A,B,C,D,E系数,并且分别对其做出明确的规定。其中,A是指一个恒定的指示误差,例如,罗盘相对于船舶纵向偏转移位的安装结果造成的指示误差;B是指纵向船磁的影响;C是指横向船磁的影响;D是指由低碳钢部件感应生成的磁性;E是指船体钢材的不对称分布(“罗盘ABC”,A.Hein著,K1asing+Co出版社出版(1983),43~45页)。由于D和E的影响很小,其系数一般忽略不计。
在测定这些系数时,将船舶设定在东、南、西、北的已知航向上,分别读出罗盘相对于已知航向的指示误差。根据相对于选定导向方向的偏差值的平均值求出每个系数。
在陆地导向中由于不精确的里程检测和山路导向而产生的相对于地图所标距离的里程偏差对于船舶导向不起作用。但是,针对车辆的自动驾驶,除了用作方向测量所用的磁罗盘之外,还需要另外加装用于计量里程用的一个里程表和一个坡度计;以便能够将在上坡和下坡的山路行驶导向中计量的里程换算成地图平面上所标的相应数值。
为了校准罗盘的指示,一般是采用环路行驶,并在按照相对于圆心的角度定义的多个位置上测取测量值。有的还借助于坡度传感器来校准磁方向指示值以供水平平面之用。在Fa.Leica AG,Herrbrugg,Schweiz制造的数字式磁罗盘(DMC)中,除了拥有三个供空间坐标使用的磁场传感器之外,还有两个供仰角和坡度用的坡度计传感器。里程检测和由此结合方向检测所求得的交通工具的位置可以借助于单独获取的卫星导向信号(GPS)进行验证,有时还要进行校准。方向检测、里程检测以及位置检测可以采用各自独立的***进行(Fa.KVHIndustries,Inc.USA,的信息文件(1995),TACNAV***)。
本发明的任务所依附的基础是:提供一种能够用来求算在车辆中装设的、供检测方位角、仰角、和里程之用的简单可行的方法,从而达到大大提高导向的精确度,并且可以省却GPS验证。
这项任务采用本发明的下述方案就能够完成。确定校正参数的方法,用来对于装在车辆中供导向目的使用的磁罗盘指示的交通工具的行驶方向的方位角a、坡度仪指示的交通工具行驶方向相对于水平平面的仰角e、以及里程表指示的驶过里程测量值s进行计算所用的校正参数;在进行计算时,交通工具的瞬时方向矢量按下式计算:
式中:Lj=交通工具在水平平面上的行驶方向;
sj=在两个检测点j和j-1之间的里程;
其特征在于:
第一次测试行驶是在以目视导向的方式从一个标有地理坐标的
起点到一个同样标有地理坐标的终点进行的;
而接下来的第二次测试行驶则是在以目视导向改变方向到达标
有地理坐标的第二个终点进行的;
当测试行驶的时刻tj为j=1...N时,测得的测量值为aj,ej,
sj;根据已知的起点和终点的地理坐标求出的相应值为a’j,e’
j,s’j;
将求出的方向矢量替代通过检测求出与下式相对应的测量值;
a’=a+A+B·sina+c·cosa
e’=e-A2
s’=ρ·s
求出校正参数:
A供校正方位角用的角偏移量及罗盘安装误差,
B,C供校正硬磁和软磁的车辆磁性,
A2供校正仰角用的坡度仪安装误差,
ρ供校正里程表的比例。
当采用在标有地理坐标的两点之间来回行驶的办法进行时,特别有利于数值的计算工作。起点和终点的地理坐标最好是通过在交通工具中安装的一套GPS***获取。在测试行驶的过程中GPS连续进行坐标的测试,确定出与驶过路段相关的GPS坐标的精确度,并且据此确定与其相关的终点。
图中所示是交通工具行驶方向相对于水平平面=地图平面的矢量图。图中:
图1是方位角和仰角的透视图,
图2所示是方位角误差对于仰角指示值的影响图。
现以下列示例对本发明进行说明。该示例是采用将方位角检测和仰角检测互相结合的***(DMC)进行的。起点和终点的地理坐标可以从地图、表格或者路标上读取,或者也利用GPS检测***测取。起点和终点一般可以任选,其中的具体终点可以在测试行驶过程中方才确定。这样选定的终点位置的地理坐标最好是通过GPS位置检测获取。对于确定终点有决定性意义的可能是,要使GPS坐标值的质量和测试行驶的行驶路段保持足够良好的相互关系。在测试行驶过程中要不断对这种关系进行核查。
方位角和仰角的数值是以交通工具行驶方向
LN F按水平平面的单位矢量表示,并且按磁北方向换算。图1是相互关系的透视图,图中,eF表示交通工具实际行驶方向
LF与水平平面之间的仰角;aF表示磁北和
LF在水平平面上的投影之间的方位角。通过乘以sF的运算,得出在水平平面中的位置的通用表达式:
在实际情况下,达到的位置是以
LJ,sJ的多个中间数值是以取j=1...N的数列为起点算出的。在船舶的行驶中,这种方法称为复式导向法。省却其中的指数N和F,即适用于交通工具沿着水平平面的行驶方向。
还可以使用其他的近似积分式,仍然处于专业人员的技能范畴以内。
在仰角e、方位角a和里程段s可供使用、起点已知的先决条件下,通过总计值进行的计算,即可得到精确的位置数据,或者从地图中取a和s值,求出精确的导向值。实际上,如在开头部分中所述以及在图2中所示,从测量仪表中所读取的值都受误差的影响。
在DMC坐标***中测出仰角e和方位角s。其x-轴应当相当于交通工具的行驶方向。图2所示是交通工具行驶方向
LF的投影与x-轴的投影之间的方位角移位量ΔaF,以及x-轴的仰角e和交通工具行驶方向的仰角eF之间的差异。
按照本发明,测量值a,e,s应该使用按下式规定的校准值a’,e’,s’替代:
a’=a+A+B·sina+c·cosa
e’=e-A2
s’=ρ·s
式中的参数表示:
A方位角与磁北之间角偏移及其中的罗盘安装误差,
B,C硬磁和软磁的车辆磁性,
A2仰角中坡度仪的安装误差,
ρ里程表的比例误差。
未知的校正系数按照本发明的方法通过两次目视驾驶测试行驶求出,从而找到在起点到终点之间的校正值a’,e,’,s’,并且测出实际值a,e,s。在每次测试行驶中得出供空间坐标x,y,z使用的、与测量值相对应的、足够多的独立测定公式,所以能够测定专用的校正参数,可供在日后仪表导向行驶中的检测仪表参照之用。
特别有利的是:在两次测试行驶中是在一次往返方向中进行的。这仅只需要知道标有地理坐标的两个点,实际的路程差异等于零,从而使测定公式得以简化。
当交通工具是在平地上使用时,就可以省略不用坡度仪。从而减少了校正参数的个数,也简化了测定公式的求解过程。这些特殊情况当然不是根据本发明的思路推导出的。主要的是知识,借以能够对于经过校正的方位角用一定的形式加以描述,并且能够在最简单情况下通过在已知的两点之间的两次测试行驶求出所有必需的校正参数。
Claims (4)
1.确定校正参数的方法,用来对于装在车辆中供导向目的使用的磁罗盘指示的交通工具的行驶方向的方位角a、坡度仪指示的交通工具行驶方向相对于水平平面的仰角e、以及里程表指示的驶过里程测量值s进行计算所用的校正参数;在进行计算时,交通工具的瞬时方向矢量按下式计算:
式中:Lj=交通工具在水平平面上的行驶方向;
sj=在两个检测点j和j-1之间的里程;
其特征在于:
第一次测试行驶是在以目视导向的方式从一个标有地理坐标的起点到
一个同样标有地理坐标的终点进行的;
而接下来的第二次测试行驶则是在以目视导向改变方向到达标有地理
坐标的第二个终点进行的;
当测试行驶的时刻为tj,而j=1...N时,测得的测量值为aj,ej,sj;
根据已知的起点和终点的地理坐标求出的相应值为a’j,e’j,s’j;
将求出的方向矢量替代通过检测求出与下式相对应的测量值;
a’ =a+A+B·sina+C·cosa
e’=e-A2
s’=ρ· s
求出校正参数:
A 供校正方位角用的角偏移量及罗盘安装误差,
C,C 供校正硬磁和软磁的车辆磁性,
A2 供校正仰角用的坡度仪安装误差,
ρ 供校正里程表的比例。
2.如权利要求1中的方法,其特征在于:
第二次测试行驶是从第一次的终点驶回起点进行的。
3.如权利要求1的方法,其特征在于:起点和终点的地理坐标通过在交通工具中安装的GPS检测***测取。
4.如权利要求3的方法,其特征在于:在测试行驶过程中不断进行GPS坐标检测,确定出与驶过路段s成比例的GPS坐标的精确度,并且据此确定相关的满足比例的终点。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE19704853.6 | 1997-02-10 | ||
DE19704853A DE19704853C1 (de) | 1997-02-10 | 1997-02-10 | Verfahren zum Bestimmen von Korrekturparametern |
Publications (2)
Publication Number | Publication Date |
---|---|
CN1216104A CN1216104A (zh) | 1999-05-05 |
CN1103910C true CN1103910C (zh) | 2003-03-26 |
Family
ID=7819729
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN98800118.7A Expired - Fee Related CN1103910C (zh) | 1997-02-10 | 1998-02-05 | 校正参数的确定方法 |
Country Status (10)
Country | Link |
---|---|
EP (1) | EP0901609B8 (zh) |
JP (1) | JP3774753B2 (zh) |
KR (1) | KR100550944B1 (zh) |
CN (1) | CN1103910C (zh) |
AT (1) | ATE308028T1 (zh) |
AU (1) | AU723107B2 (zh) |
CA (1) | CA2255115C (zh) |
DE (2) | DE19704853C1 (zh) |
NO (1) | NO324073B1 (zh) |
WO (1) | WO1998035206A1 (zh) |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
BR0008643B1 (pt) * | 1999-03-02 | 2014-04-15 | Gentex Corp | Conjunto de espelho retrovisor, e, detector de inclinação para um conjunto de espelho retrovisor |
JP4698087B2 (ja) * | 2001-08-15 | 2011-06-08 | 富士通テン株式会社 | レーダの水平方向軸ずれ発生検出装置、軸ずれ量決定装置、および軸ずれ補正装置 |
GB0329959D0 (en) * | 2003-12-24 | 2004-01-28 | Qinetiq Ltd | Magnetic field sensor |
KR100809352B1 (ko) | 2006-11-16 | 2008-03-05 | 삼성전자주식회사 | 파티클 필터 기반의 이동 로봇의 자세 추정 방법 및 장치 |
CN101241009B (zh) * | 2007-12-28 | 2010-06-09 | 北京科技大学 | 一种磁电子罗盘误差补偿方法 |
CN105717325A (zh) * | 2016-04-15 | 2016-06-29 | 江西中船航海仪器有限公司 | 一种用于风向测量的磁方位传感器 |
CN107473092B (zh) * | 2017-10-10 | 2019-06-14 | 三一海洋重工有限公司 | 吊具摆动角度获取方法及装置,和起重机防摇方法及装置 |
CN109933093A (zh) * | 2017-12-18 | 2019-06-25 | 华创车电技术中心股份有限公司 | 自动追随装置与自动追随*** |
EP3667355A1 (en) | 2018-12-12 | 2020-06-17 | Rohde & Schwarz GmbH & Co. KG | Method for radio direction finding, direction finding system as well as platform |
CN114001752A (zh) * | 2021-10-27 | 2022-02-01 | 一汽解放汽车有限公司 | 车辆坡度传感器校准方法、装置、传感器校准设备及介质 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB2042181B (en) * | 1979-01-24 | 1983-03-23 | Nippon Telegraph & Telephone | Determining positional coordinates utilising the terrestrial magnetism as a directional reference |
JPS6212976Y2 (zh) * | 1980-10-20 | 1987-04-03 | ||
DE3418081A1 (de) * | 1984-05-16 | 1985-11-21 | Teldix Gmbh, 6900 Heidelberg | Ortungsverfahren fuer fahrzeuge, insbesondere fuer landfahrzeuge |
EP0392448B1 (de) * | 1989-04-13 | 1992-08-19 | Siemens Aktiengesellschaft | Verfahren zur Ermittlung eines Winkelfehlers bei einem Magnetfeldsensor |
DE3937160A1 (de) * | 1989-11-08 | 1991-05-16 | Bosch Gmbh Robert | Elektronischer kompass mit neigungswinkelkorrektur |
JP2664800B2 (ja) * | 1990-09-19 | 1997-10-22 | 三菱電機株式会社 | 車両用ナビゲーション装置 |
-
1997
- 1997-02-10 DE DE19704853A patent/DE19704853C1/de not_active Expired - Fee Related
-
1998
- 1998-02-05 JP JP53376098A patent/JP3774753B2/ja not_active Expired - Fee Related
- 1998-02-05 CN CN98800118.7A patent/CN1103910C/zh not_active Expired - Fee Related
- 1998-02-05 CA CA002255115A patent/CA2255115C/en not_active Expired - Fee Related
- 1998-02-05 KR KR1019980708064A patent/KR100550944B1/ko not_active IP Right Cessation
- 1998-02-05 AU AU63947/98A patent/AU723107B2/en not_active Ceased
- 1998-02-05 AT AT98909395T patent/ATE308028T1/de active
- 1998-02-05 EP EP98909395A patent/EP0901609B8/de not_active Expired - Lifetime
- 1998-02-05 DE DE59813132T patent/DE59813132D1/de not_active Expired - Lifetime
- 1998-02-05 WO PCT/EP1998/000627 patent/WO1998035206A1/de active IP Right Grant
- 1998-10-09 NO NO19984744A patent/NO324073B1/no not_active IP Right Cessation
Also Published As
Publication number | Publication date |
---|---|
CA2255115C (en) | 2006-04-11 |
NO984744D0 (no) | 1998-10-09 |
KR20000064880A (ko) | 2000-11-06 |
ATE308028T1 (de) | 2005-11-15 |
CN1216104A (zh) | 1999-05-05 |
AU6394798A (en) | 1998-08-26 |
NO324073B1 (no) | 2007-08-06 |
CA2255115A1 (en) | 1998-08-13 |
DE19704853C1 (de) | 1998-06-18 |
KR100550944B1 (ko) | 2006-05-25 |
JP3774753B2 (ja) | 2006-05-17 |
JP2001506759A (ja) | 2001-05-22 |
EP0901609B1 (de) | 2005-10-26 |
WO1998035206A1 (de) | 1998-08-13 |
EP0901609B8 (de) | 2005-12-28 |
DE59813132D1 (de) | 2005-12-01 |
EP0901609A1 (de) | 1999-03-17 |
AU723107B2 (en) | 2000-08-17 |
NO984744L (no) | 1998-11-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US5946813A (en) | Method and device for determining correction parameters | |
EP0534892B1 (en) | Position-locating method | |
US5339246A (en) | Apparatus for correcting vehicular compass heading with the aid of the global positioning system | |
EP0451988A1 (en) | Heading detecting apparatus | |
US6931322B2 (en) | Method for correcting position error in navigation system | |
EP0678228B1 (en) | Position correction method and apparatus for a vehicle navigation system | |
KR930005713B1 (ko) | 이동체용 네비게이션 장치 | |
EP0544403A1 (en) | Vehicle navigation system | |
JP4746374B2 (ja) | 位置補正方法及びナビゲーション装置 | |
JP2001503519A (ja) | 衛星受信器を有する自動車用の位置検出装置 | |
CN1103910C (zh) | 校正参数的确定方法 | |
CN109470276B (zh) | 基于零速修正的里程计标定方法与装置 | |
JP2006275619A (ja) | 高度算出装置及びナビゲーション装置 | |
KR20080036099A (ko) | 네비게이션 시스템 및 네비게이션 시스템의 작동 방법 | |
JP2647342B2 (ja) | 車両走行距離検出装置 | |
JPH08178681A (ja) | ハイブリッドナビゲーションシステム | |
KR101208717B1 (ko) | 차량의 경사각 보정방법 및 그 보정장치 | |
CN112013859B (zh) | 一种快速获取道路标线精准位置的方法 | |
KR100216535B1 (ko) | 위치 정합도를 이용한 차량 항법용 주행 차량의 위치 측정 방법 | |
JP3401997B2 (ja) | 車両走行方位算出装置 | |
CN113532425B (zh) | 基于振荡标线和手机传感的隧道无基站车路协同定位方法 | |
CN109141405B (zh) | 一种路网环境下的车辆地磁匹配定位方法及*** | |
JPH04201B2 (zh) | ||
JPH04353784A (ja) | ナビゲーション装置 | |
JPH07119616B2 (ja) | 車両位置検出装置 |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20030326 Termination date: 20160205 |