JP4229358B2 - 無人車両の走行制御装置 - Google Patents

無人車両の走行制御装置 Download PDF

Info

Publication number
JP4229358B2
JP4229358B2 JP2001012722A JP2001012722A JP4229358B2 JP 4229358 B2 JP4229358 B2 JP 4229358B2 JP 2001012722 A JP2001012722 A JP 2001012722A JP 2001012722 A JP2001012722 A JP 2001012722A JP 4229358 B2 JP4229358 B2 JP 4229358B2
Authority
JP
Japan
Prior art keywords
roadside
vehicle
distance
positioning
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.)
Expired - Fee Related
Application number
JP2001012722A
Other languages
English (en)
Other versions
JP2002215236A (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.)
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 JP2001012722A priority Critical patent/JP4229358B2/ja
Priority to US10/050,824 priority patent/US6751535B2/en
Publication of JP2002215236A publication Critical patent/JP2002215236A/ja
Application granted granted Critical
Publication of JP4229358B2 publication Critical patent/JP4229358B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Images

Classifications

    • 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/01Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13Receivers
    • G01S19/23Testing, monitoring, correcting or calibrating of receiver elements
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • 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
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/86Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
    • 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/01Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13Receivers
    • G01S19/14Receivers specially adapted for specific applications
    • 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/40Correcting position, velocity or attitude
    • 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/485Determining 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 optical system or imaging system
    • 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
    • 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/50Determining position whereby the position solution is constrained to lie upon a particular curve or surface, e.g. for locomotives on railway tracks
    • 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
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/48Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
    • G01S7/497Means for monitoring or calibrating
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • G05D1/024Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/027Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising intertial navigation means, e.g. azimuth detector
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0278Control 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

Description

