JPH04204184A - 電波測量による車両位置検出装置 - Google Patents

電波測量による車両位置検出装置

Info

Publication number
JPH04204184A
JPH04204184A JP33423890A JP33423890A JPH04204184A JP H04204184 A JPH04204184 A JP H04204184A JP 33423890 A JP33423890 A JP 33423890A JP 33423890 A JP33423890 A JP 33423890A JP H04204184 A JPH04204184 A JP H04204184A
Authority
JP
Japan
Prior art keywords
radio wave
vehicle
station
time difference
gps
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
JP33423890A
Other languages
English (en)
Inventor
Kenji Tanabe
賢司 田辺
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.)
Komatsu Ltd
Original Assignee
Komatsu Ltd
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 Komatsu Ltd filed Critical Komatsu Ltd
Priority to JP33423890A priority Critical patent/JPH04204184A/ja
Publication of JPH04204184A publication Critical patent/JPH04204184A/ja
Pending legal-status Critical Current

Links

Landscapes

  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。

Description

【発明の詳細な説明】 〔産業上の利用分野〕 この発明は電波測量(双曲線方式)による車両位置検出
装置に関する。
〔従来の技術 および発明が解決しようとする課題〕
従来、ダンプトラックなどの有人車両の運転支援システ
ムや無人走行車の走行システムにおいて、電波測量(双
曲線方式)によって車両の誘導を行なう技術がある。
この電波測量方式においては、電波を送信する、主局お
よび2つの従局を地上に設置し、車両に設置された車載
局でこれら電波を受信し、主局と一方の従局との受信時
間差と、主局と他方の従局との受信時間差とを求め、こ
れらの受信時間差に基ずいて2次元平面上における車両
の2次元位置を検出するようにしており、該検出された
車両位置と車両の目標経路に応じて車両が誘導走行され
る。
この種の誘導システムにおいては、車両の2次元位置を
正確に検出することが不可欠であり、その検出精度を最
大ならしめるためには、上記主局および2つの従局は同
一2次元平面上に設置されることが必須となる。
しかし、地形の起伏がある場所で、上記電波測量を実施
する場合、上記主局および2つの従局を完全に同一平面
上に設置することは事実上不可能であり、また車両にお
いても地形の起伏のある場所を走行するため、車載局に
おける電波受信位置が同一2次元平面上になることはあ
り得ない。
このように、電波送受信位置に高低差が生じた場合には
、位置検出精度が劣化し、誘導システムの信頼性を著し
く損なわせる問題がある。
そこで、特開昭63−300982号においては、車両
にジャイロセンサを配設し、このジャイロセンサの検出
出力(鉛直方向の角速度)を積分することで車両の鉛直
方向座標を求め、該求めた鉛直方向座標と前記主局およ
び2つの従局からの電波の受信時間差とに基ずき車両の
3次元位置を検出するようにしている。
しかしながら、ジャイロセンサは累積誤差を生じるもの
であるため、この累積誤差を適当な間隔で補正する必要
がある。この累積誤差を補正する方法として、当該エリ
アの3次元位置情報を含む電波を送信するサインポスト
を適応な間隔で配設し、これらサインポストからの3次
元位置情報を車両側で受信することで累積誤差を補正す
る方法が考えられるが、建設機械などが用いられる作業
現場では必ずしもサインポストを設置できる環境にある
とは限らない。また、サインポストを設置できたとして
も補正精度を向上させるためにはサインポストを狭い間
隔て多数個設置しなくてはならず、さらにこのようにサ
インポストを多数個設置したときは、これらのサインポ
ストが障害物となって車両軌道が大きく制限されるとい
う問題がある。
この発明はこのような実情に鑑みてなされたもので、移
動体の3次元位置計測を正確になし得る電波測量による
車両位置検出装置を提供することを目的とする。
〔課題を解決するための手段〕
この発明では、電波測量用の電波を送信する主局および
2つの従局を所定の位置関係で配設するとともに、前記
主局および2つの従局から送信された電波を受信する受
信手段を移動体に設け、前記受信手段二寄って受信され
た各電波の受信時間差に基ずき車両の位置を検出するよ
うにした電波測量による車両位置検出装置において、電
波を送信する少なくとも3つのGPS衛星を設けるとと
もに、前記移動体に、前記3つのGPS衛星から送信さ
れる電波を受信するGPS電波受信手段と、前記受信手
段で受信された各電波の受信時間差および前i己GPS
電波受信手段で受信されたGPS衛星からの電波の受信
時間差に基ずいて移動体の3次元位置を検出する位置演
算手段とを具えるようにする。
〔作用〕
かかる本発明の構成によれば、GPS電波受信手段で受
信されたGPS衛星からの電波の受信時間差に基ずいて
移動体の高さ位置が求められる。
このようにして求めた高さ位置によって前記主局および
2つの従局から送信された電波にもとすく電波測量の2
次元位置が補正される。
〔実施例〕
以下、この発明を添付図面に示す実施例にしたがって詳
細に説明する。
第1図は、本発明が適用される地形起伏がある作業現場
の一例を示す概略図である。
同図において、車両1はその積み荷を降ろすホッパ部2
を始点として切羽部3まで走行し、ここで土砂などの積
荷が積み込まれる。そして、車両1は再びホッパ部2へ
戻り、ここで積荷を降ろす作業が行なわれる。
上記車両が走行する領域外で、車両1を見通すことがで
きる適宜の場所には、主局4、従局5.6がそれぞれ設
置されて゛いる。
さらに、上空(地球上空の約数刃km)には、この場合
4個のGPS衛星7〜10が打ち上げられていて、これ
らGPS衛星7〜1oはそれぞれ地上に向けて電波を送
信する。GPSは(グローバル・ボジショニング・シス
テム;全地球域測位システム)の略で、このGPSシス
テムは近年、陸海空の移動体の2次元、3次元位置を計
測するシステムとしてその利用が注目されている。
第2図は、主に車両側の構成を示すブロック図であり、
車両1には、地上に設置された主局4および従局5.6
からの電波を受信する車載局1゜と、前記GPS衛星7
〜1oがらの電波を受信するGPS受信局20か設けら
れている。GPS受信局20は、4つのGPS衛星7〜
1oがらGPS受信局20に到達する各電波の時間差を
用いて車両1の3次元位置(x、y、H)を求め、これ
ら3次元位置(x、y、H)のながの高さ位置HをCP
U40に入力する。
例えばGPS受信局20では、GPS衛星7および8か
らGPS受信局20に到達する電波の時間差と、GPS
衛星7および9がらGPS受信局20に到達する電波の
時間差と、GPS衛星7および10からGPS受信局2
0に到達する電波の時間差とを求め、これら3つの時間
差とGPS衛星7〜10の位置に基すき車両1の位置(
x、y。
H)を演算する。なお、GPS衛M7〜10の位置は各
衛星の軌道情報に基ずき予め求められている。
CPU40は、車載局10の受信出力を用いて、主局4
および従局5から車載局10に到達する電波の時間差Δ
11と、主局4および従局6から車載局10に到達する
電波の時間差Δ(2とを求め、これらの時間差Δ!1、
Δ12および前記GPS受信局20から入力された高さ
位置Hに基ずいて車両の3次元位置を検出するものであ
る。
ここで、この実施例における3次元位置の検出原理を第
3図に基ずいて説明する。
同図に示すように、空間(X、Y、Z)座標内に主局4
、従局5,6が設置され、車両1の位置を計測するもの
とする。この場合、主局4を座標の原点とし、従局5は
Xz平面内にあるものとしても一般性を失わないので、
図中のような座標とした。
主局 −(0,0,0) 従局 −(b、0.c)     ・・・■従局 −(
d、e、f) さて、車両1の位置を(x、y、z)とすると、電波測
量(双曲線方式)では主局4−車両1間の距NL1と従
局5−車両1間の距離L2との差ΔL1、および上記距
離Llと従局6−車両1間の距離L3との差ΔL2を用
いて車両1の位置を算出するので、下式■■が成立する
・・・■ ・・・■ なお、前記時間差Δ11.Δ;2は、上記へLl。
ΔL2にそれぞれ対応する。
ここで、上記■■式より下式■■がそれぞれ成立する。
JJ−乙ゴ]]了 = (2bc+2cz+ΔLl 2−b2−C2)/2
ΔLl− ・・・■ −(2dx+2ey+2f z+ΔL22−d2− 2
−f2)/2ΔL2 ・・・■ さらに■式−■式より下式■が成立する。
y−(ΔL2/2eΔLl)([2x(bΔL2−dΔ
Ll)/ΔL2 ] + [2H(cΔL2−fΔL1
)/ΔL2] +ΔL12−b 2−C2)<ΔL22
−d2−C2−f2)/2e ・・・■ ただし、上記0式において、車両1の2式分はGPS受
信局20で算出した高さ位置Hを用いているので、z−
Hを代入゛している。
そして、上記0式を■式に代入し、Ax2+BX+C−
0の形に整理すると、 A−f(bΔLl−dΔLl)2+e2 (ΔLL  
 −1)l/e2ΔL12 B−2αβ−(bγ/2ΔL12) C−b  +H−(γ/4ΔL12) ただしここで、 a−(bΔL2−aΔLl)/eΔL1β−(ΔL2/
2eΔLl )  ([2H(cΔL2−fΔL1)/
ΔL2]  +ΔL12−b2−c2)−(ΔL22−
d2−e2− f ” ) / 2 e 7−2CH+ΔLl ”−b2−c2 したがって、2次方程式の解の公式より、x−(−B±
JB2−4AC)/2A ・・・■ が成立する。
上記2次方程式の解は2個存在するが、ΔLl。
ΔL2の正負符号などから最適な一方の解Xを選択し、
このXを先の第0式に代入することて座標値yを求める
ことができる。
CPU40では、上述した原理に基ずき車両1の3次元
位置を測定する。
すなわち、CPU40ては、車両1がホッパ部2からス
タートすると、GPS受信局30がら車両1の高さHを
取り込む。また、CPU40では車載局20の出力に基
ずいて上記電波の時間差Δ11、Δ12を求め、これら
によって上記距離ΔLl。
ΔL2を求める。
そして、CPU40は先の第■式、および上記高さH1
距離ΔLl、 ΔL2に基ずき、車1ifiilのX座
標Xを演算し、さらにこの座標値Xと第0式から車両1
のY座標yを演算する。
CPU40では、このようにして車両1の3次元座標(
x、y、H)を求め、該求めた3次元位置(x、y、H
)の予め設定された目標軽路に対するコースずれ量およ
び姿勢角を求め、これらコースずれ量および姿勢角が零
になるよう車両1の操舵制御を実行する。
なお、実施例では、GPS衛星を4個用い、これら4個
のGPS衛星衛星型波を受信することで車両1の3次元
位置を演算するようにしたが、車両社1の高さ位置のみ
を知るためには、GPs衛星は最低3個で良い。ただし
、4このGPS衛星を用いた場合は、車両1の3次元位
置を演算できるので、例えば、地上局からの電波による
電波測量装置が動作しなくても車両1の3次元位置が得
られる事になり安全性や制御性の面で有利である。
〔発明の効果〕
以上説明したようにこの発明によれば、GPS衛星から
の電波の受信時間差に基ずいて移動体の高さ位置を求め
、この高さ位置によって前記主局および2つの従局から
送信された電波にもとずく電波測量の2次元位置を補正
するようにしたので、サインポストか設置できない作業
現場においても移動体の3次元位置計測を正確になし得
る事ができる。
【図面の簡単な説明】
第1図はこの発明を適用する作業現場を示す図、第2図
はこの発明の実施例を示すブロック図、第3図は各地上
局の位置を定義する図である。 1・・・車両  4・・主局  5,6・・・従局7〜
10・・GPS衛星 20・・・車載局30・・・GP
S受信局  40・・・CPU第1区

