CN1216104A - 校正参数的确定方法 - Google Patents

校正参数的确定方法 Download PDF

Info

Publication number
CN1216104A
CN1216104A CN98800118.7A CN98800118A CN1216104A CN 1216104 A CN1216104 A CN 1216104A CN 98800118 A CN98800118 A CN 98800118A CN 1216104 A CN1216104 A CN 1216104A
Authority
CN
China
Prior art keywords
vehicles
travelled
compass
magnetic
vehicle
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.)
Granted
Application number
CN98800118.7A
Other languages
English (en)
Other versions
CN1103910C (zh
Inventor
S·格内普夫
P·纳赫鲍尔
F·迪特里希
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Leica Geosystems AG
Original Assignee
Leica Geosystems AG
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Leica Geosystems AG filed Critical Leica Geosystems AG
Publication of CN1216104A publication Critical patent/CN1216104A/zh
Application granted granted Critical
Publication of CN1103910C publication Critical patent/CN1103910C/zh
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28Navigation; 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
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C17/00Compasses; Devices for ascertaining true or magnetic north for navigation or surveying purposes
    • G01C17/38Testing, 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·cosa,e’=e-A2,s’=ρ·s校正的a’,e’,s’替换;通过将已知的方向值和行程值a’,e’,s’与实测值进行矢量对比,求出供校正方位角的角偏移及罗盘安装误差用的校正参数A,供校正硬磁和软磁的车辆磁性校正参数B、C,供校正仰角用的坡度仪安装误差用的校正参数A2,以及供校正里程表的比例用的校正参数ρ。

Description

校正参数的确定方法
本发明涉及权利要求1前序部分所述的校正参数的确定方法。
当在车辆导向中利用电子罗盘指示方位角、利用坡度仪指示仰角或标高、以及利用里程表指示距离时,会在计算出的位置上产生误差。其原因在于:
-作为导向用的每张地图的北向和磁北之间存在差异,
-罗盘和坡度计的安装误差和导向方向之间存在地理差异,
-车辆的软磁和硬磁对罗盘产生影响,
-利用里程表计量里程时的刻度误差。
在导向时要使用地图北系统坐标标注交通工具的行驶方向,这种方向与磁北系统相比,还要在水平方向上增加一个偏转量。该偏转量可以从表中查取。但是,还要对此另外叠加一个罗盘坐标系统与导向方向之间的偏转量,该偏转量是个未知数。
如果交通工具是一辆车辆,其行驶方向不容易通过几何结构或者光学结构参照事先给定车底架数据或者根据制造数据求出。只能按照实际的、和计算的驾驶方向之间的差异,根据经验确定。
DE 4125369A1发表了一种装在汽车上的导向装置,其中包括一个作为方位角传感器使用的地磁传感器。为了对于该传感器受磁性环境的影响产生的指示误差进行补偿,利用另外获取的GPS导向数据进行比较。然而这仅只能够对于坐标系的零点移位进行校准。
在DE 3141439A1中介绍一种方位角确定装置,用来校准在交通工具上安装的方位角传感器的正北和正东方向。针对测定的方位角传感器双组分检测信号与预先规定的校准值之间的偏差通过校准电路对检测信号进行的调整加以补偿。由于方位角传感器的剩磁产生的伪输出信号也同样通过零点移位加以校准。
通过船舶导向发现了磁罗盘对航向所作的错误校正产生的影响,以及硬磁场和软磁场对于指示误差产生的影响。为了对于罗盘误差进行补偿,定义了A,B,C,D,E系数,并且分别对其做出明确的规定。其中,A是指一个恒定的指示误差,例如,罗盘相对于船舶纵向偏转移位的安装结果造成的指示误差;B是指纵向船磁的影响;C是指横向船磁的影响;D是指由低碳钢部件感应生成的磁性;E是指船体钢材的不对称分布(“罗盘ABC”,A.Hein著,Klasing+Co出版社出版(1983),43到45页)。由于D和E的影响很小,其系数一般忽略不计。
在测定这些系数时,将船舶设定在东、南、西、北的已知航向上,分别读出罗盘相对于已知航向的指示误差。根据相对于选定导向方向的偏差值的平均值求出每个系数。
在陆地导向中由于不精确的里程检测和山路导向而产生的相对于地图所标距离的里程偏差对于船舶导向不起作用。但是,针对车辆的自动驾驶,除了用作方向测量所用的磁罗盘之外,还需要另外加装用于计量里程用的一个里程表和一个坡度计;以便能够将在上坡和下坡的山路行驶导向中计量的里程换算成地图平面上所标的相应数值。
为了校准罗盘的指示,一般是采用环路行驶,并在按照相对于圆心的角度定义的多个位置上测取测量值。有的还借助于坡度传感器来校准磁方向指示值以供水平平面之用。在Fa.Leica AG,Herrbrugg,Schweiz制造的数字式磁罗盘(DMC)中,除了拥有三个供空间坐标使用的磁场传感器之外,还有两个供仰角和坡度用的坡度计传感器。里程检测和由此结合方向检测所求得的交通工具的位置可以借助于单独获取的卫星导向信号(GPS)进行验证,有时还要进行校准。方向检测、里程检测以及位置检测可以采用各自独立的系统进行(Fa.KVHIndustries,Inc.USA,的信息文件(1995),TACNAV系统)。
本发明的任务是:提供一种能够用来确定在车辆中装设的、供检测方位角、仰角、和里程之用的简单可行的方法,从而达到大大提高导向的精确度,并且可以省却GPS验证。
这项任务通过本发明利用权利要求1中的特征部分就能够完成。当采用在标有地理坐标的两点之间来回行驶的办法进行时,特别有利于数值的计算工作。
图中所示是交通工具行驶方向相对于水平平面=地图平面的矢量图。图中:
图1是方位角和仰角的透视图,
图2所示是方位角误差对于仰角指示值的影响图。
现以下列示例对本发明进行说明。该示例是采用将方位角检测和仰角检测互相结合的系统(DMC)进行的。
方位角和仰角的数值是以交通工具行驶方向 LN F按水平平面的单位矢量表示,并且按磁北方向换算。图1是相互关系的透视图,图中,eF表示交通工具实际行驶方向 LF与水平平面之间的仰角;aF表示磁北和 LF在水平平面上的投影之间的方位角。通过乘以sF的运算,得出在水平平面中的位置的通用表达式:
Figure A9880011800051
在实际情况下,达到的位置是以 Lj,sj的多个中间数值是以取j=1…N的数列为起点算出的。在船舶的行驶中,这种方法称为复式导向法。省却其中的指数N和F,即适用于交通工具沿着水平平面的行驶方向。
Figure A9880011800052
还可以使用其他的近似积分式,仍然处于专业人员的技能范畴以内。
在仰角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 (2)

1.确定校正参数的方法,用来对于装在车辆中供导向目的使用的磁罗盘指示的交通工具的行驶方向的方位角a、坡度仪指示的交通工具行驶方向相对于水平平面的仰角e、以及里程表指示的驶过里程测量值s进行计算所用的校正参数;在进行计算时,交通工具的瞬时方向矢量按下式计算:
Figure A9880011800021
式中: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’=p·s求出校正参数:A    供校正方位角用的角偏移量及罗盘安装误差,B,C  供校正硬磁和软磁的车辆磁性,A2   供校正仰角用的坡度仪安装误差,ρ   供校正里程表的比例。
2.如权利要求1中的方法,其特征在于:
第二次测试行驶是从第一次的终点驶回起点进行的。
CN98800118.7A 1997-02-10 1998-02-05 校正参数的确定方法 Expired - Fee Related CN1103910C (zh)

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 true CN1216104A (zh) 1999-05-05
CN1103910C 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)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN100353183C (zh) * 2001-08-15 2007-12-05 富士通天株式会社 对雷达水平方向轴偏移的检测方法和装置
CN101241009B (zh) * 2007-12-28 2010-06-09 北京科技大学 一种磁电子罗盘误差补偿方法
CN105717325A (zh) * 2016-04-15 2016-06-29 江西中船航海仪器有限公司 一种用于风向测量的磁方位传感器
CN107473092A (zh) * 2017-10-10 2017-12-15 三海洋重工有限公司 吊具摆动角度获取方法及装置,和起重机防摇方法及装置
CN109933093A (zh) * 2017-12-18 2019-06-25 华创车电技术中心股份有限公司 自动追随装置与自动追随系统
CN114001752A (zh) * 2021-10-27 2022-02-01 一汽解放汽车有限公司 车辆坡度传感器校准方法、装置、传感器校准设备及介质

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CA2363472C (en) * 1999-03-02 2004-01-20 Gentex Corporation Rearview mirror assembly with internally mounted compass sensor
GB0329959D0 (en) * 2003-12-24 2004-01-28 Qinetiq Ltd Magnetic field sensor
KR100809352B1 (ko) 2006-11-16 2008-03-05 삼성전자주식회사 파티클 필터 기반의 이동 로봇의 자세 추정 방법 및 장치
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

