JPH09229697A - Self-position orienting apparatus - Google Patents

Self-position orienting apparatus

Info

Publication number
JPH09229697A
JPH09229697A JP3228296A JP3228296A JPH09229697A JP H09229697 A JPH09229697 A JP H09229697A JP 3228296 A JP3228296 A JP 3228296A JP 3228296 A JP3228296 A JP 3228296A JP H09229697 A JPH09229697 A JP H09229697A
Authority
JP
Japan
Prior art keywords
self
pass filter
low
odometer
output
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.)
Pending
Application number
JP3228296A
Other languages
Japanese (ja)
Inventor
Junichi Takiguchi
純一 瀧口
Hisao Sone
久雄 曽根
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.)
Mitsubishi Electric Corp
Original Assignee
Mitsubishi Electric Corp
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 Mitsubishi Electric Corp filed Critical Mitsubishi Electric Corp
Priority to JP3228296A priority Critical patent/JPH09229697A/en
Publication of JPH09229697A publication Critical patent/JPH09229697A/en
Pending legal-status Critical Current

Links

Landscapes

  • Gyroscopes (AREA)
  • Navigation (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)
  • Measurement Of Distances Traversed On The Ground (AREA)

Abstract

PROBLEM TO BE SOLVED: To carry out self-position orientation even at a site where no GPS radio waves reach by carrying out computation processing using output signals from a high-pass filter through which only high frequency components of output signals of a gyroscope can pass, a low pass filter through which only low frequency of output signals of a flux gate compass can pass, and an odometer. SOLUTION: A high pass filter 6 removes low frequency wave components from output of a gyroscope 2 and the output of the filter 6 is supplied to a computing process apparatus 5. A flux gate compass 7 detects the North and sends out the deflection from the North as an electric signal. A low pass filter 8 removes high frequency components from the output of the flux-gate compass 7 and the output of the filter 8 is supplied to the computing process apparatus 5. The total of the angular signals processed by the filters 6, 8 becomes an angle formed between the proceeding direction of a vehicle 1 and a standard line for a certain time duration and the angle is sent to the computing process apparatus 5.

Description

【発明の詳細な説明】Detailed Description of the Invention

【0001】[0001]

【発明の属する技術分野】この発明は、搬送車を自動化
する等、移動体の自己位置を標定する技術に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a technique for locating a self-position of a moving body such as automating a carrier vehicle.

【0002】[0002]

【従来の技術】従来、この種の装置としては全世界測位
システム(Global Positioning S
ystem、以下GPSと称する)を用いる方法やジャ
イロの検出する角度とオドメータの走行距離から自己位
置を計算する方法、ジャイロの検出する角度とオドメー
タの走行距離から自己位置を計算しGPSで補正する方
法、GPSから得られた自己位置を方位センサで補正す
る方法などがあった。GPSとは周知のように複数個の
人工衛星から送られてくる電波を受信し、その電波間の
時間差から三角測量の原理で自己位置の緯度、経度、高
度を計算するシステムの総称である。これらの自己位置
標定装置は近年では自動車のナビゲーション(以下、カ
ーナビという)に良く用いられるようになっている。カ
ーナビでは道路上を走行する自動車が正しく道路上を走
行しているように検知し、CRT等に表示することが重
要である。
2. Description of the Related Art Conventionally, a global positioning system (Global Positioning System) has been used as an apparatus of this type.
ysystem, hereinafter referred to as GPS), a method of calculating a self-position from an angle detected by a gyro and a traveling distance of an odometer, and a method of calculating a self-position from an angle detected by a gyro and a traveling distance of an odometer and correcting it by GPS. , There is a method of correcting the self-position obtained from GPS with an azimuth sensor. As is well known, GPS is a general term for a system which receives radio waves transmitted from a plurality of artificial satellites and calculates the latitude, longitude and altitude of its own position from the time difference between the radio waves based on the principle of triangulation. In recent years, these self-positioning devices have been often used for automobile navigation (hereinafter referred to as car navigation). In car navigation, it is important to detect that a vehicle traveling on the road is traveling correctly on the road and display it on a CRT or the like.

【0003】例えば、カーナビ用の自己位置標定装置の
一つの形態である車載用位置表示装置としては特公平7
−66052号公報に示された図11に示すような構成
のものがあった。図11において、30は方位センサ、
31はGPS測位手段で衛星からの電波を受信するため
のアンテナ部、受信電波処理部および信号処理部等を含
む。方位センサ30とGPS測位手段31の出力はCP
U32に入力され、このCPU32の出力は更に地図情
報記憶手段33に入力されている。この地図情報記憶手
段33の一方の出力は表示用メモリ34を含む表示用処
理手段35に入力され、他方は測地系補正手段36に入
力されている。測地系補正手段36の出力は前記の表示
用処理手段35に入力されている。37は前記の表示用
処理手段35の出力側に接続されて地図情報と測位され
た自動車の現在位置を同時に表示する表示器である。こ
こで、地図情報記憶手段33は走行する自動車の道路に
かかわる地図を道路方位の分岐点の位置データを含めて
記憶している。
For example, as a vehicle-mounted position display device, which is one form of a self-locating device for a car navigation system, Japanese Patent Publication No.
There is a structure as shown in FIG. 11 disclosed in Japanese Patent No. 66052. In FIG. 11, 30 is a direction sensor,
Reference numeral 31 includes an antenna unit for receiving radio waves from a satellite by a GPS positioning unit, a reception radio wave processing unit, a signal processing unit, and the like. The outputs of the direction sensor 30 and the GPS positioning means 31 are CP
The data is input to U32, and the output of the CPU 32 is further input to the map information storage means 33. One output of the map information storage means 33 is input to the display processing means 35 including the display memory 34, and the other output is input to the geodetic system correction means 36. The output of the geodetic system correction means 36 is input to the display processing means 35. Reference numeral 37 is a display device which is connected to the output side of the display processing means 35 and simultaneously displays the map information and the current position of the positioned vehicle. Here, the map information storage means 33 stores a map relating to the road of the traveling automobile including the position data of the branch point of the road direction.