【0001】
【発明の属する技術分野】
本発明は、鉱山、採石場等で予め設定された走行経路を自動走行する無人車両の走行制御装置に関する。
【0002】
【従来の技術】
従来、予め設定された走行経路を自動走行する無人車両の走行システムとしては、GPS受信器により無人車両の絶対位置をする衛星測位航法(以後、GPS航法と言う)と、無人車両の走行方向及び走行距離を検出して前記絶対位置を基準とした相対位置及び方位を内界センサにより推定演算する自律的な航法とを併用し、両者の相互補完により位置計測精度を向上して走行するようにしたものが良く知られている。前記自律的な航法には、推測航法(速度センサや移動距離センサを用いて走行距離を求め、かつジャイロや地磁気センサを用いて方位を推定することで車両の位置と方位を推定する航法)や、慣性航法(ジャイロと加速度センサを用いて車両の位置と方位を推定する航法)等が良く知られている。以後、これらを総称して自律航法と呼ぶ。
【0003】
図12は、無人車両の走行システムを説明する図である。同図において、固定基地局1は無人車両10の管制を制御するものであり、管制通信アンテナ2bを介して走行経路データや車両管制制御指令を無人車両10に送信したり、車両状態信号を受信するようにしている。
【0004】
また、無人車両10は、位置計測部及び走行制御部を有している。位置計測部により、GPSアンテナ12aを介してGPS受信器により受信した複数の衛星3a,〜3eからの位置情報に基づいて車両自身の現在位置の絶対座標値を求める(GPS航法)。このとき、前記位置計測部はGPSによる前記絶対座標位置からの相対位置及び方位を走行方向と走行距離に基づいて求め、順次現在位置及び方位を推定演算している(自律航法)。そして、所定のGPS測位サンプリング時間走行した後に、新たに計測したGPSによる絶対位置に基づいて前記相対位置及び方位による現在位置及び方位を補正する。そして、走行制御部により、予め設定されている走行経路の位置及び方位(走行方向)と前記現在位置及び方位との比較結果に基づいて走行方向を演算すると共に、該走行方向に所定速度で走行するように操舵及び車速を制御する。以上の処理を繰り返して、無人車両を走行経路に沿って誘導走行するようにしている。
【0005】
上記のようなGPS航法は、測位開始したタイミングからの計算時間及びGPS受信機から最終的な位置計測部までの通信遅れ、測位データを出力するタイミング時間間隔が、自律航法での位置演算時間よりも遅いという欠点がある。また、衛星3a,〜3eの受信環境、即ち、無人車両の上空が周囲の岩壁、森林、構造物等のために正常にGPS受信可能な状態であるかという上空視界性、衛星配置、及び周囲の反射物から反射された電波を受信した時のマルチパス等の受信環境要因により、またDGPS(いわゆる、ディファレンシャル方式GPS)の場合には固定基地局1からの補正情報通信が山、岸壁、森林、構造物、電波環境などの様々な要因により遅れることにより、その測位精度が劣化したり、測位不能になる場合があるという問題も知られている。
【0006】
一方、自律航法は、その欠点を補完するために用いられ、例えば速度センサと方位センサとの計測値に基づき所定時間毎に短時間で走行距離を演算して相対位置を算出しているので、リアルタイムに測位できる。ところが、速度センサや方位センサ等のセンサ誤差が累積し、測位精度の劣化の問題があるために、上記GPS航法により所定時間毎に補正して、位置精度の維持を図っている。
【0007】
【発明が解決しようとする課題】
しかしながら、上記従来の無人車両の走行システムにおいては、次のような問題がある。
(1)GPS航法では、前述のように衛星受信環境の悪化や、DGPSの場合には基地局からの補正データの受信環境の悪化等により測位精度が劣化したり、測位不能となる場合がある。この場合には、GPS航法による絶対位置と自律航法による相対位置及び方位とに基づいて求める現在位置及び現在方位の精度が劣化したり、あるいは自律航法のみで走行すると計測誤差の累積により現在位置及び現在方位の精度が劣化する。このため、無人車両の誘導精度が低下するから、車両管制に支障を来す。
(2)自律航法に係わる速度センサや方位センサ等が故障した場合、GPS航法のみにより走行すると、前述のようにGPS航法による測位データ出力時間間隔が遅いので、計測する絶対座標位置の間隔が長過ぎてこの間の走行誘導精度が低下する。また、GPS航法のみでは低速時に速度精度や方位精度が劣化すること、及び旋回時にGPSアンテナ軌跡(GPSによる方位に相当する)が車両の姿勢方向とは異なることによる測位(位置及び方位)精度が劣化することなどが影響し、走行誘導精度が低下する。
また、このときGPS航法の受信環境や通信環境の悪化による測位(位置及び方位)精度の低下が生じると、さらに走行誘導精度が低下する。このため、自律航法不可となる故障の場合には車両管制に支障を来し、無人車両の稼働率が低下する。
しかしながら、上記の場合でも確実に誘導走行できるような信頼性の高い走行システムが強く要望されている。
【0008】
本発明は、上記の問題点に着目してなされたものであり、GPS航法又は自律航法の測位精度の劣化や測位不能な状態を招いた場合でも、走行誘導精度を高く維持できる無人車両の走行制御装置を提供することを目的としている。
【0009】
【課題を解決するための手段、作用及び効果】
上記の目的を達成するために、第1発明は、GPS信号を受信して車両の絶対座標位置を測位するGPS受信器と、車両の走行方向及び走行距離を計測し、この計測結果に基づいて車両の特定位置からの相対座標位置及び方位を測位する自律航法演算器と、GPS受信器及び自律航法演算器のそれぞれの測位結果に基づき車両の現在位置及び方位を演算する位置計測部と、予め設定された走行経路の位置及び方位と位置計測部により演算された現在位置及び方位とをそれぞれ比較し、それぞれの偏差値を小さくするように車両走行を制御する走行制御部とを備えた無人車両の走行制御装置において、車両から走行経路の脇に設けた路側帯までの距離を計測する路側帯距離計測器を設け、前記位置計測部は、路側帯の座標位置や路側帯と走行経路との間の距離情報を記憶している地形情報、及び路側帯距離計測器により計測した路側帯距離から現在位置を推定し、該推定した現在位置に基づき、前記GPS受信器の測位位置、及び/又は、自律航法演算器の測位位置と方位との少なくとも一方を補正して現在位置と方位を求め、路側帯距離の変化率、又は複数の位置で計測した路側帯距離から算出される車両に対する路側帯の相対向きのパラメータが所定許容値以上の大きさであるときには、路側帯が不安定であると判断し、路側帯距離計測による測位データは前記補正に使用しない構成としている。
【0010】
第1発明によると、予め路側帯の座標位置や路側帯と走行経路との間の距離情報を記憶している地形情報、及び路側帯(路肩、看板、反射板等により構成される)までの距離の計測値から現在位置を推定し、該推定した現在位置に基づき、GPS航法による測位位置、及び/又は、自律航法による測位位置と方位との内少なくともいずれか一方を補正して現在位置と方位を算出し、路側帯距離の変化率、又は複数の位置で計測した路側帯距離から算出される土手の車両に対する相対向きのパラメータが所定許容値以上の大きさであるときには、路側帯が不安定であると判断し、路側帯距離計測による測位データは前記補正に使用しないので、GPS測位誤差や、自律航法の測位誤差による位置と方位の計測精度の低下を低減して、より信頼性の高い車両位置と方位を測位できる。また、GPS航法又は自律航法の測位が不能となったり、測位データの異常が認められた場合でも、正常な方のGPS航法又は自律航法による測位(位置と方位)データと路側帯距離の計測値とに基づき信頼性のある現在位置と方位を求めることができるので、誘導走行を継続でき、無人車両の稼働率を高めることができる。この結果、信頼性の高い無人車両の走行システムを構成できる。さらに、路側帯が不安定である、即ち予め設定されていないエリアで不連続に途切れていたり、又は予め設定された変化率よりも大きく変化したりするようなエリアには何か異常が発生したと判断され、このような異常の有るエリアで計測した路側帯距離は異常データとみなされる。ここで、路側帯の地形情報として、予め、路肩の設置範囲及び走行経路に対する路側帯距離変化率、看板や反射板の設置座標及び形状等を設定しておく。計測した路側帯距離から求めた路側帯距離の変化率、又は車両に対する路側帯の相対向きのパラメータが所定許容値以上であるときには、路側帯が不安定であると判断し、路側帯距離により推定した測位データは前記補正に使用しないようにしている。これにより、路側帯が不安定な場合に前記補正によって測位(位置と方位)精度が低下するのを防止し、自動走行を継続でき、無人車両の稼働率を高めることができる。
【0013】
発明は、第発明に基づき、GPS受信器、自律航法演算器及び路側帯距離計測器は、それぞれ自身の故障診断機能を有し、前記位置計測部の路側帯距離に基づく補正は、GPS受信器の測位精度推測値及び/又は自律航法演算器の測位精度推測値と、路側帯距離計測器の測位精度推測値とに応じたセンサーフュージョンにより行い、GPS受信器、自律航法演算器及び路側帯距離計測器のいずれかの測位モジュールに異常がある時は、異常モジュールの測位データを除外して他の測位データ同士をその測位精度推測値に応じたセンサーフュージョンにより補完し合うようにしている。
【0014】
発明によると、GPS受信器、自律航法演算器、路側帯距離計測器のそれぞれの測位精度推測値に応じたセンサーフュージョンにより補正位置と補正方位を演算しているので、より信頼性の高い位置を求めることができる。尚、前記測位精度推測値は、GPS受信器、自律航法演算器、路側帯距離計測器のそれぞれの測位した結果及び認識している各センサ情報や、経験的な判断から推測したものであり、リアルタイムで推測してもよいし、又は予め所定値に設定しても構わない。また、GPS受信器、自律航法演算器及び路側帯距離計測器のいずれかの測位モジュールに異常がある時は、異常モジュールの測位データを除外して他の測位データ同士をその測位精度推測値に応じたセンサーフュージョンにより補完し合うので、より正確な無人車両の位置及び方位を求めることができる。
【0015】
【発明の実施の形態】
以下に、図面を参照して本発明の実施形態について詳細に説明する。
【0016】
本発明に係る無人車両の走行システムの基本構成は図12と同じものとする。ここで、固定基地局1の位置(絶対座標)は予め正確に計測されている。固定基地局1は、GPSアンテナ2aを介してGPS受信器により受信した複数の衛星3a,〜3eからの位置情報に基づいてGPSによる絶対座標値を演算し、この演算した絶対座標値と予め正確に測量して記憶した基地座標値との比較により各演算時点でのGPSによる測位誤差パラメータ(各受信器の共通誤差を表すパラメータであり、例えば、複数の衛星3a,〜3eからの距離情報受信時の受信器内時計の時間遅れデータや、時刻情報データや、衛星軌道誤差データ等からなる)を求める。そして、求めたGPSの測位誤差パラメータを補正データとして管制通信アンテナ2bを介して無人車両10に送信する。
【0017】
図1により、本発明に係る無人車両側の制御装置構成を説明する。
GPS受信器13はGPSアンテナ12aを介して複数のGPS衛星から位置情報を受信し、車両の絶対位置、方位及び速度(この場合は、GPSアンテナ12aの移動方向を表すGPS姿勢角、及び移動速度を表すGPS速度である)を計測する。このとき、固定基地局1から管制通信アンテナ12bを介して受信した前記補正データに基づき、車両自身で測位した絶対座標値、方位及び速度を補正する(いわゆる、ディファレンシャル方式GPSである)。また、GPS受信器13は自身の故障診断機能を有しており、例えば、GPS通信情報に含まれる、つまりGPS衛星で検出した通信異常信号の解析、及びGPS受信器13側での受信データ異常検出などが行われる。
【0018】
自律航法演算器14は、基点となる位置からの相対的な移動位置を測位するものであり、自律航法による相対位置及び方位(この場合は走行方向)を演算している。本実施形態では推測航法による例で示し、無人車両の走行方向を計測するジャイロ21と、走行速度を計測する速度センサ22とを有しており、計測した走行方向と、走行速度から演算される走行距離とにより相対位置及び方位を求めている。慣性航法による場合には、一般的な構成と同様に、重力方向に対して常に平衡状態を保持するジャイロによるプラットホームを設け、このプラットホームに加速度センサを備えており、加速度信号を積分して速度信号を求め、さらに速度信号を算出して移動距離を求め、ジャイロにより走行方向を検出し、これらの各データから推測航法と同様の相対位置及び方位を求めるようにしている。以後の説明は推測航法について説明しているが、慣性航法についても同様に構成できる。尚、速度センサ22は、例えば車輪の回転数を検出する回転センサで構成され、4輪の内の少なくとも一個所に(例えば左右前輪と後輪の3個所に)設けている。また、自律航法演算器14は自身の故障診断機能を有しており、ジャイロ21からの入力データ異常や故障信号の解析、速度センサ22からの入力データ異常(例えば、検出信号の変化異常や、左右前輪及び1個の後輪にそれぞれ速度センサ22を設けた場合の各速度センサ22からの信号同士の比較)や断線検出信号の解析などにより故障診断を行っている。
【0019】
路側帯距離計測器15は、無人車両10から走行経路の路側帯(土手、又は路側帯を表す壁や反射板等)までの距離を非接触で計測するものであり、例えばレーザ距離計23や超音波距離計等を有している。路側帯距離計測器15は自身の故障診断機能を有しており、例えば、計測信号の変化異常の解析を行う。
【0020】
位置計測部11は、それぞれの測位モジュール(即ち、GPS受信器13、自律航法演算器14及び路側帯距離計測器15)の測位データ(位置及び方位であり、以後特に断らない限り同様とする)に基づいて、各測位データの信頼性に応じた重みを考慮して加算平均し、より信頼性の高い正確な無人車両の位置及び方位を演算する。以後、このような重みを考慮して加算平均により測位することをセンサーフュージョンという。即ち、それぞれの測位モジュール13,14,15からの故障診断結果信号に基づき、又はそれぞれの測位モジュール13,14,15の測位データ間の乖離(データ矛盾やデータ異常)をチェックし、異常の無い時は、各測位データの信頼性つまり測位精度推測値(以後、単に測位精度と言う)の大きさに応じたセンサーフュージョンにより測位し、いずれかの測位モジュールに異常がある時は、異常モジュールの測位データを除外して他の測位データ同士をその測位精度(信頼性)に応じたセンサーフュージョンにより補完し合い、より正確な無人車両の位置及び方位を求めるようにしている。尚、それぞれの測位モジュール13,14,15の測位精度は、測位した結果及び認識している各センサ情報や、経験的な判断から推測されるものであり、その推測値は実処理時にリアルタイムで推定演算してもよいし、又は予め所定値に設定してあっても構わない。
【0021】
尚、上記データ異常の検出方法としては、例えば、管制制御部16から走行経路に沿った地形情報を入力し、この入力した地形情報と路側帯距離計測器15からの測位データとの差値情報に基づきデータ異常判定を行う。
そして、前記求めた正確な測位データに基づき無人車両を走行させるために、この測位データをそれぞれ管制制御部16、走行制御部17及び安全管理部19に出力する。
【0022】
管制制御部16は、予め走行経路データCD及び地形情報GIを記憶しておき、自動走行時にはこの記憶している走行経路データCDを走行制御部17と位置計測部11とに、また地形情報GIを位置計測部11に出力している。地形情報GIは、走行経路に沿って設置された路側帯に関する情報であり、詳細は後程説明する。
尚、走行経路データCDは、車両を実際にマニュアル走行して教示するティーチングにより作成してもよいし、予め走行経路の測量データに基づいてオフラインにて作成したものを固定基地局1から管制通信アンテナ12bを介して受信するようにしてもよい。また、上記ティーチングで作成された走行経路データCDを路側帯との距離に応じて、即ち路側帯距離と関連づけて編集、修正したものであってもよい。
またティーチングはGPSの条件が良好な時に行われ、実際に走行経路に沿って走行した時のGPSによる位置、方位(走行方向)及び車速の各データを所定時間毎に記憶する。このとき、位置及び方位データとしては、GPSによる位置及び方位と自律航法による位置及び方位とをそれぞれの測位データの信頼性に応じて、つまりGPS通信信号の途切れ時間やGPS測位誤差、及び自律航法の計測誤差等の大きさに応じてセンサーフュージョンにより推定した位置及び方位を用いた方が好ましい。
【0023】
走行制御部17は、走行経路データに従って無人車両が走行するように操舵、速度を制御するための各種のアクチュエータ18を制御する。尚、アクチュエータ18には、例えば、操舵を行うステアリングシリンダを制御するステアリング制御弁、ブレーキやリターダを制御するブレーキ制御弁、エンジンの回転数制御レバーの揺動角を制御するモータ等がある。走行制御部17は走行経路上の目標位置及び目標方位と位置計測部11から入力した現在位置及び方位とのそれぞれの偏差が小さくなるように走行方向及び走行距離を算出し、算出した走行方向及び走行距離に基づいて前記アクチュエータ18に各制御指令を出力し、無人車両の自動走行を制御する。
【0024】
安全管理部19は、位置計測部11からの現在位置データに基づいて無人車両前方の走行コース上の障害物(人や車の侵入、落石等)を検出する機能を有し、障害物を検出した場合には無人車両を安全に停止させたり、障害物を回避して走行させたりする。また、位置計測系や制御系がなんらかの予期せぬ(つまり自身では検出不可能な)異常を来した場合には、コース上にあるはずの無い路側帯や対向車両等を障害物として検出して車両を緊急停止させる。
【0025】
次に、上記の地形情報について、詳細に説明する。
路側帯距離計測器15により計測した路側帯と走行中の無人車両との距離に基づいて無人車両の現在位置を推定し、この推定した位置データと他のGPS受信器13又は自律航法演算器14による測位データとのセンサーフュージョンを行って正確な現在位置及び方位を得るためには、走行経路の各走行位置に対応した走行経路から路側帯までの正確な距離情報が必要となる。前記地形情報GIとは、この正確な距離情報を得るための路側帯情報である。地形情報GIは、走行経路の幅、経路脇の土手の有無や連続性を表す地形情報、上空視界性が悪くて路側帯距離でのセンサーフュージョンが必要な走行エリアの走行方向距離等の条件によって、それぞれ構成されるデータ内容が異なる以下のような種々のデータ設定方式が考えられる。
【0026】
・地形情報GIの設定方式
(1)走行路幅が均一で、走行路脇の土手の整備が行き届いている場合
図2に示すように、走行経路4(路幅の略中央線)と路側帯5との距離が一定であるから、無人車両10と路側帯5との距離Lの基準値L0を予め設定しておく。この基準距離L0と路側帯距離計測器15による計測値との差値により、現在位置を推定する。
【0027】
(2)走行路幅が不均一で、土手の整備が行き届いているが、走行経路と土手との距離が不均一な場合(基準距離L0一定では成立しない場合)
図3に示すように、走行経路4と路側帯5との距離が走行経路4に応じて変化するので、走行経路4に応じて基準距離L0を逐次演算する必要がある。また、この場合には、走行経路4に対する土手の傾き(路側帯距離の変化率)も地形情報GIとして記憶している。地形情報GIは、例えば次のようないくつかの設定方法がある。
2-1)無人車両10側で、精密に測量した土手の座標データを走行経路4に応じて記憶する方法
この記憶した土手座標と走行経路4との距離により基準距離L0を逐次求め、求めた基準距離L0と実測距離データLとの差値により現在位置を推定する。また、前記土手座標と走行経路4間の距離に基づき、走行経路4に対する土手の傾き(路側帯距離の変化率)が算出される。尚、土手座標と自車位置と走行経路4とを比較して、座標が重なったり、接近し過ぎたり、座標データの乖離(矛盾)等の異常が無いかを検出することも可能である。
2-2)基地局にある車両管制システム側で、精密に測量した土手座標データと走行経路4との距離を演算しておき、走行経路4に応じて無人車両10が車両管制システム側から受信する方法
この方式は、無人車両10側の演算処理時間が速くなる利点がある。
2-3)走行経路4のティーチングの時に走行経路4に応じて土手までの距離Lを計測し、これらの走行経路4のティーチングデータと上記計測した路側帯距離Lとを共に車両管制システム側で記憶し、自動走行時、走行経路4に応じて路側帯距離Lを受信する方法
【0028】
(3)整備された土手が無いエリアが続く場合
走行路脇に一定間隔で反射ポールや看板等の所定の反射物を設置し、地形情報GIとして、反射物設置位置座標、又は該反射物と走行経路4との距離などが記憶される。自動走行時には、記憶した反射物設置座標と走行経路4の座標とから無人車両10と路側帯5(反射物)との基準距離L0を算出し、又は記憶した反射物と走行経路4との距離から前記基準距離L0を算出し、この基準距離L0に基づき無人車両10の現在位置を推定する。尚、反射物設置座標は測量して求めてもよいし、ティーチング走行時に同時に反射物位置を検出して記憶してもよい。また、反射物と走行経路4との距離も同様に測量結果から算出してもよいし、ティーチング時に同時に検出して記憶してもよい。
【0029】
(4)整備された土手があっても、車両走行方向の位置補正が必要になる場合
この場合、反射物が一定間隔で設置されたり、走行方向位置補正が必要なポイント(旋回点等)に反射物が設置される。これらの反射物の座標は予め正確に測量され、地形情報GIとして記憶される。
【0030】
次に、位置計測部11のセンサーフュージョン機能について詳細に説明する。(GPSと自律航法とのセンサーフュージョン)
GPS受信器13及び自律航法演算器14が共に故障が無く、かつ各測位データの異常が無い場合には、両者の測位データのセンサーフュージョンにより現在位置及び方位が算出される。即ち、図4に示すように、走行中は、所定時間毎にGPS受信器13により測位されたGPS絶対座標及び方位と、このときの固定基地局1からの前記補正データとを参照してGPSによる測位データ(位置及び方位)が求められ、このGPSによる測位データの計測精度とこれまでの自律航法による測位データの計測精度とを比較し、各測位データの精度(信頼性)に応じた重み(例えば0.8と0.2)をそれぞれ掛けて平均値を求め、これを補正された現在位置とし、この現在位置の補正量に基づき方位を補正する。尚、自律航法による方位データの計測精度が高い場合には、GPSによる測位データの内、位置データのみを用いてセンサーフュージョンを行なってもよい。走行制御部は、この補正された現在位置と走行経路4上の目標位置との偏差(距離)α、及び車両の実姿勢角(つまり走行方向)と走行経路4の目標姿勢角との偏差をそれぞれ小さくする方向に操舵量を決定し、無人車両10を走行させ、この間自律航法演算器14での推測航法により前記補正現在位置及び方位を基準とした相対位置から現在位置及び方位を推定演算する。以上のGPS航法と自律航法とのセンサーフュージョンを繰り返す。
【0031】
(GPSと自律航法とのセンサーフュージョンの異常検出)
GPS受信器13及び自律航法演算器14は正常であるが、測位データ間に異常(乖離)が発見された場合には、GPS受信器13、自律航法演算器14及び路側帯距離計測器15の各測位データ同士のセンサーフュージョンにより現在位置及び方位を推定する。即ち、GPS及び自律航法による各測位データのセンサーフュージョンにより求めた現在位置を、さらに路側帯距離による位置データとのセンサーフュージョンにより補正してより信頼性の高い現在位置を求め、この現在位置の補正量に基づきGPS航法及び自律航法による方位を補正してより信頼性の高い方位を求める。
ここで上記のデータ異常検出方法としては、例えば、図5に示すように正常な路側帯距離計測器15により計測した路側帯距離Lの実測値と前記地形情報GIにより設定された又は求められた基準距離L0との差値が所定値を越えた(即ち極端に小さくなり過ぎた、又は大きくなり過ぎた)ときに異常と判断することができる。あるいは、異なる測位方法での前記各測位データ同士の差値が所定値以上となったとき、データ間に大きな乖離があって異常とみなすこともできる。但し、基準距離L0及び路側帯実測距離のデータの安定性を判定し、確実にその連続性が認められ、かつ土手形状が安定して検出される、つまり連続性がある場合のみに、上記の異常検出の判定がなされるようにしている。また、当然のことながら、路側帯距離計測器15の故障が発生したときは、上述の路側帯実測距離と基準距離L0との差値の大きさによる異常診断や、路側帯距離によるセンサーフュージョンは行わないものとする。
【0032】
(GPS異常時の路側帯計測と自律航法とのセンサーフュージョン)
GPS受信器13の故障診断で異常が認められた場合、自律航法により走行するが、ジャイロ21と速度センサ22の累積誤差の影響により推定現在位置及び方位は徐々にズレを生じ、このずれた位置及び方位情報に基づき走行制御するので、図6に示すようにその実際の走行軌跡7はそのずれた分だけ目標の走行経路4から徐々に逸脱して行く。このとき、路側帯距離計測器15による路側帯距離Lの実測値と前記基準距離L0との差値に基づいて現在位置を推定し、この路側帯距離Lに基づく推定現在位置と前記自律航法による推定現在位置とのセンサーフュージョンにより位置補正を行ってより信頼性の高い現在位置を求め、この現在位置の補正量に基づき方位を補正する。通常の略直線的な又は緩やかなカーブの走行路で、路側帯5が土手や壁のようなものである場合には、上記で求めた現在位置に基づき、走行方向に対して横方向のみの位置補正を行う。この理由は、そのような場合、走行方向の位置誤差は横方向に比べて小さく、かつ横方向誤差の方が自動走行に関してはより重要であるのに対し、走行方向誤差は問題とならないことが多いからである。
尚、計測した路側帯距離Lが所定値よりも小さ過ぎたり、大き過ぎたりした時には、走行経路4から極端に逸脱したと判断して上記補正を行う前に、緊急停止するようにしている。
【0033】
(土手が無い場合、又は走行方向誤差が問題となる場合)
a)土手の無いエリアR(図7参照)が長い距離に及んで続く場合
b)交差点で曲がる場合、又は急旋回する場合
c)ホッパ、排土場や、積込場等の停止位置の近傍で、走行方向の位置精度が要求される場合
これらの場合には、図7に示すように、設置座標が予め正確に測量された、走行方向の位置補正用の反射ポールや看板等の反射板25を路側帯5として設置する。この座標既知の反射板25までの距離を路側帯距離計測器15により計測し、この計測距離に基づき現在位置を精度良く推定して横方向位置と共に走行方向位置を正確に補正することが可能となる。尚、路側帯距離計測器15による計測値から現在位置を求めるには、当該反射板25の既知座標と、計測時の車両の走行方向と、この走行方向に対する路側帯距離計測器15からのレーザや超音波の発信方向とに基づいて求めることが可能である。従って、仮にこのような場所でGPSによる測位が不能になったり異常となった時、又は自律航法に異常が認められた時には、路側帯距離計測器15による現在位置の測位データと、GPSによる測位及び自律航法演算器14による測位のいずれか正常である方の現在位置の測位データとのセンサーフュージョンにより、走行方向位置精度も高くでき、信頼性の高い位置を計測できる。この結果、走行経路4に沿って確実に操向でき、交差点や急旋回点での旋回が正確に行え、また停止位置での停止精度を向上できる。
【0034】
(自律航法異常時の路側帯計測とGPSでの測位とのセンサーフュージョン)
ジャイロ21や速度センサ22の故障等による自律航法演算器14の異常を認めた場合には、異常形態により以下のようにそれぞれ冗長系を形成している計測手段に切換えるようにしている。
a)装着している全速度センサが異常の場合
速度センサ22の代わりに、GPS速度を使用する。GPS速度データは、所定時間(例えば0.5秒)毎にGPS受信器13から出力される。
b)ジャイロに関する異常がある場合
ジャイロ21の代わりに、GPS姿勢角を使用する。GPS姿勢角は、GPS受信器13が出力する姿勢角、又はGPSアンテナ12aの位置移動軌跡による姿勢角(ここでは移動方向)の推定値である。
【0035】
上記のGPS速度は、所定時間毎の移動距離に基づき算出しているので低速での精度が低いときがあり、またデータ出力時間間隔がGPSのサンプリング時間よりも小さくならない為、自律航法による速度の計測精度よりも劣化するときがある。また上記のGPS姿勢角はGPSアンテナ位置の変化から算出されるので、車両直進時にはある程度の高い精度であるが、旋回時などには車両姿勢角(つまり走行方向)とは一致しないことから精度が劣化する等の欠点もある。従って、このようなGPS速度及びGPS姿勢角による位置計測精度は自律航法よりも低下するので、このGPSデータを用いた疑似的な自律航法により誘導走行すると、図8に示すように軌跡7aがずれて行く。このとき、路側帯距離計測器15による路側帯5(土手や、前述の反射板25等を含む)までの距離実測値Lに基づいて演算した現在位置と、上記GPS速度及び/又はGPS姿勢角により計測した現在位置とのずれ量から、この疑似的な自律航法による計測精度を推定し、推定した計測精度に基づき前記GPS速度及び/又はGPS姿勢角による現在位置を補正する。そして、補正した現在位置とGPS測位による現在位置とのセンサーフュージョンによって、より信頼性の高い現在位置を求め、さらにこの現在位置の補正量に基づき方位を補正する。
尚、上記の補正を行う以前に、路側帯距離の実測値と基準距離L0との差が極端に大きくなり過ぎた時は目標の走行経路4を逸脱しているから、無人車両10を緊急停止させるようにする。
【0036】
(土手安定判別について)
上述のような、路側帯距離計測に基づいてセンサーフュージョンや異常検出を実施する場合に重要なことは、先ず第1に、計測対象が土手や壁の場合、均一性(なだらかに変化すること)及び連続性(途切れてないこと)等の安定性を評価し、必ず評価結果が良好な時(安定と判断した時)に上記路側帯距離計測による測位データを使用すると言う大前提上で成立することである。即ち、予め土手や壁が設置されているエリアで不連続に途切れていたり、又は予め設定された変化率よりも大きく変化したりするような、路側帯5が不安定であるエリアには何か異常が発生したと判断され、このような異常の有るエリアで計測した路側帯距離は異常データとみなされる。第2に、反射ポールの場合には反射ポールの反射強度が所定値以上であること、また看板(所定の形状をなすサイン看板等)の場合にはその形状、設置位置及び設置距離等により特徴化することにより、これらの反射板25の特徴検出を可能として、他の物との識別を明確に行うことが重要である。
土手等の上記安定性の判別は、例えば路側帯距離の前回計測値からの変化量(差値)、変化率、又は複数の位置での計測距離から算出される土手の車両に対する相対向き(つまり土手の傾き)などのパラメータに基づき評価する。このとき、求めたパラメータが所定許容値(例えば、地形情報GIに基づいて求められる路側帯距離変化率に対して許容値を予め設定する)以上の大きさである時は、土手等の変化が急激であり、不安定であると判断し、路側帯距離計測による測位データは使用しないようにしている。また,安定判別評価結果は路側帯距離計測の精度推測値を計算する判断材料としており、これによりセンサーフュージョンする際の重み付けに反映してもよい。
尚、上記の方法に限定されず、予め安定エリアと不安定エリア又は土手の無いエリアとを測量して地形情報GIとして固定基地局1にある車両管制システム側で記憶しておき、無人車両10は車両管制システム側から通信でこの地形情報GIを入力してもよいことは言うまでもない。
【0037】
以上説明した位置計測部11のセンサーフュージョンの処理手順を、図9及び図10に示すフローチャートにより説明する。
先ずステップS1で、GPS受信器13からGPS航法に関係する情報を入力し、故障診断を行う。次にステップS2で、自律航法演算器14から自律航法の情報を入力し、故障診断を行う。次にステップS3で、路側帯距離計測器15から路側帯距離計測に関係する情報を入力し、故障診断を行う。さらにステップS4で、固定基地局1の車両管制システムから通信で走行経路データCD、地形情報GIを入力し、故障診断を行う。
【0038】
そしてステップS5で、走行経路データCDが正常か否か、即ち走行経路データCDの通信が正常か、及び受信したデータが連続的かをチェックし、正常のときは、ステップS7で地形情報GIが正常か否か、即ち地形情報GIの通信が正常か、及び受信したデータが正常か(例えば、土手の座標値の変化量、変化率が所定値以内か等)をチェックする。地形情報GIが正常のときは、ステップS8で路側帯距離計測に関する故障診断で正常かチェックし、正常なときは、さらにステップS9で路側帯距離計測データに基づき求めた路側帯5の安定性は良好かを判別する。前記ステップS7、ステップS8で正常でないとき、及びステップS9で安定性良好でないときには、ステップS10で路側帯計測不可フラグをセットし、ステップS11に移行する。尚、ステップS5で走行経路データCDが正常でないときは、ステップS6で走行制御部17に車両停止指令を出力して車両を停止させる。
【0039】
ステップS9で安定性が良好なときは、ステップS11で自律航法の故障診断結果が正常かをチェックし、正常なときは次にステップS12でGPS航法の故障診断結果が正常かをチェックし、正常なときはさらにステップS13で路側帯計測不可フラグがセットされているかチェックする。この後、路側帯計測不可フラグがセットされてないときは、ステップS14で自律航法、GPS航法及び路側帯距離計測によりそれぞれ現在位置を演算し、各現在位置同士の差値を求め、次にステップS15でこの各差値が所定値以内かチェックし、所定値以内のときはステップS16で各現在位置データ同士の乖離(相互矛盾)が無いと判断し、GPS航法、自律航法及び路側帯距離計測により求めたそれぞれの現在位置及び方位データに基づきセンサーフュージョンを行ない、補正現在位置及び方位を演算する。そして、この後、ステップ18でこの補正現在位置及び方位を最終的な車両位置及び方位として決定し、そのデータを管制制御部16、走行制御部17、安全管理部19に出力する。管制制御部16、走行制御部17及び安全管理部19はこの補正現在位置と方位、目標位置及び目標走行姿勢に基づきそれぞれ所定の管制制御、走行制御、安全走行管理を行う。これ以降、ステップS1に戻って処理を繰り返す。
【0040】
ステップS15で前記各差値が所定値以内でないときは、ステップS17で前記各現在位置データ同士の乖離が有ると判断し、走行制御部17に車両停止指令を出力して車両を停止させる。
【0041】
前記ステップS13で路側帯計測不可フラグがセットされているときは、ステップS19で自律航法及びGPS航法によりそれぞれ現在位置及び方位を演算し、両現在位置同士の差値を求め、次にステップS20でこの差値が所定値以内かチェックし、所定値以内のときはステップS21で両現在位置データ同士の乖離が無いと判断し、GPS航法及び自律航法により求めたそれぞれの現在位置及び方位データに基づきセンサーフュージョンを行ない、補正現在位置及び方位を演算し、この後前記ステップS18に移行する。またステップS20で前記差値が所定値以内でないときは、前記ステップS17に移行して車両を停止させる。
【0042】
前記ステップS12でGPS航法の故障診断結果が正常でないときは、ステップS22で路側帯計測不可フラグがセットされているかチェックし、路側帯計測不可フラグがセットされてないときは、ステップS23で自律航法及び路側帯距離計測によりそれぞれ現在位置を演算し、両現在位置同士の差値を求める。次にステップS24でこの差値が所定値以内かチェックし、所定値以内のときはステップS25で両現在位置データ同士の乖離が無いと判断し、自律航法及び路側帯距離計測により求めたそれぞれの現在位置及び方位データに基づきセンサーフュージョンを行ない、補正現在位置及び方位を演算する。この後、前記ステップS18に移行する。また、ステップS24で前記差値が所定値以内でないときは、前記ステップS17に移行して車両を停止させる。
【0043】
前記ステップS22で路側帯計測不可フラグがセットされているときは、ステップS26で自律航法により現在位置及び方位を推定演算し、ステップS27でこの推定現在位置及び方位に基づき車両を減速させて停止させるように走行制御部17に指令を出力する。
【0044】
前記ステップS11で自律航法の故障診断結果が正常でないときは、ステップS28でGPS航法の故障診断結果が正常かをチェックする。正常なときはステップS29で、前記自律航法の走行速度と走行方向との冗長を切換える、即ち走行速度に関する全ての(複数センサがある場合)入力データ異常又は全ての速度センサ異常と診断したら、速度データとしてGPS速度を用い、走行方向に関する入力データ異常又は方位センサ異常と診断したら、走行方向データとしてGPS姿勢を用いて自律航法を行う。
【0045】
そして、ステップS30で路側帯計測不可フラグがセットされているかチェックし、路側帯計測不可フラグがセットされてないときは、ステップS31で、速度センサ及び方位センサの内故障の無い方の計測データと、その故障した方の代用のGPS速度及び/又はGPS姿勢とに基づき自律航法により現在位置を演算すると共に、GPS航法及び路側帯距離計測によりそれぞれ現在位置を演算し、各現在位置同士の差値を求める。次にステップS32でこの各差値が所定値以内かチェックし、所定値以内のときはステップS33でGPS航法、自律航法(前記代用のGPS速度及び/又はGPS姿勢に基づく)及び路側帯距離計測により求めたそれぞれの現在位置データに基づきセンサーフュージョンを行なって補正現在位置及び方位を演算し、前記ステップS18に移行する。上記ステップS32で前記各差値が所定値以内でないときは、前記ステップS17に移行する。
【0046】
前記ステップS30で路側帯計測不可フラグがセットされているときは、ステップ34で車両減速停止指令を出力して車両の減速を開始させ、次にステップS35で、車両が停止するまでは、前記代用のGPS速度及び/又はGPS姿勢による代替自律航法を継続し、前記ステップ18に移行して所定の処理を行う。
【0047】
前記ステップS28でGPS航法の故障診断結果が正常でないときは、ステップS36で路側帯計測不可フラグがセットされているかチェックし、路側帯計測不可フラグがセットされてないときは、ステップS37で車両減速停止指令を出力して車両を減速停止させる。また、車両が停止するまでの操舵誘導は、路側帯計測の計測値と地形情報GIデータとに基づき走行を制御するように指令を出力する。次にステップS38では、車両が停止するまで、自律航法データの走行距離及び走行方向の内の異常発生していない方のデータと、異常が認められた方のデータについて過去の正常時の車両速度及び/又は車両姿勢、車両軌跡、現在の操舵角度等から推測した車両速度及び/又は走行方向データとに基づく自律航法、及び路側帯距離計測による位置補正演算を実施する。仮に、自律航法データの走行距離及び走行方向の両方共が異常である場合には、過去の正常時の車両速度と車両姿勢、車両軌跡、現在の操舵角度等から推測した車両速度及び走行方向データに基づく車両停止までの予測に基づいた自律航法と、路側帯距離計測とによる位置補正演算を実施する。
【0048】
前記ステップS36で路側帯計測不可フラグがセットされているときは、ステップS39で急制動をかけて車両を緊急停止させる。次にステップ40で、車両が停止するまで、自律航法データの走行距離及び走行方向の内の異常発生していない方のデータと異常が認められた方のデータを過去の正常時の車両速度及び/又は車両姿勢、車両軌跡、現在の操舵角度等から推測することでなされる自律航法を実施する。また、自律航法データの走行距離及び走行方向の両方が異常である場合には、その両方において過去の正常時の車両速度と車両姿勢、車両軌跡、現在の操舵角度等から車両停止までの予測に基づいた自律航法を実施する。
【0049】
図11は、本発明に係る走行制御装置を用いて行った実機テスト結果を表す走行軌跡図である。同図において、5aは走行経路4に沿って車両を走行させて土手までの距離を計測した時に安定判別結果が良好であったエリアの路側帯5を表し、5b(太線で示す)は安定判別結果がNGであったエリアの路側帯5を表している。このような路側帯5を設けた走行経路4に沿って自律航法のみで(GPS航法による測位が異常又は不能であると仮定している)走行した場合には、軌跡4aのようにずれて行くことが示されている。そして、このとき、路側帯安定判別結果が良好な時に路側帯距離計測と自律航法とのセンサーフュージョンにより現在位置を演算して走行した場合には、走行経路4から逸脱することなく図示のように走行することを確認した。このことから、路側帯距離計測とのセンサーフュージョンにより車両位置の測位精度を高めることができることが分かる。
【0050】
以上説明したように、本発明によると以下の効果を奏する。
(1)路肩、看板、反射板25等により構成される路側帯5までの距離の計測値に基づき、GPS航法による測位位置(さらに必要ならば方位)、及び/又は、自律航法による測位位置と方位との少なくともいずれか一方をセンサーフュージョンにより補正して現在位置と方位を算出するので、GPS測位誤差や自律航法測位誤差による位置計測精度の低下を抑制して、より信頼性の高い車両位置を測位できる。
(2)また、固定基地局1からの補正データ等の遅れ時間増大などの通信環境の悪化や、上空視界性、衛星配置、マルチパス等の受信環境の悪化によって、GPS航法の測位不能や測位精度の劣化が発生したり、自律航法の測位が不能となったり、両航法のいずれかの測位データの異常が認められた場合には、正常な方のGPS航法又は自律航法による測位データと路側帯距離の計測値とに基づきセンサーフュージョンにより信頼性のある現在位置及び方位を算出することができる。従って、上記異常が発生しても確実に誘導走行を制御でき、無人車両の稼働率を高めることができる。この結果、信頼性の高い無人車両の走行システムを構成できる。
【0051】
(3)路側帯5が不安定であるエリアで計測した路側帯距離は異常データとみなされ、路側帯5の安定性が認められた場合に路側帯距離計測による測位データを使用する。この路側帯距離の計測値に基づきセンサーフュージョンにより、GPS航法による測位位置(さらに必要ならば方位)、及び/又は自律航法による測位位置と方位との少なくともいずれか一方の補正を行うので、路側帯5が不安定な場合に前記補正を行うことによって生じる測位精度の低下を防止できる。また、路側帯5の安定性が認められた場合に、路側帯距離の計測値に基づき測位データ間の乖離(データ異常)が無いかをチェックするので、間違いのない判断ができる。この結果、路側帯5の不安定状況に左右されずに自動走行を継続でき、無人車両の稼働率を高めることができる。
【0052】
(4)GPS受信器13、自律航法演算器14及び路側帯距離計測器15のそれぞれの測位精度に応じたセンサーフュージョンにより補正位置を演算しているので、より信頼性の高い位置及び方位を求めることができる。従って、確実に無人車両10の誘導走行を制御できる。
【0053】
(5)地形情報GIと路側帯距離とに基づいて車両位置及び方位を測位しているので、例えば一時的にGPS航法及び自律航法の測位が共に不能となったり、両測位データに異常が認められた場合でも、直ちに停止することなく減速するなどして路側帯距離計測のみにより自動誘導走行ができる。従って、無人車両の誘導停止の頻度を少なくし稼働率を高めるので、信頼性の高い走行システムを構成できる。
(6)地形情報GIは路側帯5の状態に応じて、一定値の路側帯距離(基準距離L0)、あるいは走行経路4に対応した路側帯5の座標位置又は路側帯距離等を記憶することにより、様々な地形条件の走行経路4の場合でも本走行制御装置は対応できるようになっており、汎用的な走行システムを構成できる。
(7)土手の無いエリアや、例えば急旋回位置や停止位置近傍等のように車両の走行方向位置が重要となるエリアでは、路側帯として反射板25を設置することにより、精度の高い測位ができ、より信頼性を向上できる。
【図面の簡単な説明】
【図1】本発明の無人車両の制御装置の構成図である。
【図2】均一な路幅の走行路の説明図である。
【図3】走行経路と路側帯との距離が不均一な場合の走行路の説明図である。
【図4】GPSと自律航法とのセンサーフュージョンの説明図である。
【図5】路側帯距離計測値に基づく測位データ異常検出方法の説明図である。
【図6】路側帯計測と自律航法とのセンサーフュージョンの説明図である。
【図7】反射板を設置する場合の走行路の説明図である。
【図8】路側帯計測とGPSでの測位とのセンサーフュージョンの説明図である。
【図9】センサーフュージョンの処理手順を表すフローチャート(前半)例である。
【図10】センサーフュージョンの処理手順を表すフローチャート(後半)例である。
【図11】実機テスト結果を表す走行軌跡図である。
【図12】無人車両の走行システムの構成図である。
【符号の説明】
1…固定基地局、4…走行経路、5…路側帯、7,7a…軌跡、10…無人車両、11…位置計測部、13…GPS受信器、14…自律航法演算器、15…路側帯距離計測器、16…管制制御部、17…走行制御部、18…アクチュエータ、19…安全管理部、21…ジャイロ、22…速度センサ、23…レーザ距離計、25…反射板。