Family Cites Families (6)

* Cited by examiner, † Cited by third party
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 三菱電機株式会社 車両用ナビゲーション装置

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN100353183C (zh) * 2001-08-15 2007-12-05 富士通天株式会社 对雷达水平方向轴偏移的检测方法和装置
CN101241009B (zh) * 2007-12-28 2010-06-09 北京科技大学 一种磁电子罗盘误差补偿方法
CN105717325A (zh) * 2016-04-15 2016-06-29 江西中船航海仪器有限公司 一种用于风向测量的磁方位传感器
CN107473092A (zh) * 2017-10-10 2017-12-15 三海洋重工有限公司 吊具摆动角度获取方法及装置,和起重机防摇方法及装置
CN107473092B (zh) * 2017-10-10 2019-06-14 三一海洋重工有限公司 吊具摆动角度获取方法及装置,和起重机防摇方法及装置
CN109933093A (zh) * 2017-12-18 2019-06-25 华创车电技术中心股份有限公司 自动追随装置与自动追随系统
CN114001752A (zh) * 2021-10-27 2022-02-01 一汽解放汽车有限公司 车辆坡度传感器校准方法、装置、传感器校准设备及介质

Also Published As

Publication number Publication date
AU723107B2 (en) 2000-08-17
NO324073B1 (no) 2007-08-06
EP0901609B1 (de) 2005-10-26
JP2001506759A (ja) 2001-05-22
ATE308028T1 (de) 2005-11-15
KR20000064880A (ko) 2000-11-06
AU6394798A (en) 1998-08-26
CA2255115C (en) 2006-04-11
DE19704853C1 (de) 1998-06-18
KR100550944B1 (ko) 2006-05-25
CA2255115A1 (en) 1998-08-13
CN1103910C (zh) 2003-03-26
EP0901609A1 (de) 1999-03-17
NO984744L (no) 1998-11-30
WO1998035206A1 (de) 1998-08-13
DE59813132D1 (de) 2005-12-01
NO984744D0 (no) 1998-10-09
EP0901609B8 (de) 2005-12-28
JP3774753B2 (ja) 2006-05-17

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
US5235514A (en) Apparatus for estimating current heading using magnetic and angular velocity sensors
KR930005713B1 (ko) 이동체용 네비게이션 장치
US5323152A (en) Apparatus for detecting the position of a vehicle
EP0678228B1 (en) Position correction method and apparatus for a vehicle navigation system
US6931322B2 (en) Method for correcting position error in navigation system
US5319561A (en) Apparatus for estimating current heading using magnetic and angular velocity sensors
US4729172A (en) Process for establishing the driving direction of a vehicle with an electronic compass
JP2001503519A (ja) 衛星受信器を有する自動車用の位置検出装置
CN1103910C (zh) 校正参数的确定方法
CN109470276B (zh) 基于零速修正的里程计标定方法与装置
CN112833917B (zh) 基于磁航向角和最小二乘法的三轴磁传感器标定方法
JP2001522986A (ja) 車両のナビゲーション装置
JPH07306056A (ja) 車両走行距離検出装置
CN110631573A (zh) 一种惯性/里程计/全站仪多信息融合方法
KR100216535B1 (ko) 위치 정합도를 이용한 차량 항법용 주행 차량의 위치 측정 방법
JPS62140017A (ja) 車両用現在地認識装置
Rogers Improved heading using dual speed sensors for angular rate and odometry in land navigation
JP3401997B2 (ja) 車両走行方位算出装置
JPH0785019B2 (ja) 船首方位計測装置
RU89692U1 (ru) Устройство обработки измерительной информации инерциальной навигационной системы
JPH04201B2 (zh)
JPH03221810A (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