【0004】次に動作について説明する。GPS測位手
段31は図示していない複数個のGPSを構成する人工
衛星からの電波を受信して走行している自動車の現在位
置を測定する。一方、地図情報記憶手段33に記憶され
ている地図情報はGPSとは無関係に測地され、作成さ
れているのが一般的である。そこでGPS測位手段31
によって測定した位置を地図情報記憶手段33に記憶さ
れている地図情報と共に表示用メモリ34に格納し且つ
表示器37に表示しようとすると測地系の違いによる差
が出てくることになる。そこで、方位センサ30で測定
された走行方位の情報とGPS測位手段31で測定され
た位置情報とをCPU32に導入する。CPU32は方
位センサ30とGPS測位手段31によって得られる両
情報を地図情報記憶手段33を介して測地系補正手段3
6に供給する。測地系補正手段36では自動車が走行方
位を変更したときに方位センサ30からの走行方位の変
化とGPS測位手段31で測定された自動車の位置の近
傍の分岐点につながる道路の道路方位の変化を比較す
る。
Next, the operation will be described. The GPS positioning means 31 receives radio waves from artificial satellites (not shown) constituting a plurality of GPSs and measures the current position of the running vehicle. On the other hand, the map information stored in the map information storage means 33 is generally measured and created irrespective of GPS. Therefore, the GPS positioning means 31
If the position measured by is stored in the display memory 34 together with the map information stored in the map information storage means 33 and is to be displayed on the display 37, a difference due to the difference in the geodetic system will appear. Therefore, the CPU 32 is introduced with the information on the traveling azimuth measured by the azimuth sensor 30 and the position information measured by the GPS positioning means 31. The CPU 32 uses the map information storage unit 33 to store both pieces of information obtained by the direction sensor 30 and the GPS positioning unit 31 in the geodetic system correction unit 3.
6 The geodetic correction means 36 changes the traveling direction from the direction sensor 30 when the traveling direction of the vehicle changes, and changes the road orientation of the road connected to the branch point near the position of the vehicle measured by the GPS positioning means 31. Compare.

【0005】図12に示すように、自動車がその走行方
位を破線で示す基準線から角度α1の方向に沿って道路
R1を走行しているときに分岐点にさしかかり、ついで
基準線から角度α2の方向に走行方位を変更して道路R
2に進路を変更した時、方位センサ30からの走行方位
の変化した点が分岐点Qである。したがって、自動車が
分岐点Qを通過したことは方位センサ30からの走行方
位の変化によって判ることになる。方位センサ30から
の走行方位の変化によって見つけられた分岐点Qにおい
て、GPS測位手段31によって測定された自動車の位
置の近傍における地図情報上における道路の分岐点を見
つける。地図情報上で見つけた道路の分岐点につながる
道路間の道路方位の変化が、方位センサ30からの走行
方位の変化と一致したとき、両分岐点が同一であると判
定する。前記近傍における地図情報上の分岐点が複数あ
っても、その分岐点のうち道路方位の変化が、方位セン
サ30からの走行方位の変化と一致する分岐点が判定さ
れる。
As shown in FIG. 12, when a vehicle is traveling on a road R1 along a direction of an angle α1 from a reference line indicated by a broken line, it approaches a branch point, and then an angle α2 from the reference line. Road R
When the course is changed to 2, the point where the traveling direction from the direction sensor 30 has changed is the branch point Q. Therefore, the fact that the vehicle has passed the branch point Q can be recognized by the change in the traveling direction from the direction sensor 30. At the branch point Q found by the change in the running direction from the direction sensor 30, the road branch point on the map information near the position of the vehicle measured by the GPS positioning means 31 is found. When the change in the road direction between the roads connected to the branch point of the road found on the map information matches the change in the running direction from the direction sensor 30, it is determined that both branch points are the same. Even if there are a plurality of branch points on the map information in the vicinity, a branch point in which the change in the road direction matches the change in the running direction from the direction sensor 30 is determined.

【0006】GPS測位手段31によって測定された自
動車の位置と前記地図情報記憶手段33に記憶されてい
る地図情報の分岐点の位置とから測地系の相違に起因し
て生じる緯度、経度の偏差を演算する。そしてGPS測
位手段31によって測定された自動車の位置データにこ
の偏差を加算する。これにより測地系補正手段36にお
いてGPSの測地系から地図の測地系に適合する位置デ
ータに補正されることになる。この補正された位置デー
タは表示用処理手段35に送付され表示用メモリ34に
格納されると共に表示器37に表示される。即ち、表示
器37では自動車の現在位置を地図情報と対応させて偏
差なく道路地図上に表示することが可能となる。
From the position of the vehicle measured by the GPS positioning means 31 and the position of the branch point of the map information stored in the map information storage means 33, the deviation in latitude and longitude caused by the difference in the geodetic system is calculated. Calculate Then, this deviation is added to the position data of the vehicle measured by the GPS positioning means 31. As a result, the geodetic system correction means 36 corrects the GPS geodetic system to position data suitable for the map geodetic system. The corrected position data is sent to the display processing means 35, stored in the display memory 34, and displayed on the display 37. That is, the display 37 can display the current position of the automobile on the road map without any deviation in association with the map information.

【0007】このような車載用位置表示装置ではドライ
バーに自分の位置を教えるという目的から自動車の現在
位置を道路地図上に表示しているが、表示に関する部分
を除けば自己位置標定装置の一つの形態と考えることが
できる。
In such a vehicle-mounted position display device, the current position of the automobile is displayed on the road map for the purpose of teaching the driver's own position. However, except for the portion related to the display, it is one of the self-position locating devices. It can be considered as a form.

【0008】図13は従来の自己位置標定装置の別の形
態で、推測航法、積分航法または自立航法と呼ばれるも
のの改良形であり、図14はそのブロック図を示すもの
である。図13、図14において、1は車体、2は車体
1のヨー方向の角度を検出するジャイロ、3はオドメー
タの構成品である車輪、4はオドメータの構成品である
エンコーダで、車輪3の車軸に取り付けられている。5
はジャイロ2からの信号とエンコーダ4からの信号を入
力し自己位置を計算する演算処理器である。今、車体1
の現在位置(x0,y0)が分かっているとする。ジャ
イロ2である時間τ1の間の車体1の進行方向が基準線
となす角β1を検出し、角β1は演算処理器5に入力さ
れる。その時間τ1の間の移動距離λ1は車輪3の円周
長さLと回転数ν1から求められる。回転数ν1はエン
コーダ4からの出力パルスとして演算処理器5に入力さ
れる。時間τ1後の位置(x1,y1)は移動距離λ
1、角β1と現在位置(x0,y0)と図15に示すよ
うな関係にあるため
FIG. 13 shows another form of the conventional self-locating apparatus, which is an improved version of what is called dead-reckoning navigation, integral navigation or self-contained navigation, and FIG. 14 is a block diagram thereof. In FIGS. 13 and 14, 1 is a vehicle body, 2 is a gyro that detects an angle of the vehicle body 1 in the yaw direction, 3 is a wheel that is a component of an odometer, 4 is an encoder that is a component of an odometer, and an axle of the wheel 3 Is attached to. 5
Is an arithmetic processor for calculating the self-position by inputting the signal from the gyro 2 and the signal from the encoder 4. Now car body 1
It is assumed that the current position (x0, y0) of is known. The angle β1 formed by the traveling direction of the vehicle body 1 and the reference line during the time τ1 of the gyro 2 is detected, and the angle β1 is input to the arithmetic processing unit 5. The moving distance λ1 during the time τ1 is obtained from the circumferential length L of the wheel 3 and the rotation speed ν1. The rotation speed ν1 is input to the arithmetic processing unit 5 as an output pulse from the encoder 4. The position (x1, y1) after the time τ1 is the moving distance λ
1, the angle β1 and the current position (x0, y0) have a relationship as shown in FIG.

