JP5806207B2 - 可動機械用の位置監視システム - Google Patents

可動機械用の位置監視システム Download PDF

Info

Publication number
JP5806207B2
JP5806207B2 JP2012508500A JP2012508500A JP5806207B2 JP 5806207 B2 JP5806207 B2 JP 5806207B2 JP 2012508500 A JP2012508500 A JP 2012508500A JP 2012508500 A JP2012508500 A JP 2012508500A JP 5806207 B2 JP5806207 B2 JP 5806207B2
Authority
JP
Japan
Prior art keywords
signal
received
value
controller
position signal
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
Application number
JP2012508500A
Other languages
English (en)
Other versions
JP2012525587A (ja
Inventor
マイケル ドネリ アロン
マイケル ドネリ アロン
ローレンス コールセン クレイグ
ローレンス コールセン クレイグ
エル.ストラットン ケネス
エル.ストラットン ケネス
ストラブル ジョシュア
ストラブル ジョシュア
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.)
Caterpillar Inc
Original Assignee
Caterpillar Inc
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 Caterpillar Inc filed Critical Caterpillar Inc
Publication of JP2012525587A publication Critical patent/JP2012525587A/ja
Application granted granted Critical
Publication of JP5806207B2 publication Critical patent/JP5806207B2/ja
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/20Monitoring the location of vehicles belonging to a group, e.g. fleet of vehicles, countable or determined number of vehicles
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining 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/42Determining position
    • G01S19/48Determining 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/49Determining 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)
  • Navigation (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Description

本開示は、概して位置監視システムに関し、より詳細には、可動機械用の位置監視システムに関する。
土木機械等の可動機械において、位置を監視し機械の移動を案内する位置監視システムが採用されてきた。通常の位置監視システムは、複数のGPS(全地球測位システム)衛星から位置データを受信するように可動機械に搭載されている、GPS受信機を含む。状況によっては、たとえば、機械がトンネル内を移動している時、GPS信号が受信できなくなる場合がある。こうした状況では、GPSシステムを補完し、可動機械のための位置データを提供するために、慣性航法システムを採用することができる。こうした慣性航法システムは、通常、速度センサ、加速度センサ、ジャイロスコープ等、さまざまな慣性センサを有している。
2008年5月8日に公開されたTakaoka他による(特許文献1)(’166公開公報)に、ナビゲーション装置が記載されている。’166公開公報のナビゲーション装置は、GPS信号を受信し処理するGPS処理部と加速度センサとを有している。GPS信号が受信できなくなると、加速度センサによって提供される加速度信号と、GPS信号が受信できなくなる前に先に受信されたGPS信号からさまざまなパラメータを学習する演算処理装置の学習部によって提供される学習結果とに基づいて、位置データが計算される。
米国特許出願公開第2008/0109166A1号明細書
’166公開公報のナビゲーション装置は、GPS信号が受信できなくなった時に自律位置データを提供することができるが、そのナビゲーション装置には問題がある可能性がある。たとえば、GPS処理部および加速度センサの少なくとも一方が誤動作し誤った位置データを提供する可能性があり、’166公開公報のナビゲーション装置は、こうした誤動作を診断し検出することができない可能性がある。
本開示は、既存の技術における改善に関する。
一態様では、本開示はシステムに関する。本システムは可動機械を有し、可動機械は、通信装置と可動機械に関連付けられた位置監視システムとを有する。位置監視システムは、測位衛星から位置データを受信するとともに、受信された位置データに基づいて位置信号を生成するように構成された受信機を有する。受信機は、可動機械に搭載されている。位置監視システムはまた、センサを有し、可動機械の移動に関連するパラメータを測定するとともに、測定されたパラメータに基づいて移動信号を生成するように構成された慣性航法装置も有する。慣性航法装置は、可動機械に搭載されている。位置監視システムはまた、受信機および慣性航法装置に関連付けられたコントローラも有する。コントローラは、位置信号が受信可能である場合に位置信号を受信し、移動信号を受信し、位置信号が受信できないことを検出するように構成されている。コントローラはまた、受信された移動信号と、位置信号が受信できないことを検出する前に受信された位置信号とに基づいて、可動機械に対する位置パラメータを計算し、位置信号から確定されたパラメータの第1値と移動信号から確定された同じパラメータの第2値との差が所定閾値を超えるか否かを確定し、差が所定閾値を超えると確定した後に警報信号を生成するようにも構成されている。本システムはまた、中央制御ステーションも有し、それは、通信装置を介してコントローラと通信し、通信装置を介して位置信号および/または移動信号を受信し、可動機械の位置を監視するように構成されている。
別の態様では、本開示はシステムに関する。本システムは可動機械を有し、可動機械は、通信装置と可動機械に関連付けられた位置監視システムとを有する。位置監視システムは、測位衛星から位置データを受信するとともに、受信された位置データに基づいて位置信号を生成するように構成された受信機を有する。受信機は、可動機械に搭載されている。位置監視システムはまた、センサを有し、可動機械の移動に関連するパラメータを測定するとともに、測定されたパラメータに基づいて移動信号を生成するように構成された慣性航法装置も有する。慣性航法装置は、可動機械に搭載されている。位置監視システムはまた、受信機および慣性航法装置に関連付けられたコントローラも有する。コントローラは、位置信号が受信可能である場合に位置信号を受信し、移動信号を受信し、位置信号が受信できないことを検出するように構成されている。コントローラはまた、受信された移動信号と、位置信号が受信できないことを検出する前に受信された位置信号とに基づいて、可動機械に対する位置パラメータを計算し、位置信号から確定されたパラメータの第1値と移動信号から確定された同じパラメータの第2値との差が所定閾値を超えるか否かを確定し、差が所定閾値を超えると確定した後に警報信号を生成するようにも構成されている。本システムはまた、中央制御ステーションも有し、それは、通信装置を介してコントローラと通信し、通信装置を介して位置信号および/または移動信号を受信し、可動機械の位置を監視するように構成されている。位置監視システムは、可動機械の移動に関連する位置データを提供するように構成された地上ベース測位システムをさらに有する。コントローラは、同じパラメータの第3値を計算し、同じパラメータの第1値、第2値および第3値を比較し、第1値、第2値および第3値のうちの任意の1つと、第1値、第2値および第3値のうちの残りの2つとの差が、所定閾値を超えるか否かを確定するようにさらに構成されている。コントローラは、自己診断が行われるべきか否かを確定するとともに、自己診断が行われた後に、かつ第1値、第2値および第3値のうちの任意の1つと第1値、第2値および第3値のうちの残りの2つとの差が所定閾値を超えていないことを確定した後に、受信された位置信号を最後の位置信号として保存するようにさらに構成されている。
例示的な位置監視システムを有する例示的な開示されているシステムの概略図である。 図1の開示されている位置監視システムの例示的な動作の概略図である。 図1の開示されている位置監視システムの例示的な動作の概略図である。 図1の開示されている位置監視システムの例示的な動作の概略図である。
図1は、例示的なシステム10の概略図である。システム10を、採掘現場および工事現場等における可動機械管理等、多種多様の応用で採用することができる。システム10はネットワーク化された作業現場であってもよい。システム10は、少なくとも1つの可動機械20を含むことができる。システム10はまた、たとえば有線手段または無線手段を介して可動機械20に信号を送信しかつ可動機械20から信号を受信することにより、可動機械20と通信するように構成された、中央制御ステーション30を有することができる。中央制御ステーション30を、作業現場に配置してもよく、または遠隔に配置してもよい。
システム10は、位置監視システム50を有することができ、それは、可動機械20および/または中央制御ステーション30のための位置データを提供するように構成された少なくとも1つの測位システムまたは装置を有することができる。たとえば、位置監視システム50は全地球測位システム(GPS)45を有することができ、それは、少なくとも1つのGPS衛星40と通信するように構成されている受信機55を有することができる。受信機55を、可動機械20に搭載することができ、GPS衛星40から位置データを受信するように構成することができる。受信機55は、受信されたGPS位置データに基づいて測位信号を生成することができる。受信機55はまた、GPS衛星40に信号を送信することも可能であることが企図されている。たとえば可動機械20がトンネル内を移動している時、衛星40からのGPS信号が受信機55によって受信できなくなった場合、たとえば受信機55により、GPS信号が受信できないことを示す信号を生成することができる。
位置監視システム50はまた、可動機械20の位置を監視する少なくとも1つまたは複数の追加の測位システムを有することができる。たとえば、位置監視システム50は慣性航法装置60を有することができる。
慣性航法装置60を、可動機械20に搭載することができる。慣性航法装置60は、可動機械20の移動に関連する1つまたは複数のパラメータを測定するように構成された1つまたは複数のセンサを有することができる。一実施形態では、図1に示すように、慣性航法装置60は、速度センサ61、加速度センサ62および操舵方向センサ63を有することができる。速度センサ61を、可動機械20の速度を測定するように構成することができる。加速度センサ62を、可動機械20の加速度を測定するように構成することができる。操舵方向センサ63を、可動機械20の操舵または移動方向を測定するように構成することができる。慣性航法装置60は、他のタイプのセンサを有することができ、より多いかまたは少ないセンサを有することができることが企図されている。たとえば、いくつかの実施形態では、慣性航法装置60は速度センサ61を有していなくてもよい。いくつかの実施形態では、慣性航法装置60は、可動機械20の位置の高度を測定するように構成された気圧計、可動機械20の移動距離を測定するように構成された走行距離計等の追加のセンサを有することができる。いくつかの実施形態では、慣性航法装置60はジャイロスコープを有することができ、それは、構成要素として加速度センサ62を有することができる。
いくつかの実施形態では、位置監視システム50は、可動機械20の位置、速度、加速度、高度、角速度、ピッチレート等の移動パラメータを確定するように構成された地上ベース測位システム75をさらに有することができる。地上ベース測位システム75は、たとえばレーザベースの測位システム等、任意の好適な地上ベース測位システムであってもよい。地上ベース測位システム75は、ステーション80、受信装置95および複数の装置90を有することができる。ステーション80を、信号を発信しかつ/または受信するように構成することができ、受信装置95および装置90の少なくとも一方と通信するように構成することができる。
受信装置95を、ステーション80から信号を受信するように可動機械20に搭載することができる。装置90は、センサ、発信機または受信機であってもよく、装置90を、地上のさまざまな位置に配置することができる。装置90は、受信装置95および/またはステーション80と通信して、可動機械20の移動パラメータを確定することができる。地上ベース測位システム75は、中央制御ステーション30と通信することができる。たとえば、ステーション80、装置90および受信装置95のうちの少なくとも1つは、中央制御ステーション30に測定された移動パラメータを送信することができる。中央制御ステーション30はまた、ステーション80、装置90および受信装置95のうちの少なくとも1つにコマンド信号を送信することも可能である。地上ベース測位システム75は、たとえばレーザ地上ベース測位システム等、任意の好適な地上ベースシステムであってもよく、より多いか少ない構成要素を含むことができることが企図されている。
位置監視システム50は、コントローラ65を有することができる。コントローラ65を、可動機械20に搭載することができ、または他の好適な位置、たとえば中央制御ステーション30に配置することができる。可動機械20は、中央制御ステーション30と通信するように構成されている通信装置70を有することができる。コントローラ65は、可動機械20に搭載された既存のマシンコントローラかまたはスタンドアロンコントローラであってもよい。コントローラ65は、さまざまなシステムおよび装置、たとえば、受信機55、通信装置70および慣性航法装置60のうちの少なくとも1つと通信することができる。コントローラ65はまた、ステーション80、装置90および受信装置95のうちの少なくとも1つと通信することも可能である。コントローラ65と他のシステムまたは装置との間の通信は、本技術分野において既知である有線手段または無線手段であり得る。図1に示すように、コントローラ65は、速度センサ61、加速度センサ62および/または操舵方向センサ63等、慣性航法装置60内に設けられているセンサと通信することができる。コントローラ65を、GPS信号が受信可能である時に受信機55によって生成される位置信号を受信するように構成することができる。GPS信号が受信機55によって受信できなくなると、コントローラ65もまた、GPS信号が受信できないことを示す、受信機55によって生成された信号を受信することができる。したがって、コントローラ65を、GPS信号が受信可能であることおよび/または受信不可能であることを検出するように構成することができる。
コントローラ65を、検知された移動パラメータに基づいて、速度センサ61、加速度センサ62および/または操舵方向センサ63によってそれぞれ生成され得る、可動機械20の速度、加速度および/または移動方向を示す信号等、慣性航法装置60によって生成される移動信号を受信するように構成することも可能である。コントローラ65は、受信された移動信号を処理して、可動機械20の位置に関連するパラメータを計算することができる。コントローラ65はまた、通信装置70を介して中央制御ステーション30からコマンド信号を受信することができる。逆に、コントローラ65は、可動機械20の位置を示す位置信号、警報信号等の信号を、通信装置70を介して中央制御ステーション30に送信することができる。
一実施形態では、コントローラ65を、地上ベース測位システム75によって生成される測位信号を受信するように構成することも可能である。一実施形態では、地上ベース測位システム75によって生成される測位信号を中央制御ステーション30に送信することができ、中央制御ステーション30は、その測位信号を、通信装置70を介してコントローラ65に送信することができる。一実施形態では、コントローラ65を、中央制御ステーション30内に配置することができ、コントローラ65は、中央制御ステーション30において地上ベース測位システム75から送信される測位信号を受信することができる。
開示した位置監視システム50の例示的な動作プロセスを、図2に示すフローチャートに概略的に示す。ステップ110において、位置監視システム50は、GPS信号が受信可能であるか否かを確定することができる。GPS信号が受信可能であるか否かの確定を、コントローラ65によって行うことができる。通常の動作状態で、すなわち、GPS信号が受信可能である場合、受信機55は、GPS衛星40から位置データを受信することができ、受信された位置データに基づいて位置信号を生成することができる。受信機55は、位置信号をコントローラ65に送信することができる。GPS信号が受信機55によって受信できなくなると、たとえば、可動機械20がトンネル内を移動している時、受信機55は、GPS信号が受信できないことを示す信号を生成することができ、受信することができないことを示す信号を、コントローラ65に送信することができる。したがって、コントローラ65は、受信機55によって生成された信号に基づいて、GPS信号が受信できないことを検出しまたは確定することができる。
GPS信号が受信可能である場合(ステップ110において、Yes)、位置監視システム50は、GPS航法モード(ステップ130)を実行して、たとえば可動機械20の移動のための位置データを提供することができる。GPS信号が受信できない場合(ステップ110において、No)、位置監視システム50は、慣性航法モード(ステップ120)を実行して、たとえば可動機械20の移動のための位置データを提供することができる。コントローラ65を、GPS信号の受信可能性の確定に基づいて慣性航法モード(第1航法モード)またはGPS航法モード(第2航法モード)を選択するように構成することができる。GPS航法モードおよび慣性航法モードの詳細については後述する。GPS航法モード(ステップ130)および慣性航法モード(ステップ120)のうちの一方を完了した後、位置監視システム50は、たとえばコントローラ65により、可動機械20の移動の案内または監視を継続すべきか否かを確定することができる(ステップ140)。コントローラ65が、可動機械20の移動の案内または監視を継続するように確定した場合(ステップ140において、Yes)、位置監視システム50は、ステップ110〜140でステップを継続することができる。コントローラ65が、可動機械20の移動の案内または監視を継続しないと確定した場合(ステップ140において、No)、位置監視システム50は、図2に示すプロセスを終了することができる。
図3は、図2に示すステップ120における慣性航法モードの例示的な動作プロセスを概略的に示す。例示的な慣性航法モードを、GPS信号が受信できない時に実行することができる。コントローラ65は、たとえば、メモリ等のデータ記憶装置から、先に保存されたGPS位置信号を検索することができる(ステップ210)。一実施形態では、保存されたGPS位置信号は、GPS信号が受信できないことを検出する前に最後に保存されたGPS位置信号を含むことができる。別法として、いくつかの実施形態では、保存されたGPS位置信号は、GPS信号が受信できないことを検出する前の複数の保存されたGPS位置信号を含むことができる。ステップ220において、可動機械20の移動に関連するパラメータを、慣性航法装置60の慣性センサによって測定することができる。移動信号を、測定された移動パラメータに基づいて慣性センサによって生成することができる(ステップ230)。たとえば、速度センサ61は、可動機械20の速度を測定し、測定された速度を示す信号を生成することができる。加速度センサ62は、可動機械20の加速度を測定し、測定された加速度を示す信号を生成することができる。操舵方向センサ63は、可動機械20の移動方向を測定し、測定された移動方向を示す信号を生成することができる。これらの信号を、慣性航法装置60から処理するためにコントローラ65に送信することができる(ステップ240)。慣性センサは、連続して、移動パラメータを測定し、測定されたパラメータを示す信号を生成することができ、または移動パラメータを測定し、所定時間間隔に従って信号を生成することができる。
さらに図3を参照すると、ステップ250において、コントローラ65は、慣性航法装置60の慣性センサによって生成された移動信号と、GPS信号が受信できないことを検出した後に受信機55によって受信された、最後に保存されたGPS位置信号等、検索された保存GPS位置信号とに基づき、位置データを計算することができる。計算された位置データは、可動機械20の現在位置、および/または推定された移動方向、速度、加速度等、可動機械20の移動に関連する任意の好適なパラメータを含むことができる。計算された位置データを、可動機械20の移動を案内するために提供することができる(ステップ260)。たとえば、コントローラ65は、計算された位置データを、有線通信手段または無線通信手段を介して可動機械20のオペレータに、または通信装置70を介して中央制御ステーション30に位置する遠隔オペレータに提供することができる。
位置監視システム50は、ステップ260を完了した後、または別法としてステップ260を完了する前の任意の好適な時点で、GPS信号が受信可能であるか否かを監視することができる。位置監視システム50は、GPS信号が受信可能であるか否かを確定することができる(ステップ270)。GPS信号が依然として受信できない場合(ステップ270において、No)、位置監視システム50は、ステップ220〜270を実行することにより、慣性航法装置60を利用して可動機械20に対する位置データを提供し続けることができる。GPS信号が受信できない状況においてステップ220〜270が繰り返される場合、位置データの計算は、先に計算された位置データ、GPS信号が受信できないことを検出する前に保存された、検索されたGPS信号、および慣性センサによって目下測定された移動パラメータのうちの少なくとも1つに基づくことができる。GPS信号が受信可能となると(ステップ270において、Yes)、位置監視システム50は、図2のステップ130に示すGPS航法モードに進むことができ(ステップ280)、図3に示す慣性航法モードを終了することができる。
図4は、図2のステップ130に示す例示的なGPS航法モードを概略的に示す。この例示的なGPS航法モードでは、受信機55は、GPS衛星40からGPS位置データを受信することができる(ステップ300)。受信機55は、受信されたGPS位置データに基づいてGPS位置信号を生成することができる(ステップ310)。GPS位置信号を、受信機55からコントローラ65に送信することができる。コントローラ65は、受信機55から送信されたGPS位置信号を受信し、自己診断が実行されるべきか否かを確定することができる(ステップ315)。コントローラ65は、自己診断が実行されるべきではないと確定した場合(ステップ315において、No)、受信されたGPS位置信号を処理し、受信されたGPS位置信号を保存する。一実施形態では、コントローラ65は、受信されたGPS位置信号を、最後に受信されたGPS信号として保存することができる(ステップ320)。自己診断を実行するべきか否かを確定するために、コントローラ65は、可動機械20のオペレータから、または中央制御ステーション30のオペレータから入力を受け取ることができることが企図される。自己診断が実行されるべきでない場合(ステップ315において、No)、GPS位置信号を、たとえば中央制御ステーション30にさらに提供することができ、または可動機械20の移動を案内するためにコントローラ65によってさらに処理することができる(ステップ325)。ステップ320の前にステップ325を実行することができることが企図される。図4に示す実施形態では、ステップ325が完了した後、GPS航法モードを終了することができる。GPS航法モードが終了した後、位置監視システム50は、図1に示すステップ140を実行することができる。
さらに図4を参照すると、コントローラ65は、自己診断が実行されるべきであると確定した場合(ステップ315において、Yes)、受信されたGPS位置信号に基づいてパラメータCの第1値を計算することができる(ステップ330)。パラメータCは、受信されたGPS位置信号と慣性センサによって生成された移動信号とに基づいて計算することができる任意の好適なパラメータであり得る。たとえば、パラメータCは、可動機械20の現在位置、または可動機械20の移動の速度、加速度および/または操舵方向であってもよい。
慣性航法装置60は、1つまたは複数の慣性センサによって、可動機械20の移動に関連するパラメータを測定することができる(ステップ335)。たとえば、速度センサ61は、可動機械20の速度を測定することができ、加速度センサ62は、可動機械20の加速度を測定することができ、操舵方向センサ63は、可動機械20の操舵方向または移動方向を測定することができる。慣性航法装置60は、測定された移動パラメータを示す移動信号を生成することができ、移動信号をコントローラ65に送信することができる(ステップ340)。コントローラ65は、慣性航法装置60によって生成された移動信号を受信しかつ処理することができる。コントローラ65は、受信された移動信号に基づいて同じパラメータCの第2値を計算することができる(ステップ345)。別法として、いくつかの実施形態では、慣性航法装置60は、慣性センサによって生成された移動信号を処理し、同じパラメータCの第2値を計算するように構成されたプロセッサを含むことができる。プロセッサによって計算された同じパラメータCの第2値を、ステップ330においてGPS信号に基づいて計算された同じパラメータCの第1値と比較するためにコントローラ65に送信することができる。
GPS位置信号に基づいて同じパラメータCの第1値を計算し(ステップ300)、移動信号に基づいて第2値を計算した(ステップ345)後、コントローラ65は、同じパラメータCの第1値と第2値との差を計算することができる(ステップ350)。コントローラ65は、差が所定閾値を超えるか否かを確定することができる(ステップ355)。たとえば、コントローラ65は、それぞれGPS位置信号に基づいて計算された可動機械20の位置と移動信号に基づいて計算された可動機械20の位置との差が、所定閾値を超えるか否かを確定することができる。その差が所定閾値を上回る場合(ステップ355において、Yes)、それは、たとえばGPS受信機55および慣性航法装置60のうちの一方の誤動作を示す場合があり、コントローラ65は、自己診断が継続され繰り返されるべきであるか否かを確定することができる。コントローラ65、可動機械20のオペレータ、または中央制御ステーション30のオペレータが、自己診断を継続するように確定した場合、ステップ330〜355を繰り返すことができる。自己診断が継続されるべきでないと確定された場合(ステップ365において、No)、コントローラ65は、警報信号を生成することができ(ステップ370)、警報信号を、通信装置70を介して中央制御ステーション30に送信することができる(ステップ375)。警報信号が中央制御ステーション30に送信された後、GPS航法モードを終了することができる。警報信号は、GPS受信機55または慣性航法装置60のうちの少なくとも一方が正常に機能していない可能性があり、さらなる診断、修理または交換が必要である可能性があることを示すことができる。
ステップ355を参照すると、同じパラメータCの第1値と第2値との差が所定閾値を超えない場合(ステップ355において、No)、コントローラ65は、受信されたGPS位置信号を、たとえば、メモリ等の記憶装置に保存することができる(ステップ360)。一実施形態では、コントローラ65は、受信されたGPS位置信号を最後に受信されたGPS信号として保存することができる。受信されたGPS位置信号を、可動機械20の移動を案内するために提供することができる(ステップ325)。たとえば、受信されたGPS位置信号を、通信装置70を介して中央制御ステーション30に送信することができ、または可動機械20に搭載されているディスプレイに表示することができる。ステップ325が完了した後、GPS航法モードを終了することができる。
いくつかの実施形態では、可動機械20の位置を監視するために、GPS45、慣性航法装置60および地上ベース測位システム75のすべてを合わせて採用することができる。たとえば、中央制御ステーション30またはコントローラ65は、GPS45、慣性航法装置60および地上ベース測位システム75の各々によって生成される位置データを受信することができ、受信された位置データに基づいて、1つまたは複数のシステムが正常に動作していないか否かを診断することができる。コントローラ65は、地上ベース測位システム75によって生成される位置データに基づいて同じパラメータCの第3値を計算することができる。コントローラ65は、GPS45、慣性航法装置60および地上ベース測位システム75のすべてによって提供される位置データを用いて、自己診断が行われるべきか否かを確定することができる。自己診断を、第1値、第2値および第3値に基づいて行うことができる。コントローラ65は、同じパラメータCの第1値、第2値および第3値を比較し、第1値、第2値および第3値のうちの任意の1つと、第1値、第2値および第3値のうちの残りの2つとの間との差が所定閾値を超えるか否かを確定することができる。たとえば、第2値および第3値が互いに近い場合、かつ第1値と第2値および第3値との差が所定閾値を超える場合、コントローラ65は、第1値が間違っているかまたは無効である可能性があると確定することができる。これは、GPS45が正常に動作していない可能性があり、受信機55によって提供される位置データが、可動機械20の移動を監視し案内するために信頼できない可能性があることを示すことができる。こうした状況では、GPS信号が、たとえばGPS信号が受信できないために無効である場合、慣性航法装置60および地上ベース測位システム75のうちの少なくとも一方が、可動機械20の移動を監視し案内するために位置データを提供することができる。一方で、同じパラメータCの第1値、第2値および第3値間の差が所定閾値内である場合、それは、GPS45、慣性航法装置60および地上ベース測位システム75のすべてが正常に動作しており、GPSシステム45、慣性航法装置60および地上ベース測位システム75の各々によって提供される位置データを、可動機械20の移動を案内するために用いることができることを示すことができる。コントローラ65は、自己診断が行われた後、かつ第1値、第2値および第3値のうちの任意の1つと第1値、第2値および第3値のうちの残りの2つとの差が所定閾値を超えないと確定した後、受信されたGPS位置信号を最後のGPS位置信号として保存することができる。これにより、可動機械20を案内するために提供される位置データの正確さを確実にすることができる。
開示した位置監視システムを、任意の可動機械においてその可動機械の位置を監視しかつ/または移動を案内するために採用することができる。慣性航法装置および地上ベース測位システムのうちの少なくとも一方が、GPS位置信号が受信できない時に可動機械の移動を案内するための位置データを提供することができる。GPS位置信号が受信可能である場合、慣性航法装置および地上ベース測位システムのうちの少なくとも一方を使用して、GPS信号が有効であるか否かを検証することができる。自動自己診断を定期的に実行することにより、慣性航法装置および地上ベース測位システムのうちの少なくとも一方によって提供されるGPS信号および/または他の測位信号の有効性を確実にすることができる。一方で、自己診断はまた、任意の測位システムが適切に機能していないか否かを示すことも可能である。開示した位置測定システムは、可動機械20の位置監視の信頼性および品質を向上させることができる。
当業者には、開示した位置測定システムにおいてさまざまな変更および変形を行うことができることが明らかとなろう。本明細書における開示した実施形態の仕様および実施を考慮することにより、当業者には他の実施形態が明らかとなろう。仕様および例は、単に例示するものとして考慮され、本開示の真の範囲は以下の特許請求の範囲によって示されていることが意図されている。

Claims (4)

  1. システム(10)であって、
    可動機械(20)であって、通信装置(70)と可動機械に関連付けられた位置監視システム(50)とを有し、位置監視システムが、
    測位衛星(40)から位置データを受信するとともに、受信された位置データに基づいて位置信号を生成するように構成され、可動機械に搭載されている受信機(55)と、
    センサ(61、62、63)を有し、可動機械の移動に関連するパラメータを測定するとともに、測定されたパラメータに基づいて移動信号を生成するように構成され、可動機械に搭載されている慣性航法装置(60)と、
    受信機および慣性航法装置に関連付けられたコントローラ(65)であって、
    位置信号が受信可能である場合に位置信号を受信し、
    移動信号を受信し、
    位置信号が受信できないことを検出し、
    受信された移動信号と、位置信号が受信できないことを検出する前に受信された位置信号とに基づいて、可動機械に対する位置パラメータを計算し、
    位置信号から確定されたパラメータの第1値と移動信号から確定された同じパラメータの第2値との差が所定閾値を超えるか否かを確定し、
    差が所定閾値を超えると確定した後に警報信号を生成する
    ように構成されたコントローラ(65)と、
    を有する、可動機械(20)と、
    中央制御ステーション(30)であって、
    通信装置を介してコントローラと通信し、
    通信装置を介して位置信号および/または移動信号を受信し、
    可動機械の位置を監視する
    ように構成された中央制御ステーション(30)と、
    を具備し、
    位置監視システムが、可動機械の移動に関連する位置データを提供するように構成された地上ベース測位システム(75)をさらに有し、コントローラが、
    地上ベース測位システムから提供された位置データに基づいて同じパラメータの第3値を計算し、
    同じパラメータの第1値、第2値および第3値を比較し、
    第1値、第2値および第3値のうちの任意の1つと、第1値、第2値および第3値のうちの残りの2つとの差が、所定閾値を超えるか否かを確定し、
    差が所定閾値を超えると確定した後に、任意の1つが間違っているかまたは無効である可能性があると確定する
    ようにさらに構成される、
    コントローラが、位置信号から確定されたパラメータの第1値と移動信号から確定された同じパラメータの第2値との差が、所定閾値を超えないことを確定した後、位置信号を保存するように構成され、自己診断が行われるべきか否かを確定するとともに、自己診断が行われた後に、かつ差が所定閾値を超えていないことを確定した後に、受信された位置信号を最後の位置信号として保存するようにさらに構成される、
    システム。
  2. センサが、可動機械の速度を測定するように構成された速度センサ(61)、可動機械の加速度を測定するように構成された加速度センサ(62)、および可動機械の移動方向を測定するように構成された方向センサ(63)のうちの少なくとも1つを有する、請求項1に記載のシステム。
  3. コントローラが、測位衛星から受信された位置信号を、測位衛星から受信された最後の位置信号として保存し、受信された移動信号と位置信号が受信できないことが検出される前に受信された最後の位置信号とに基づき、位置パラメータを計算するようにさらに構成される、請求項1に記載のシステム。
  4. コントローラが、自己診断が行われるべきか否かを確定するとともに、自己診断が行われた後に、かつ第1値、第2値および第3値のうちの任意の1つと第1値、第2値および第3値のうちの残りの2つとの差が所定閾値を超えていないことを確定した後に、受信された位置信号を最後の位置信号として保存するようにさらに構成される、請求項1に記載のシステム。
JP2012508500A 2009-04-28 2010-03-29 可動機械用の位置監視システム Expired - Fee Related JP5806207B2 (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
US12/453,038 2009-04-28
US12/453,038 US8306726B2 (en) 2009-04-28 2009-04-28 Position monitoring system for a mobile machine
PCT/US2010/029009 WO2010129111A2 (en) 2009-04-28 2010-03-29 Position monitoring system for a mobile machine

Publications (2)

Publication Number Publication Date
JP2012525587A JP2012525587A (ja) 2012-10-22
JP5806207B2 true JP5806207B2 (ja) 2015-11-10

Family

ID=42992843

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2012508500A Expired - Fee Related JP5806207B2 (ja) 2009-04-28 2010-03-29 可動機械用の位置監視システム

Country Status (8)

Country Link
US (1) US8306726B2 (ja)
EP (1) EP2425275A4 (ja)
JP (1) JP5806207B2 (ja)
CN (1) CN102414578B (ja)
AU (1) AU2010245237B2 (ja)
BR (1) BRPI1007082A2 (ja)
CA (1) CA2759040A1 (ja)
WO (1) WO2010129111A2 (ja)

Families Citing this family (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9382797B2 (en) 2009-05-01 2016-07-05 The University Of Sydney Integrated automation system
PE20121020A1 (es) * 2009-05-01 2012-08-19 Univ Sydney Metodo para la generacion de una representacion de datos de una region geografica como un agregado a la conduccion de operaciones autonomas dentro de dicha region geografica
US7995482B2 (en) * 2009-06-08 2011-08-09 Alcatel-Lucent Usa Inc. Femto base stations and methods for operating the same
US9199616B2 (en) 2010-12-20 2015-12-01 Caterpillar Inc. System and method for determining a ground speed of a machine
US8457882B2 (en) * 2011-04-19 2013-06-04 Honeywell International Inc. Systems and methods for navigation in a GPS-denied environment
US8868304B2 (en) * 2012-02-10 2014-10-21 Deere & Company Method and stereo vision system for facilitating the unloading of agricultural material from a vehicle
CN104380143A (zh) 2012-06-18 2015-02-25 悉尼大学 用于处理地球物理数据的系统和方法
US9063211B2 (en) * 2012-08-31 2015-06-23 Autonomous Tractor Corporation Navigation system and method
JP2016536613A (ja) * 2013-09-20 2016-11-24 キャタピラー インコーポレイテッドCaterpillar Incorporated 無線周波数信号を用いた位置決めシステム
DE102014215570B4 (de) * 2014-08-06 2021-12-30 Elektrobit Automotive Gmbh Fahrzeugnavigationssystem
AU2016101951A4 (en) * 2015-08-04 2016-12-15 Commonwealth Scientific And Industrial Research Organisation Navigation of mining machines
CA2951515C (en) 2016-03-31 2019-12-31 Komatsu Ltd. Control system for work machine, work machine, and control method for work machine
WO2017177929A1 (zh) * 2016-04-12 2017-10-19 苏州宝时得电动工具有限公司 自动工作系统自移动设备及其控制方法
US10448555B2 (en) * 2016-05-27 2019-10-22 Cnh Industrial America Llc System and method for scouting vehicle mapping
CA3020322A1 (en) * 2017-12-13 2019-06-13 Matthew Usi Systems and methods for threshold detection of a wireless device
WO2019172874A1 (en) * 2018-03-05 2019-09-12 Reavire, Inc. Maintaining localization and orientation of an electronic headset after loss of slam tracking
FR3100066B1 (fr) * 2019-08-22 2021-07-23 Safran Electronics & Defense Detection d'une operation de leurrage d'un recepteur de signaux satellitaires
CN113970356A (zh) * 2021-10-29 2022-01-25 深圳市创鸿新智能科技有限公司 一种在智慧工地使用的设备物资监测系统

Family Cites Families (38)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5517419A (en) 1993-07-22 1996-05-14 Synectics Corporation Advanced terrain mapping system
JPH07286853A (ja) * 1994-04-15 1995-10-31 Nissan Motor Co Ltd 車両用位置検出装置
US5512904A (en) 1994-06-13 1996-04-30 Andrew Corporation Method and apparatus of establishing a vehicle azimuth
US5600329A (en) * 1995-06-30 1997-02-04 Honeywell Inc. Differential satellite positioning system ground station with integrity monitoring
US5657025A (en) 1995-08-07 1997-08-12 Litton Systems, Inc. Integrated GPS/inertial navigation apparatus providing improved heading estimates
JP3623568B2 (ja) * 1995-10-16 2005-02-23 株式会社ジッピーズ Gps受信機を用いた位置認識装置
GB9524754D0 (en) 1995-12-04 1996-04-24 Symmetricom Inc Mobile position determination
US6999779B1 (en) * 1997-02-06 2006-02-14 Fujitsu Limited Position information management system
US5877723A (en) 1997-03-05 1999-03-02 Caterpillar Inc. System and method for determining an operating point
US5906655A (en) 1997-04-02 1999-05-25 Caterpillar Inc. Method for monitoring integrity of an integrated GPS and INU system
JPH10281781A (ja) * 1997-04-08 1998-10-23 Japan Radio Co Ltd 車両用自車位置検出表示方法及び装置
US6343254B1 (en) 1998-10-22 2002-01-29 Trimble Navigation Limited Seamless surveying system
JP2000284830A (ja) * 1999-03-30 2000-10-13 Komatsu Ltd 無人走行制御装置
US7292223B2 (en) 2000-02-24 2007-11-06 Innalabs Technologies, Inc. Location tracking device
US6484096B2 (en) 2000-06-06 2002-11-19 Satellite Devices Limited Wireless vehicle monitoring system
US6408245B1 (en) * 2000-08-03 2002-06-18 American Gnc Corporation Filtering mechanization method of integrating global positioning system receiver with inertial measurement unit
US6622090B2 (en) * 2000-09-26 2003-09-16 American Gnc Corporation Enhanced inertial measurement unit/global positioning system mapping and navigation process
US6424914B1 (en) 2000-12-26 2002-07-23 American Gnc Corporation Fully-coupled vehicle positioning method and system thereof
GB0101692D0 (en) * 2001-01-23 2001-03-07 Koninkl Philips Electronics Nv Mobile device comprising a gps receiver
US6711496B2 (en) 2001-11-01 2004-03-23 Jack A. Denton System and method of monitoring cargo container mobility and efficiency
JP2003272098A (ja) * 2002-03-14 2003-09-26 Denso Corp 車両用情報管理システム及び車載情報端末装置
JP2004069536A (ja) * 2002-08-07 2004-03-04 Matsushita Electric Ind Co Ltd データ検定装置および方法
US6831599B2 (en) 2002-08-26 2004-12-14 Honeywell International Inc. Remote velocity sensor slaved to an integrated GPS/INS
US6859729B2 (en) 2002-10-21 2005-02-22 Bae Systems Integrated Defense Solutions Inc. Navigation of remote controlled vehicles
US7027919B2 (en) 2002-11-01 2006-04-11 Daniel Bernesi Vehicle and/or asset tracking and localization system and method
US6784833B1 (en) * 2003-02-21 2004-08-31 Lockheed Martin Corporation Personal surveillance system with locating capabilities
KR100518852B1 (ko) 2003-08-25 2005-09-30 엘지전자 주식회사 차량의 후진 개선 추측항법
JP2005274363A (ja) * 2004-03-25 2005-10-06 Hitachi Ltd 無線位置検出システム
US7245215B2 (en) 2005-02-10 2007-07-17 Pinc Solutions Position-tracking device for position-tracking system
JP4807728B2 (ja) * 2005-05-17 2011-11-02 富士重工業株式会社 車両の走行制御装置
JP2007064853A (ja) * 2005-08-31 2007-03-15 Hitachi Ltd 複合測位による移動体の測位制御装置、システムおよびプログラム
EP1930693B1 (en) 2005-09-30 2013-02-13 Pioneer Corporation Position estimation device, position estimation method, position estimation program, and computer-readable recording medium
JP4716886B2 (ja) 2006-02-06 2011-07-06 アルパイン株式会社 位置算出装置の進行角決定方法
JP4816339B2 (ja) 2006-08-31 2011-11-16 ソニー株式会社 ナビゲーション装置、ナビゲーション情報算出方法及びナビゲーション情報算出プログラム
US9746329B2 (en) * 2006-11-08 2017-08-29 Caterpillar Trimble Control Technologies Llc Systems and methods for augmenting an inertial navigation system
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
TWI357493B (en) 2007-10-12 2012-02-01 Grt Tech Co Ltd Augmented navigation system and method of a moving
US8725327B2 (en) * 2008-04-22 2014-05-13 Exelis Inc. Navigation system and method of obtaining accurate navigational information in signal challenging environments

Also Published As

Publication number Publication date
US20100274434A1 (en) 2010-10-28
JP2012525587A (ja) 2012-10-22
AU2010245237B2 (en) 2014-10-23
CN102414578A (zh) 2012-04-11
BRPI1007082A2 (pt) 2016-02-10
CN102414578B (zh) 2014-02-19
EP2425275A4 (en) 2015-12-09
US8306726B2 (en) 2012-11-06
WO2010129111A3 (en) 2011-01-27
CA2759040A1 (en) 2010-11-11
AU2010245237A1 (en) 2011-11-03
WO2010129111A2 (en) 2010-11-11
EP2425275A2 (en) 2012-03-07

Similar Documents

Publication Publication Date Title
JP5806207B2 (ja) 可動機械用の位置監視システム
US8560218B1 (en) Method and apparatus to correct for erroneous global positioning system data
US10139835B2 (en) Vehicle position detector, automatic steering controller, vehicle position detecting method, and automatic steering control method
US8269624B2 (en) Positioning apparatus and method
CN105164551B (zh) 具有多重交叉检查的位置识别系统
US7987049B2 (en) GPS-based attitude determination system with self-diagnosis function
EP2219044A1 (en) Navigation method, navigation system, navigation device, vehicle provided therewith and group of vehicles
JP5973024B1 (ja) 位置検出装置
US11852725B2 (en) System and method for determining an elevation of a laser detector
AU2014201513B2 (en) Mining machine position tracking and mapping
KR20190104827A (ko) 지중변위 감지 시스템 및 방법
US20080059062A1 (en) Vehicle position detecting system and method
AU2015213260A1 (en) Machine positioning system having alignment error detection
KR20180105322A (ko) 차량의 주행 검사 장치 및 방법
US20160017670A1 (en) Apparatus for aligning drilling machines
US11340357B2 (en) Method and apparatus for detecting a position of a vehicle having a high level of automation
JP4357266B2 (ja) レーダ装置及びレーダ装置の異常判定方法
KR101445872B1 (ko) 차량의 주행 기록 데이터를 이용한 위치 추정 장치 및 방법
KR20010009181A (ko) 자가진단장치를 구비한 차량항법장치 및 그 자가진단방법
US20150185024A1 (en) Machine positioning system utilizing relative pose information
KR20090049501A (ko) 차량의 위치 보정 방법 및 장치
JP4978533B2 (ja) 位置測定装置
KR20160086035A (ko) 차량의 진단 시스템, 그 제어 방법 및 이에 포함된 자세 제어 센서
KR20160134998A (ko) 표면 붕괴 감지 시스템
AU2016234954A1 (en) Mining machine position tracking and mapping

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20130304

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20140313

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20140318

A601 Written request for extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A601

Effective date: 20140618

A602 Written permission of extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A602

Effective date: 20140625

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20140711

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20150113

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20150312

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: 20150804

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20150903

R150 Certificate of patent or registration of utility model

Ref document number: 5806207

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

LAPS Cancellation because of no payment of annual fees