Claims (1)

  1. 【特許請求の範囲】 電波測量用の電波を送信する主局および2つの従局を所
    定の位置関係で配設するとともに、前記主局および2つ
    の従局から送信された電波を受信する受信手段を移動体
    に設け、前記受信手段によって受信された各電波の受信
    時間差に基ずき車両の位置を検出するようにした電波測
    量による車両位置検出装置において、 電波を送信する少なくとも3つのGPS衛星を設けると
    ともに、 前記移動体に、 前記3つのGPS衛星から送信される電波を受信するG
    PS電波受信手段と、 前記受信手段で受信された各電波の受信時間差および前
    記GPS電波受信手段で受信されたGPS衛星からの電
    波の受信時間差に基ずいて移動体の3次元位置を検出す
    る位置演算手段と、 を具えるようにした電波測量による車両位置検出装置。
JP33423890A 1990-11-30 1990-11-30 電波測量による車両位置検出装置 Pending JPH04204184A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP33423890A JPH04204184A (ja) 1990-11-30 1990-11-30 電波測量による車両位置検出装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP33423890A JPH04204184A (ja) 1990-11-30 1990-11-30 電波測量による車両位置検出装置

Publications (1)

Publication Number Publication Date
JPH04204184A true JPH04204184A (ja) 1992-07-24