【0009】[0009]

【数1】 [Equation 1]

【0010】の関係が成り立つ。演算処理器5ではこの
計算を行い、時間τ1後の位置(x1,y1)を出力す
る。
The following relationship holds. The arithmetic processor 5 performs this calculation and outputs the position (x1, y1) after the time τ1.

【0011】その後、向きをかえ時間τ2の間の車体1
の進行方向が基準線となる角β2とすると、角β2およ
び移動距離λ2は先程と同様に検出され演算処理器5に
入力される。演算処理器5では先程と同様に時間τ1+
τ2後の位置(x2,y2)を計算する。ところがジャ
イロ2にはドリフトがあるため、角度の検出値に誤差が
入ってしまうのは避けられない。図15より分かるよう
にこの誤差は累積されることは明らかである。この誤差
の累積による位置の標定精度の悪化を補正するためにG
PSによる補正をする。
Thereafter, the vehicle body 1 is turned for a time τ2.
Assuming that the traveling direction of is an angle β2 with the reference line, the angle β2 and the movement distance λ2 are detected and input to the arithmetic processing unit 5 in the same manner as above. In the arithmetic processing unit 5, the time τ1 +
The position (x2, y2) after τ2 is calculated. However, since the gyro 2 has a drift, it is inevitable that an error is included in the detected value of the angle. As can be seen from FIG. 15, it is clear that this error is cumulative. In order to correct the deterioration of the orientation accuracy of the position due to the accumulation of this error, G
Correct by PS.

【0012】[0012]

【発明が解決しようとする課題】従来の装置はこのよう
に構成されているのでGPSの電波を受信できないとこ
ろでは位置の標定ができなかったり、補正ができなかっ
たりする。ところが、建設中のビルの中などではGPS
の電波が受信できないという問題があった。また、土木
作業の現場など道路地図がないような場所では位置の標
定ができないという問題もあった。この発明は、GPS
電波の届かない建設中のビル内や地図のない場所でも移
動体の自己位置標定を可能とすることを目的とする。
Since the conventional device is constructed as described above, the position cannot be located or the position cannot be corrected in a place where GPS radio waves cannot be received. However, GPS is used in buildings under construction.
There was a problem that the radio wave of could not be received. In addition, there is a problem that the location cannot be located in a place where there is no road map such as a site of civil engineering work. This invention uses GPS
The purpose is to enable the self-localization of a moving body even in a building under construction where radio waves do not reach or where there is no map.

【0013】[0013]

【課題を解決するための手段】この発明による自己位置
標定装置は角度を検出するジャイロと、ハイパスフィル
タと、北を検出するフラックスゲートコンパスと、ロー
パスフィルタと、走行距離を検出するオドメータと、ジ
ャイロとフラックスゲートコンパスからの信号をフィル
タで処理した信号およびオドメータからの信号を入力し
自己位置を計算する演算処理器からなり、GPSの助け
によらず誤差が累積しないようにしたものである。
A self-locating device according to the present invention comprises a gyro for detecting an angle, a high-pass filter, a fluxgate compass for detecting north, a low-pass filter, an odometer for detecting a traveling distance, and a gyro. It is composed of an arithmetic processing unit for inputting a signal obtained by processing a signal from the fluxgate compass with a filter and a signal from an odometer and calculating a self-position so that errors are not accumulated without the aid of GPS.

【0014】また、この発明による自己位置標定装置は
走行距離を検出するオドメータを車輪と上記車輪の車軸
に取り付けたエンコーダから構成するものである。
Further, the self-locating device according to the present invention comprises an odometer for detecting a traveling distance, which is composed of wheels and an encoder mounted on an axle of the wheels.

【0015】また、この発明による自己位置標定装置は
オドメータを構成する車輪を走行用とは別の検出輪とす
るものである。
Further, the self-locating device according to the present invention uses the wheels constituting the odometer as detection wheels different from those for traveling.

【0016】また、この発明による自己位置標定装置は
検出輪を車体に対して自由に回転できるように取り付
け、検出輪の車体に対する回転角を検出するものであ
る。
Further, the self-locating apparatus according to the present invention has the detection wheel mounted so as to be freely rotatable with respect to the vehicle body, and detects the rotation angle of the detection wheel with respect to the vehicle body.

【0017】また、この発明による自己位置標定装置は
車体の3軸の角度を検出するジャイロと、3つのハイパ
スフィルタと、北を検出するフラックスゲートコンパス
と、車体の2軸の傾きを検出する傾斜計と、3つのロー
パスフィルタと、走行距離を検出するオドメータと、ジ
ャイロとフラックスゲートコンパスと傾斜計からの信号
をフィルタで処理した信号およびオドメータからの信号
を入力し自己位置を計算する演算処理器からなり、傾斜
地などを走行しても傾斜による誤差が累積しないように
したものである。
Further, the self-locating apparatus according to the present invention has a gyro for detecting the angles of the three axes of the vehicle body, three high pass filters, a fluxgate compass for detecting the north, and an inclination for detecting the inclination of the two axes of the vehicle body. Meter, three low-pass filters, an odometer for detecting the distance traveled, an arithmetic processor for calculating the self-position by inputting the signal from the gyro / fluxgate compass and the signal from the inclinometer with a filter and the signal from the odometer. It is designed to prevent the error due to inclination from accumulating even when traveling on a sloping ground.

【0018】[0018]

【発明の実施の形態】BEST MODE FOR CARRYING OUT THE INVENTION

実施の形態1.図1はこの発明の実施の形態1による自
己位置標定装置を示すものであり、図2はそのブロック
図を示すものである。図1および図2において、1から
5までは従来の自己位置標定装置と同じである。6はジ
ャイロ2の出力から低周波成分を取り除くハイパスフィ
ルタでその出力は演算処理器5に供給されている。7は
北を検出し、北からの偏差を電気信号として出力するフ
ラックスゲートコンパス、8はフラックスゲートコンパ
ス7の出力から高周波成分を取り除くローパスフィルタ
でその出力も演算処理器5に供給されている。
Embodiment 1. 1 shows a self-positioning apparatus according to Embodiment 1 of the present invention, and FIG. 2 shows a block diagram thereof. 1 and 2, 1 to 5 are the same as those of the conventional self-positioning apparatus. A high-pass filter 6 removes low-frequency components from the output of the gyro 2, and its output is supplied to the arithmetic processor 5. Reference numeral 7 is a flux gate compass that detects north and outputs a deviation from north as an electric signal, and 8 is a low pass filter that removes high frequency components from the output of the flux gate compass 7, and the output thereof is also supplied to the arithmetic processing unit 5.

