JP3837160B2 - 陸ベース車両の作動点を正確に求めるためのコンピュータベースのシステム - Google Patents
陸ベース車両の作動点を正確に求めるためのコンピュータベースのシステム Download PDFInfo
- Publication number
- JP3837160B2 JP3837160B2 JP51395496A JP51395496A JP3837160B2 JP 3837160 B2 JP3837160 B2 JP 3837160B2 JP 51395496 A JP51395496 A JP 51395496A JP 51395496 A JP51395496 A JP 51395496A JP 3837160 B2 JP3837160 B2 JP 3837160B2
- Authority
- JP
- Japan
- Prior art keywords
- estimated
- vehicle
- receiver
- kalman filter
- operating point
- 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
- 230000008859 change Effects 0.000 claims description 26
- 230000000694 effects Effects 0.000 claims description 3
- 238000005259 measurement Methods 0.000 description 48
- 230000007246 mechanism Effects 0.000 description 10
- 238000001914 filtration Methods 0.000 description 9
- 238000000034 method Methods 0.000 description 9
- 239000003245 coal Substances 0.000 description 6
- 239000011159 matrix material Substances 0.000 description 6
- 238000010586 diagram Methods 0.000 description 4
- 230000008569 process Effects 0.000 description 4
- 230000033001 locomotion Effects 0.000 description 3
- 239000007787 solid Substances 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 241000364057 Peoria Species 0.000 description 1
- 230000001174 ascending effect Effects 0.000 description 1
- 238000009412 basement excavation Methods 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
- G01S19/49—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an inertial position system, e.g. loosely-coupled
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/01—Determining conditions which influence positioning, e.g. radio environment, state of motion or energy consumption
- G01S5/017—Detecting state or type of motion
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/027—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising intertial navigation means, e.g. azimuth detector
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0272—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising means for registering the travel distance, e.g. revolutions of wheels
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Description
本発明は、一般的に自律式車両の制御に関する。より詳細には、本発明は、自律式車両の正確な作動点を求めるためのシステムと方法に関する。
背景技術
イリノイ州ペオリア在住のキャタピラー社は、オフロード炭鉱用車両を製造している。本件出願人によって1995年2月14日に許可された米国特許第5、390、125号の“車両位置決定システム及び方法”では、炭鉱用車両に用いるための自律式車両システムを開示する。本発明は、この先行技術を引用し、この特許明細書の記述を本明細書の記述の一部とする。
自律性を達成するために、車両は、常にその状況に対する位置を求めることができなければならない。米国特許第5、390、125号に開示された車両システムは、車両位置システム(VPS)を用いて車両の位置を求める。VPSは、第1位置推定値と第2位置推定値の重み付け平均を行なうことによって車両の位置の正確な推定値を求める。第1位置推定値は全地球的航法(GPS)受信機から受け取られる。第2位置推定値は、慣性基準ユニットから受け取られる。第1及び第2位置推定値は予想される精密さの関数として重み付けされて、より正確な第3の位置推定値を作り出す。米国特許第5、390、125号に開示されるようなシステムは非常に高価である。例えば、慣性基準ユニットだけでも、約10、000ドルから100、000ドルかかる。
位置決めのために、GPS受信機だけを用いることは可能である。しかしながら、高度な精密さが要求されるときには、集積型位置システムが好ましい。集積型位置システムは、いくつかの異なる種類のセンサーからの計測値を用いて、かなり正確な位置情報を得ることができる。集積型位置システムの多くの例が知られている。このような集積型システムは、GPS航法信号とともに、慣性及び別の車両運動型センサーからの計測値を用いてより正確な位置推定値を作り出す。しかしながら、これらのシステムは、一般的にカスタム設計であるために、これを達成するには費用もかかり厄介である。
費用の点で有効な手段で正確な位置推定値を作り出せるシステムが必要とされる。このようなシステムは比較的費用が安く、商業的にも入手可能な部品を使用するのが好ましい。
発明の開示
本発明は、炭鉱用トラックのような自律式車両の作動点を正確に求めるためのシステムと方法である。トラック基準ユニット(TRU)は、車両の作動点を求める。“作動点”とは、車両の動的な位置を表すパラメータの数のことをいう。例えば、これらの動的なパラメータは、位置、速度、加速度、速さ、向き変更、向き変更率、ピッチ、ピッチ率、ロール、及びロール率を含んでいればよいが、これらに限定されない。好ましい実施例において、作動点は、北の位置、東の位置、速さ、向き変更及び向き変更率を含む。
好ましい実施例において、本発明は自律式車両システムにおいて達成される。トラック基準ユニット(TRU)は車両の作動点を求める。ナビゲータはTRUから作動点を受け取り、作動点情報を用いて車両を誘導する。
TRUは、いくつかの商業的に入手可能なセンサーから受け取られた計測値を組み合わせて、車両の作動点を求める。好ましい実施例において、これらのセンサーは、衛星位置システム受信機、速さインジケータ、オドメータ、リゾルバ、及び角速度センサーを含む。これらの計測値は重み付けされ、組み合わされて作動点の正確な推定値を与える。
TRUは、推定値の質が低下するかもしれないが、どれか一つのセンサーがなくてもナビゲータに作動点の推定値を与えるTRUの能力を失わないように設計されている。これによって、センサーがオンライン状態に戻る、即ちセンサーが作動するまで、ナビゲータは所望のルートに沿って自律式車両に命令し続けることができる。
好ましい実施例において、TRUは、全地球航法(GPS)受信機から北の位置、北の速度、東の位置及び東の速度の測定値を、2方向性オドメータから移動した距離と方向を、実対地速度ドップラレーダから速度を、リゾルバからかじ取り角を、固体状態の角速度センサーから向き変更率を受信するコンピュータベースシステムである。TRUは、9つの状態か4つの状態に拡張したカルマンフィルタのいずれかを用いて計測値を組み合わせて、車両の作動点の推定値を計算する。9状態に拡張したカルマンフィルタは車両が移動するときに用いられる。4状態に拡張したカルマンフィルタは、車両が静止しているときに用いられる。
本発明の前述及び他の特徴及び利点は、添付した図面に示すように、次の本発明の好ましい実施例のより詳細な記載から明らかになるであろう。
【図面の簡単な説明】
図1は、本発明の自律式車両を表す高レベルのブロック線図である。
図2は、本発明のトラック基準ユニットの構造を表すブロック線図である。
図3は、本発明のトラック基準ユニットの作動を表すフローチャートである。
図4は、本発明のトラック基準ユニットによって実施されるフィルタリング作動を表すフローチャートである。
本発明を実施するのに最良の形態
本発明の好ましい実施例を以下に詳細に述べる。特定部分の符号と形状に関して述べているが、これは図示を目的にするだけのものである。本分野における当業者であれば、別の成分及び形状も本発明の精神と範囲から逸脱することなく用いてもよいことがわかるであろう。
本発明の好ましい実施例は、図面を参照して記載されており、同じ参照符号は同じ要素を表す。さらに、各参照番号の最も左側の数字は、この番号が最初に用いられた図を示している。
産業上の利用可能性
本発明は、自律式車両の作動点を正確に求めるためのシステム及び方法に関する。“作動点”とは、動的な車両位置のことをいう。車両の動的位置を表す動的パラメータは、例えば位置、速度、加速度、向き変更、ピッチ、ロール、速さ、向き変更率、ピッチ率、およびロール率を含む。好ましい実施例において、作動点は、北の位置、東の位置、速度、向き変更及び向き変更率を含む。図示のために、本発明を自律式車両システムの状況で記載する。これは図示の目的のためにのみなされる。本分野における当業者であれば、本発明を別の用途に用いてもよいことがわかるであろう。
図1は、自律式車両システム100を表す高レベルのブロック線図である。自律式車両システム100は、車両群管理機構102、車両制御システム104、及びテレオペレーションパネル106を含む。車両群管理機構102は、ダンプトラックのような一群の自律式炭鉱用車両を管理するように構成されている。車両群管理機構102は職長のように作用し、炭鉱用車両に作業を割当て、車両が作業を行なうときの進行状態を追跡する。車両群管理機構102は無線リンク108によって各車両と通信する。各車両は、オンボード車両制御システム104を含む。車両制御システム104は、車両群管理機構102の制御のもとで炭鉱用車両の自律操作を行なうことができる。車両制御システム104は、ナビゲータ120、トラック基準ユニット(TRU)122、障害物検出機124、機械制御モジュール(MCM)126、進歩したディーゼルエンジン管理機構(ADEM)128、電子プログラム可能トランスミッション機構(EPTC)130、および必須情報管理機構(VIMS)132を含む。
ナビゲータ120は、無線リンク108を介して車両群管理機構102から指令を受け取る。この指令は、例えば仕事の作業割当を含む。ナビゲータ120は次に進むべきルートを仕事から決定する。例えば、このルートは、オープンピット鉱山操作における掘削場所と破砕場所との間の運搬部分である。
TRU122は、衛星ベースの位置システムとオンボードセンサーから求められた計測値を用いて車両の作動点を求める。車両の作動点と所望のルートに基づいて、ナビゲータ120は車両に対して所望のかじ取り角と所望の速度を作り出す。障害物検出機124は、車両前部の領域を障害物に対して走査するレーダユニットである。障害物検出機124が障害物を検出すると、ナビゲータ120に障害物が検出されたことを知らせたり、または障害物の位置を知らせる。ナビゲータ120は、車両を停止させたり、または障害物の回りを誘導する。
テレオペレーション106は、110で示されているような無線信号を介してかじ取り角、速度及び他の命令をナビゲータ120に直接通信するのに用いられて、車両の遠隔制御操作を行なうことができる。
車両群管理機構102、ナビゲータ120、及び障害物検出器124の作動については、上述で組み込んだ米国特許第5、390、125号に詳細に記載されている。
ナビゲータ120、TRU122及び障害物検出器124は、車両オンボード情報を表し、自律制御コマンドを速度及びかじ取り角コマンドの形態で作り出せる。ナビゲータ120は、所望の移動ルートと車両の作動点に基づいて速度及びかじ取り角コマンドを作り出す。ナビゲータ120は、現在の作動点に基づいて現在のかじ取り角と速度の調整を計算し、車両を所望のルートに沿って動かす。車両群管理機102は、ナビゲータ120に所望のルートを与える。TRU122はナビゲータ120に自律式車両の作動点を与える。
TRU122の構造を表すブロック線図を図2に示す。好ましい実施例において、TRU、TRUセンサインターフェイス202、TRUディジタル入力カード204、TRUアナログ入力カード206、TRUプロセッサ208、TRU直列インターフェイス210及びTRUデータ母線212を含む。センサーインターフェイス202は、2方向オドメータ230、ドプラ対地速度インジケータ232、固形状態の向き変更率センサ234、及びかじ取りリゾルバ236から信号を受信する。2方向性オドメータ230は、車両が移動する距離と方向、即ち前進または後退かの方向を計測する。ドプラ対地速度インジケータ232は、車両が進行する速度を計測する。固体状態の向き変更率センサ234は、車両が向き変更、即ち向きを変えるときの割合を計測する。かじ取りリゾルバ236は車両のかじ取り角を計測する。本分野の当業者であれば、様々な別のセンサーを同じパラメータを計測するのに用いてもよいことがわかる。例えば、タコメータは速度を計測するのに用いることができたり、またはジャイロスコープを向き変更率を計測するのに用いることができる。
さらに、別の精密さを得ようとする際に、付加的な又は異なるセンサーから計測が行なわれて本発明に組み込まれる。例えば、上昇角を計測するのに傾斜計を用いて、ピッチ率センサーを上昇の変更率を計測するのに用いたり、またはコンパスは向き変更を計測するのに用いることができる。一方、精密さをいくらか失うという犠牲を払って、費用を節約するためにいくつかのセンサーを取り除くことができる。
センサー計測値は、センサーインターフェイス202によって収集される。センサーインターフェイス202は、例えば、タインミングストロブ、パルス幅変調信号等のようなディジタル信号をディジタル入力カード204に通過させ、電圧、電流等のアナログ信号をアナログ入力カード206に通過させる。ディジタル入力カード204は、ディジタルタイミングとパルス信号をディジタル値に変換してディジタルレジスタ205内に記録する。アナログ入力カード206は、アナログ信号を基準化してディジタル値に変換し、アナログレジスタ207に記憶する。TRUプロセッサ208、即ち一般的な目的のためのマイクロプロセッサは、ディジタルレジスター205、またはアナログレジスタ207にデータ母線212を介してアクセスしており、センサー計測値を得る。
TRU122は衛星ベースの位置システム218から位置データを受け取る。好ましい実施例において、衛星ベースの位置システム218は、全地球航法(GPS)である。GPS受信機216は、衛星ベース位置システム218から衛星信号を受信しこれらの信号に基づいて位置を求める。GPS受信機216は、北の位置、東の位置、北の速度および東の速度とともにタイミング情報を含む受信機が判定した計測値をTRU122に与える。TRU122は、直列インターフェイス210を介してGPS受信機216から計測値を受信する。TRUプロセッサ208は、直列インタフェイス210からGPS受信機計測値を受け取る。GPS受信機で得られた計測値と上述で得られたセンサー計測値で、TRUプロセッサ208は自律式車両の作動点の推定値を計算する。TRUプロセッサ208は、作動点を直列インターフェイスを通過させ、作動点を直列データライン214でナビゲータ120に送る。
残りの説明ではカルマンフィルタの簡単な説明を必要とする。一般的にカルマンフィルタは、最適な最小二乗平均の推定値である。好ましい実施例において、伸長したカルマンフィルタが用いられる。拡張したカルマンフィルタは、現在の状態の非線形システムに基づいて線形化したモデルを用いて最小平均二乗推定値を計算する。本明細書では“カルマンフィルタ”と“カルマンフィルタリング”を用いており、これは同様に“拡張したカルマンフィルタ”と“拡張したカルマンフィルタリング”にも適用できる。
カルマンフィルタリングは本分野においてよく知られている。これはGPS位置システムに該当する。実際、多くの引例では、カスタムの用途としてカルマンフィルタ、慣性航法ユニット、及びGPS位置システムを一体化して精密度の高い車両の車両位置と挙動を作り出すことを開示する。これらのシステムにおいて、中央プロセッサは、GPS位置システムから動的位置を求め、慣性航法ユニット(INU)からの信号に基づいて動的位置を求め、GPSおよびINUサブシステムと対応した複雑化した命令と制御を履行することを含む作業を実施する。中央プロセッサは、カルマンフィルタリングを行なって、車両の作動点の推定値を得なければならない。これらのサブシステムは、広範囲の展開ととりまとめ時間を必要とし、多くの場合高価なハードウェアを必要とする。
しかしながら、本発明は、商業的に入手可能なGPS受信機と、車両の作動点を推定するための既製のセンサーを用いる。中央プロセッサ(即ちTRUプロセッサ208)の役割は、GPS受信機のようなセンサーからの計測値を収集して、カルマンフィルタリングを実施し、作動点を推定することである。部品の費用がより安いことに加えて、このシステムは、展開ととりまとめに必要とする時間は少ない。このように、本発明は、効率的にかつ費用も有効な手段で正確な作動点を作り出すように機能できる。
しかしながら、GPS受信機があるフィルタリングを内的に実行するという事実のために、カルマンフィルタによって得られる推定値において精密さが幾分か損なわれる。これによって2つの問題が発生する。第1に、GPS受信機におけるフィルタリングは、GPS受信機が出力するデータにおいてタイムラグを導くことになる。このため、車両が静止しはじめるまで、GPS受信機によって計算された位置と挙動が、一貫して実際の位置と動きに遅れることになる。車両が数秒の間停止したままであったとき、GPS受信機によって計算される位置は車両の実際の位置に設定される。タイムラグは、カルマンフィルタにおいてモデル化されてこれを説明する。
好ましい実施例において、タイムラグは、カルマンフィルタの入力として用いられた4個のGPS受信機で決定された計測値のそれぞれごとに第1番目のラグとしてモデル化される。これによって、カルマンフィルタはどの推定値がタイムラグなしであるべきかを推定する。タイムラグをモデル化するのにカルマンフィルタにおいて4つの状態が必要である。4つの状態は、推定された受信機判定北位置、推定された受信機判定東位置、推定された受信機判定北速度、推定された受信機判定東速度である。この方法でGPS受信機をモデル化することによってカルマンフィルタを介してラグの影響を小さくして、車両の作動点の推定値がよりよくなる。
GPS受信機によって実施されたフィルタリングの第2の影響は、GPS受信機に入るホワイトノイズがカラー化したノイズとして受信機に残ったままとなることである。即ち、このノイズは相関関係が高い。カルマンフィルタに入るノイズがホワイトであるか非相関関係であるとして考えられるのでカルマンフィルタの性能をいくらか低下させる。広範囲の処理を行なうことなく、この問題を殆ど解決することはできない。この結果として、車両の作動点の正確な推定値がわずかに悪くなる。
カルマンフィルタを含むTRUプロセッサ208によって実施された処理を表すフローチャートを図3に表す。処理は、各センサーによって与えられた計測値を読み取ることによって段階302において開始する。これを達成するためにTRUプロセッサ208はディジタル入力カード204上でディジタルレジスタ205を読み取り、オドメータ230、速さインジケータ232、またはかじ取りリゾルバ236から計測値を受取り、アナログ入力カード206上でアナログレジスタ207を読み取り、向き変更率センサ234から測定値を受け取るようになっている。段階304において、TRUプロセッサ208は、段階302において得られた各測定値を較べ、この測定値が各センサの有効範囲にあることをチェックする。
判定段階306において、TRUプロセッサ208は直列インターフェイス210をチェックし、新しいGPS受信機測定値が存在するかどうかをチェックする。新しいGPS受信機測定値が存在する場合には、TRUプロセッサ208はGPS受信機測定値が段階308内において有効範囲内にあることをチェックする。有効範囲内にない測定値は無視する。新しいGPS受信機測定値が存在しない場合には、処理が段階310に続く。
判定段階312において、TRUプロセッサ208が直列インターフェイス210をチェックし、ナビゲータ120から新しい情報が存在するかを判定する。ナビゲータ120は、かじ取り角と速さコマンドに関するTRU122情報を送る。ナビゲータ120からのこの情報が存在する場合には、TRUプロセッサ208は段階312に進む。ナビゲータ120からの新しい情報がない場合には、処理が段階313に続く。
段階312において、TRUプロセッサ208はナビゲータ120から受け取った情報をチェックし、この情報が有効範囲内にあることを確認する。有効範囲内にない情報は無視されて、次の処理には使用されない。ナビゲータ120から受け取ったいかなる情報も確認したあと、TRUプロセッサ208は段階313にすすむ。
段階313において、TRUプロセッサ208は段階302において受け取ったセンサ測定値、または段階308において受け取られた受信機測定値と、現在の作動点の一致性をチェックする。これらの測定値のいずれもが現在の作動点と一致しない場合には、これらの不一致性の測定値は、段階314においてカルマンフィルタを更新するために無視される。例えば、速さインジケータ232が100マイル/時間(mph)の速度測定値を示し、現在の作動点が10mphの速度を示す場合には、速さインジケータ232からの速さ測定値は、一回のフィルタ更新の間、速度がこの量によって変更されたとは考えられないので無視される。あり得る結果としては、測定値が信頼できないものであったり、またはセンサーが停止していることがある。信頼ある情報をカルマンフィルタにできるかぎり与えるために、不一致な測定値が無視される。TRUプロセッサ208が一致性の測定値をチェックし、不一致な計測値を無視した後、処理が段階314に続く。
段階314において、TRUプロセッサ208は、段階302において受け取ったセンサー測定値、または段階306において受け取られたGPS受信機測定値でカルマンフィルタを更新する。好ましい実施例において、センサー測定値は10ヘルツ(Hz)で受け取られ、GPS受信機測定値は1ヘルツで受け取られる。このため、カルマンフィルタは、GPS受信機測定値で更新される場合と同じようにセンサ測定値で10回更新される。カルマンフィルタが様々な源から、かつ異なる割合で測定値を処理するのに適することが本分野においてよく知られている。段階316において、TRUプロッセッサ208は、ナビゲータ120に自律式車両の作動点の新しい推定値を直列インターフェイス210を介して与える。
本発明は、車両が動いているかどうかによって異なるカルマンフィルタを用いる。車両が動いている場合には、本発明は9状態のカルマンフィルタを用いて、車両の作動点を推定する。9状態のカルマンフィルタは、動く車両のよりすぐれたモデルを作る。この明細書のために、9状態のカルマンフィルタモデルは移動用カルマンフィルタモデルといわれる。好ましい実施例において、移動用カルマンフィルタモデルを用いて推定される状態は、推定される北の位置、推定される東の位置、推定される向き変更、推定される向き変更率、推定される速さ及び4GPS受信機測定値;推定される受信機判定北の位置、推定される受信機が判定する東の位置、推定される受信機が判定する北の速度、推定される受信機が判定する東の速度である。
車両が静止している場合には、本発明は、4状態カルマンフィルタを用いる。4状態カルマンフィルタは静止車両のよりすぐれたモデルを形成する。4状態カルマンフィルタモデルは、静止カルマンフィルタモデルといわれる。静止カルマンフィルタモデルを用いて推定される状態は、推定北の位置、推定東の位置、推定される受信機判定北の位置、および推定される受信機判定東の位置である。
車両が動かない(即ち静止状態)とき、フィルタモデルを変更することによって、カルマンフィルタは、センサーからのノイズの影響が不必要な測定値を与えることなく、より早く収束できる。例えば、速度の積分として位置がカルマンフィルタ内でモデル化される。積分の影響のために、速さ測定値の小さな誤差(例えばオフセット、移動等のために)のために位置の推定値の誤差が大きくなる。同様に、向き変更率計測値における小さな誤差のために向き変更推定値の誤差が大きくなる。カルマンフィルタは最終的に実際の作動点に収束されるときでさえ全体のシステムの応答がカルマンフィルタモデルを変更することによって高められる。
この場合、移動及び静止カルマンフィルタモデルは、静止モデルが移動モデルから状態の数を取り除くという点において異なる。好ましい実施例において、取り除かれる状態は、推定される受信機判定北の速度、推定される受信機判定東の速度、推定される向き変更、推定される向き変更率及び推定される速さである。最終的に、静止カルマンフィルタモデルは、静止車両をより正確にモデル化し、車両の作動点をより良好に推定することになる(静止の場合においては、結局車両の位置に等しくなる)。
車両が静止し始めると、本発明は、カルマンフィルタを移動カルマンフィルタモデルから静止カルマンフィルタモデルに切り変える。好ましい実施例においてオドメータは、車両が動いているか静止しているかを判定するのに用いられる。オドメータが、5回の連続したフィルタ更新に対してしきい値以下に変わる場合は、車両は停止していると考えられる。反対に、オドメータの計測値がいかなるフィルタ更新においてもしきい値よりも大きい値に変化する場合には、車両は動いていると考えられる。本分野の当業者であれば、他の方法を車両が静止しているか、又は動いているかを判定するのに用いてもよいことがわかる。例えば、カルマンフィルタから得られた車両速さの推定値は、しきい値に比較されたり、または異なる数の連続した更新を用いることができる。
好ましい実施例において、移動カルマンフィルタモデルから静止カルマンフィルタを用いることに変更することは、移動カルマンフィルタの最後の更新から得られた値(例えば、移動カルマンフィルタを用いるフィルタ)で静止カルマンフィルタ(例えば、静止カルマンフィルタモデルを用いるフィルタ)を初期化することによって達成される。例えば、静止カルマンフィルタにおける状態の初期値は、移動カルマンフィルタによって計算された最後の推定値である。先のフィルタの最後の推定値は、新しいフィルタを開始するのに最良の推定である。同様の推理が誤差共分散マトリックスに用いられる。ここで、状態の推定値の共分散を表す、移動カルマンフィルタの主対角線に沿った限界点は、静止カルマンフィルタの対角線共分散マトリックスを構成するのに用いられる。残ったマトリックスの値は、単位が減少するということを除いては、同じである。静止カルマンフィルタモデルから移動カルマンフィルタモデルに切り替えるとき、同じ処理が逆に用いられる。静止カルマンフィルタの共分散マトリックスの対角線の限界点は移動カルマンフィルタの共分散マトリックスの対角線を初期化するのに用いられる。残った5個の対角線限界点の値は、共分散マトリックスの初期値に対して本分野において公知である方法と類似した手段で選択される。
前述の記載は、図4に図示されており、段階314の処理をより詳細に表す。判定段階402において、TRUプロセッサ208は車両が動いているかどうかを判定する。好ましい実施例において、TRUプロセッサは、図3に示した処理ループを通して少なくとも5回の、しきい値以下であるオドメータ内における変化を捜す。TRUプロセッサ208が、車両が動いていないことを判定する場合には、TRUプロセッサはカルマンフィルタが判定段階404において初期化される必要あるかどうかを判定する。TRUプロセッサ208が、段階402の前に車両状態が移動状態から非移動状態に変更したことを判定する場合に、カルマンフィルタを初期化しなければならない。カルマンフィルタが初期化されるべきである場合には、TRUプロセッセ208は、上述したように、段階406において静止カルマンフィルタを初期化する。次に、段階408において、TRUプロセッサ208は、GPS受信機測定値のみを用いて、カルマンフィルタを更新する。段階410において、TRUプロセッサ208は、更新されたカルマンフィルタを用いて車両の作動点を推定する。
TRUプロセッサ208が、車両が動くことを判定すると、TRUプロセッサは、カルマンフィルタが判定段階412において初期化される必要があるかを判定する。TRUプロセッサ208が、段階402の前に車両状態が非移動から移動段階に変わったことを判定した場合には、カルマンフィルタは初期化されなければならない。カルマンフィルタが初期化される必要がある場合には、TRUプロセッサ208は、上述したように段階414において移動カルマンフィルタを初期化する。次に段階416において、TRUプロセッサ208は、GPS受信機測定値と、オドメータ230、ドプラ対地速度インジケータ232、向き変更率センサー234、及びかじ取りリゾルバ236から受け取られた測定値の双方を用いてカルマンフィルタを更新する。段階410において、TRUプロセッサ208は更新されたカルマンフィルタを用いて車両の作動点を推定する。
本発明は、いくつかの好ましい実施例を参照して部分的に示し、説明してきたが、本発明の当業者であれば、添付の請求の範囲に定義されているように本発明の精神と範囲から逸脱することなく、形態と詳細において様々な変更を行なえることがわかる。
Claims (3)
- 陸ベース車両の作動点を正確に求めるためのコンピュータベースのシステム(100)であって、
衛星ベース位置システム(218)から航法信号を受信し、該航法信号を用いて車両の受信機判定位置を求めるための、前記車両に取付けられた受信機手段(216)と、
前記車両の少なくとも一つの動的パラメータを計測するセンサー手段(230,232,234,236)と、
前記受信機判定位置と前記センサー手段(230,232,234,236)からの少なくとも一つの動的パラメータとを組み合わせて、推定される位置を含む前記作動点を求めるためのカルマンフィルタ手段(208)と、
が設けられており、
前記カルマンフィルタ手段(208)は、前記センサー手段(230,232,234,236)が、前記車両が静止状態であることを示すときに静止カルマンフィルタモデルに変わり、前記センサー手段(230,232,234,236)が前記車両が動いていることを示すときに移動カルマンフィルタモデルに変わる手段を有し、前記受信機判定位置の適時性に影響を及ぼすような、前記受信機手段に関連したタイムラグをモデル化する手段を含むものであり、
前記カルマンフィルタ手段(208)は、前記モデル化手段と前記受信機判定位置とを用いて改善された推定位置を形成するようになっていることを特徴とするコンピュータベースのシステム(100)。 - 陸ベース車両の作動点を正確に求めるためのコンピュータベースのシステム(100)であって、
衛星ベース位置システム(218)から航法信号を受信し、該航法信号を用いて車両の受信機判定位置を求めるための、前記車両に取付けられた受信機手段(216)と、
前記車両の少なくとも一つの動的パラメータを計測するセンサー手段(230,232,234,236)と、
前記受信機判定位置と前記センサー手段(230,232,234,236)からの少なくとも一つの動的パラメータとを組み合わせて、推定される位置を含む前記作動点を求めるためのカルマンフィルタ手段(208)と、
が設けられており、
前記カルマンフィルタ手段(208)は、前記センサー手段(230,232,234,236)が前記車両が静止状態であることを示すときに前記作動点の良好な判定が得られるように、推定された受信機判定北の位置と、推定された受信機判定東の位置と、前記推定される北の位置および東の位置を含むカルマンフィルタ状態を含む静止カルマンフィルタモデルに変わる手段と、前記センサー手段(230,232,234,236)が前記車両が動いていることを示すときに、推定された受信機判定北の位置と、推定された受信機判定東の位置と、推定された受信機判定北の速度と、推定された受信機判定東の速度と、前記推定北の位置と、前記推定東の位置と、推定向き変更と、推定向き変更率及び推定速さを含むカルマンフィルタ状態を含む移動カルマンフィルタモデルに変わる手段とを含んでいることを特徴とするコンピュータベースのシステム(100)。 - 陸ベース車両の作動点を正確に求めるためのコンピュータベースのシステム(100)であって、
衛星ベース位置システム(218)から航法信号を受信し、該航法信号を用いて車両の受信機判定位置を求めるための、前記車両に取付けられた受信機手段(216)と、
前記車両の少なくとも一つの動的パラメータを計測するセンサー手段(230,232,234,236)と、
前記受信機判定位置と前記センサー手段(230,232,234,236)からの少なくとも一つの動的パラメータとを組み合わせて、推定される位置を含む前記作動点を求めるためのカルマンフィルタ手段(208)と、
が設けられており、
前記カルマンフィルタ手段(208)は、前記センサー手段(230,232,234,236)が前記車両が静止状態であることを示すときに前記作動点の良好な判定が得られるように、推定された受信機判定北の位置と、推定された受信機判定東の位置と、前記推定される北の位置および東の位置を含むカルマンフィルタ状態を含む静止カルマンフィルタモデルに変わる手段と、前記センサー手段(230,232,234,236)が前記車両が動いていることを示すときに、推定された受信機判定北の位置と、推定された受信機判定東の位置と、推定された受信機判定北の速度と、推定された受信機判定東の速度と、前記推定北の位置と、前記推定東の位置と、推定向き変更と、推定向き変更率及び推定速さを含むカルマンフィルタ状態を含む移動カルマンフィルタモデルに変わる手段とを含んでおり、さらに前記カルマンフィルタ手段(208)は、前記受信機手段(216)に対応するタイムラグが前記受信機判定位置に及ぼす影響を判定し、モデル化する手段を含んでおり、
前記受信機手段(216)は、前記車両の受信機判定速度も求めるようになっており、
前記カルマンフィルタ手段(208)が、前記受信機判定位置と、前記センサー手段(230,232,234,236)及び前記受信機判定速度を組み合わせて前記作動点を求めるようになっているものであることを特徴とするコンピュータベースのシステム(100)。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US32786494A | 1994-10-24 | 1994-10-24 | |
US08/327,864 | 1994-10-24 | ||
PCT/US1995/012828 WO1996012973A1 (en) | 1994-10-24 | 1995-10-13 | System and method for precisely determining an operating point for an autonomous vehicle |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH09507581A JPH09507581A (ja) | 1997-07-29 |
JP3837160B2 true JP3837160B2 (ja) | 2006-10-25 |
Family
ID=23278406
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP51395496A Expired - Fee Related JP3837160B2 (ja) | 1994-10-24 | 1995-10-13 | 陸ベース車両の作動点を正確に求めるためのコンピュータベースのシステム |
Country Status (8)
Country | Link |
---|---|
EP (1) | EP0737320B1 (ja) |
JP (1) | JP3837160B2 (ja) |
BR (1) | BR9506721A (ja) |
CA (1) | CA2176000A1 (ja) |
DE (1) | DE69518224T2 (ja) |
MX (1) | MX9602434A (ja) |
WO (1) | WO1996012973A1 (ja) |
ZA (1) | ZA957639B (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10634777B2 (en) | 2018-05-30 | 2020-04-28 | Ford Global Technologies, Llc | Radar odometry for vehicle |
Families Citing this family (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5906655A (en) * | 1997-04-02 | 1999-05-25 | Caterpillar Inc. | Method for monitoring integrity of an integrated GPS and INU system |
US7228230B2 (en) | 2004-11-12 | 2007-06-05 | Mitsubishi Denki Kabushiki Kaisha | System for autonomous vehicle navigation with carrier phase DGPS and laser-scanner augmentation |
DE102005058628B4 (de) * | 2005-12-07 | 2015-10-22 | Götting KG | Navigationssystem für ein Mobil mit einem Zugfahrzeug und einem Anhänger/Auflieger |
US7643939B2 (en) * | 2006-03-08 | 2010-01-05 | Honeywell International Inc. | Methods and systems for implementing an iterated extended Kalman filter within a navigation system |
SE530874C2 (sv) * | 2007-02-14 | 2008-09-30 | Atlas Copco Rock Drills Ab | Anordning och metod för positionsbestämning av en gruv- eller anläggningsmaskin |
JP5398120B2 (ja) * | 2007-03-22 | 2014-01-29 | 古野電気株式会社 | Gps複合航法装置 |
JP2008249396A (ja) * | 2007-03-29 | 2008-10-16 | Brother Ind Ltd | 移動局の静止判定を利用した位置検出システム |
US8024119B2 (en) | 2007-08-14 | 2011-09-20 | Honeywell International Inc. | Systems and methods for gyrocompass alignment using dynamically calibrated sensor data and an iterated extended kalman filter within a navigation system |
DE102008011947A1 (de) * | 2008-02-29 | 2009-09-03 | Robert Bosch Gmbh | Roboterfahrzeug sowie Ansteuerverfahren für ein Roboterfahrzeug |
US8390510B2 (en) * | 2009-09-16 | 2013-03-05 | Qualcomm Incorporated | Methods and apparatuses for affecting application of a filtering model using carrier phase |
JP5017392B2 (ja) * | 2010-02-24 | 2012-09-05 | クラリオン株式会社 | 位置推定装置および位置推定方法 |
JP5602070B2 (ja) * | 2011-03-15 | 2014-10-08 | 三菱電機株式会社 | 位置標定装置、位置標定装置の位置標定方法および位置標定プログラム |
US8954241B2 (en) * | 2012-08-10 | 2015-02-10 | Caterpillar Inc. | Mining truck spotting under a shovel |
SE538082C2 (sv) * | 2013-11-21 | 2016-03-01 | Scania Cv Ab | Systemkonfiguration och förfarande för möjliggörande av autonom drift av ett fordon |
CN103674024A (zh) * | 2013-11-28 | 2014-03-26 | 卡斯柯信号有限公司 | 基于多普勒雷达和编码里程计的列车组合定位*** |
US10001566B2 (en) | 2013-11-29 | 2018-06-19 | Clarion Co., Ltd. | Distance factor learning device, distance factor learning method and current position calculating device |
DE102015218810A1 (de) | 2015-09-29 | 2017-03-30 | Continental Teves Ag & Co. Ohg | Verfahren zum Auswählen von Lokalisierungsalgorithmen in einem Fahrzeug |
JP6712037B2 (ja) * | 2017-01-27 | 2020-06-17 | 株式会社FADrone | 慣性計測方法と慣性計測装置及び慣性計測プログラム |
CN108115727A (zh) * | 2017-12-19 | 2018-06-05 | 北斗七星(重庆)物联网技术有限公司 | 一种安防机器人巡防的方法、装置及*** |
JP6625295B1 (ja) * | 2018-03-02 | 2019-12-25 | 三菱電機株式会社 | 目標監視装置および目標監視システム |
DE102018206828A1 (de) | 2018-05-03 | 2019-11-07 | Continental Teves Ag & Co. Ohg | Von der Fahrzeuggeschwindigkeit abhängiges Verfahren zum Bestimmen der Position eines Fahrzeugs |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB2158965B (en) * | 1984-05-16 | 1988-05-18 | Gen Electric Co Plc | Driverless vehicle |
CA1321418C (en) * | 1988-10-05 | 1993-08-17 | Joseph C. Mcmillan | Primary land arctic navigation system |
-
1995
- 1995-09-12 ZA ZA957639A patent/ZA957639B/xx unknown
- 1995-10-13 JP JP51395496A patent/JP3837160B2/ja not_active Expired - Fee Related
- 1995-10-13 WO PCT/US1995/012828 patent/WO1996012973A1/en active IP Right Grant
- 1995-10-13 EP EP95935724A patent/EP0737320B1/en not_active Expired - Lifetime
- 1995-10-13 BR BR9506721A patent/BR9506721A/pt not_active Application Discontinuation
- 1995-10-13 MX MX9602434A patent/MX9602434A/es unknown
- 1995-10-13 DE DE69518224T patent/DE69518224T2/de not_active Expired - Fee Related
- 1995-10-13 CA CA002176000A patent/CA2176000A1/en not_active Abandoned
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10634777B2 (en) | 2018-05-30 | 2020-04-28 | Ford Global Technologies, Llc | Radar odometry for vehicle |
Also Published As
Publication number | Publication date |
---|---|
DE69518224T2 (de) | 2001-03-29 |
DE69518224D1 (de) | 2000-09-07 |
WO1996012973A1 (en) | 1996-05-02 |
EP0737320A1 (en) | 1996-10-16 |
EP0737320B1 (en) | 2000-08-02 |
BR9506721A (pt) | 1997-09-23 |
MX9602434A (es) | 1997-02-28 |
CA2176000A1 (en) | 1996-05-02 |
JPH09507581A (ja) | 1997-07-29 |
ZA957639B (en) | 1996-05-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3837160B2 (ja) | 陸ベース車両の作動点を正確に求めるためのコンピュータベースのシステム | |
US5877723A (en) | System and method for determining an operating point | |
KR101311590B1 (ko) | 운동 모델에 기초한 혼성형 관성 항법 시스템 | |
US6643587B2 (en) | Navigation system and method for tracking the position of an object | |
US5906655A (en) | Method for monitoring integrity of an integrated GPS and INU system | |
Huang et al. | A low-order DGPS-based vehicle positioning system under urban environment | |
Yang et al. | Magnetometer and differential carrier phase GPS-aided INS for advanced vehicle control | |
US20200025572A1 (en) | Navigation system utilizing yaw rate constraint during inertial dead reckoning | |
US5784029A (en) | Recognition of and method and apparatus for GPS antenna lever arm compensation in integrated GPS/dead reckoning navigation systems | |
US7640102B2 (en) | Self-tuning apparatus of vehicle speed pulse coefficient and method thereof | |
Carlson et al. | Practical position and yaw rate estimation with GPS and differential wheelspeeds | |
CN113029139B (zh) | 基于运动检测的机场飞行区车辆差分北斗/sins组合导航方法 | |
Carlson et al. | Error sources when land vehicle dead reckoning with differential wheelspeeds | |
CN115060257B (zh) | 一种基于民用级惯性测量单元的车辆变道检测方法 | |
Barshan et al. | Orientation estimate for mobile robots using gyroscopic information | |
CN110864688A (zh) | 一种用于车载方位开环水平姿态角闭环的航姿方法 | |
KR100308572B1 (ko) | 자이로와 가속도계를 이용한 경사각 및 차량속도 검출장치 | |
Dissanayake et al. | A new algorithm for the alignment of inertial measurement units without external observation for land vehicle applications | |
Yang et al. | High-accuracy, high-frequency differential carrier phase GPS aided low-cost INS | |
CN112406861B (zh) | 利用地图数据进行卡尔曼滤波器参数选择的方法和装置 | |
Wada et al. | Nonlinear filter road vehicle model development | |
WO2023218526A1 (ja) | 移動体測位装置 | |
Chowdhary et al. | Improving GPS location availability and reliability by using a suboptimal, low-cost MEMS sensor set | |
Bétaille et al. | Vehicles Modeling and Multi-Sensor Smoothing Techniques for Post-Processed Vehicles Localisation | |
Jilani | Topic 02: Sensor Fusion Techniques for Autonomous Driving Applications |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20040803 |
|
A601 | Written request for extension of time |
Free format text: JAPANESE INTERMEDIATE CODE: A601 Effective date: 20041104 |
|
A602 | Written permission of extension of time |
Free format text: JAPANESE INTERMEDIATE CODE: A602 Effective date: 20041220 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20050203 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20060104 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20060310 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20060509 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20060601 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20060718 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20060731 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
LAPS | Cancellation because of no payment of annual fees |