Family

ID=18275092

Family Applications (1)

Application Number Title Priority Date Filing Date
JP33423890A Pending JPH04204184A (ja) 1990-11-30 1990-11-30 電波測量による車両位置検出装置

Country Status (1)

Country Link
JP (1) JPH04204184A (ja)

Similar Documents

Publication Publication Date Title
US4743913A (en) Hybrid navigation system for determining a relative position and direction of a vehicle and method therefor
EP0679973B1 (en) Integrated vehicle positioning and navigations system, apparatus and method
EP0870174B1 (en) Improved vehicle navigation system and method using gps velocities
US6560535B2 (en) Global positioning system roadside integrated precision positioning system
US8548731B2 (en) Navigation method, navigation system, navigation device, vehicle provided therewith and group of vehicles
JP3075889B2 (ja) ナビゲーション装置
KR20200040136A (ko) 차량의 위치 결정 방법, 위치 결정 장치 및 주행 제어 시스템
JPH10267650A (ja) 道路線形自動測量装置
JPH11190771A (ja) Gps測定位置補正装置
CN110345949A (zh) 一种车辆所在车道的定位方法及其系统
JPH04204184A (ja) 電波測量による車両位置検出装置
TWI564546B (zh) On - board Vehicle Navigation System Calibration Method
JP7414683B2 (ja) 自車位置推定装置及び自車位置推定方法
JPH0875479A (ja) 電波航法装置
JP2007225408A (ja) 移動体の横滑り計測装置
JPH10103984A (ja) 車両の位置算出装置
JP2786309B2 (ja) 車両位置検出装置
JP2685624B2 (ja) 移動体用ナビゲーション装置
US20240321096A1 (en) Localization using position coordination of road signs
Chowdhary et al. Improving GPS location availability and reliability by using a suboptimal, low-cost MEMS sensor set
JPH07128420A (ja) 移動体位置検出装置及びこれを用いた移動体間距離検出装置
JPH0628031A (ja) 移動体の位置出し用群制御装置
US20240263949A1 (en) Egomotion location enhancement using sensed features measurements
Wang et al. Vehicle localization with global probability density function for road navigation
Liu et al. ESKF-based Vehicle Positioning Through Cellular Signals, GNSS, IMU, and Odometer