【0019】図3はフラックスゲートコンパス7の動作
原理を説明する図である。図において71は磁性体でで
きたトロイダルコア、72は検出巻線1、73は検出巻
線2、74はドライブ巻線であり、図のように2組巻い
てある。磁性体でできたコアに磁界をかけると磁束はコ
アに沿って曲がるが、コアが磁気的に飽和しているとき
には外部磁界の磁束はコアの影響を受けない。しかし、
コア内部の磁束は外部磁界の影響を受けて変化する。そ
の変化を2つの検出巻線72と73で検出し北を演算す
る。ドライブ巻線74はトロイダルコア71内部の磁束
を磁気的に飽和させるためのものである。フラックスゲ
ートコンパス7の出力は
FIG. 3 is a diagram for explaining the operating principle of the flux gate compass 7. In the figure, 71 is a toroidal core made of a magnetic material, 72 is a detection winding 1, 73 is a detection winding 2 and 74 is a drive winding, and two sets are wound as shown. When a magnetic field is applied to a core made of magnetic material, the magnetic flux bends along the core, but when the core is magnetically saturated, the magnetic flux of the external magnetic field is not affected by the core. But,
The magnetic flux inside the core changes under the influence of the external magnetic field. The change is detected by the two detection windings 72 and 73, and north is calculated. The drive winding 74 is for magnetically saturating the magnetic flux inside the toroidal core 71. The output of Fluxgate Compass 7 is

【0020】[0020]

【数2】 [Equation 2]

【0021】で与えられる。ここで、θとωはそれぞれ
フラックスゲートコンパス7のピッチ角とロール角、ま
たψmag は磁気方位角、fx ,fy ,fz はそれぞれフ
ラックスゲートコンパスのx,y,z出力である。ピッ
チ、ロール共にゼロの場合には容易に北が検出できるこ
とになる。
Is given by Here, θ and ω are the pitch angle and roll angle of the fluxgate compass 7, ψ mag is the magnetic azimuth angle, and f x , f y , and f z are the x, y, and z outputs of the fluxgate compass, respectively. If both pitch and roll are zero, north can be easily detected.

【0022】次に動作について説明する。ジャイロ2の
ドリフトはジャイロ2の出力信号の低周波成分として現
れる。ジャイロ2の出力信号をハイパスフィルタ6で処
理した後の信号にはドリフトに起因する低周波の信号成
分は含まれていない。車体がゆっくりと走行の向きを変
えた場合のジャイロ2の出力信号は低周波の信号成分と
なるのだが、ハイパスフィルタ6で処理した後の信号に
はそれも含まれていないことになる。フラックスゲート
コンパス7は前述したように磁気の変化から車体1の基
準線となす角を検出する。フラックスゲートコンパス7
は原理的に磁気的なノイズに弱く、それらに対しては出
力が高周波で変動することになる。
Next, the operation will be described. The drift of the gyro 2 appears as a low frequency component of the output signal of the gyro 2. The signal obtained by processing the output signal of the gyro 2 with the high-pass filter 6 does not include a low-frequency signal component due to drift. The output signal of the gyro 2 when the vehicle body slowly changes its traveling direction becomes a low-frequency signal component, which is not included in the signal after being processed by the high-pass filter 6. The fluxgate compass 7 detects the angle formed with the reference line of the vehicle body 1 from the change in magnetism as described above. Fluxgate compass 7
Is, in principle, vulnerable to magnetic noise, and its output will fluctuate at high frequencies.

【0023】フラックスゲートコンパス7の出力信号を
ローパスフィルタ8で処理した後の信号には磁気的なノ
イズに起因する高周波の信号成分は含まれていない。車
体がゆっくりと走行の向きを変えた場合の地磁気に対す
る角度の変化の様に低周波の信号成分のみが、ローパス
フィルタ8で処理した後の信号には含まれていることに
なる。現在位置(x0,y0)が分かっているとする。
ジャイロ2で検出されハイパスフィルタ6で処理された
角度信号と、フラックスゲートコンパス7で検出されロ
ーパスフィルタ8で処理された角度信号の和はある時間
τ1の間の車体1の進行方向が基準線となる角β1とな
る。角β1は演算処理器5に入力される。その時間τ1
の間の移動距離λ1は従来の装置と同様に車輪3の円周
長さLと回転数ν1から求められる。回転数ν1はエン
コーダ4からの出力パルスとして演算処理器5に入力さ
れる。演算処理器5では”数1”の計算を行い、時間τ
1後の位置(x1,y1)を出力する。
The signal after the output signal of the fluxgate compass 7 is processed by the low-pass filter 8 does not contain a high frequency signal component due to magnetic noise. Only the low-frequency signal component is included in the signal after being processed by the low-pass filter 8, such as the change in the angle with respect to the earth's magnetism when the vehicle body slowly changes its traveling direction. It is assumed that the current position (x0, y0) is known.
The sum of the angle signal detected by the gyro 2 and processed by the high-pass filter 6 and the angle signal detected by the fluxgate compass 7 and processed by the low-pass filter 8 indicates that the traveling direction of the vehicle body 1 during a certain time τ1 is the reference line. Angle β1. The angle β1 is input to the arithmetic processor 5. That time τ1
The moving distance λ1 between them is obtained from the circumferential length L of the wheel 3 and the rotation speed ν1 as in the conventional device. The rotation speed ν1 is input to the arithmetic processing unit 5 as an output pulse from the encoder 4. The arithmetic processing unit 5 performs the calculation of "Equation 1", and the time τ
The position (x1, y1) after 1 is output.

【0024】その後、向きを変えある時間τ2の間の車
体1の進行方向が基準線となす角β2とすると、角β2
および移動距離λ2は先程と同様に検出され演算処理器
5に入力される。演算処理器5では先程と同様の計算を
行い時間τ1+τ2後の位置(x2,y2)を計算す
る。ジャイロ2のドリフトをこの様にフラックスゲート
コンパス7で補正することになる。
After that, assuming that the direction of travel of the vehicle body 1 during a certain time τ2 of changing direction is the angle β2 with the reference line, the angle β2
And the moving distance λ2 is detected and inputted to the arithmetic processing unit 5 in the same manner as described above. The arithmetic processing unit 5 performs the same calculation as above to calculate the position (x2, y2) after the time τ1 + τ2. The drift of the gyro 2 will be corrected by the flux gate compass 7 in this way.