Claims (2)

  1. GPS信号を受信して車両の絶対座標位置を測位するGPS受信器(13)と、車両の走行方向及び走行距離を計測し、この計測結果に基づいて車両の特定位置からの相対座標位置及び方位を測位する自律航法演算器(14)と、GPS受信器(13)及び自律航法演算器(14)のそれぞれの測位結果に基づき車両の現在位置及び方位を演算する位置計測部(11)と、予め設定された走行経路(4) の位置及び方位と位置計測部(11)により演算された現在位置及び方位とをそれぞれ比較し、それぞれの偏差値を小さくするように車両走行を制御する走行制御部(17)とを備えた無人車両の走行制御装置において、
    車両から走行経路(4) の脇に設けた路側帯(5) までの距離を計測する路側帯距離計測器(15)を設け、
    前記位置計測部(11)は、路側帯 (5) の座標位置や路側帯と走行経路 (4) との間の距離情報を記憶している地形情報 (GI) 、及び路側帯距離計測器(15)により計測した路側帯距離から現在位置を推定し、該推定した現在位置に基づき、前記GPS受信器(13)の測位位置、及び/又は、自律航法演算器(14)の測位位置と方位との少なくとも一方を補正して現在位置と方位を求め、路側帯距離の変化率、又は複数の位置で計測した路側帯距離から算出される車両に対する路側帯 (5) の相対向きのパラメータが所定許容値以上の大きさであるときには、路側帯が不安定であると判断し、路側帯距離計測による測位データは前記補正に使用しない
    ことを特徴とする無人車両の走行制御装置。
  2. 請求項記載の無人車両の走行制御装置において、
    GPS受信器 (13) 、自律航法演算器 (14) 及び路側帯距離計測器 (15) は、それぞれ自身の故障診断機能を有し、
    前記位置計測部(11)の路側帯距離に基づく補正は、GPS受信器(13)の測位精度推測値及び/又は自律航法演算器(14)の測位精度推測値と、路側帯距離計測器(15)の測位精度推測値とに応じたセンサーフュージョンにより行い、GPS受信器 (13) 、自律航法演算器 (14) 及び路側帯距離計測器 (15) のいずれかの測位モジュールに異常がある時は、異常のあるモジュールの測位データを除外して他の測位データ同士をその測位精度推測値に応じたセンサーフュージョンにより補完し合う
    ことを特徴とする無人車両の走行制御装置。
