JP3264360B2 - 作業用車両の障害物警報装置及び障害物位置登録方法 - Google Patents
作業用車両の障害物警報装置及び障害物位置登録方法Info
- Publication number
- JP3264360B2 JP3264360B2 JP19939696A JP19939696A JP3264360B2 JP 3264360 B2 JP3264360 B2 JP 3264360B2 JP 19939696 A JP19939696 A JP 19939696A JP 19939696 A JP19939696 A JP 19939696A JP 3264360 B2 JP3264360 B2 JP 3264360B2
- Authority
- JP
- Japan
- Prior art keywords
- obstacle
- vehicle
- alarm
- work vehicle
- position data
- 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 - Lifetime
Links
Landscapes
- Navigation (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Traffic Control Systems (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Description
地点を事前に検知し、オペレータに対して自動的に障害
物があることの情報,警報を出力する作業用車両の障害
物警報装置及び障害物位置登録方法に関する。
業用車両が走行する道路の障害物として、マンホール
蓋,道路段差,道路標識,橋の欄干,橋のフィンガージ
ョイント部,或いは、軟弱な路肩や雪崩等の危険な場所
等がある。オペレータはこれらの障害物及び危険箇所に
注意を払いながら作業用車両を運転するが、これらの障
害物が堆積した雪の中に埋没したり、降雪による視界不
良等によってオペレータの視認が困難な場合が発生す
る。また、オペレータは対向車両や歩行者に気を取られ
たり、車両の操向や除雪速度の調整等の本来の除雪作業
に忙しく、障害物又は危険箇所の存在や位置に十分注意
が届かないこともある。また、山間部等では、軟弱な路
肩に寄り過ぎて転落事故を起こす虞もある。
る工区の地理や道路状況を熟知した経験者が携わること
が多いが、十分注意していても誤って接触し除雪機械や
構造物の破損等を招くことがあり、この注意を払う労力
を軽減することが要求されている。そこで、何らかの方
法で、作業用車両の現在位置を検出して、予めその位置
が判明している障害物を事前に検知しこれを回避するこ
とが要求される。
ては、地上側に設備を必要とするものに、電磁波による
地点マーカ方式、道路上にバーコード状の特定のパター
ンを描いて通過する作業用車両がそれを認識する方式等
が考案されている。この電磁波による地点マーカ方式と
して特開平4−344506号公報に示す作業用車両障
害物認識伝達装置が考案されている。
路の脇に設置した地点マーカに、該地点マーカの設置場
所固有の地点情報を記憶している記憶媒体と、作業用車
両から呼出信号を無線受信し、記憶媒体の該地点マーカ
の設置場所固有の地点情報の信号を作業用車両に無線送
信する送受信部とを設け、一方、作業用車両に、地点マ
ーカに呼出信号を無線送信するとともに地点マーカから
の固有の地点情報の信号を無線受信する送受信部と、地
点マーカの設置場所固有の地点情報に対応して地点マー
カからの障害物等までの距離を記憶している記憶媒体
と、作業用車両の送受信部が地点マーカからの信号を受
けた時点から作業用車両の進んだ距離を測定する移動距
離計測器と、地点マーカを特定する地点マーカ判断手段
と、地点マーカから道路上の障害物または危険が予想さ
れる地点までの距離をオペレータまたは該作業用車両に
伝える危険状態伝達手段とを設けたもので、呼出信号に
応答した地点マーカから発信される地点情報は車両の送
受信部に伝達され、作業用車両側の地点マーカ判断手段
によって特定された地点マーカから道路上の障害物また
は危険が予想される地点までの距離の情報が危険状態伝
達手段を介して作業用車両のオペレータまたは該作業用
車両に知らされ、例えばオペレータは、この情報により
障害物の有無を確認し障害物の手前で、車両の停止等装
置の適切な回避動作等を行なうものである。
両単独での位置検出手段として、ある原点(起点)から
の移動距離とステアリング角を作業用車両側で計測演算
し、その操行軌跡から自己の位置を推定する方式または
ステアリング角の代わりにジャイロセンサによる加速度
の変化と距離センサを組み合わせた慣性航法方式等が考
案されている。
用車両障害物認識伝達装置は、道路上の障害物または危
険が予想される地点毎に、地上側に地点マーカ等の特定
の設備を必要とし、莫大な設備費用がかかるという問題
がある。また、地点マーカの電波到達範囲は一定範囲内
の局所的なものであり、作業用車両はその範囲内に達し
なければ自己の現在位置を決定することができない。ま
た、地点マーカを通過してからの作業用車両の移動距離
により、予め登録されている障害物地点と作業用車両間
の相対距離から警報出力のタイミングを計算するもので
あるが、移動距離の計測はタイヤ回転数に依存するた
め、圧雪路等でのタイヤスリップの影響や作業中の前後
進による移動距離の累積誤差が発生するという問題があ
る。このため、1つの地点マーカで位置を登録できる障
害物の範囲には限界があり、位置の登録や変更も、例え
ば該地点マーカから実際の障害物の地点までの相対距離
を実測し記憶媒体にそのデータを登録する必要があり、
緊急を要する場合などには対処し難い。
合、地点マーカの設置場所を障害物地点から十分な距離
に設置しないと、警報発生のタイミングが遅れ車速に対
応した危険回避に必要な回避時間が不足する虞が生じ
る。
ーンを描き、この上を通過する作業用車両がこの特定の
パターンを読み取ることにより自己の位置を検出する方
式は、道路上に降雪や圧雪等があると、パターンの検出
そのものが困難となり実用に供さない。一方、後者の作
業用車両が単独で自己の現在位置を検出する方式は、地
上側に特定の設備は必要ないが、最初に何らかの原点
(起点)が必要で、更に所定の場所から必ずスタートす
る必要がある。また、電源断等で途中で位置データを失
うと、最初からやり直す必要が生じる。この方式を例え
ばロータリ式除雪車等に適用しようとした場合、除雪速
度が遅く(数km/h程度)、また、雪によるタイヤス
リップの影響,及び頻繁な前後進が繰り返されるため、
走行距離の誤差の累積の問題が避けられず、実用に供す
るのは困難とされている。
なされたもので、その目的は、地上側に特定の設備を要
することなく、DGPSを利用して正確な作業用車両の
自己の絶対位置を測位し、適切なタイミングで警報をオ
ペレータに発することができる作業用車両の障害物警報
装置及び障害物位置登録方法を提供するものである。
GPS衛星から発信している電波とDGPS補正情報を
用いて作業用車両の補正された位置データを出力するG
PS受信機と、作業用車両の走行速度を検出する車速セ
ンサと、入力側にGPS受信機,車速センサが接続さ
れ、出力側に警報出力手段が接続された制御装置とを備
え、制御装置は、道路上における予め複数登録された障
害物毎の位置データと測位された作業用車両の位置デ−
タから、両者の相対距離を計算する相対距離計算手段
と、相対距離の時間的変化から作業用車両が障害物に接
近しているか否かを判定する接近判定手段と、作業用車
両が障害物の位置に到達するまでの到達時間を車速を用
いて計算する到達時間計算手段と、作業用車両が障害物
に接近中であることを条件として、障害物のデータとし
て記憶されている警報距離と作業用車両の現在の位置デ
ータから、作業用車両がこの警報距離内にあるか否かを
判定し、作業用車両がこの警報距離内にあると判定した
場合には警報出力手段に警報を指令するとともに、作業
用車両が警報距離内にいないと判定した場合には到達時
間が障害物毎に予め設定された障害物回避時間より小さ
いか否かを判定して到達時間が障害物回避時間より小さ
ければ警報出力手段に警報を指令する警報判定手段とを
備えていることを特徴とする。
業用車両の障害物警報装置において、制御装置の出力側
には入出力可能な外部記憶装置が接続され、外部記憶装
置の不揮発性記憶媒体に障害物毎の位置データが予め複
数登録されていることを特徴とする。
信している電波とDGPS補正情報を用いて作業用車両
の補正された位置データを出力するGPS受信機と、入
力側にGPS受信機,出力側に警報出力手段が接続され
た制御装置とを備え、制御装置は、道路上における予め
複数登録された障害物毎の位置データと測位された作業
用車両の位置デ−タから、両者の相対距離を計算する相
対距離計算手段と、相対距離の時間的変化から作業用車
両が障害物に接近しているか否かを判定する接近判定手
段と、相対距離が前記障害物毎の警報距離より小さいか
否かを判定し、相対距離が警報距離より小さく、且つ作
業用車両がその障害物に接近中であれば、警報出力手段
に警報を指令する警報判定手段とを備え、制御装置の出
力側には入出力可能な外部記憶装置が接続され、外部記
憶装置の不揮発性記憶媒体に障害物毎の位置データが予
め複数登録されていることを特徴とする。請求項4記載
の発明は、GPS受信機により、GPS衛星から発信し
ている電波とDGPS補正情報を用いて作業用車両の補
正された位置データを出力し、補正された作業用車両の
位置データをGPS受信機から入出力装置が接続された
制御装置に入力し、制御装置により、オペレータが障害
物地点において入出力装置を介し選択もしくは変更した
障害物データの位置データと、その地点の作業用車両の
測位した位置データを対応して外部記憶装置の不揮発性
記憶媒体に記憶することを特徴とする。
GPS衛星の電波とDGPS補正情報によって補正され
た作業用車両の現在の位置データがGPS受信機から出
力され、その位置データは制御装置の相対距離計算手段
に入力される。障害物の位置データは例えば外部記憶装
置の不揮発性記憶媒体に予め複数登録されている。
いる障害物の位置データに基づいて、障害物と作業用車
両間との相対距離が計算され、相対距離は外部記憶装置
の不揮発性記憶媒体の対応する障害物の相対距離データ
の項目に記憶され、測位を実施する毎にこの値は更新さ
れる。接近判定手段においては、この外部記憶装置の不
揮発性記憶媒体に記憶された全ての障害物の相対距離デ
ータの時間的な変化(増減)が比較され、全ての登録さ
れた障害物について作業用車両に接近しているものがあ
るか否かが判定され、接近している障害物があると判定
された場合、その中で、相対距離が最も小さい障害物、
即ち作業用車両が最初に遭遇する障害物の登録データが
到達時間計算手段に送られる。
により作業用車両の車速が検出され、接近判定手段にお
いて接近が判定された障害物に対して作業用車両がその
車速で到達するまでの到達時間、例えばt=(d−2
ρ)/vが計算され、到達時間が警報判定手段に送られ
る。ここで、 t:作業用車両が車速vで障害物に到達するまでの到達
時間 d:障害物と作業用車両間の相対距離の絶対値 ρ:DGPSによる障害物及び作業用車両の測位誤差 v:作業用車両の車速 警報判定手段においては、作業用車両が障害物に接近中
であることを条件として、障害物のデータとして記憶さ
れている警報距離と作業用車両の現在の位置データか
ら、作業用車両がこの警報距離内にあるか否かが判定さ
れ、この判定に従って次の指令がされる。 (1)作業用車両がこの警報距離内にあると判定された
場合には警報出力手段に警報が指令される。 (2)また、作業用車両が警報距離内にいないと判定さ
れた場合には到達時間が障害物毎に予め設定された障害
物回避時間より小さいか否かが判定され、到達時間が障
害物回避時間より小さければ警報出力手段に警報が指令
される。
より、例えば音声発生装置を介して警報メッセージを出
力したり、タッチパネル表示器を介して障害物の種類や
相対距離情報等を表示しオペレータに必要な警報を発す
る。請求項2記載の発明においては、障害物の位置デー
タは外部記憶装置の不揮発性記憶媒体に予め複数登録さ
れており、相対距離計算手段に送られる。
星の電波とDGPS補正情報によって補正された作業用
車両の現在の位置データがGPS受信機から出力され、
その位置データは制御装置の相対距離計算手段に入力さ
れる。障害物の位置データは、外部記憶装置の不揮発性
記憶媒体に予め複数登録されており、相対距離計算手段
に送られる。相対距離計算手段は、予め複数登録されて
いる障害物の位置データに基づいて、障害物と作業用車
両間との相対距離が計算され、相対距離は外部記憶装置
の不揮発性記憶媒体の対応する障害物の相対距離データ
の項目に記憶され、測位を実施する毎にこの値は更新さ
れる。
置の不揮発性記憶媒体に記憶された全ての障害物の相対
距離データの時間的な変化(増減)が比較され、全ての
登録された障害物について作業用車両に接近しているも
のがあるか否かが判定され、接近している障害物がある
と判定された場合、その中で、相対距離が最も小さい障
害物、即ち作業用車両が最初に遭遇する障害物の登録デ
ータが警報判定手段に送られる。
おいて接近中と判定された障害物の登録データから、相
対距離計算手段によって得られた相対距離が、該障害物
に予め設定されている警報距離より小さいか否かを判定
し、相対距離が、警報距離より小さい時、警報出力手段
に対して警報指令が出力される。
より、例えば音声発生装置を介して警報メッセージを出
力したり、タッチパネル表示器を介して障害物の種類や
相対距離情報等を表示しオペレータに必要な警報を発す
る。
たは危険箇所が新たに追加されたり、もしくはそれらの
位置が変更になった場合、オペレータは作業用車両を運
転しながら障害物の設置地点において、タッチパネル表
示器等の入出力装置を介して必要に応じて障害物データ
を新たに登録又は変更することができる。この場合、制
御装置は障害物の登録データにDGPSによる作業用車
両の測位データを、障害物の位置データとして外部記憶
装置の不揮発性記憶媒体に自動的に付加するため、オペ
レータは障害物の位置座標を入力する必要が無く、容易
に障害物の登録または変更ができる。
形態について説明する。請求項1ないし請求項4の発明
の実施の形態に係わる作業用車両の障害物警報装置及び
その障害物位置登録方法について、作業用車両としてロ
ータリ式除雪車を例に挙げて説明する。
で、このロータリ式除雪車1は除雪装置2を有し、除雪
装置2は、雪を掻き込むオーガ3と、図示しないブロア
の回転により雪を投雪するシュート4と、上部にGPS
アンテナ6Aおよび移動電話器アンテナ11Aとを備え
ている。更に、ロータリ式除雪車1には、図2に示すよ
うにマイクロコンピュータからなる制御装置5が装備さ
れ、この制御装置5の入力側にはGPS受信機6、車速
センサ7が接続され、出力側には音声発生装置8、タッ
チパネル表示器10が接続されるとともに、双方向でデ
ータが入出力される外部記憶装置9が接続されている。
外部記憶装置9には、逐次読出し又は逐次書き込み可能
で取り外し可能な不揮発性記憶媒体9Aが挿入・取り出
し可能になっている。
ず)と、スピーカ(図示せず)からなり、音声で警報メ
ッセ−ジを出力するものである。外部記憶装置9とし
て、例えばICカード装置が用いられ、このICカード
装置に挿入される不揮発性記憶媒体9Aとして例えばI
Cカードが用いられ、次の表1に示す障害物データ(登
録番号、種類、登録日時、除雪コース、位置データ,警
報距離,障害物回避時間,警報メッセ−ジ,前回の相対
距離等のデ−タ)が所定のフォーマットに従って書き込
まれている。なお、制御装置5に外部記憶装置9が接続
されているので、簡単に制御装置5に位置データ等を取
り込むことができる。
果たし、例えば図5に示す内容が表示される。符号15
は警報出力手段であり、音声発生装置8と、タッチパネ
ル表示器10とからなっている。符号11は移動電話
機、12はモデム、13はGPS衛星、14はDGPS
補正情報発信基地(基準局)である。
機6との間で信号の変調,復調を行なうものである。移
動電話機11はDGPS補正情報発信基地14より発信
されているDGPS補正情報を移動電話回線網により受
信し、これをモデム12を介してGPS受信機6に与え
るものである。
S」とは、ディファレンシャルGPSシステムで、GP
S(GlobalPositioning Syste
m)で測位された移動体(ロータリ式除雪車1)の位置
座標の測位誤差を補正することにより、移動体(ロータ
リ式除雪車1)の高精度側位を可能にするものである。
即ち、予め位置座標(緯度、経度、高度など)が正確
に判明している固定した基準局(DGPS補正情報発信
基地14)で移動体(ロータリ式除雪車1)と同じGP
S衛星からの電波を同時刻に受信し、自己の正確な位置
座標と照合することによってGPSに含まれる測位誤差
を求め、無線もしくはFM多重放送または電話回線等を
介して移動体にDGPS補正情報を伝送する。一方、移
動体(ロータリ式除雪車1)は伝送された補正位置情報
を基に、自己のGPS受信機6によって測位した位置座
標をこの補正情報によって補正することにより、より正
確な位置座標を得ることが可能となる。ここでは、DG
PS補正情報の伝送手段として移動電話機11を例に挙
げて説明する。
複数のGPS衛星13から地上に送信される電波をGP
Sアンテナ6Aを介して受信し、移動体であるロータリ
式除雪車1の絶対位置座標(経度,緯度、高度)をリア
ルタイムで測位する。各GPS衛星13はその内部に互
いに高精度に同期した原子時計を内蔵し、常時地上に向
けて各GPS衛星13の軌道情報並びに送信時刻等を所
定の伝送フォーマットに基いて符号変調し送信してい
る。GPS受信機6は各GPS衛星13の電波の到達時
間等を測定し、さらに受信データから各GPS衛星の詳
細な軌道情報を演算することにより、各GPS衛星13
とGPS受信機6との相対距離を検出することができ
る。少なくとも4個以上のGPS衛星13からの距離を
求めることにより、それぞれの球面の地球上の交点が受
信座標位置、即ち自己の車両位置となるためGPSアン
テナ6Aを設置したロータリ式除雪車1の現在位置を測
位することができる。
これを回避、補正する手段の1つとして前述のDGPS
システムが挙げられ、GPS受信機6において、GPS
衛星13から発信している電波とDGPS補正情報発信
基地14から送られるDGPS補正情報を用いてロータ
リ式除雪車1の位置データがリアルタイムで補正され、
ロータリ式除雪車1の高精度な位置検出が可能となる。
と、制御用の処理プログラムが格納された読出専用メモ
リROM17Aと、データまたは変数の一時記憶用とし
て読出書き込み用メモリRAM17Bによって構成され
る。演算部16は、GPS受信機6からのロータリ式除
雪車1の測位データ及び車速センサ7からの車速信号を
受け、図6、図7のフローチャートに従って、一連の手
順で演算を実行し、警報を警報出力手段15を介して出
力する。
関係がブロック図として示されている。演算部16は、
相対距離計算手段18と、到達時間計算手段19と、接
近判定手段20と、警報判定手段21とから構成され
る。相対距離計算手段18は、障害物とロータリ式除雪
車1の相対距離(d)を計算するものである。
車1の車速を読み込み,障害物とロータリ式除雪車1の
相対距離(d),GPS受信機6によるロータリ式除雪
車1および障害物の位置データに含まれる測位誤差
(ρ)から、ロータリ式除雪車1が障害物にその車速で
達するまでの到達時間を計算するものである。接近判定
手段20は、ロータリ式除雪車1が登録番号Nの障害物
に接近しているか否かを判定し、登録された全ての障害
物について判定する。これによって、ロータリ式除雪車
1が登録番号Nの障害物に対して接近していると判定さ
れた場合、接近判定手段20は、さらに接近中と判定さ
れた障害物中で最も相対距離の小さい、即ちロータリ式
除雪車1に対して最も近い障害物を選択し、その登録番
号Nを到達時間計算手段19および警報判定手段21に
出力するものである。
がある障害物Nに対して接近中であり、且つ到達時間計
算手段19から送られた到達時間tが障害物Nに登録さ
れた障害物回避時間より小さい場合、または、ロータリ
式除雪車1がある障害物Nに登録された警報範囲内に進
入したことを検知し、且つその障害物Nに接近中である
場合について、これを危険な状態と判定し警報出力手段
15に対し障害物Nに登録された警報メッセージおよび
相対距離等の情報を出力し、警報出力手段15を介して
警報を発するものである。
る。なお、図9ないし図11においては、ロータリ式除
雪車の用語として「車両」を用いている。先ず、以下の
ように、障害物の位置が制御装置5に教示され、登録さ
れる。オペレータによりロータリ式除雪車1が障害物の
ある除雪作業経路に沿って運転される。GPS受信機6
はGPS衛星13の発信する電波を受信し、DGPS補
正情報発信基地14からDGPS補正情報14Aが移動
電話器11及びモデム12を介してGPS受信機6に伝
送され、GPS受信器6はDGPS補正情報によってロ
ータリ式除雪車1の自己の位置を補正し、所定の時間間
隔、例えば1秒毎に制御装置5に位置データを出力す
る。
作業経路に沿って運転する途中で障害物を発見し、これ
を例えば新たに登録する場合、ロータリ式除雪車1を障
害物の地点で図5に示すタッチパネル表示器10の画面
から、例えば障害物が「マンホール」であった場合、メ
ニュー欄の「マンホール」を選択し、次に「登録」を選
択する。
録番号N、種類「マンホール」、登録日時、除雪コー
ス、警報距離10m、位置データ(X1,Y1)、警報
距離10m、障害物回避時間20sec 、前回の相対距離
0m、警報メッセージ「10m手前にマンホール有り、
注意してください」等の障害物データを所定のフォーマ
ットに従って自動的に作成し、外部記憶装置9を介し不
揮発性記憶媒体(ICカード)9Aに保存し登録する。
ここで、障害物の種類以外は制御装置5が、障害物の種
類に応じて自動的に作成し登録データに付加するため、
オペレータはロータリ式除雪車1の位置を入力する必要
がなく、簡単に障害物のデータの「登録」を行なうこと
ができ、本来の除雪作業の障害を来すことはない。
事用の機材が置かれたり、または春山シーズンによって
雪崩の危険個所が発生したりするなどして変化し、障害
物の場所が変化するような場合、オペレータがタッチパ
ネル表示器10の画面を触れることにより、現場の状況
を判断して任意に障害物のデータを追加登録したり、削
除したり、現場でこれらの変更を行なうことができる。
図6,図7のフローチャートの手順に従って以下のよう
に警報が発せられる。先ず、電源が投入されると初期化
が開始され、RAM17Bのデータ等が初期化される
(ステップS1)。制御装置5は移動電話機11に信号
を送り、移動電話機11はDGPS補正情報発信基地1
4の電話番号を自動的にダイヤルし移動電話回線網に接
続する(ステップS2)。
信される電波と、移動電話機11及びモデム12を介し
て送られてくるDGPS補正情報から、ロータリ式除雪
車1の位置データを自動的に補正演算し、その位置デー
タを制御装置5へ所定の時間間隔(例えば1秒間隔)で
制御装置5へ出力し、位置データは制御装置5の演算部
16へ送られる(ステップS3)。
号Nを1とする(ステップS4)。不揮発性記憶媒体
(ICカード)9Aに記憶されている登録番号N(初期
状態のNは1である)の障害物データを読み込み、RA
M17Bに一時的に格納される(ステップ5)。相対距
離計算手段18は、GPS受信機6から得たロータリ式
除雪車1の現在の位置データと、登録番号Nの障害物の
位置データから両者の相対距離(絶対値)を求め、この
相対距離を今回の相対距離d1としてRAM17Bに一
時的に記憶する(ステップS6)。
が障害物Nに対して接近しているか否かを判定するた
め、障害物Nの前回の相対距離d2と今回の相対距離d
1との差(d2−d1)を計算する(ステップS7)。
ここで、「今回」及び「前回」とかの「1回」の単位
は、図6,図7に示すフローチャートのプログラムの1
ループが単位で、例えば実際には1秒程度の時間にな
る。従って、制御装置5はこの時間間隔で周期的にロー
タリ式除雪車1の位置を絶えず検出している。
れ、(d2−dl)>0か(d2−dl)≦0か否かが
判定される。(d2−dl)>0ならば、ロータリ式除
雪車1は障害物Nに対して接近中と判断される。例え
ば、前回(その1回前)に得られたロータリ式除雪車1
から障害物までの相対距離d2(絶対値でプラスの値,
例えば100m)から、今回(現在)得た相対距離dl
(絶対値でプラスの値,例えば90m)との差をとるこ
とにより判る。d2−dl=100m−90m=10m
で、10m(>0)となり、「接近している」(YE
S)と判定されステップS9へ進む。ロータリ式除雪車
1が停車している場合や障害物から遠ざかっている場
合,及び図10で斜線領域Rにある場合には(d2−d
l)≦0となり、接近の判定はNOとなりステップS1
1へ進む。
物Nの相対距離計算手段18で計算された相対距離d1
について、ステップS9を通過する繰り返しループの中
でより小さい値をとったか否かを判別する。即ち、接近
中と判定された各障害物の中でロータリ式除雪車1に最
も近い障害物を判別し、YESと判別されればステップ
S10へその登録番号Nを送り、NOと判別すればステ
ップS11へ進む。
られた登録番号Nを、接近中の障害物の中でこれまでで
相対距離が最小の障害物の登録番号NSとして順次更新
し、ステップS12により全ての登録された障害物が終
了した時、ステップS10における登録番号NSの値
は、接近中の障害物の中で相対距離が最小の障害物の登
録番号を示している。
対距離d2をステップS6で求めたd1の値によって更
新し、再び不揮発性記憶媒体(ICカード)9Aの登録
番号Nに対応する相対距離d2に書き込み、次回の接近
の判定時に用いられる。ステップS12では、不揮発性
記憶媒体(ICカード)9Aに登録された障害物全てに
ついてステップS5からS11までの処理が終了したか
判定するものである。終了した場合は※1の処理へ進
み、未了の場合はステップS13へ進む。
N=N+1としてステップS5へ戻る。ステップS14
では、不揮発性記憶媒体に登録された障害物の内、ステ
ップS11で得られた登録番号NSの障害物のデータを
読み込み、RAM17Bに格納する。
より、障害物NSに記憶されている警報距離とロータリ
式除雪車1の現在の位置データから、ロータリ式除雪車
1がこの警報距離内にあるか否かを判定する。ロータリ
式除雪車1がこの警報距離内と判定された場合(YE
S)は、危険状態と判断されステップS19の警報出力
へ進む(図10)。 ロータリ式除雪車1がこの警報距
離内にいないと判定された場合(NO)は、ステップS
16へ進む(図9)。
雪車1の車速が到達時間判定手段19によって読み込ま
れる。ステップS17において、到達時間判定手段11
はt=(d−2ρ)/vが計算される(図11)。ここ
で、tはロータリ式除雪車1が障害物Nにその車速vで
達するまでの到達時間(sec)である。dは相対距離
計算手段18により計算されたロータリ式除雪車1の現
在の位置から障害物NSの登録された位置までの相対距
離(m)である。ρはDGPSによるロータリー式除雪
車1及び障害物NSの位置の測位誤差であり、DGPS
によって補正しても避けられない測位誤差の最大値であ
る。vは車速(m/sec)である。
21により、ロータリ式除雪車1がその車速vで障害物
NSに達するまでの到達時間tが障害物を回避するのに
十分か否かを、障害物NSに登録された障害物回避時間
tsにより判定される。即ち、到達時間t≦障害物回避
時間tsか否かが判定される。YESと判断されると
(t≦ts)、障害物の回避動作に要する時間が不足し
ていると判断され、ステップS19に進み、例えば図
5,図8に示すようにタッチパネル表示器10に「10
m前方にマンホール有り」等の情報が表示され(ステッ
プS19)、音声発生装置8により警報メッセージが音
声合成により発生される(ステップS20)。
考慮して予め決められる。ここで、到達時間tはオペレ
ータが警告を無視してそのままの車速vでロータリ式除
雪車1を走行させた場合の最悪の場合の時間であり、オ
ペレータが警告に従ってロータリ式除雪車1に制動をか
ければ、この到達時間tより長い時間となる。ステップ
S21において、タッチパネル表示器10が押されるま
では、ステップS19,S20の動作が一定の周期で繰
り返される。タッチパネル表示器10の画面の「了解」
が押されると、*2の経路でステップS3に戻り図6、
図7のフローチャートが繰り返し実行される。
連行をする時には、ロータリ式除雪車1の位置が最初の
起点でなくても、ステップS2からプログラムがスター
トする。以上のように図6,図7のフローチャートに示
すプログラムが実行される。
置5は、DGPSによって正確なロータリ式除雪車1の
自己位置の検出ができ、これによりロータリ式除雪車1
と障害物との相対距離を正確且つ連続的に求めることが
可能となり、更にその変化からロータリ式除雪車1が障
害物に接近しているか否かを判定し、接近中ならば同時
にロータリ式除雪車1の車速を読み取ることによって障
害物に達するまでの到達時間が計算され、ロータリ式除
雪車1の車速に応じてオペレータが安全な回避動作が可
能な距離の手前で、警報出力手段15により自動的に警
報を発し、障害物の種類,距離等の情報をオペレータに
出力し警告することができる。
式除雪車1の位置データを測位しているので、地上側に
特定の設備を設置する必要がなく、従って、ロータリ式
除雪車1はそれ自体の車輪の回転で走行距離を積算する
従来の方式とは異なり走行距離の誤差の累積の問題が無
く、任意の地点からスタートまたは再開できる。第2
に、警報距離の範囲内にロータリ式除雪車1が進入して
いる時に、ロータリ式除雪車1が障害物に接近している
か否かを判定し、接近中ならば警報が発せられるが、逆
に、警報距離の範囲外にロータリ式除雪車1がある時や
警報距離の範囲内であっても障害物から遠ざかる場合に
は不要な警報を発しないので、オペレータは警報に煩わ
されることなく本来の除雪作業(車両の操向や除雪速度
の調整等)に没頭できる。
ては、ロータリ式除雪車1を作業経路に沿って運転しな
がら障害物上で、必要に応じてタッチパネル表示器10
により登録または変更をすれば良く、制御装置5はDG
PSを利用して測位されたロータリ式除雪車1の位置デ
ータを自動的に障害物の位置,種類等を対応させてなる
障害物データとして作成し外部記憶装置9を介して不揮
発性記憶媒体(ICカード)9Aに記憶保存するので、
障害物の位置が変更になったり、追加が生じてもオペレ
ータは障害物の位置を意識せずに容易に登録の変更また
は追加ができるため、緊急を要する場合などに容易に対
処できる。
両としてロータリ式除雪車を例に挙げて説明したが、こ
れに限定されることなく、例えば、プラウ,グレーダ等
の作業用車両に適用することもできる。また、本実施の
形態においては、ロータリ式除雪車1が障害物に達する
までの到達時間tを、t=(d−2ρ)/vとして計算
されているが、かかる計算式に限定されることはない。
例えば、測位誤差2σより安全を見込むならば誤差を2
倍以上の係数×σにすることもできる。
データは不揮発性記憶媒体9AとしてのICカードに記
憶され1台のロータリ式除雪車1で使用されているが、
ICカードは持ち運び可能な不揮発性記憶媒体であるた
め、他のロータリ式除雪車1または作業用車両でも使用
することもできる。
性記憶媒体(ICカード)9Aに記憶されている障害物
データの複製を作ることにより、同時に複数のロータリ
式除雪車1または作業用車両間で障害物データを共有し
利用することも容易に可能である。
性記憶媒体9AとしてICカードが用いられているが、
これに限定されることはない。
両はDGPSによって正確な自己の位置検出ができ、こ
れにより作業用車両と障害物との相対距離を正確且つ連
続的に求めることが可能となり、更にその変化から作業
用車両が障害物に接近しているか否かを判定し、接近中
ならば同時に作業用車両の車速を読み取ることによって
障害物に達するまでの到達時間が計算され、作業用車両
の車速に応じてオペレータが安全な回避動作が可能な距
離の手前で、警報出力手段により自動的に警報を発し、
障害物の種類,個数,障害物までの距離等の情報をオペ
レータに出力し警告することができる。
の位置データを測位しているので、地上側に特定の設備
を設置する必要がなく、従って、作業用車両はそれ自体
の車輪の回転で走行距離を積算する従来の方式とは異な
り走行距離の誤差の累積の問題が無く、任意の地点から
スタートまたは再開できる。請求項2記載の発明によれ
ば、障害物の位置データは外部記憶装置の不揮発性記憶
媒体に予め複数登録されているので、簡単に制御装置に
位置データを取り込むことができる。
内に作業用車両が進入している時に、作業用車両が障害
物に接近しているか否かを判定し、接近中ならば警報が
発せられるが、逆に、警報距離の範囲外に作業用車両が
ある時や警報距離の範囲内であっても障害物から遠ざか
る場合には不要な警報を発しないので、オペレータは警
報に煩わされることなく本来の除雪作業(車両の操向や
除雪速度の調整等)に没頭できる。
置の不揮発性記憶媒体に予め複数登録されているので、
簡単に制御装置に位置データを取り込むことができる。
請求項4の発明によれば、障害物の登録または変更にあ
たっては、作業用車両を作業経路に沿って運転しながら
障害物上で、必要に応じてタッチパネル表示器により登
録または変更をすれば良く、制御装置はDGPSを利用
して測位された作業用車両の位置データを自動的に障害
物の位置,種類等を対応させてなる障害物データとして
作成し外部記憶装置を介して不揮発性記憶媒体に記憶保
存するので、障害物の位置が変更になったり、追加が生
じてもオペレータは障害物の位置を意識せずに容易に登
録の変更または追加ができるため、緊急を要する場合な
どに容易に対処できる。
態に係わる作業用車両の例としてロータリ式除雪車の外
観図である。
ある。
ける機能ブロック図である。
器,外部記憶装置,及び外部記憶媒体を示す斜視図であ
る。
における表示内容を示す説明図である。
けるフローチャート図である。
けるフローチャート図である。
示す平面説明図である。
面説明図である。
平面説明図である。
Claims (4)
- 【請求項1】 GPS衛星から発信している電波とDG
PS補正情報を用いて作業用車両の補正された位置デー
タを出力するGPS受信機と、 作業用車両の走行速度を検出する車速センサと、 入力側にGPS受信機,車速センサが接続され、出力側
に警報出力手段が接続された制御装置とを備え、 制御装置は、 道路上における予め複数登録された障害物毎の位置デー
タと測位された作業用車両の位置デ−タから、両者の相
対距離を計算する相対距離計算手段と、 相対距離の時間的変化から作業用車両が障害物に接近し
ているか否かを判定する接近判定手段と、 作業用車両が障害物の位置に到達するまでの到達時間を
車速を用いて計算する到達時間計算手段と、 作業用車両が障害物に接近中であることを条件として、
障害物のデータとして記憶されている警報距離と作業用
車両の現在の位置データから、作業用車両がこの警報距
離内にあるか否かを判定し、作業用車両がこの警報距離
内にあると判定した場合には警報出力手段に警報を指令
するとともに、作業用車両が警報距離内にいないと判定
した場合には到達時間が障害物毎に予め設定された障害
物回避時間より小さいか否かを判定して到達時間が障害
物回避時間より小さければ警報出力手段に警報を指令す
る警報判定手段とを備えていることを特徴とする作業用
車両の障害物警報装置。 - 【請求項2】 制御装置の出力側には入出力可能な外部
記憶装置が接続され、外部記憶装置の不揮発性記憶媒体
に障害物毎の位置データが予め複数登録されていること
を特徴とする請求項1記載の作業用車両の障害物警報装
置。 - 【請求項3】 GPS衛星から発信している電波とDG
PS補正情報を用いて作業用車両の補正された位置デー
タを出力するGPS受信機と、 入力側にGPS受信機,出力側に警報出力手段が接続さ
れた制御装置とを備え、 制御装置は、 道路上における予め複数登録された障害物毎の位置デー
タと測位された作業用車両の位置デ−タから、両者の相
対距離を計算する相対距離計算手段と、 相対距離の時間的変化から作業用車両が障害物に接近し
ているか否かを判定する接近判定手段と、 相対距離が前記障害物毎の警報距離より小さいか否かを
判定し、相対距離が警報距離より小さく、且つ作業用車
両がその障害物に接近中であれば、警報出力手段に警報
を指令する警報判定手段とを備え、 制御装置の出力側には入出力可能な外部記憶装置が接続
され、外部記憶装置の不揮発性記憶媒体に障害物毎の位
置データが予め複数登録されている ことを特徴とする作
業用車両の障害物警報装置。 - 【請求項4】 GPS受信機により、GPS衛星から発
信している電波とDGPS補正情報を用いて作業用車両
の補正された位置データを出力し、 補正された作業用車両の位置データをGPS受信機から
入出力装置が接続された制御装置に入力し、 制御装置により、オペレータが障害物地点において入出
力装置を介し選択もしくは変更した障害物データの位置
データと、その地点の作業用車両の測位した位置データ
を対応して外部記憶装置の不揮発性記憶媒体に記憶する
ことを特徴とする障害物位置登録方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP19939696A JP3264360B2 (ja) | 1996-07-29 | 1996-07-29 | 作業用車両の障害物警報装置及び障害物位置登録方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP19939696A JP3264360B2 (ja) | 1996-07-29 | 1996-07-29 | 作業用車両の障害物警報装置及び障害物位置登録方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH1038586A JPH1038586A (ja) | 1998-02-13 |
JP3264360B2 true JP3264360B2 (ja) | 2002-03-11 |
Family
ID=16407097
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP19939696A Expired - Lifetime JP3264360B2 (ja) | 1996-07-29 | 1996-07-29 | 作業用車両の障害物警報装置及び障害物位置登録方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3264360B2 (ja) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107924630A (zh) * | 2015-08-05 | 2018-04-17 | 株式会社电装 | 位置检测装置、位置检测方法以及位置检测*** |
CN108122295A (zh) * | 2017-12-29 | 2018-06-05 | 安徽中凯信息产业股份有限公司 | 一种车联网*** |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000046574A (ja) * | 1998-07-24 | 2000-02-18 | Honda Motor Co Ltd | 車両用ナビゲーション装置 |
JP3198475B2 (ja) * | 1999-06-07 | 2001-08-13 | 社団法人 雪センター | 路面処理用車両の支援システム |
JP2002116034A (ja) * | 2000-07-31 | 2002-04-19 | Fujitsu Ten Ltd | ナビゲーション装置、及び道路情報提供装置、並びに道路情報提供システム |
JP3999088B2 (ja) * | 2002-09-18 | 2007-10-31 | 本田技研工業株式会社 | 障害物検出装置 |
JP2014114536A (ja) * | 2012-12-06 | 2014-06-26 | Fujii Corporation Kk | 除雪機 |
JP6041397B2 (ja) * | 2014-03-19 | 2016-12-07 | 国土交通省北陸地方整備局長 | 道路除雪作業支援装置 |
JP6819980B1 (ja) * | 2020-06-23 | 2021-01-27 | 株式会社ネクスコ・エンジニアリング新潟 | 路側マーカーによる測位システム |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2513372B2 (ja) * | 1991-05-21 | 1996-07-03 | 株式会社新潟鉄工所 | 作業用車両障害物認識伝達装置 |
JP3135723B2 (ja) * | 1992-12-10 | 2001-02-19 | マツダ株式会社 | 車両の走行安全装置 |
JP2799375B2 (ja) * | 1993-09-30 | 1998-09-17 | 本田技研工業株式会社 | 衝突防止装置 |
JPH07104846A (ja) * | 1993-09-30 | 1995-04-21 | Fuji Heavy Ind Ltd | 自律走行車の走行制御装置 |
-
1996
- 1996-07-29 JP JP19939696A patent/JP3264360B2/ja not_active Expired - Lifetime
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107924630A (zh) * | 2015-08-05 | 2018-04-17 | 株式会社电装 | 位置检测装置、位置检测方法以及位置检测*** |
CN108122295A (zh) * | 2017-12-29 | 2018-06-05 | 安徽中凯信息产业股份有限公司 | 一种车联网*** |
Also Published As
Publication number | Publication date |
---|---|
JPH1038586A (ja) | 1998-02-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8260543B2 (en) | Hidden point detection and warning method and apparatus for navigation system | |
US20030055562A1 (en) | Global positioning system roadside integrated precision positioning system | |
AU2018329306B2 (en) | Safe driving assistance device | |
JP4268278B2 (ja) | ナビゲーション装置 | |
CN105008860A (zh) | 用于创建地图数据的方法及设备 | |
JP4617723B2 (ja) | 中継装置 | |
CN102445702A (zh) | 使用邻近实体信息的基于gps的相对定位增强方法 | |
JP2007148901A (ja) | 渋滞情報表示装置 | |
JP3264360B2 (ja) | 作業用車両の障害物警報装置及び障害物位置登録方法 | |
CN102472822A (zh) | 用于探测车辆的车道变换以及激活乘客保护装置的方法和控制设备 | |
CN111942382A (zh) | 自动驾驶辅助*** | |
JP2008196906A (ja) | 車両位置検出システム、車載装置及び車両位置検出方法 | |
JP5101691B2 (ja) | 情報表示装置、位置算出装置、表示制御方法、位置算出方法、表示制御プログラム、位置算出プログラムおよび記録媒体 | |
JP2011237217A (ja) | 車載用情報端末 | |
JP4125569B2 (ja) | 運転支援システム、運転支援方法及び運転支援プログラム | |
JP2009031241A (ja) | 車両位置特定システム、車載機、送信機、時刻補正システム及び時刻補正装置 | |
JP3933025B2 (ja) | 障害物情報提供装置及び障害物衝突防止支援システム | |
EP1096228B1 (en) | Navigation device | |
JP2011137706A (ja) | 現在位置表示装置 | |
JP2008151708A (ja) | 表示装置、表示システム及び表示方法 | |
JP2001319294A (ja) | 無線標識システム用送信機、車載無線受信機及び無線標識システム | |
JP3263678B2 (ja) | 事故車両表示装置 | |
JP6149949B2 (ja) | 中継装置、車載装置 | |
JP4725503B2 (ja) | 車載装置、運転支援システム及び運転支援方法 | |
JP2002163794A (ja) | 車両の走行安全装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
S111 | Request for change of ownership or part of ownership |
Free format text: JAPANESE INTERMEDIATE CODE: R313117 |
|
R371 | Transfer withdrawn |
Free format text: JAPANESE INTERMEDIATE CODE: R371 |
|
S111 | Request for change of ownership or part of ownership |
Free format text: JAPANESE INTERMEDIATE CODE: R313117 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20071228 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20081228 Year of fee payment: 7 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20091228 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20101228 Year of fee payment: 9 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20101228 Year of fee payment: 9 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111228 Year of fee payment: 10 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111228 Year of fee payment: 10 |
|
S531 | Written request for registration of change of domicile |
Free format text: JAPANESE INTERMEDIATE CODE: R313531 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111228 Year of fee payment: 10 |
|
R360 | Written notification for declining of transfer of rights |
Free format text: JAPANESE INTERMEDIATE CODE: R360 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111228 Year of fee payment: 10 |
|
R370 | Written measure of declining of transfer procedure |
Free format text: JAPANESE INTERMEDIATE CODE: R370 |
|
S531 | Written request for registration of change of domicile |
Free format text: JAPANESE INTERMEDIATE CODE: R313531 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111228 Year of fee payment: 10 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111228 Year of fee payment: 10 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121228 Year of fee payment: 11 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121228 Year of fee payment: 11 |
|
S111 | Request for change of ownership or part of ownership |
Free format text: JAPANESE INTERMEDIATE CODE: R313117 |
|
R360 | Written notification for declining of transfer of rights |
Free format text: JAPANESE INTERMEDIATE CODE: R360 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121228 Year of fee payment: 11 |
|
R370 | Written measure of declining of transfer procedure |
Free format text: JAPANESE INTERMEDIATE CODE: R370 |
|
S531 | Written request for registration of change of domicile |
Free format text: JAPANESE INTERMEDIATE CODE: R313531 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131228 Year of fee payment: 12 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131228 Year of fee payment: 12 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
S111 | Request for change of ownership or part of ownership |
Free format text: JAPANESE INTERMEDIATE CODE: R313117 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
EXPY | Cancellation because of completion of term |