【0025】実施の形態2.図4はこの発明の実施の形
態2による自己位置標定装置を示すものである。図1に
おいて、3の車輪については特に制限がなく、走行用の
車輪と共用であってもよかった。しかしながら、走行用
の車輪は駆動力を地面等に伝達する必要があり、地面の
状況と伝達すべき駆動力の関係によってはスリップして
しまうことが避けられない。図4はその場合の解決策の
一つであり、ブロック図は図2と同じである。3は走行
用の車輪9とは別に設けられた検出用の車輪である。こ
の車輪は地面と車輪の摩擦力によって、移動体が進むと
ともに地面に沿って回転する。本車輪はそれ自体が駆動
力を持たないため、地面との摩擦は常に静止摩擦とな
り、地面との摩擦が動摩擦(静止摩擦トルク>>動摩擦
トルク)となる駆動車輪に比べてはるかに大きな地面グ
リップ力が得られ、スリップしにくくなる。このように
検出用の車輪3を走行用の車輪9とは別に設けることで
駆動力の大小や、地面の状況によらず検出用の車輪3は
スリップしないで回転し移動距離を正確に計測すること
ができる。この実施の形態では走行用の車輪はこれに限
らず無限軌道等でも問題はない。
Embodiment 2 FIG. 4 shows a self-locating device according to Embodiment 2 of the present invention. In FIG. 1, the wheel 3 is not particularly limited and may be shared with the traveling wheel. However, the traveling wheel needs to transmit the driving force to the ground or the like, and slipping is inevitable depending on the relationship between the ground condition and the driving force to be transmitted. FIG. 4 is one of the solutions in that case, and the block diagram is the same as FIG. Reference numeral 3 denotes a detection wheel provided separately from the traveling wheel 9. This wheel rotates along the ground as the moving body advances due to the frictional force between the ground and the wheel. Since this wheel has no driving force itself, the friction with the ground is always static friction, and the friction with the ground is dynamic friction (static friction torque >> dynamic friction torque). Strength is obtained and it is difficult to slip. By providing the detection wheel 3 separately from the traveling wheel 9 in this way, the detection wheel 3 rotates without slipping regardless of the magnitude of the driving force or the ground condition and the moving distance is accurately measured. be able to. In this embodiment, the traveling wheels are not limited to this, and there is no problem even if the track is a track or the like.

【0026】実施の形態3.図5はこの発明の実施の形
態3による自己位置標定装置を示すものである。実施の
形態2のように走行用の車輪9とは別に検出用の車輪を
設けることになると出来合いの走行台車にオドメータを
設置する場合がでてくる。図5はその場合の解決策の一
つであり、図6はオドメータの詳細図、図7はその場合
のブロック図である。10は検出用の車輪3を車体1に
対して取り付けるための支持具である。11は支持具1
0に対して自由に回転するように取り付けられたシャフ
トで、その一方の端に検出用の車輪3が取り付けられて
いる。12はこの支持具10に対するシャフト11の回
転角度を検出するための角度検出器でここではポテンシ
ョメータとしている。このように検出用の車輪3を車体
1に対して自由に回転ができるように取り付け、その車
体1に対する角度を検出することで車体1が小さな半径
で向きを変えたときにも、図6のように検出用の車輪3
は横方向にスリップしないで回転するので移動距離を正
確に計測することができる。時間τ1の間の移動距離λ
1は車輪3の円周長さL、エンコーダ4からの回転数ν
1、ポテンショメータ12の与える支持具10に対する
シャフト11の回転角度をγ1として、
Embodiment 3 FIG. FIG. 5 shows a self-locating device according to Embodiment 3 of the present invention. When the detection wheel is provided separately from the traveling wheel 9 as in the second embodiment, the odometer may be installed on a ready-made traveling vehicle. FIG. 5 is one of the solutions in that case, FIG. 6 is a detailed view of the odometer, and FIG. 7 is a block diagram in that case. Reference numeral 10 is a support for attaching the detection wheel 3 to the vehicle body 1. 11 is a support tool 1
The shaft is attached so as to rotate freely with respect to 0, and the detection wheel 3 is attached to one end thereof. Reference numeral 12 is an angle detector for detecting the rotation angle of the shaft 11 with respect to the support 10, and is a potentiometer here. As described above, the detection wheel 3 is attached to the vehicle body 1 so as to be freely rotatable, and the angle with respect to the vehicle body 1 is detected. For detection 3
The can rotate without slipping in the lateral direction, so the moving distance can be accurately measured. Travel distance λ during time τ1
1 is the circumferential length L of the wheel 3, the rotational speed ν from the encoder 4
1, the rotation angle of the shaft 11 with respect to the support tool 10 provided by the potentiometer 12 is γ1,

【0027】[0027]

【数3】 (Equation 3)

【0028】で求められる。このようにして、時間τ1
の間の移動距離λ1を計算することで”数1”を使って
時間τ1後の位置(x1,y1)を求めることができ
る。
It is calculated by In this way, time τ1
The position (x1, y1) after the time τ1 can be obtained by using "Equation 1" by calculating the moving distance λ1 between.

【0029】無限軌道を有する車体1で左右の無限軌道
を逆方向に回し、超信地旋回と呼ばれる、その場回転を
した時でもシャフト11が回転し、検出用の車輪3の車
軸は車体1に対して約直角に回転することで検出用の車
輪3は回転できるようになる。その時の走行距離は検出
用の車輪3の回転しても”数3”においてγがほぼ90
度であるのでほぼ0となり、ほとんど移動していないと
いう現実が測定できることになる。
The left and right endless tracks are turned in the opposite direction in the car body 1 having the endless track, and the shaft 11 rotates even when the in-situ rotation called super-spinning turning is performed, and the axle of the wheel 3 for detection is the vehicle body 1. The wheel 3 for detection can be rotated by rotating the wheel 3 at a right angle with respect to. At that time, even if the wheel 3 for detection is rotated, γ is approximately 90 in "Equation 3".
Since it is a degree, it becomes almost 0, and the reality that it hardly moves can be measured.