JP2001012722A 2001-01-22 2001-01-22 無人車両の走行制御装置 Expired - Fee Related JP4229358B2 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2001012722A JP4229358B2 (ja) 2001-01-22 2001-01-22 無人車両の走行制御装置
US10/050,824 US6751535B2 (en) 2001-01-22 2002-01-18 Travel controlling apparatus of unmanned vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2001012722A JP4229358B2 (ja) 2001-01-22 2001-01-22 無人車両の走行制御装置

Publications (2)

Publication Number Publication Date
JP2002215236A JP2002215236A (ja) 2002-07-31
JP4229358B2 true JP4229358B2 (ja) 2009-02-25

Family

ID=18879690

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2001012722A Expired - Fee Related JP4229358B2 (ja) 2001-01-22 2001-01-22 無人車両の走行制御装置

Country Status (2)

Country Link
US (1) US6751535B2 (ja)
JP (1) JP4229358B2 (ja)

Families Citing this family (156)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20050149256A1 (en) * 2002-05-10 2005-07-07 Siemens Aktiengesellschaft Device for determining the position by means of fixed and/or variable landmarks
DE10228064B4 (de) * 2002-06-17 2005-08-11 Robert Bosch Gmbh Verfahren, Echtzeit-Rechengerät und Initialisierungs-Programm zur Teilinitialisierung eines auf dem Rechengerät ablauffähigen Computerprogramms
US6907347B2 (en) * 2002-11-21 2005-06-14 Ford Global Technologies, Llc Systems and method for estimating speed and pitch sensor errors
JP3710451B2 (ja) * 2003-03-03 2005-10-26 川崎重工業株式会社 移動体の位置計測方法及び装置
FI115414B (fi) * 2003-07-03 2005-04-29 Sandvik Tamrock Oy Järjestely kaivosajoneuvon sijainnin valvontaan kaivoksessa
GB2419759B (en) * 2003-07-11 2007-02-14 Omnicom Engineering Ltd A system of surveying and measurement
JP4436632B2 (ja) * 2003-08-19 2010-03-24 コマツエンジニアリング株式会社 位置誤差補正機能を持つ測量システム
US7007625B2 (en) * 2003-09-25 2006-03-07 H2Eye (International) Limited Location and movement of remote operated vehicles
DE10354290A1 (de) * 2003-11-20 2005-06-02 Daimlerchrysler Ag Fahrspurvorrichtung, Auswahlvorrichtung und Verfahren zur Ermittlung der Fahrspur eines Fahrzeugs
US7184888B2 (en) * 2003-12-23 2007-02-27 Honda Motor Co., Ltd. System and method for transferring navigation information using different coordinate systems
US7146271B2 (en) * 2003-12-23 2006-12-05 Honda Motor Co., Ltd. System and method for managing navigation information
US7480561B2 (en) * 2003-12-23 2009-01-20 Honda Motor Co., Ltd. Prioritized delivery of navigation information
US7263438B2 (en) * 2003-12-23 2007-08-28 Honda Motor Co., Ltd. Smart storage and transmission of navigation information
CN100400861C (zh) 2004-02-27 2008-07-09 三菱重工业株式会社 风力发电装置及其主动式减振方法以及风车塔架
US7206696B2 (en) * 2004-05-19 2007-04-17 Honda Motor Co., Ltd. Method for modifying navigation information
JP4328660B2 (ja) * 2004-04-15 2009-09-09 富士重工業株式会社 航空機の自動離陸装置、自動着陸装置及び自動離着陸装置並びに航空機の自動離陸方法、自動着陸方法及び自動離着陸方法
US8192137B2 (en) 2004-05-03 2012-06-05 Jervis B. Webb Company Automatic transport loading system and method
US8075243B2 (en) 2004-05-03 2011-12-13 Jervis B. Webb Company Automatic transport loading system and method
US7980808B2 (en) * 2004-05-03 2011-07-19 Jervis B. Webb Company Automatic transport loading system and method
CN101090840A (zh) * 2004-05-03 2007-12-19 杰维斯·B·韦布国际公司 运输装置的自动装货系统和方法
US8210791B2 (en) 2004-05-03 2012-07-03 Jervis B. Webb Company Automatic transport loading system and method
JP4476687B2 (ja) * 2004-05-07 2010-06-09 株式会社ナビタイムジャパン 携帯ナビゲーション端末および地図表示方法ならびにプログラム
US7292936B2 (en) * 2004-05-19 2007-11-06 Honda Motor Co., Ltd. System and method for displaying information
US20050261829A1 (en) * 2004-05-19 2005-11-24 Honda Motor Co., Ltd. System and method for off route processing
US20050261824A1 (en) * 2004-05-19 2005-11-24 Honda Motor Co., Ltd. System and method for varying content
WO2006011276A1 (ja) * 2004-07-23 2006-02-02 Yamaha Corporation 方位処理装置、方位処理方法、方位処理プログラム、方位測定装置、傾斜オフセットの補正方法、方位計測方法、方位センサユニット及び携帯電子機器
US8065083B2 (en) * 2004-07-23 2011-11-22 Yamaha Corporation Azimuth processing device, azimuth processing method, azimuth processing program, direction finding device, tilt offset correcting method, azimuth measuring method, compass sensor unit, and portable electronic device
US20060061469A1 (en) * 2004-09-21 2006-03-23 Skyfence Inc. Positioning system that uses signals from a point source
US7499774B2 (en) * 2004-10-22 2009-03-03 Irobot Corporation System and method for processing safety signals in an autonomous vehicle
US7499776B2 (en) * 2004-10-22 2009-03-03 Irobot Corporation Systems and methods for control of an unmanned ground vehicle
US8078338B2 (en) 2004-10-22 2011-12-13 Irobot Corporation System and method for behavior based control of an autonomous vehicle
US7499775B2 (en) * 2004-10-22 2009-03-03 Irobot Corporation System and method for terrain feature tracking
US7499804B2 (en) * 2004-10-22 2009-03-03 Irobot Corporation System and method for multi-modal control of an autonomous vehicle
US7706977B2 (en) * 2004-10-26 2010-04-27 Honeywell International Inc. Personal navigation device for use with portable device
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
US7626701B2 (en) * 2004-12-27 2009-12-01 Asml Netherlands B.V. Lithographic apparatus with multiple alignment arrangements and alignment measuring method
JP2006301716A (ja) * 2005-04-15 2006-11-02 Fuji Heavy Ind Ltd 自律走行車及びその制御方法
US20060259233A1 (en) * 2005-05-11 2006-11-16 Industrial Technology Research Institute Road precursory and vehicle trip recording method of navigation system
US20060276958A1 (en) * 2005-06-02 2006-12-07 Jervis B. Webb Company Inertial navigational guidance system for a driverless vehicle utilizing laser obstacle sensors
US20080109122A1 (en) * 2005-11-30 2008-05-08 Ferguson Alan L Work machine control using off-board information
JP4467533B2 (ja) * 2006-03-16 2010-05-26 富士通株式会社 折線追従移動ロボットおよび折線追従移動ロボットの制御方法
KR101060320B1 (ko) * 2006-03-21 2011-08-29 스카이메터 코포레이션 사설, 감사가능 차량 위치결정 시스템 및 그를 위한 온-보드 유닛
US20090157566A1 (en) * 2006-03-21 2009-06-18 Bernard Grush Method and process to ensure that a vehicular travel path recording that includes positional errors can be used to determine a reliable and repeatable road user charge
JP2007303989A (ja) * 2006-05-12 2007-11-22 Pioneer Electronic Corp 移動体端末装置、移動体端末装置の制御方法、移動体端末装置の制御プログラム、および移動体端末装置の制御プログラムを記録した記録媒体
US8417383B2 (en) * 2006-05-31 2013-04-09 Irobot Corporation Detecting robot stasis
US20070282565A1 (en) * 2006-06-06 2007-12-06 Honeywell International Inc. Object locating in restricted environments using personal navigation
KR101297388B1 (ko) * 2006-06-16 2013-08-19 삼성전자주식회사 위치 보정 기능을 제공하는 이동 장치 및 위치 보정 방법
US20080039991A1 (en) * 2006-08-10 2008-02-14 May Reed R Methods and systems for providing accurate vehicle positioning
KR100791386B1 (ko) * 2006-08-18 2008-01-07 삼성전자주식회사 이동 로봇의 영역 분리 방법 및 장치
US8437900B2 (en) * 2007-01-30 2013-05-07 Komatsu Ltd. Control device for guided travel of unmanned vehicle
US7873444B1 (en) 2007-02-08 2011-01-18 Lockheed Martin Corporation Controlling movement of an unmanned vehicle
JP2008249666A (ja) * 2007-03-30 2008-10-16 Fujitsu Ten Ltd 車両位置特定装置および車両位置特定方法
US7676967B2 (en) * 2007-04-30 2010-03-16 Caterpillar Inc. Machine with automated blade positioning system
JP4976948B2 (ja) * 2007-07-25 2012-07-18 古野電気株式会社 姿勢計測装置
DE502007005855D1 (de) * 2007-08-02 2011-01-13 Siemens Ag Mobiles Bediengerät und Verfahren zu seinem Einsatz
US20090054067A1 (en) * 2007-08-23 2009-02-26 Telefonaktiebolaget Lm Ericsson (Publ) System and method for gesture-based command and control of targets in wireless network
US8560157B2 (en) 2007-09-19 2013-10-15 Topcon Positioning Systems, Inc. Partial manual control state for automated vehicle navigation system
US7844760B2 (en) * 2007-09-29 2010-11-30 Intel Corporation Schedule and data caching for wireless transmission
US8112178B2 (en) * 2008-01-07 2012-02-07 Toyota Motor Engineering & Manufacturing North America, Inc. Robotic platform for autonomous automotive vehicle development
US20090216410A1 (en) * 2008-02-26 2009-08-27 William Edward Allen Automated machine management system with destination selection
US8099205B2 (en) * 2008-07-08 2012-01-17 Caterpillar Inc. Machine guidance system
JP4631064B2 (ja) * 2008-09-01 2011-02-16 国土交通省国土地理院長 無線lan測位とgps測位とを併用した移動体の連続的測位方法及び装置、並びに移動体の連続的測位プログラム
US8237389B2 (en) * 2008-11-12 2012-08-07 Irobot Corporation Multi mode safety control module
JP5213655B2 (ja) * 2008-11-19 2013-06-19 株式会社日立製作所 自律移動ロボット
TWI391629B (zh) * 2008-11-25 2013-04-01 Ind Tech Res Inst 導航資訊修正方法及其導航裝置
EP2192385A1 (en) * 2008-11-26 2010-06-02 Nederlandse Organisatie voor toegepast- natuurwetenschappelijk onderzoek TNO Signal processing module, navigation device with the signal processing module, vehicle provided with a navigation device and method of providing navigation data
US20100152933A1 (en) * 2008-12-11 2010-06-17 Honeywell International Inc. Apparatus and method for unmanned aerial vehicle ground proximity detection, landing and descent
US8352120B2 (en) * 2009-02-17 2013-01-08 Lockheed Martin Corporation System and method for stability control using GPS data
US8359178B2 (en) * 2009-03-04 2013-01-22 Honeywell International Inc. Method and apparatus for identifying erroneous sensor outputs
US8150621B1 (en) 2009-04-07 2012-04-03 The United States of America as represeneted by the Secretary of the Navy Command and control of autonomous surface vehicle
US8751102B2 (en) * 2009-04-10 2014-06-10 Ford Global Technologies, Llc Vehicle ready light control method and system
US9273968B2 (en) * 2010-06-23 2016-03-01 Aisin Aw Co., Ltd. Track information generating device, track information generating method, and computer-readable storage medium
JP2012105557A (ja) * 2010-11-15 2012-06-07 Original Soft:Kk 自動芝刈り機
KR20120059109A (ko) * 2010-11-30 2012-06-08 한국전자통신연구원 레이저 스캐너 센서를 이용한 다중 차량 감지 장치 및 그 방법
EP2527943A1 (en) * 2011-05-24 2012-11-28 BAE Systems Plc. Vehicle navigation
AU2012260626C1 (en) 2011-05-24 2015-12-10 Bae Systems Plc Vehicle navigation
DE112011105204T5 (de) * 2011-05-31 2014-07-03 Hitachi, Ltd. Autonomes Bewegungssystem
US20130006482A1 (en) * 2011-06-30 2013-01-03 Ramadev Burigsay Hukkeri Guidance system for a mobile machine
CN102393744B (zh) * 2011-11-22 2014-09-10 湖南大学 一种无人驾驶汽车的导航方法
CN102495415B (zh) * 2011-11-28 2013-03-06 北京航空航天大学 一种gps滞后时间的自适应检测方法
US8855847B2 (en) 2012-01-20 2014-10-07 Toyota Motor Engineering & Manufacturing North America, Inc. Intelligent navigation system
JP5601332B2 (ja) * 2012-02-08 2014-10-08 村田機械株式会社 搬送車
US8755966B2 (en) 2012-04-03 2014-06-17 Caterpillar Inc. System and method for controlling autonomous machine within lane boundaries during position uncertainty
US9205828B1 (en) * 2012-06-29 2015-12-08 Google Inc. Method and apparatus for determining vehicle location based on motor feedback
US10154382B2 (en) 2013-03-12 2018-12-11 Zendrive, Inc. System and method for determining a driver in a telematic application
US20140288824A1 (en) * 2013-03-22 2014-09-25 Qualcomm Incorporated Method and/or system for selective application of direction of travel
JP2014191689A (ja) * 2013-03-28 2014-10-06 Hitachi Industrial Equipment Systems Co Ltd 移動体の走行制御手段に対して制御指令を出力する位置検出装置を取り付けた移動体及びその位置検出装置
US8954205B2 (en) * 2013-06-01 2015-02-10 Savari, Inc. System and method for road side equipment of interest selection for active safety applications
CN104541217B (zh) * 2013-07-30 2018-04-03 株式会社小松制作所 矿山机械的管理系统以及管理方法
FR3013834B1 (fr) * 2013-11-28 2015-12-25 Airbus Operations Sas Methode de fusion de donnees de capteurs utilisant un critere de coherence
KR101534958B1 (ko) * 2013-12-09 2015-07-07 현대자동차주식회사 차량의 자동 조향 제어 장치 및 방법
CA2934874C (en) 2013-12-27 2020-06-09 Komatsu Ltd. Mining machine management system and management method
CA2934879C (en) * 2013-12-27 2020-07-28 Komatsu Ltd. Mining machine management system, mining machine, and management method
AU2013408995B2 (en) * 2013-12-27 2018-02-22 Komatsu Ltd. Management system and managing method of mining machine
GB2513738A (en) * 2014-05-08 2014-11-05 Daimler Ag Method for determining a position of a vehicle by a navigation system of the vehicle
WO2015033709A1 (ja) 2014-07-30 2015-03-12 株式会社小松製作所 作業車両及び作業車両の制御方法
JP6050886B2 (ja) 2014-07-30 2016-12-21 株式会社小松製作所 作業車両及び作業車両の制御方法
JP6539958B2 (ja) 2014-08-28 2019-07-10 村田機械株式会社 搬送車
DE102014221751A1 (de) * 2014-10-27 2016-04-28 Robert Bosch Gmbh Verfahren und Vorrichtung zum Führen eines Fahrzeugs auf einem Parkplatz
SE540131C2 (en) 2014-12-24 2018-04-10 Husqvarna Ab Robotic work tool with trajectory correction
US10800406B2 (en) 2014-12-26 2020-10-13 Komatsu Ltd. Mining machine, management system of mining machine, and management method of mining machine
JP6521753B2 (ja) * 2015-06-09 2019-05-29 株式会社Subaru 車両の測位システム
DK3338105T3 (da) 2015-08-20 2022-01-24 Zendrive Inc Fremgangsmåde til accelerometerunderstøttet navigation
US9818239B2 (en) 2015-08-20 2017-11-14 Zendrive, Inc. Method for smartphone-based accident detection
WO2017072980A1 (ja) * 2015-10-30 2017-05-04 株式会社小松製作所 作業機械の制御システム、作業機械、作業機械の管理システム、及び作業機械の管理方法
WO2016060281A1 (ja) * 2015-10-30 2016-04-21 株式会社小松製作所 作業機械の制御システム、作業機械、作業機械の管理システム、作業機械の制御方法及びプログラム
WO2016060282A1 (ja) * 2015-10-30 2016-04-21 株式会社小松製作所 作業機械の制御システム、作業機械、作業機械の管理システム、作業機械の制御方法及びプログラム
JP6671152B2 (ja) 2015-11-19 2020-03-25 日立建機株式会社 自己位置推定装置の異常検知装置及び車両
US10126753B2 (en) * 2015-11-30 2018-11-13 Komatsu Ltd. Work machine control system, work machine, work machine management system, and method for controlling work machine
JP6672336B2 (ja) * 2015-12-25 2020-03-25 株式会社小松製作所 作業機械の制御システム、作業機械、作業機械の管理システム、及び作業機械の管理方法
JP6657257B2 (ja) * 2015-12-25 2020-03-04 株式会社小松製作所 作業機械の管理システム、作業機械及び作業機械の管理装置
AU2016210131B2 (en) * 2016-02-29 2017-04-27 Komatsu Ltd. Control system for work machine, work machine, and management system for work machine
US10162354B2 (en) * 2016-07-21 2018-12-25 Baidu Usa Llc Controlling error corrected planning methods for operating autonomous vehicles
CN107784850A (zh) * 2016-08-26 2018-03-09 中兴通讯股份有限公司 一种无人驾驶车辆控制方法、终端、服务器及系统
US9955319B2 (en) 2016-09-12 2018-04-24 Zendrive, Inc. Method for mobile device-based cooperative data capture
US10012993B1 (en) 2016-12-09 2018-07-03 Zendrive, Inc. Method and system for risk modeling in autonomous vehicles
JP6851589B2 (ja) * 2016-12-22 2021-03-31 株式会社クボタ 作業車
KR20180091357A (ko) * 2017-02-06 2018-08-16 한국전자통신연구원 추측 항법을 이용한 자율주행 차량의 제어 방법 및 장치
US10802503B2 (en) 2017-03-31 2020-10-13 Komatsu Ltd. Control system of transporter vehicle, transporter vehicle, and control method of transporter vehicle
CN108733068A (zh) * 2017-04-24 2018-11-02 菜鸟智能物流控股有限公司 飞行器
CN108882168B (zh) * 2017-05-10 2020-09-08 腾讯科技(深圳)有限公司 出行轨迹获取方法、装置及服务器
JP2019008646A (ja) * 2017-06-27 2019-01-17 株式会社クボタ 作業車
US11151813B2 (en) 2017-06-28 2021-10-19 Zendrive, Inc. Method and system for vehicle-related driver characteristic determination
US10304329B2 (en) 2017-06-28 2019-05-28 Zendrive, Inc. Method and system for determining traffic-related characteristics
WO2019104348A1 (en) 2017-11-27 2019-05-31 Zendrive, Inc. System and method for vehicle sensing and analysis
US10409287B2 (en) * 2017-11-30 2019-09-10 Komatsu America Corp. Vehicle guide display and path navigation method
CN107943049B (zh) * 2017-12-13 2020-04-21 江西洪都航空工业集团有限责任公司 一种无人车控制方法及无人割草车
KR102074905B1 (ko) * 2017-12-13 2020-02-07 (주)자스텍엠 운전 위험도 분석 차량 정보 처리 장치
FR3075355B1 (fr) * 2017-12-14 2019-11-08 Safran Electronics & Defense Procede d'estimation de donnees de navigation d'un vehicule terrestre utilisant des parametres de geometrie et d'orientation de route
US10627236B2 (en) * 2018-02-27 2020-04-21 Sharp Kabushiki Kaisha Position measurement apparatus, position correction method, and position information acquisition system
CN108762245B (zh) * 2018-03-20 2022-03-25 华为技术有限公司 数据融合方法以及相关设备
JP2020008461A (ja) * 2018-07-10 2020-01-16 株式会社豊田自動織機 自律移動体の位置推定装置
KR102252033B1 (ko) * 2018-09-06 2021-05-14 엘지전자 주식회사 이동 로봇 및 그 제어방법
WO2020050494A1 (en) 2018-09-06 2020-03-12 Lg Electronics Inc. A robot cleaner and a controlling method for the same
US11432697B2 (en) 2018-09-06 2022-09-06 Lg Electronics Inc. Robot cleaner and a controlling method for the same
KR20200087307A (ko) * 2018-12-28 2020-07-21 현대자동차주식회사 차량 및 그 제어방법
DE102019201697A1 (de) * 2019-02-11 2020-06-25 Zf Friedrichshafen Ag Verfahren zum Stoppen eines autonomen Fahrzeugs
US10539644B1 (en) * 2019-02-27 2020-01-21 Northern Digital Inc. Tracking an object in an electromagnetic field
JP7157876B2 (ja) * 2019-05-08 2022-10-20 日立Astemo株式会社 車両位置検出装置、及び、車両位置検出用パラメータセット作成装置
TWI710489B (zh) * 2019-07-08 2020-11-21 宏碁股份有限公司 車輛及車輛控制方法
US11899139B2 (en) * 2019-09-20 2024-02-13 Intel Corporation Photonic devices with redundant components and their applications
KR102629323B1 (ko) * 2019-09-24 2024-01-26 현대모비스 주식회사 차량의 군집 주행 방법
US11775010B2 (en) 2019-12-02 2023-10-03 Zendrive, Inc. System and method for assessing device usage
US11175152B2 (en) 2019-12-03 2021-11-16 Zendrive, Inc. Method and system for risk determination of a route
CN110862279B (zh) * 2019-12-18 2021-11-16 华中农业大学 一种基于激光雷达导航的履带式无人驾驶有机肥翻抛机
US11520009B2 (en) * 2020-02-05 2022-12-06 Caterpillar Inc. Method and system for detecting an obstacle
CN113408331A (zh) * 2020-03-17 2021-09-17 株式会社斯巴鲁 注视对象检测装置
CN112462749B (zh) * 2020-05-12 2023-06-06 丰疆智能科技股份有限公司 农机自动导航方法、农机自动导航系统以及农机
US11608066B1 (en) 2020-05-19 2023-03-21 Waymo Llc Responding to input on a brake pedal of a brake by wire system for an autonomous vehicle
JP2021191648A (ja) 2020-06-05 2021-12-16 トヨタ自動車株式会社 位置推定装置及び位置推定方法
CN112665538B (zh) * 2020-12-09 2023-10-13 云南昆船电子设备有限公司 车辆自主导航横向测距系统及方法
AU2021202152A1 (en) * 2021-04-08 2022-10-27 Caterpillar Underground Mining Pty Ltd System, apparatus, and method to select and apply route properties of a mine site
CN113298727B (zh) * 2021-05-17 2023-08-18 中国矿业大学 一种基于多标识线的井下辅助运输车辆导航系统与方法
WO2023032277A1 (ja) * 2021-09-01 2023-03-09 ソニーグループ株式会社 測位装置および測位方法、並びにプログラム
CN114397115A (zh) * 2022-01-10 2022-04-26 招商局检测车辆技术研究院有限公司 港口自动驾驶车辆的定位性能测试方法及系统
CN116686535B (zh) * 2023-06-30 2023-12-01 哈尔滨市大地勘察测绘有限公司 基于数据分析的无人驾驶收割机控制方法及系统

