JP2004264182A - 移動体の位置計測方法及び装置 - Google Patents
移動体の位置計測方法及び装置 Download PDFInfo
- Publication number
- JP2004264182A JP2004264182A JP2003055379A JP2003055379A JP2004264182A JP 2004264182 A JP2004264182 A JP 2004264182A JP 2003055379 A JP2003055379 A JP 2003055379A JP 2003055379 A JP2003055379 A JP 2003055379A JP 2004264182 A JP2004264182 A JP 2004264182A
- Authority
- JP
- Japan
- Prior art keywords
- moving body
- traveling
- reflector
- direction position
- distance
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 22
- 238000012937 correction Methods 0.000 claims abstract description 20
- 238000005259 measurement Methods 0.000 claims abstract description 7
- 238000001514 detection method Methods 0.000 description 11
- 238000012360 testing method Methods 0.000 description 8
- 238000012545 processing Methods 0.000 description 7
- 238000010586 diagram Methods 0.000 description 4
- 230000003287 optical effect Effects 0.000 description 4
- 238000000691 measurement method Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000001678 irradiating effect Effects 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 239000000835 fiber Substances 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000001788 irregular Effects 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Optical Radar Systems And Details Thereof (AREA)
- Navigation (AREA)
- Traffic Control Systems (AREA)
Abstract
【課題】所定の走行路を比較的高速で自動走行させる移動体の位置，進路等の計測に適した移動体の位置計測方法及びその実施に適した装置を提供する。
【解決手段】移動体１は、自動操縦装置４を備え、通常は、ＧＰＳデータから特定される移動体１の位置及び方位に基づいて自動走行するが、ＧＰＳデータの受信状態が良くない場合に、ジャイロ４２及び車速センサ４３等により慣性航法に切り換える。慣性航法は、時間経過と共に計測誤差が積み重なるので、定期的にＧＰＳデータにより補正するが、ＧＰＳデータの受信状態が良くない場合が継続するようなときには、走行路に沿った所定の位置に設置された反射体３に基づいて移動体１の位置及び方位を特定する。
【選択図】 図２
【解決手段】移動体１は、自動操縦装置４を備え、通常は、ＧＰＳデータから特定される移動体１の位置及び方位に基づいて自動走行するが、ＧＰＳデータの受信状態が良くない場合に、ジャイロ４２及び車速センサ４３等により慣性航法に切り換える。慣性航法は、時間経過と共に計測誤差が積み重なるので、定期的にＧＰＳデータにより補正するが、ＧＰＳデータの受信状態が良くない場合が継続するようなときには、走行路に沿った所定の位置に設置された反射体３に基づいて移動体１の位置及び方位を特定する。
【選択図】 図２
Description
【０００１】
【発明の属する技術分野】
本願発明は、例えば、移動体を無人走行させる場合の移動体の位置，方位等の計測方法及びその実施に適した装置に関し、特に、多目的軽量走行車両等の走行耐久試験のように高速で自動運転させる場合に適した移動体の位置，方位等の計測方法及び装置に関する。
【０００２】
【従来の技術】
従来から、多目的軽量走行車両と呼ばれる大きな荷台を後部に備えた小型四輪作業車が実用化されており、ゴルフ場、牧場、スキー場、砂浜等のフィールドで活躍している。
【０００３】
このように、多目的軽量走行車両は、通常は、勾配が多く、凸凹の多い不整地での走行に使用されることから、その開発段階における走行耐久試験にあっては、同様の不整地で行なわれる。
【０００４】
一般に、このような走行耐久試験は、何十時間と長時間連続して行なわれることから、運転者の疲労も大きい。また、耐久試験では、周辺地域への配慮から山中に特設された一定の走行路を幾度となく周回走行することも、運転者の疲労を大きくしている。
【０００５】
従って、走行耐久試験に利用する車両等の移動体を自動走行させることが望まれ、例えば、走行路に沿って白線を設ける一方、白線を検出する一対の光学センサを移動体の下面に左右方向に並設し、一対の光学センサの間に白線を維持しながら白線に沿って移動体を走行させる技術がある。
【０００６】
また、例えば、走行路に沿って磁気マーカ又は電波マーカ等を間欠的に埋設する一方、これらのマーカを検出する磁気又は電波センサを移動体の下面に配設し、センサの真下にマーカを維持しながらセンサに沿って移動体を走行させる技術もある。
【０００７】
ところが、耐久試験に利用する走行路には、移動体の繰り返し走行により路面が削り取られる等の理由から、基本的には、走行路内に如何なる物体も敷設することはできない。
【０００８】
そこで、例えば、走行路に沿って反射体を適宜の間隔で設置し、予め測量等により反射体の正確な位置を特定しておく一方、移動体に光ビーム照射／受光手段を備えさせ、移動体を走行させながら移動体から光ビームを照射し、その反射光の受光方向、及び反射体と移動体との相対距離から、移動体の位置，進路等を計測する技術が種々開発されている（例えば、特許文献１及び２参照）。
【０００９】
【特許文献１】
特開平１１−１８３１７４号公報
【特許文献２】
特開平１１−２７１０４３号公報
【００１０】
【発明が解決しようとする課題】
しかしながら、上述した如き従来技術にあっては、無人搬送車のような工場等で利用される移動体を想定しているものであって、すべての反射体は、所定の高さに設けられているものの、移動体の向きに対してどのような方位に設けられているかわからないため、移動体の光ビーム照射／受光手段は、全周囲を走査するように構成されている。
【００１１】
このため、一回の位置，進路等の計測に時間を要するので、無人搬送車に比べてかなり高速で走行させる必要がある走行耐久試験の用途には不向きであった。
【００１２】
本願発明は、斯かる事情に鑑みてなされたものであり、所定の走行路を比較的高速で自動走行させる移動体の位置，進路等の計測に適しており、しかも、全周囲を走査する光ビーム照射／受光手段を必要としない移動体の位置計測方法及びその実施に適した装置を提供することを目的とする。
【００１３】
【課題を解決するための手段】
上記課題を解決するため、本願発明に係る移動体の位置計測方法は、所定の走行路を走行する移動体の前記走行路に沿った方向の前記移動体の進行方向位置と、前記走行路の幅方向における前記移動体の幅方向位置と、前記移動体の方位とを、前記移動体に搭載された慣性航法装置により推定すると共に、該慣性航法装置が発生する前記進行方向位置、前記幅方向位置、及び前記方位の誤差を補正する方法であって、前記移動体が前記所定の走行路の外側で該走行路に沿った所定の位置に設置された反射体の側方を通過する際に、前記移動体が具備する距離計測手段によって、前記反射体を計測基準とする距離計測手段の出力変化に基づいて前記移動体が前記反射体を通過することを検出すると共に、検出した前記反射体の位置から前記進行方向位置を求め、前記距離計測手段の出力から前記移動体と前記反射体との間の第１距離を求め、前記慣性航法装置により推定された前記幅方向位置から前記移動体と前記反射体との第２距離を求め、前記第１距離と前記第２距離との差に基づいて、前記慣性航法装置が推定する方位と幅方向位置とを補正すること、及び、前記進行方向位置に基づいて、前記慣性航法装置が推定する進行方向位置を補正することを、前記反射体を通過する毎に繰り返すことを特徴とする。
【００１４】
また、本願発明に係る移動体の位置計測装置は、所定の走行路を走行する移動体の前記走行路に沿った方向の前記移動体の進行方向位置と、前記走行路の幅方向における前記移動体の幅方向位置と、前記移動体の方位とを、前記移動体に搭載された慣性航法装置により推定すると共に、該慣性航法装置が発生する進行方向位置、前記幅方向位置、及び前記方位の誤差を補正する装置であって、前記移動体に設けられる距離計測手段と、前記移動体が前記所定の走行路の外側で該走行路に沿った所定の位置に前記距離計測手段の計測基準となるべく設置された反射体の側方を通過する際に、前記距離計測手段の出力変化に基づいて前記移動体が前記反射体を通過することを検出する通過検出手段と、該通過検出手段により検出された前記反射体の位置から前記進行方向位置を演算する進行方向位置演算手段と、前記距離計測手段の出力から前記移動体と前記反射体との間の第１距離を演算する第１距離演算手段と、前記慣性航法装置により推定された前記幅方向位置から前記移動体と前記反射体との第２距離を演算する第２距離演算手段と、前記第１距離と前記第２距離との差に基づいて、前記慣性航法装置が推定する方位と幅方向位置とを補正する方位・幅方向位置補正手段と、前記方向位置演算手段により演算された進行方向位置に基づいて、前記慣性航法装置が推定する進行方向位置を補正する進行方向位置補正手段とを備え、前記方位・幅方向位置補正手段による補正と、前記進行方向位置補正手段とを、前記反射体を通過する毎に繰り返すべくなしてあることを特徴とする。
【００１５】
本願発明によれば、非常に簡易に移動体の位置及び方位を求めることができるため、処理時間の短縮化を図れ、従って、所定の走行路を比較的高速で自動走行させる移動体の位置，進路等の検出に適しており、しかも、従来技術のような全周囲を走査する光ビーム照射／受光手段を必要としない。また、走行路への加工も不要である。
【００１６】
なお、本願発明において、慣性航法装置は、ジャイロ、及び速度パルスを利用して走行距離等を検出する自動車等で利用されている一般的な速度センサ等を備えている。
【００１７】
また、本願発明においては、移動体への適用として、前述したような多目的軽量走行車両又は無人搬送車のほかにも、例えば、自動車，除雪車，又は自動芝刈り機等に適用することができる。
【００１８】
また、本願発明は、ＧＰＳ航法装置及び慣性航法装置を併用する構成であって、山中等、ＧＰＳ衛星からの電波を受信できないような場所又は環境での利用において慣性航法装置の測定誤差を補正することに適用可能である。
【００１９】
【発明の実施の形態】
以下、本願発明に係る位置計測方法を、添付の図面を参照しながら具体的に説明する。
【００２０】
本願発明に係る位置計測方法によれば、次のような原理により、移動体の位置（ｘ１，ｙ１）及び方位φ１を計測することができる。
【００２１】
図１に示すように、例えば、実線矢符方向に走行する移動体１の片側（図１においては右側）に、レーザ距離計等の距離計測手段２を設ける。なお、距離計測手段は、反射体との間の距離を計測できるものであればよく、例えば、光ビーム，超音波等を利用した距離計であってもよい。
【００２２】
一方、所定の走行路Ｃの片側（図１においては右側）に沿って複数の反射体３，３…が設置されており、各反射体３の位置は、測量等により予め絶対座標位置として求められている。距離計測手段２は、移動体１の走行方向に直角な方向の距離を計測するものであり、移動体１と反射体３との間の相対的な距離を計測するものである。なお、反射体３の近傍には、距離計測手段２が反射体３と間違うような障害物は無いものとする。
【００２３】
このとき、走行中に距離計測手段２の出力をモニタしておれば、反射体３の略直角の位置に移動体１が来たことを検知すること、及び反射体３と移動体１との間の距離を求めることができる。
【００２４】
図１においては、反射体３を２個配置している。進行方向手前側の反射体３をＢ０、その先の反射体３をＢ１とし、移動体１によるＢ０，Ｂ１それぞれの反射体検出位置をＰ０，Ｐ１とする。また、Ｐ０の位置において、移動体１の位置（ｘ０，ｙ０）及び方位（φ０）が既に求められているものとする。
【００２５】
以下では、Ｐ０の位置からＰ１の位置へ移動体１が走行する際に生じる誤差の補正方法について説明する。
【００２６】
図１における破線の移動軌跡は、慣性航法のために移動体１に搭載している慣性航法装置が推定している軌跡であり、慣性航法装置を構成するジャイロのドリフト等の慣性航法装置が発生する出力誤差により、図１において実線で示す実際の走行軌跡とはずれている。
【００２７】
いま、移動体１がＰ１の位置に来たとき、距離計測手段２で移動体１と反射体Ｂ１との間の距離ｄを求める。ここで、反射体Ｂ１の走行路Ｃの中央線（図１において一点鎖線で示す）に対する幅方向の距離が図１におけるＤ１（既知）、慣性航法装置が推定する走行路Ｃの中央線に対する移動体１の幅方向の距離をｅ１とすると、慣性航法装置の推定値から計算される移動体１と反射体Ｂ１との距離は、Ｄ１−ｅ１となり、慣性航法装置の推定位置は距離計測手段２で計測した実際との誤差は、ｅ２＝（Ｄ１−ｅ１）−ｄにより求められる。Ｐ０の位置からＰ１の位置に移動する移動体１の走行距離をＬとすると、方位が概略ｅ２／Ｌだけずれていることになり、慣性航法装置の推定しているＰ１の位置における方位をｅ２／Ｌだけ補正することで、慣性航法装置の誤差の蓄積を防止することができる。
【００２８】
同時に、慣性航法装置の進行方向距離の推定値についても、既知の反射体Ｂ１の位置から走行路Ｃ側に距離ｄ離れた位置に移動体１があるものとして位置（ｘ１，ｙ２）を補正することができる。
【００２９】
以下、本願発明に係る位置計測方法を適用した移動体について説明する。
【００３０】
図２は、本願発明の実施の形態に係る移動体の構成を示すブロック図である。本実施の形態の移動体１は、走行耐久試験用に自動操縦機能を持つ多目的軽量走行車両である。
【００３１】
本実施の形態に係る移動体１は、所定の走行路（図示せず）の外側に所定の間隔で設置された反射体３にレーザ光等の光ビームを照射し、該反射体３で反射された光ビームを受光する一又は複数のレーザ距離計２と、移動体１のステアリング５，ブレーキ６，及びアクセル７等を操作して移動体１の自動操縦を行なう自動操縦装置４とを備えている。
【００３２】
自動操縦装置４は、タイマ４０ａを内蔵した制御演算装置４０，ＧＰＳ受信機４１，ジャイロ４２，車速センサ４３，及び駆動装置４４等を備えており、基本的には、ＧＰＳデータに基づいた自動操縦を行い、ジャイロ４２及び車速センサ４３から構成される慣性航法装置４５（図４参照）による慣性航法も可能となっている。
【００３３】
なお、本実施の形態においては、自動操縦装置４が車速センサ４３を備えるように構成してあるが、一般に、多目的軽量走行車両等の車両には、このような車速センサが元々取り付けられているため、これを利用することも可能である。
【００３４】
ＧＰＳ受信機４１は、例えばリアルタイムキネマティック（Ｒｅａｌ Ｔｉｍｅ Ｋｉｎｅｍａｔｉｃ）方式のＧＰＳ受信機（ＲＴＫ−ＧＰＳ）であり、ＧＰＳ衛星８及び図示しない地上の基準局から受信した情報（時間情報，位相情報等）を制御演算装置４０に与えるようになっている。ＲＴＫ方式では、受信位置を約数ｃｍの誤差で測定することが可能である。なお、ＧＰＳ受信機４１には、多少精度は低下するが、ディファレンシャル方式のＧＰＳ受信機（ＤＧＰＳ）を採用することも可能である。
【００３５】
慣性航法装置４５を構成するジャイロ４２は、ファイバオプティカル式，リングレーザ式等からなり、移動体１の３軸加速度を検出し、検出結果を制御演算装置４０に与えるようになっている。
【００３６】
車速センサ４３は、移動体１の車軸に設けられた電気式，磁気式，又は光学式のセンサであり、車軸の１回転ごとにパルス信号を発生し、これを制御演算装置４０に与えるようになっている。
【００３７】
駆動装置４４は、移動体１のステアリング５，ブレーキ６，及びアクセル７等を作動させる各種のアクチュエータからなり、制御演算装置４０からの制御指示に応じてアクチュエータを作動し、移動体１の方位及び速度を調節する。
【００３８】
次に、制御演算装置４０の構成及び作用について、さらに、図３及び図４を参照しながら説明する。
【００３９】
制御演算装置４０は、マイクロプロセッサを備え、基本的には、図３に示すように、ＧＰＳ受信機４１から与えられる情報に基づいて移動体１の位置及び方位（ｘ，ｙ，φ）を演算し、この位置及び方位に基づいて、駆動装置４４に制御指示を出力し、移動体１が所定の走行路の中央線に沿って走行するように制御している（ステップＳ１）。なお、走行路のコースデータは、反射体３の位置データと共に、制御演算装置４０が内蔵するメモリ（図示せず）に記憶されている。
【００４０】
しかし、ＧＰＳ受信機４１がＧＰＳ衛星８及び図示しない地上の基準局から情報を適切に受信できない状態となった場合には、ＧＰＳ受信機４１からの情報に依存することができなくなるので、この場合には、ジャイロ４２及び車速センサ４３等から構成される慣性航法装置４５（図４参照）による慣性航法に切り換える（ステップＳ２）。
【００４１】
ただし、ドリフト等によってジャイロ４２から与えられる角速度データ、及び車速センサから与えられるパルス信号には、誤差が生じてくるため、定期的に補正する必要がある。補正は、ＧＰＳデータによる補正を優先的に行なうが、ＧＰＳデータに依存することができない場合には、レーザ距離計２によるレーザ距離定点位置計測（ｘ１，ｙ１，φ１）を行い、この結果に基づいて、慣性航法に利用する移動体１の位置及び方位（ｘ，ｙ，φ）を補正する（ステップＳ３）。
【００４２】
より詳しくは、制御演算装置４０は、図４に示すように、ＧＰＳ位置検出部４０１，慣性航法位置検出部４０２，及び位置・方位補正処理部４０３等を備えており、該位置・方位補正処理部４０３は、方位補正演算部４０４及び位置補正演算部４０５等を備えている。
【００４３】
ＧＰＳ受信機４１からのＧＰＳデータは、ＧＰＳ位置検出部４０１に与えられ、該ＧＰＳ位置検出部４０１は、ＧＰＳデータに基づいて移動体１の位置及び方位を演算するようになっている。
【００４４】
慣性航法装置４５（ジャイロ４２及び車速センサ４３等）からの慣性航法データは、慣性航法位置検出部４０２に与えられ、該慣性航法位置検出部４０２は、ＧＰＳ位置検出部４０１に演算された移動体１の位置及び方位を初期位置及び初期方位として利用し、慣性航法データに基づいて移動体１の位置及び方位を演算するようになっている。
【００４５】
位置・方位補正処理部４０３は、前述した本願発明の第１及び／又は第２の観点の原理を用いて、方位補正演算部４０４により移動体１の方位を演算し、位置補正演算部４０５により移動体１の位置を演算するようになっている。
【００４６】
位置・方位補正処理部４０３での移動体１の位置及び方位の演算で用いられる反射体３の設置間隔及びその絶対座標位置等の情報は、制御演算装置４０が内蔵するメモリ（図示せず）に予め記憶されている。
【００４７】
また、位置・方位補正処理部４０３での移動体１の位置及び方位の演算で用いられる走行距離及び走行速度等の情報は、車速センサ４３からのパルス信号（又はジャイロ４２からの加速度信号）と、タイマ４０ａからの時刻信号と、移動体１の車輪の周囲長の情報とに基づいて特定され、車輪の周囲長の情報は、制御演算装置４０が内蔵するメモリ（図示せず）に記憶されている。
【００４８】
【発明の効果】
以上のように、本願発明に係る移動体の位置計測方法及びその実施に適した装置によれば、所定の走行路を比較的高速で自動走行させる移動体の位置，進路等の計測に適しており、しかも、全周囲を走査する光ビーム照射／受光手段を必要としない等、本願発明は優れた効果を奏する。
【図面の簡単な説明】
【図１】本願発明に係る移動体の位置計測方法を説明するための原理図である。
【図２】本願発明の実施の形態に係る移動体としての走行耐久試験用に自動操縦機能を持った多目的軽量走行車両の構成を示すブロック図である。
【図３】図２に示した移動体の自動操縦装置の位置及び方向検出の切り換え方法を示すフローチャートである。
【図４】図２に示した移動体の制御演算装置の詳細な構成を示すブロック図である。
【符号の説明】
１ 移動体
２ レーザ距離計
３ 反射体
４ 自動操縦装置
５ ステアリング
６ ブレーキ
７ アクセル
８ ＧＰＳ衛星
４０ａ タイマ
４０ 制御演算装置
４１ ＧＰＳ受信機
４２ ジャイロ
４３ 車速センサ
４４ 駆動装置
４５ 慣性航法装置
４０１ ＧＰＳ位置検出部
４０２ 慣性航法位置検出部
４０３ 位置・方位補正処理部
４０４ 方位補正演算部
４０５ 位置補正演算部
【発明の属する技術分野】
本願発明は、例えば、移動体を無人走行させる場合の移動体の位置，方位等の計測方法及びその実施に適した装置に関し、特に、多目的軽量走行車両等の走行耐久試験のように高速で自動運転させる場合に適した移動体の位置，方位等の計測方法及び装置に関する。
【０００２】
【従来の技術】
従来から、多目的軽量走行車両と呼ばれる大きな荷台を後部に備えた小型四輪作業車が実用化されており、ゴルフ場、牧場、スキー場、砂浜等のフィールドで活躍している。
【０００３】
このように、多目的軽量走行車両は、通常は、勾配が多く、凸凹の多い不整地での走行に使用されることから、その開発段階における走行耐久試験にあっては、同様の不整地で行なわれる。
【０００４】
一般に、このような走行耐久試験は、何十時間と長時間連続して行なわれることから、運転者の疲労も大きい。また、耐久試験では、周辺地域への配慮から山中に特設された一定の走行路を幾度となく周回走行することも、運転者の疲労を大きくしている。
【０００５】
従って、走行耐久試験に利用する車両等の移動体を自動走行させることが望まれ、例えば、走行路に沿って白線を設ける一方、白線を検出する一対の光学センサを移動体の下面に左右方向に並設し、一対の光学センサの間に白線を維持しながら白線に沿って移動体を走行させる技術がある。
【０００６】
また、例えば、走行路に沿って磁気マーカ又は電波マーカ等を間欠的に埋設する一方、これらのマーカを検出する磁気又は電波センサを移動体の下面に配設し、センサの真下にマーカを維持しながらセンサに沿って移動体を走行させる技術もある。
【０００７】
ところが、耐久試験に利用する走行路には、移動体の繰り返し走行により路面が削り取られる等の理由から、基本的には、走行路内に如何なる物体も敷設することはできない。
【０００８】
そこで、例えば、走行路に沿って反射体を適宜の間隔で設置し、予め測量等により反射体の正確な位置を特定しておく一方、移動体に光ビーム照射／受光手段を備えさせ、移動体を走行させながら移動体から光ビームを照射し、その反射光の受光方向、及び反射体と移動体との相対距離から、移動体の位置，進路等を計測する技術が種々開発されている（例えば、特許文献１及び２参照）。
【０００９】
【特許文献１】
特開平１１−１８３１７４号公報
【特許文献２】
特開平１１−２７１０４３号公報
【００１０】
【発明が解決しようとする課題】
しかしながら、上述した如き従来技術にあっては、無人搬送車のような工場等で利用される移動体を想定しているものであって、すべての反射体は、所定の高さに設けられているものの、移動体の向きに対してどのような方位に設けられているかわからないため、移動体の光ビーム照射／受光手段は、全周囲を走査するように構成されている。
【００１１】
このため、一回の位置，進路等の計測に時間を要するので、無人搬送車に比べてかなり高速で走行させる必要がある走行耐久試験の用途には不向きであった。
【００１２】
本願発明は、斯かる事情に鑑みてなされたものであり、所定の走行路を比較的高速で自動走行させる移動体の位置，進路等の計測に適しており、しかも、全周囲を走査する光ビーム照射／受光手段を必要としない移動体の位置計測方法及びその実施に適した装置を提供することを目的とする。
【００１３】
【課題を解決するための手段】
上記課題を解決するため、本願発明に係る移動体の位置計測方法は、所定の走行路を走行する移動体の前記走行路に沿った方向の前記移動体の進行方向位置と、前記走行路の幅方向における前記移動体の幅方向位置と、前記移動体の方位とを、前記移動体に搭載された慣性航法装置により推定すると共に、該慣性航法装置が発生する前記進行方向位置、前記幅方向位置、及び前記方位の誤差を補正する方法であって、前記移動体が前記所定の走行路の外側で該走行路に沿った所定の位置に設置された反射体の側方を通過する際に、前記移動体が具備する距離計測手段によって、前記反射体を計測基準とする距離計測手段の出力変化に基づいて前記移動体が前記反射体を通過することを検出すると共に、検出した前記反射体の位置から前記進行方向位置を求め、前記距離計測手段の出力から前記移動体と前記反射体との間の第１距離を求め、前記慣性航法装置により推定された前記幅方向位置から前記移動体と前記反射体との第２距離を求め、前記第１距離と前記第２距離との差に基づいて、前記慣性航法装置が推定する方位と幅方向位置とを補正すること、及び、前記進行方向位置に基づいて、前記慣性航法装置が推定する進行方向位置を補正することを、前記反射体を通過する毎に繰り返すことを特徴とする。
【００１４】
また、本願発明に係る移動体の位置計測装置は、所定の走行路を走行する移動体の前記走行路に沿った方向の前記移動体の進行方向位置と、前記走行路の幅方向における前記移動体の幅方向位置と、前記移動体の方位とを、前記移動体に搭載された慣性航法装置により推定すると共に、該慣性航法装置が発生する進行方向位置、前記幅方向位置、及び前記方位の誤差を補正する装置であって、前記移動体に設けられる距離計測手段と、前記移動体が前記所定の走行路の外側で該走行路に沿った所定の位置に前記距離計測手段の計測基準となるべく設置された反射体の側方を通過する際に、前記距離計測手段の出力変化に基づいて前記移動体が前記反射体を通過することを検出する通過検出手段と、該通過検出手段により検出された前記反射体の位置から前記進行方向位置を演算する進行方向位置演算手段と、前記距離計測手段の出力から前記移動体と前記反射体との間の第１距離を演算する第１距離演算手段と、前記慣性航法装置により推定された前記幅方向位置から前記移動体と前記反射体との第２距離を演算する第２距離演算手段と、前記第１距離と前記第２距離との差に基づいて、前記慣性航法装置が推定する方位と幅方向位置とを補正する方位・幅方向位置補正手段と、前記方向位置演算手段により演算された進行方向位置に基づいて、前記慣性航法装置が推定する進行方向位置を補正する進行方向位置補正手段とを備え、前記方位・幅方向位置補正手段による補正と、前記進行方向位置補正手段とを、前記反射体を通過する毎に繰り返すべくなしてあることを特徴とする。
【００１５】
本願発明によれば、非常に簡易に移動体の位置及び方位を求めることができるため、処理時間の短縮化を図れ、従って、所定の走行路を比較的高速で自動走行させる移動体の位置，進路等の検出に適しており、しかも、従来技術のような全周囲を走査する光ビーム照射／受光手段を必要としない。また、走行路への加工も不要である。
【００１６】
なお、本願発明において、慣性航法装置は、ジャイロ、及び速度パルスを利用して走行距離等を検出する自動車等で利用されている一般的な速度センサ等を備えている。
【００１７】
また、本願発明においては、移動体への適用として、前述したような多目的軽量走行車両又は無人搬送車のほかにも、例えば、自動車，除雪車，又は自動芝刈り機等に適用することができる。
【００１８】
また、本願発明は、ＧＰＳ航法装置及び慣性航法装置を併用する構成であって、山中等、ＧＰＳ衛星からの電波を受信できないような場所又は環境での利用において慣性航法装置の測定誤差を補正することに適用可能である。
【００１９】
【発明の実施の形態】
以下、本願発明に係る位置計測方法を、添付の図面を参照しながら具体的に説明する。
【００２０】
本願発明に係る位置計測方法によれば、次のような原理により、移動体の位置（ｘ１，ｙ１）及び方位φ１を計測することができる。
【００２１】
図１に示すように、例えば、実線矢符方向に走行する移動体１の片側（図１においては右側）に、レーザ距離計等の距離計測手段２を設ける。なお、距離計測手段は、反射体との間の距離を計測できるものであればよく、例えば、光ビーム，超音波等を利用した距離計であってもよい。
【００２２】
一方、所定の走行路Ｃの片側（図１においては右側）に沿って複数の反射体３，３…が設置されており、各反射体３の位置は、測量等により予め絶対座標位置として求められている。距離計測手段２は、移動体１の走行方向に直角な方向の距離を計測するものであり、移動体１と反射体３との間の相対的な距離を計測するものである。なお、反射体３の近傍には、距離計測手段２が反射体３と間違うような障害物は無いものとする。
【００２３】
このとき、走行中に距離計測手段２の出力をモニタしておれば、反射体３の略直角の位置に移動体１が来たことを検知すること、及び反射体３と移動体１との間の距離を求めることができる。
【００２４】
図１においては、反射体３を２個配置している。進行方向手前側の反射体３をＢ０、その先の反射体３をＢ１とし、移動体１によるＢ０，Ｂ１それぞれの反射体検出位置をＰ０，Ｐ１とする。また、Ｐ０の位置において、移動体１の位置（ｘ０，ｙ０）及び方位（φ０）が既に求められているものとする。
【００２５】
以下では、Ｐ０の位置からＰ１の位置へ移動体１が走行する際に生じる誤差の補正方法について説明する。
【００２６】
図１における破線の移動軌跡は、慣性航法のために移動体１に搭載している慣性航法装置が推定している軌跡であり、慣性航法装置を構成するジャイロのドリフト等の慣性航法装置が発生する出力誤差により、図１において実線で示す実際の走行軌跡とはずれている。
【００２７】
いま、移動体１がＰ１の位置に来たとき、距離計測手段２で移動体１と反射体Ｂ１との間の距離ｄを求める。ここで、反射体Ｂ１の走行路Ｃの中央線（図１において一点鎖線で示す）に対する幅方向の距離が図１におけるＤ１（既知）、慣性航法装置が推定する走行路Ｃの中央線に対する移動体１の幅方向の距離をｅ１とすると、慣性航法装置の推定値から計算される移動体１と反射体Ｂ１との距離は、Ｄ１−ｅ１となり、慣性航法装置の推定位置は距離計測手段２で計測した実際との誤差は、ｅ２＝（Ｄ１−ｅ１）−ｄにより求められる。Ｐ０の位置からＰ１の位置に移動する移動体１の走行距離をＬとすると、方位が概略ｅ２／Ｌだけずれていることになり、慣性航法装置の推定しているＰ１の位置における方位をｅ２／Ｌだけ補正することで、慣性航法装置の誤差の蓄積を防止することができる。
【００２８】
同時に、慣性航法装置の進行方向距離の推定値についても、既知の反射体Ｂ１の位置から走行路Ｃ側に距離ｄ離れた位置に移動体１があるものとして位置（ｘ１，ｙ２）を補正することができる。
【００２９】
以下、本願発明に係る位置計測方法を適用した移動体について説明する。
【００３０】
図２は、本願発明の実施の形態に係る移動体の構成を示すブロック図である。本実施の形態の移動体１は、走行耐久試験用に自動操縦機能を持つ多目的軽量走行車両である。
【００３１】
本実施の形態に係る移動体１は、所定の走行路（図示せず）の外側に所定の間隔で設置された反射体３にレーザ光等の光ビームを照射し、該反射体３で反射された光ビームを受光する一又は複数のレーザ距離計２と、移動体１のステアリング５，ブレーキ６，及びアクセル７等を操作して移動体１の自動操縦を行なう自動操縦装置４とを備えている。
【００３２】
自動操縦装置４は、タイマ４０ａを内蔵した制御演算装置４０，ＧＰＳ受信機４１，ジャイロ４２，車速センサ４３，及び駆動装置４４等を備えており、基本的には、ＧＰＳデータに基づいた自動操縦を行い、ジャイロ４２及び車速センサ４３から構成される慣性航法装置４５（図４参照）による慣性航法も可能となっている。
【００３３】
なお、本実施の形態においては、自動操縦装置４が車速センサ４３を備えるように構成してあるが、一般に、多目的軽量走行車両等の車両には、このような車速センサが元々取り付けられているため、これを利用することも可能である。
【００３４】
ＧＰＳ受信機４１は、例えばリアルタイムキネマティック（Ｒｅａｌ Ｔｉｍｅ Ｋｉｎｅｍａｔｉｃ）方式のＧＰＳ受信機（ＲＴＫ−ＧＰＳ）であり、ＧＰＳ衛星８及び図示しない地上の基準局から受信した情報（時間情報，位相情報等）を制御演算装置４０に与えるようになっている。ＲＴＫ方式では、受信位置を約数ｃｍの誤差で測定することが可能である。なお、ＧＰＳ受信機４１には、多少精度は低下するが、ディファレンシャル方式のＧＰＳ受信機（ＤＧＰＳ）を採用することも可能である。
【００３５】
慣性航法装置４５を構成するジャイロ４２は、ファイバオプティカル式，リングレーザ式等からなり、移動体１の３軸加速度を検出し、検出結果を制御演算装置４０に与えるようになっている。
【００３６】
車速センサ４３は、移動体１の車軸に設けられた電気式，磁気式，又は光学式のセンサであり、車軸の１回転ごとにパルス信号を発生し、これを制御演算装置４０に与えるようになっている。
【００３７】
駆動装置４４は、移動体１のステアリング５，ブレーキ６，及びアクセル７等を作動させる各種のアクチュエータからなり、制御演算装置４０からの制御指示に応じてアクチュエータを作動し、移動体１の方位及び速度を調節する。
【００３８】
次に、制御演算装置４０の構成及び作用について、さらに、図３及び図４を参照しながら説明する。
【００３９】
制御演算装置４０は、マイクロプロセッサを備え、基本的には、図３に示すように、ＧＰＳ受信機４１から与えられる情報に基づいて移動体１の位置及び方位（ｘ，ｙ，φ）を演算し、この位置及び方位に基づいて、駆動装置４４に制御指示を出力し、移動体１が所定の走行路の中央線に沿って走行するように制御している（ステップＳ１）。なお、走行路のコースデータは、反射体３の位置データと共に、制御演算装置４０が内蔵するメモリ（図示せず）に記憶されている。
【００４０】
しかし、ＧＰＳ受信機４１がＧＰＳ衛星８及び図示しない地上の基準局から情報を適切に受信できない状態となった場合には、ＧＰＳ受信機４１からの情報に依存することができなくなるので、この場合には、ジャイロ４２及び車速センサ４３等から構成される慣性航法装置４５（図４参照）による慣性航法に切り換える（ステップＳ２）。
【００４１】
ただし、ドリフト等によってジャイロ４２から与えられる角速度データ、及び車速センサから与えられるパルス信号には、誤差が生じてくるため、定期的に補正する必要がある。補正は、ＧＰＳデータによる補正を優先的に行なうが、ＧＰＳデータに依存することができない場合には、レーザ距離計２によるレーザ距離定点位置計測（ｘ１，ｙ１，φ１）を行い、この結果に基づいて、慣性航法に利用する移動体１の位置及び方位（ｘ，ｙ，φ）を補正する（ステップＳ３）。
【００４２】
より詳しくは、制御演算装置４０は、図４に示すように、ＧＰＳ位置検出部４０１，慣性航法位置検出部４０２，及び位置・方位補正処理部４０３等を備えており、該位置・方位補正処理部４０３は、方位補正演算部４０４及び位置補正演算部４０５等を備えている。
【００４３】
ＧＰＳ受信機４１からのＧＰＳデータは、ＧＰＳ位置検出部４０１に与えられ、該ＧＰＳ位置検出部４０１は、ＧＰＳデータに基づいて移動体１の位置及び方位を演算するようになっている。
【００４４】
慣性航法装置４５（ジャイロ４２及び車速センサ４３等）からの慣性航法データは、慣性航法位置検出部４０２に与えられ、該慣性航法位置検出部４０２は、ＧＰＳ位置検出部４０１に演算された移動体１の位置及び方位を初期位置及び初期方位として利用し、慣性航法データに基づいて移動体１の位置及び方位を演算するようになっている。
【００４５】
位置・方位補正処理部４０３は、前述した本願発明の第１及び／又は第２の観点の原理を用いて、方位補正演算部４０４により移動体１の方位を演算し、位置補正演算部４０５により移動体１の位置を演算するようになっている。
【００４６】
位置・方位補正処理部４０３での移動体１の位置及び方位の演算で用いられる反射体３の設置間隔及びその絶対座標位置等の情報は、制御演算装置４０が内蔵するメモリ（図示せず）に予め記憶されている。
【００４７】
また、位置・方位補正処理部４０３での移動体１の位置及び方位の演算で用いられる走行距離及び走行速度等の情報は、車速センサ４３からのパルス信号（又はジャイロ４２からの加速度信号）と、タイマ４０ａからの時刻信号と、移動体１の車輪の周囲長の情報とに基づいて特定され、車輪の周囲長の情報は、制御演算装置４０が内蔵するメモリ（図示せず）に記憶されている。
【００４８】
【発明の効果】
以上のように、本願発明に係る移動体の位置計測方法及びその実施に適した装置によれば、所定の走行路を比較的高速で自動走行させる移動体の位置，進路等の計測に適しており、しかも、全周囲を走査する光ビーム照射／受光手段を必要としない等、本願発明は優れた効果を奏する。
【図面の簡単な説明】
【図１】本願発明に係る移動体の位置計測方法を説明するための原理図である。
【図２】本願発明の実施の形態に係る移動体としての走行耐久試験用に自動操縦機能を持った多目的軽量走行車両の構成を示すブロック図である。
【図３】図２に示した移動体の自動操縦装置の位置及び方向検出の切り換え方法を示すフローチャートである。
【図４】図２に示した移動体の制御演算装置の詳細な構成を示すブロック図である。
【符号の説明】
１ 移動体
２ レーザ距離計
３ 反射体
４ 自動操縦装置
５ ステアリング
６ ブレーキ
７ アクセル
８ ＧＰＳ衛星
４０ａ タイマ
４０ 制御演算装置
４１ ＧＰＳ受信機
４２ ジャイロ
４３ 車速センサ
４４ 駆動装置
４５ 慣性航法装置
４０１ ＧＰＳ位置検出部
４０２ 慣性航法位置検出部
４０３ 位置・方位補正処理部
４０４ 方位補正演算部
４０５ 位置補正演算部
Claims (2)
- 所定の走行路を走行する移動体の前記走行路に沿った方向の前記移動体の進行方向位置と、前記走行路の幅方向における前記移動体の幅方向位置と、前記移動体の方位とを、前記移動体に搭載された慣性航法装置により推定すると共に、該慣性航法装置が発生する前記進行方向位置、前記幅方向位置、及び前記方位の誤差を補正する方法であって、
前記移動体が前記所定の走行路の外側で該走行路に沿った所定の位置に設置された反射体の側方を通過する際に、前記移動体が具備する距離計測手段によって、前記反射体を計測基準とする前記距離計測手段の出力変化に基づいて前記移動体が前記反射体を通過することを検出すると共に、検出した前記反射体の位置から前記進行方向位置を求め、
前記距離計測手段の出力から前記移動体と前記反射体との間の第１距離を求め、
前記慣性航法装置により推定された前記幅方向位置から前記移動体と前記反射体との第２距離を求め、
前記第１距離と前記第２距離との差に基づいて、前記慣性航法装置が推定する方位と幅方向位置とを補正すること、及び、前記進行方向位置に基づいて、前記慣性航法装置が推定する進行方向位置を補正することを、前記反射体を通過する毎に繰り返す
ことを特徴とする移動体の位置測定方法。 - 所定の走行路を走行する移動体の前記走行路に沿った方向の前記移動体の進行方向位置と、前記走行路の幅方向における前記移動体の幅方向位置と、前記移動体の方位とを、前記移動体に搭載された慣性航法装置により推定すると共に、該慣性航法装置が発生する進行方向位置、前記幅方向位置、及び前記方位の誤差を補正する装置であって、
前記移動体に設けられる距離計測手段と、
前記移動体が前記所定の走行路の外側で該走行路に沿った所定の位置に前記距離計測手段の計測基準となるべく設置された反射体の側方を通過する際に、前記距離計測手段の出力変化に基づいて前記移動体が前記反射体を通過することを検出する通過検出手段と、
該通過検出手段により検出された前記反射体の位置から前記進行方向位置を演算する進行方向位置演算手段と、
前記距離計測手段の出力から前記移動体と前記反射体との間の第１距離を演算する第１距離演算手段と、
前記慣性航法装置により推定された前記幅方向位置から前記移動体と前記反射体との第２距離を演算する第２距離演算手段と、
前記第１距離と前記第２距離との差に基づいて、前記慣性航法装置が推定する方位と幅方向位置とを補正する方位・幅方向位置補正手段と、
前記方向位置演算手段により演算された進行方向位置に基づいて、前記慣性航法装置が推定する進行方向位置を補正する進行方向位置補正手段と
を備え、
前記方位・幅方向位置補正手段による補正と、前記進行方向位置補正手段とを、前記反射体を通過する毎に繰り返すべくなしてある
ことを特徴とする移動体の位置計測装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003055379A JP3710451B2 (ja) | 2003-03-03 | 2003-03-03 | 移動体の位置計測方法及び装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003055379A JP3710451B2 (ja) | 2003-03-03 | 2003-03-03 | 移動体の位置計測方法及び装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2004264182A true JP2004264182A (ja) | 2004-09-24 |
| JP3710451B2 JP3710451B2 (ja) | 2005-10-26 |
Family
ID=33119407
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2003055379A Expired - Fee Related JP3710451B2 (ja) | 2003-03-03 | 2003-03-03 | 移動体の位置計測方法及び装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3710451B2 (ja) |
Cited By (23)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2005062083A (ja) * | 2003-08-19 | 2005-03-10 | Komatsu Engineering Corp | 位置誤差補正機能を持つ測量システム |
| KR100571122B1 (ko) | 2005-10-27 | 2006-04-13 | 한진정보통신(주) | 항공레이저측량시스템 보정을 위한 조정인자 산출방법 |
| JP2006301716A (ja) * | 2005-04-15 | 2006-11-02 | Fuji Heavy Ind Ltd | 自律走行車及びその制御方法 |
| CN100455992C (zh) * | 2006-03-09 | 2009-01-28 | 重庆四通都成科技发展有限公司 | 公交车辆综合定位信息装置 |
| JP2009103497A (ja) * | 2007-10-22 | 2009-05-14 | Churyo Eng Kk | 初期位置補正機能を有する単独ｇｐｓ測位による移動局の走行軌跡計測装置 |
| JP2009193097A (ja) * | 2008-02-12 | 2009-08-27 | Yaskawa Electric Corp | 移動ロボットの制御装置および移動ロボットシステム |
| CN102661749A (zh) * | 2012-05-11 | 2012-09-12 | 苏州大方特种车股份有限公司 | 动力平板运输车精确对接控制系统 |
| CN103233430A (zh) * | 2013-04-02 | 2013-08-07 | 中铁科工集团有限公司 | 一种基于激光测距的箱梁运架一体机穿越隧道自动导航系统 |
| JP5555367B1 (ja) * | 2013-11-18 | 2014-07-23 | 株式会社シーティーエス | 締固め及び敷均し管理システム |
| JP2015007572A (ja) * | 2013-06-25 | 2015-01-15 | 東京航空計器株式会社 | 車両速度計測装置 |
| JP2016090428A (ja) * | 2014-11-06 | 2016-05-23 | 株式会社デンソー | 測位装置 |
| WO2018056661A1 (ko) * | 2016-09-23 | 2018-03-29 | 한국생산기술연구원 | 지상원점 기준의 실시간 고정밀 공간정보 계측 지원시스템 |
| JPWO2017072980A1 (ja) * | 2015-10-30 | 2018-08-23 | 株式会社小松製作所 | 作業機械の制御システム、作業機械、作業機械の管理システム、及び作業機械の管理方法 |
| CN108449951A (zh) * | 2015-12-03 | 2018-08-24 | 三星电子株式会社 | 用户终端及其控制方法 |
| CN108931794A (zh) * | 2018-04-13 | 2018-12-04 | 东风商用车有限公司 | 一种盲区车辆定位系统及其控制方法 |
| JP2019120629A (ja) * | 2018-01-10 | 2019-07-22 | 三菱電機株式会社 | 位置計算装置、位置計算プログラム及び座標マーカ |
| JP2020032873A (ja) * | 2018-08-30 | 2020-03-05 | 先進モビリティ株式会社 | 自動運行方法 |
| US10816675B2 (en) | 2016-02-12 | 2020-10-27 | Panasonic Intellectual Property Management Co., Ltd. | Coordinate output method and coordinate output device |
| WO2021255797A1 (ja) * | 2020-06-15 | 2021-12-23 | 株式会社Doog | 自律移動装置、自律移動方法及びプログラム |
| JP2022009595A (ja) * | 2018-08-30 | 2022-01-14 | 先進モビリティ株式会社 | 自動運行方法 |
| JP2023142798A (ja) * | 2022-03-25 | 2023-10-05 | いすゞ自動車株式会社 | 操舵制御装置 |
| JP2023142797A (ja) * | 2022-03-25 | 2023-10-05 | いすゞ自動車株式会社 | 操舵制御装置 |
| JP2023142794A (ja) * | 2022-03-25 | 2023-10-05 | いすゞ自動車株式会社 | 操舵制御装置 |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN107839670B (zh) * | 2017-10-27 | 2020-08-25 | 苏州浪潮智能科技有限公司 | 一种车辆转向舒适度提升方法及系统 |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH05216531A (ja) * | 1992-02-05 | 1993-08-27 | Komatsu Ltd | 移動体のコースずれ検出装置 |
| JPH06138939A (ja) * | 1992-10-26 | 1994-05-20 | Komatsu Ltd | 移動体の相対距離計測装置および位置計測装置 |
| JP2002215236A (ja) * | 2001-01-22 | 2002-07-31 | Komatsu Ltd | 無人車両の走行制御装置 |
-
2003
- 2003-03-03 JP JP2003055379A patent/JP3710451B2/ja not_active Expired - Fee Related
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH05216531A (ja) * | 1992-02-05 | 1993-08-27 | Komatsu Ltd | 移動体のコースずれ検出装置 |
| JPH06138939A (ja) * | 1992-10-26 | 1994-05-20 | Komatsu Ltd | 移動体の相対距離計測装置および位置計測装置 |
| JP2002215236A (ja) * | 2001-01-22 | 2002-07-31 | Komatsu Ltd | 無人車両の走行制御装置 |
Cited By (34)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2005062083A (ja) * | 2003-08-19 | 2005-03-10 | Komatsu Engineering Corp | 位置誤差補正機能を持つ測量システム |
| JP2006301716A (ja) * | 2005-04-15 | 2006-11-02 | Fuji Heavy Ind Ltd | 自律走行車及びその制御方法 |
| KR100571122B1 (ko) | 2005-10-27 | 2006-04-13 | 한진정보통신(주) | 항공레이저측량시스템 보정을 위한 조정인자 산출방법 |
| CN100455992C (zh) * | 2006-03-09 | 2009-01-28 | 重庆四通都成科技发展有限公司 | 公交车辆综合定位信息装置 |
| JP2009103497A (ja) * | 2007-10-22 | 2009-05-14 | Churyo Eng Kk | 初期位置補正機能を有する単独ｇｐｓ測位による移動局の走行軌跡計測装置 |
| JP2009193097A (ja) * | 2008-02-12 | 2009-08-27 | Yaskawa Electric Corp | 移動ロボットの制御装置および移動ロボットシステム |
| CN102661749A (zh) * | 2012-05-11 | 2012-09-12 | 苏州大方特种车股份有限公司 | 动力平板运输车精确对接控制系统 |
| CN103233430A (zh) * | 2013-04-02 | 2013-08-07 | 中铁科工集团有限公司 | 一种基于激光测距的箱梁运架一体机穿越隧道自动导航系统 |
| CN103233430B (zh) * | 2013-04-02 | 2015-03-18 | 中铁科工集团有限公司 | 一种自动导航系统及其操作方法 |
| JP2015007572A (ja) * | 2013-06-25 | 2015-01-15 | 東京航空計器株式会社 | 車両速度計測装置 |
| JP5555367B1 (ja) * | 2013-11-18 | 2014-07-23 | 株式会社シーティーエス | 締固め及び敷均し管理システム |
| JP2016090428A (ja) * | 2014-11-06 | 2016-05-23 | 株式会社デンソー | 測位装置 |
| US10935660B2 (en) | 2015-10-30 | 2021-03-02 | Komatsu Ltd. | Control system of work machine, work machine, management system of work machine, and method of managing work machine |
| JPWO2017072980A1 (ja) * | 2015-10-30 | 2018-08-23 | 株式会社小松製作所 | 作業機械の制御システム、作業機械、作業機械の管理システム、及び作業機械の管理方法 |
| CN108449951A (zh) * | 2015-12-03 | 2018-08-24 | 三星电子株式会社 | 用户终端及其控制方法 |
| CN108449951B (zh) * | 2015-12-03 | 2022-11-11 | 三星电子株式会社 | 用户终端及其控制方法 |
| US10816675B2 (en) | 2016-02-12 | 2020-10-27 | Panasonic Intellectual Property Management Co., Ltd. | Coordinate output method and coordinate output device |
| KR101874570B1 (ko) | 2016-09-23 | 2018-07-04 | 한국생산기술연구원 | 지상원점 기준의 실시간 고정밀 공간정보 계측 지원시스템 |
| KR20180032887A (ko) * | 2016-09-23 | 2018-04-02 | 한국생산기술연구원 | 지상원점 기준의 실시간 고정밀 공간정보 계측 지원시스템 |
| WO2018056661A1 (ko) * | 2016-09-23 | 2018-03-29 | 한국생산기술연구원 | 지상원점 기준의 실시간 고정밀 공간정보 계측 지원시스템 |
| JP2019120629A (ja) * | 2018-01-10 | 2019-07-22 | 三菱電機株式会社 | 位置計算装置、位置計算プログラム及び座標マーカ |
| JP7114165B2 (ja) | 2018-01-10 | 2022-08-08 | 三菱電機株式会社 | 位置計算装置、及び、位置計算プログラム |
| CN108931794A (zh) * | 2018-04-13 | 2018-12-04 | 东风商用车有限公司 | 一种盲区车辆定位系统及其控制方法 |
| JP2022009595A (ja) * | 2018-08-30 | 2022-01-14 | 先進モビリティ株式会社 | 自動運行方法 |
| JP2020032873A (ja) * | 2018-08-30 | 2020-03-05 | 先進モビリティ株式会社 | 自動運行方法 |
| JP7240472B2 (ja) | 2018-08-30 | 2023-03-15 | 先進モビリティ株式会社 | 自動運行方法 |
| WO2021255797A1 (ja) * | 2020-06-15 | 2021-12-23 | 株式会社Doog | 自律移動装置、自律移動方法及びプログラム |
| JP7495154B2 (ja) | 2020-06-15 | 2024-06-04 | 株式会社Doog | 自律移動装置、自律移動方法及びプログラム |
| JP2023142798A (ja) * | 2022-03-25 | 2023-10-05 | いすゞ自動車株式会社 | 操舵制御装置 |
| JP2023142797A (ja) * | 2022-03-25 | 2023-10-05 | いすゞ自動車株式会社 | 操舵制御装置 |
| JP2023142794A (ja) * | 2022-03-25 | 2023-10-05 | いすゞ自動車株式会社 | 操舵制御装置 |
| JP7380735B2 (ja) | 2022-03-25 | 2023-11-15 | いすゞ自動車株式会社 | 操舵制御装置 |
| JP7380733B2 (ja) | 2022-03-25 | 2023-11-15 | いすゞ自動車株式会社 | 操舵制御装置 |
| JP7380734B2 (ja) | 2022-03-25 | 2023-11-15 | いすゞ自動車株式会社 | 操舵制御装置 |
Also Published As
| Publication number | Publication date |
|---|---|
| JP3710451B2 (ja) | 2005-10-26 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3710451B2 (ja) | 移動体の位置計測方法及び装置 | |
| JP4229358B2 (ja) | 無人車両の走行制御装置 | |
| US6272405B1 (en) | Apparatus and method for guiding vehicle autonomously | |
| JP3467136B2 (ja) | 自律走行車の走行制御装置 | |
| CN112298353B (zh) | 用于校准方向盘中性位置的系统和方法 | |
| US10386840B2 (en) | Cruise control system and method | |
| US11829151B2 (en) | Construction-vehicle autonomous travel control device | |
| GB2286696A (en) | Autonomous vehicle guidance system | |
| US11015940B2 (en) | Systems and methods for longitudinal position correction of a vehicle using mapped landmarks | |
| JPH09319430A (ja) | 自動誘導車両の航行操舵制御システム | |
| US7164985B2 (en) | Vehicle-direction estimating device, and driving control device including the vehicle-direction estimating device | |
| JPH113499A (ja) | 移動体管理システム，移動体載装置，基地局備装置および移動体管理方法 | |
| CN115427759B (zh) | 地图信息校正方法、驾驶辅助方法及地图信息校正装置 | |
| JP3869108B2 (ja) | 無人車両の干渉予測装置および無人車両の誘導走行方法 | |
| JP2021113047A (ja) | 移動体制御装置、移動体制御方法、および、移動体制御装置用プログラム | |
| JP6943127B2 (ja) | 位置補正方法、車両制御方法及び位置補正装置 | |
| JP2018073010A (ja) | 移動体制御装置、移動体制御方法、および、移動体制御装置用プログラム | |
| JP2005250696A (ja) | 車両自律走行制御システム及び方法 | |
| JP7040308B2 (ja) | 無人搬送車の走行制御装置及び走行制御方法 | |
| JPH0991039A (ja) | 作業車の誘導制御装置 | |
| JP3595625B2 (ja) | 自律走行車の走行制御装置 | |
| JPH09149706A (ja) | 自律走行車の走行制御装置 | |
| JP3158029B2 (ja) | 作業車の作業状態制御装置 | |
| JP3113567B2 (ja) | 作業車の作業状態制御装置 | |
| JPH07104847A (ja) | 自律走行車の走行制御装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20050628 |
|
| 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: 20050809 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20050809 |
|
| 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 |