【0030】実施の形態4.図8はこの発明の実施の形
態4による自己位置標定装置を示すものである。今まで
述べた実施の形態では平面上の角度を検出しているが移
動距離の測定は車輪の回転数から検出しているので、建
設中のビルの中等平坦な場所や、起伏の余りない場所で
はそれ程の誤差はなかった。しかしながら、坂の多い場
所など、屋外で使う場合には、図9に示す様に移動距離
の測定が車輪の回転数から検出した坂の斜面の長さであ
り、水平面に投影した長さではないという問題を含んで
いた。図8はその場合の解決策の一つであり、図10に
ブロック図を示す。13,14は車体1のピッチとロー
ルの角度を検出するジャイロで、ここではそれぞれのジ
ャイロを区別するためヨージャイロ2、ピッチジャイロ
13、ロールジャイロ14と呼ぶ。15,16はピッ
チ、ロールの傾きを検出する傾斜計でやはり区別のため
のピッチ傾斜計15、ロール傾斜計16と呼ぶ。17,
18はピッチジャイロ13、ロールジャイロ14の出力
からドリフトによる信号成分を含む低周波成分を取り除
く第2、第3のハイパスフィルタで区別のためハイパス
フィルタ6を第1のハイパスフィルタと呼ぶ。これらの
第1のハイパスフィルタ6、第2のハイパスフィルタ1
7、第3のハイパスフィルタ18の出力は演算処理器5
に供給されている。19,20はピッチ傾斜計15、ロ
ール傾斜計16の出力から高周波成分を取り除く第2、
第3のローパスフィルタで区別のためローパスフィルタ
8を第1のローパスフィルタと呼ぶ。これらの第1のロ
ーパスフィルタ8、第2のローパスフィルタ19、第3
のローパスフィルタ20も出力は演算処理器5に供給さ
れている。
Fourth Embodiment FIG. 8 shows a self-locating apparatus according to Embodiment 4 of the present invention. In the embodiments described so far, the angle on the plane is detected, but the movement distance is detected from the rotation speed of the wheel, so a flat place such as a building under construction or a place with no undulations. Then there was no such error. However, when used outdoors such as in a place with many slopes, as shown in FIG. 9, the measurement of the moving distance is the length of the slope of the slope detected from the rotation speed of the wheels, not the length projected on the horizontal plane. It included the problem. FIG. 8 is one of the solutions in that case, and FIG. 10 shows a block diagram. Reference numerals 13 and 14 denote gyros for detecting the pitch and roll angle of the vehicle body 1, and are referred to as a yaw gyro 2, a pitch gyro 13, and a roll gyro 14 in order to distinguish the gyros from each other. Reference numerals 15 and 16 are inclinometers for detecting the pitch and the inclination of the roll, and are also called a pitch inclinometer 15 and a roll inclinometer 16 for distinction. 17,
Reference numeral 18 denotes second and third high-pass filters that remove low-frequency components including signal components due to drift from the outputs of the pitch gyro 13 and the roll gyro 14, and the high-pass filter 6 is called a first high-pass filter for distinction. These first high-pass filter 6 and second high-pass filter 1
7, the output of the third high-pass filter 18 is the arithmetic processor 5
Is supplied to Reference numerals 19 and 20 are for removing high frequency components from the outputs of the pitch inclinometer 15 and the roll inclinometer 16.
The low-pass filter 8 is referred to as a first low-pass filter for distinction by the third low-pass filter. These first low-pass filter 8, second low-pass filter 19, third
The output of the low-pass filter 20 is also supplied to the arithmetic processing unit 5.

【0031】実際の世界は三次元空間に展開しており車
体1が動き回る空間も三次元であるが、地図上で車体1
の自己位置を標定する場合や地図上で目標を指示する場
合は、その三次元空間を水平面に投影した二次元座標が
用いられる。図9に示すようにその差は移動距離λの差
として現れる。即ち図9においてA,B,C,Dは実際
の地表面、E,F,G,HはA,B,C,Dを水平面に
投影した面である。点SとTは面A,B,C,D上の点
で移動の始点と終点とする。地表面で測定した移動距離
λは線分STの長さと一致する。点Lを点Sの、点Mを
点Tの面E,F,G,H上への投影点とすると線分LM
の長さは水平面上での移動距離κということになる。線
分STを移動しているときの車体1のピッチ角をθとす
ると、これを用いて
The actual world is developed in a three-dimensional space, and the space in which the car body 1 moves around is also three-dimensional.
When locating its own position or pointing a target on a map, two-dimensional coordinates obtained by projecting the three-dimensional space on a horizontal plane are used. As shown in FIG. 9, the difference appears as a difference in the moving distance λ. That is, in FIG. 9, A, B, C, and D are actual ground surfaces, and E, F, G, and H are surfaces obtained by projecting A, B, C, and D on a horizontal plane. Points S and T are points on the planes A, B, C, and D, which are the starting point and the ending point of the movement. The moving distance λ measured on the ground surface matches the length of the line segment ST. If the point L is the projection point of the point S and the point M is the projection point of the point T on the surfaces E, F, G, and H, the line segment LM
The length of is the moving distance κ on the horizontal plane. Let θ be the pitch angle of the vehicle body 1 when moving on the line segment ST

【0032】[0032]

【数4】 (Equation 4)

【0033】で表せるように座標変換することで水平面
上での移動距離κを求めることができる。ロール角の変
動は移動距離には関係しない。フラックスゲートコンパ
ス7はそれが設置されている面で北を検出する。車体1
がロールおよびピッチの角度を持っているとフラックス
ゲートコンパス7もその角度を有しているために誤差を
生じる。
By performing coordinate conversion as represented by, the moving distance κ on the horizontal plane can be obtained. The fluctuation of the roll angle is not related to the moving distance. The Fluxgate compass 7 detects north on the surface where it is installed. Body 1
Has an angle of roll and pitch, the fluxgate compass 7 also has that angle, which causes an error.

【0034】車体1のピッチ角θとロール角ωはピッチ
ジャイロ13、ロールジャイロ14で検出できる。ジャ
イロにはドリフトがあるのでその補正をするため第2の
ハイパスフィルタ17、第3のハイパスフィルタ18で
ピッチジャイロ13、ロールジャイロ14の出力からド
リフトによる信号成分を含む低周波成分を取り除く。ピ
ッチ傾斜計15、ロール傾斜計16でゆっくりと走行の
傾きと車体姿勢を変えた場合を含めて角度の変化を検出
する。傾斜計は時定数が長く、急激な角度変化に出力が
追い付かないので、その出力を第2のローパスフィルタ
19、第3のローパスフィルタ20で処理した後の信号
にはゆっくりと走行の傾きと車体姿勢を変えた場合の角
度の変化だけが残ることになる。このようにしてジャイ
ロの持つドリフトの影響を取り除いた形でピッチ角θと
ロール角ωを検出することができる。その信号を用いて
フラックスゲートコンパスの出力を”数2”の様に座標
変換することで北を検出する。
The pitch angle θ and the roll angle ω of the vehicle body 1 can be detected by the pitch gyro 13 and the roll gyro 14. Since the gyro has a drift, the second high-pass filter 17 and the third high-pass filter 18 remove low-frequency components including a signal component due to the drift from the outputs of the pitch gyro 13 and the roll gyro 14 in order to correct the drift. The pitch inclinometer 15 and the roll inclinometer 16 detect a change in angle including a case where the traveling inclination and the vehicle body posture are slowly changed. Since the inclinometer has a long time constant and the output cannot catch up with a rapid angle change, the signal after the output is processed by the second low-pass filter 19 and the third low-pass filter 20 has a slow running inclination and a vehicle body. Only the change in angle when the posture is changed remains. In this way, the pitch angle θ and the roll angle ω can be detected while removing the influence of the drift of the gyro. Using the signal, the output of the fluxgate compass is coordinate-transformed as in "Equation 2" to detect the north.

【0035】[0035]

【発明の効果】この発明は、以上説明したように構成さ
れているので、以下に記載するような効果を奏する。
Since the present invention is configured as described above, it has the following effects.