Family Cites Families (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5208750A (en) * 1987-06-17 1993-05-04 Nissan Motor Co., Ltd. Control system for unmanned automotive vehicle
JP2609890B2 (ja) * 1988-02-16 1997-05-14 三洋電機株式会社 自走式作業車
US4939650A (en) * 1988-06-14 1990-07-03 Shinko Electric Co., Ltd. Path correction method for a self-contained unmanned vehicle
JPH0322108A (ja) * 1989-06-20 1991-01-30 Shinko Electric Co Ltd 移動ロボット
JP3164659B2 (ja) * 1992-09-16 2001-05-08 株式会社ザナヴィ・インフォマティクス 航法装置
JPH06331400A (ja) * 1993-05-24 1994-12-02 Sanyo Electric Co Ltd センサフュージョン手法
JPH0895638A (ja) * 1994-09-28 1996-04-12 East Japan Railway Co 移動作業ロボットの走行制御装置
US5875408A (en) * 1995-07-17 1999-02-23 Imra America, Inc. Automated vehicle guidance system and method for automatically guiding a vehicle
JPH10260728A (ja) * 1997-03-18 1998-09-29 Fujitsu General Ltd 床清掃ロボットの制御方法
EP0913751B1 (de) * 1997-11-03 2003-09-03 Volkswagen Aktiengesellschaft Autonomes Fahrzeug und Verfahren zur Steuerung eines autonomen Fahrzeuges
US6064926A (en) * 1997-12-08 2000-05-16 Caterpillar Inc. Method and apparatus for determining an alternate path in response to detection of an obstacle
JPH11296229A (ja) * 1998-02-13 1999-10-29 Komatsu Ltd 車両の誘導装置
JP3869108B2 (ja) * 1998-02-23 2007-01-17 株式会社小松製作所 無人車両の干渉予測装置および無人車両の誘導走行方法
ATE261108T1 (de) * 1998-04-24 2004-03-15 Inco Ltd Automatisch geführtes fahrzeug
US6445983B1 (en) * 2000-07-07 2002-09-03 Case Corporation Sensor-fusion navigator for automated guidance of off-road vehicles

Also Published As

Publication number Publication date
JP2002215236A (ja) 2002-07-31
US6751535B2 (en) 2004-06-15
US20020099481A1 (en) 2002-07-25

Similar Documents

Publication Publication Date Title
JP4229358B2 (ja) 無人車両の走行制御装置
US5926117A (en) Vehicle control system, vehicle mounting apparatus, base station apparatus and vehicle control method
US10935660B2 (en) Control system of work machine, work machine, management system of work machine, and method of managing work machine
JP3710451B2 (ja) 移動体の位置計測方法及び装置
JP3869108B2 (ja) 無人車両の干渉予測装置および無人車両の誘導走行方法
EP3729937B1 (en) Autonomous travel work machine
US11829151B2 (en) Construction-vehicle autonomous travel control device
KR20150051747A (ko) 차량의 위치 결정 방법
CN108139755A (zh) 自己位置推定装置的异常检测装置以及车辆
US20050043882A1 (en) Vehicle-direction estimating device, and driving control device including the vehicle-direction estimating device
JP2000284830A (ja) 無人走行制御装置
US9250086B1 (en) Machine positioning system having alignment error detection
US20080059062A1 (en) Vehicle position detecting system and method
US11835643B2 (en) Work machine control system, work machine, and work machine control method
US11733392B2 (en) Method for ascertaining at least one piece of integrity information relating to a location result of a GNSS-based location device of a vehicle in the event of an abruptly and significantly changing GNSS reception situation
JP2018167735A (ja) 車両の操舵支援装置
JP2023016761A (ja) 車両のgnss及びinsに基づく位置特定において障害の存在を検出する方法
CN113514069A (zh) 一种实时自动驾驶定位方法及系统
JP3551663B2 (ja) ナビゲーション装置
AU2014271294A1 (en) Machine positioning system utilizing relative pose information
KR20050076474A (ko) 이동체의 위치 결정방법
WO2023119714A1 (ja) 作業管理システム及び作業管理方法
JP4041623B2 (ja) 移動体の位置認識方法
US20230251389A1 (en) System and method for determining vehicle position by triangulation
US20240010238A1 (en) A method for controlling a driving operation of an autonomously controlled vehicle

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20070220

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20080514

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20080519

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20080715

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

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20081128

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

Ref document number: 4229358

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20111212

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20111212

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20121212

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20131212

Year of fee payment: 5

LAPS Cancellation because of no payment of annual fees