【0036】角度を検出するジャイロの信号をハイパス
フィルタで処理することでドリフトの影響をなくし、北
を検出するフラックスゲートコンパスの信号をローパス
フィルタで処理することで車体がゆっくりと走行の向き
を変えた場合の信号を出力し、走行距離を検出するオド
メータからの信号を演算処理器に入力し自己位置を計算
することでGPSの助けによらず誤差が累積しないとい
う効果がある。
A gyro signal for detecting an angle is processed by a high-pass filter to eliminate the influence of drift, and a signal for a fluxgate compass for detecting north is processed by a low-pass filter so that the vehicle body slowly changes its traveling direction. In this case, an error is not accumulated without the aid of GPS by outputting a signal in the case of being operated and inputting a signal from an odometer for detecting a traveling distance to an arithmetic processing unit to calculate a self position.

【0037】また、走行距離を検出するオドメータを車
輪と上記車輪の車軸に取り付けたエンコーダから構成す
ることで、電気的インターフェイスを簡単にできる効果
がある。
Further, since the odometer for detecting the traveling distance is composed of the wheel and the encoder attached to the axle of the wheel, there is an effect that the electrical interface can be simplified.

【0038】また、オドメータを構成する車輪を走行用
とは別の検出輪とすることで、車輪のスリップなどの影
響を排除することができる。
Further, by making the wheels constituting the odometer be detection wheels different from those for running, it is possible to eliminate the influence of wheel slippage and the like.

【0039】また、検出輪を車体に対して自由に回転で
きるように取り付け、検出輪の車体に対する回転角を検
出することで、出来合いの車体にもこの装置を組み込む
ことができるという効果がある。
Further, the detection wheel is attached so as to be freely rotatable with respect to the vehicle body, and the rotation angle of the detection wheel with respect to the vehicle body is detected, so that there is an effect that this device can be incorporated into a ready-made vehicle body.

【0040】また、車体の3軸の角度を検出するジャイ
ロの出力信号を3つのハイパスフィルタで処理すること
でドリフトの影響をなくし、北を検出するフラックス変
えた場合の信号を出力し、走行距離を検出するオドメー
タからの信号とともに演算処理器に入力し自己位置を計
算することでGPSの助けによらず誤差がゲートコンパ
スと車体の2軸の傾きを検出する傾斜計の出力信号を3
つのローパスフィルタで処理することで車体がゆっくり
と走行の向きや傾き車体姿勢を累積しないという効果が
ある。
The output signals of the gyroscope for detecting the angles of the three axes of the vehicle body are processed by three high-pass filters to eliminate the influence of drift, and the signal for changing the flux for detecting north is output to output the traveling distance. By inputting the signal from the odometer which detects the signal to the arithmetic processing unit and calculating the self-position, the error is detected by the output signal of the inclinometer which detects the inclination of the two axes of the gate compass and the car body without the aid of GPS.
By processing with one low-pass filter, there is an effect that the vehicle body does not slowly accumulate the running direction and tilt vehicle body posture.

【図面の簡単な説明】[Brief description of drawings]

【図1】 この発明の実施の形態1による自己位置標定
装置を搭載した車体を示す図である。
FIG. 1 is a diagram showing a vehicle body equipped with a self-locating device according to a first embodiment of the present invention.

【図2】 この発明の実施の形態1による自己位置標定
装置の構成を示すブロック図である。
FIG. 2 is a block diagram showing the configuration of a self-locating device according to the first embodiment of the present invention.

【図3】 フラックスゲートコンパスの動作原理を説明
する図である。
FIG. 3 is a diagram illustrating an operation principle of a fluxgate compass.

【図4】 この発明の実施の形態2による自己位置標定
装置を搭載した車体を示す図である。
FIG. 4 is a diagram showing a vehicle body equipped with a self-locating device according to a second embodiment of the present invention.

【図5】 この発明の実施の形態3による自己位置標定
装置を搭載した車体を示す図である。
FIG. 5 is a diagram showing a vehicle body equipped with a self-locating device according to a third embodiment of the present invention.

【図6】 この発明の実施の形態3によるオドメータの
詳細を示す図である。
FIG. 6 is a diagram showing details of an odometer according to a third embodiment of the present invention.

【図7】 この発明の実施の形態3による自己位置標定
装置の構成を示すブロック図である。
FIG. 7 is a block diagram showing a configuration of a self-locating device according to a third embodiment of the present invention.

【図8】 この発明の実施の形態4による自己位置標定
装置を搭載した車体を示す図である。
FIG. 8 is a diagram showing a vehicle body equipped with a self-locating device according to a fourth embodiment of the present invention.

【図9】 斜面を移動した場合の説明図である。FIG. 9 is an explanatory diagram when a slope is moved.

【図10】 この発明の実施の形態4による自己位置標
定装置の構成を示すブロック図である。
FIG. 10 is a block diagram showing a configuration of a self-locating device according to Embodiment 4 of the present invention.

【図11】 従来の自己位置標定装置の一形態である車
載用位置表示装置の構成を示すブロック図である。
FIG. 11 is a block diagram showing a configuration of a vehicle-mounted position display device, which is one form of a conventional self-locating device.

【図12】 従来の自己位置標定装置の一形態である車
載用位置表示装置の動作を説明するための図である。
FIG. 12 is a diagram for explaining the operation of a vehicle-mounted position display device, which is one form of a conventional self-locating device.

【図13】 従来の自己位置標定装置を搭載した車体を
示す図である。
FIG. 13 is a diagram showing a vehicle body equipped with a conventional self-locating device.

【図14】 従来の自己位置標定装置の構成を示すブロ
ック図である。
FIG. 14 is a block diagram showing a configuration of a conventional self-locating device.

【図15】 角度と座標関係を説明するための図であ
る。
FIG. 15 is a diagram for explaining a relationship between an angle and a coordinate.

【符号の説明】[Explanation of symbols]

1 車体、2 ジャイロ、3 (検出用の)車輪、4
エンコーダ、5 演算処理器、6 (第1の)ハイパス
フィルタ、7 フラックスゲートコンパス、8(第1
の)ローパスフィルタ、9 走行用の車輪、10 支持
具、11 シャフト、12 ポテンショメータ、13
ピッチジャイロ、14 ロールジャイロ、15 ピッチ
傾斜計、16 ロール傾斜計、17 第2のハイパスフ
ィルタ、18 第3のハイパスフィルタ、19 第2の
ローパスフィルタ、20 第3のローパスフィルタ、3
0 方位センサ、31 GPS測位手段、32 CP
U、33 地図情報記憶手段、34 表示用メモリ、3
5 表示用処理手段、36測地系補正手段、37 表示
器、71 トロイダルコア、72 検出巻線1、73
検出巻線2、74 ドライブ巻線。
1 vehicle body, 2 gyro, 3 wheels (for detection), 4
Encoder, 5 arithmetic processor, 6 (first) high-pass filter, 7 fluxgate compass, 8 (first)
Low pass filter, 9 wheels for traveling, 10 supports, 11 shafts, 12 potentiometers, 13
Pitch gyro, 14 roll gyro, 15 pitch inclinometer, 16 roll inclinometer, 17 second high pass filter, 18 third high pass filter, 19 second low pass filter, 20 third low pass filter, 3
0 direction sensor, 31 GPS positioning means, 32 CP
U, 33 map information storage means, 34 display memory, 3
5 display processing means, 36 geodetic system correction means, 37 indicator, 71 toroidal core, 72 detection windings 1, 73
Detection winding 2,74 Drive winding.

Claims (5)

【特許請求の範囲】[Claims] 【請求項1】 移動体の平面上の姿勢角度を検出するジ
ャイロと、上記ジャイロの出力信号の高周波成分のみを
通すハイパスフィルタと、移動体の進行方向に対する真
北方位を検出するフラックスゲートコンパスと、上記フ
ラックスゲートコンパスの出力信号の低周波成分のみを
通すローパスフィルタと、移動体の走行距離を検出する
オドメータと、上記ハイパスフィルタとローパスフィル
タおよびオドメータからの出力信号を用いて移動体の自
己位置を演算処理する演算処理器とを具備したことを特
徴とする自己位置標定装置。
1. A gyro that detects a posture angle of a moving body on a plane, a high-pass filter that passes only high-frequency components of an output signal of the gyro, and a fluxgate compass that detects a true north direction with respect to a traveling direction of the moving body. , A low-pass filter that passes only the low-frequency component of the output signal of the fluxgate compass, an odometer that detects the traveling distance of the moving body, and a self-position of the moving body using the output signals from the high-pass filter, the low-pass filter, and the odometer. A self-position locating device comprising: an arithmetic processing unit for arithmetically processing.
【請求項2】 走行距離を検出するオドメータを移動体
の車輪と上記車輪の車軸に取り付けたエンコーダから構
成することを特徴とする請求項1記載の自己位置標定装
置。
2. The self-positioning apparatus according to claim 1, wherein the odometer for detecting the traveling distance is composed of a wheel of the moving body and an encoder attached to an axle of the wheel.
【請求項3】 オドメータを構成する車輪を走行用とは
別の検出輪としたことを特徴とする請求項2記載の自己
位置標定装置。
3. The self-positioning apparatus according to claim 2, wherein the wheels forming the odometer are detection wheels different from those for traveling.
【請求項4】 検出輪を車体に対して自由に回転できる
ように取り付け、検出輪の回転角を検出する角度検出器
を設けたことを特徴とする請求項3記載の自己位置標定
装置。
4. The self-positioning apparatus according to claim 3, wherein the detection wheel is attached so as to be freely rotatable with respect to the vehicle body, and an angle detector for detecting a rotation angle of the detection wheel is provided.
【請求項5】 車体のロール、ピッチ、ヨー3軸の角度
を検出するジャイロと、上記ジャイロの出力信号の高周
波成分のみを通す3つのハイパスフィルタと、移動体の
進行方向に対する真北方位を検出するフラックスゲート
コンパスと、車体のロール、ピッチの2軸の傾きを検出
する傾斜計と、上記フラックスゲートコンパスと上記傾
斜計の出力信号の低周波成分のみを通す3つのローパス
フィルタと、走行距離を検出するオドメータと、上記3
つのハイパスフィルタと3つのローパスフィルタおよび
オドメータからの出力信号を用いて移動体の自己位置を
演算処理する演算処理器とを具備したことを特徴とする
自己位置標定装置。
5. A gyro that detects roll, pitch, and yaw triaxial angles of a vehicle body, three high-pass filters that pass only high-frequency components of the output signal of the gyro, and a true north direction with respect to the traveling direction of a moving body is detected. Fluxgate compass, inclinometer that detects the inclination of the two axes of roll and pitch of the vehicle body, three low-pass filters that pass only the low-frequency components of the output signals of the fluxgate compass and the inclinometer, and the travel distance Odometer to detect and above 3
A self-positioning device comprising: one high-pass filter, three low-pass filters, and an arithmetic processing unit that arithmetically processes the self-position of a moving body using output signals from an odometer.
JP3228296A 1996-02-20 1996-02-20 Self-position orienting apparatus Pending JPH09229697A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP3228296A JPH09229697A (en) 1996-02-20 1996-02-20 Self-position orienting apparatus

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP3228296A JPH09229697A (en) 1996-02-20 1996-02-20 Self-position orienting apparatus

Publications (1)

Publication Number Publication Date
JPH09229697A true JPH09229697A (en) 1997-09-05

Family

ID=12354625

Family Applications (1)

Application Number Title Priority Date Filing Date
JP3228296A Pending JPH09229697A (en) 1996-02-20 1996-02-20 Self-position orienting apparatus

Country Status (1)

Country Link
JP (1) JPH09229697A (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6128572A (en) * 1997-09-04 2000-10-03 Clarion Co., Ltd. Vehicle direction correcting apparatus
JP2001091289A (en) * 1999-09-17 2001-04-06 Data Tec:Kk Sensor unit
JP2017090051A (en) * 2015-11-02 2017-05-25 セイコーエプソン株式会社 Detection device, detection system, and movable body

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6128572A (en) * 1997-09-04 2000-10-03 Clarion Co., Ltd. Vehicle direction correcting apparatus
JP2001091289A (en) * 1999-09-17 2001-04-06 Data Tec:Kk Sensor unit
JP2017090051A (en) * 2015-11-02 2017-05-25 セイコーエプソン株式会社 Detection device, detection system, and movable body

Similar Documents

Publication Publication Date Title
EP0566390B1 (en) Apparatus for detecting the position of a vehicle
EP0496538B1 (en) Vehicle heading correction apparatus
JP4466705B2 (en) Navigation device
EP0640207B1 (en) Calibration method for a relative heading sensor
JP4897542B2 (en) Self-positioning device, self-positioning method, and self-positioning program
Collin MEMS IMU carouseling for ground vehicles
JP2007155584A (en) Inertia navigation system
JPH04238216A (en) Calculating method for scale factor of gyroscope
US7832111B2 (en) Magnetic sensing device for navigation and detecting inclination
JP2004125689A (en) Position calculation system for self-contained navigation
JP2006119144A (en) Road linearity automatic survey device
JPH04121618A (en) Moving body navigation device
JP3440180B2 (en) Navigation device
JPH09229697A (en) Self-position orienting apparatus
US8433514B1 (en) Navigation sensor mounting-angle calibration
US20230349699A1 (en) Absolute heading estimation with constrained motion
JP4268581B2 (en) Car navigation system
JP2014006131A (en) Speed calculation device, speed calculation method, speed calculation program, and recording medium
JP3168789B2 (en) Pipe measurement method
US9976857B2 (en) Apparatus for providing an azimuth angle
JPH0626873A (en) Vehicle-bearing correcting apparatus
JP6413816B2 (en) Random driving judgment device
JPH0334035B2 (en)
JP2794807B2 (en) Moving object position detection device
KR100578657B1 (en) Method for detecting azimuth