JP3599478B2 - Guidance control device for mobile vehicles - Google Patents
Guidance control device for mobile vehicles Download PDFInfo
- Publication number
- JP3599478B2 JP3599478B2 JP11227296A JP11227296A JP3599478B2 JP 3599478 B2 JP3599478 B2 JP 3599478B2 JP 11227296 A JP11227296 A JP 11227296A JP 11227296 A JP11227296 A JP 11227296A JP 3599478 B2 JP3599478 B2 JP 3599478B2
- Authority
- JP
- Japan
- Prior art keywords
- magnetic field
- vehicle
- detection
- guidance
- traveling
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
- 238000001514 detection method Methods 0.000 claims description 88
- 230000002093 peripheral effect Effects 0.000 claims description 31
- 230000007423 decrease Effects 0.000 claims description 16
- 230000006698 induction Effects 0.000 claims description 13
- 238000000926 separation method Methods 0.000 claims description 11
- 230000015654 memory Effects 0.000 description 14
- 238000013459 approach Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 5
- 238000009434 installation Methods 0.000 description 5
- 230000003321 amplification Effects 0.000 description 4
- 230000006870 function Effects 0.000 description 4
- 238000003199 nucleic acid amplification method Methods 0.000 description 4
- 230000005856 abnormality Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 239000003990 capacitor Substances 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 239000004927 clay Substances 0.000 description 1
- 238000004140 cleaning Methods 0.000 description 1
- 239000004020 conductor Substances 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000007935 neutral effect Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000003971 tillage Methods 0.000 description 1
Images
Landscapes
- Guiding Agricultural Machines (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
【0001】
【発明の属する技術分野】
本発明は、所定の誘導エリア内において移動車を誘導走行させるように構成されている移動車の誘導制御装置に関する。
【0002】
【従来の技術】
上記構成の移動車の誘導制御装置は、所定の誘導エリア内において、例えば、設定経路に沿って投射されるレーザー光線に沿わせて移動車を誘導走行させたり、固定の管理制御装置からの無線情報による指令に基づいて、移動車を誘導走行させたりする等の誘導制御を行うものである。
【0003】
ところで、このような誘導制御装置において、設定経路に沿わせて移動車を誘導走行している途中で、何らかの異常に起因して、誘導制御が適正に行われずに、移動車が誘導用設定経路の終端位置に達した後も、走行を継続してしまうおそれがある。このように誘導用設定経路から外れた状態で走行を継続すると、移動車が誘導エリアの外方側に脱出して、走行制御が不能になってしまうおそれがあった。
【0004】
そこで、従来では、誘導用設定経路の終端位置を越えて走行を継続するような場合に、誘導エリアの外周縁に達したことを、例えば、誘導エリアの外周縁に沿ってレーザー光等の光線を投射して、この光線を移動車が遮断すると、移動車を非常停止させる構成や、あるいは、管理制御装置から移動車までの離間距離に基づいて、移動車が外周縁に達したか否かを判別する構成等が考えられた。
【0005】
【発明が解決しようとする課題】
しかし、上記従来構成のうち、レーザー光線により移動車が誘導エリアの外周縁に達したことを検出する構成においては、レーザー光線を投射するための装置が構成複雑で、コスト高になる不利があると共に、光線はその検出範囲が狭く確実に移動車の通過状態を精度よく検出できるとは限らず、検出精度が悪くなる不利があった。
【0006】
又、管理制御装置からの離間距離を検出するものにあっては、無線情報により離間距離を検出するために、その距離を演算するための処理時間が必要で、応答遅れが生じるおそれがあると共に、誘導エリアが広く、移動車と管理制御装置までの離間距離が大になる場合には、精度よく検出できないおそれがある等の不利な面があった。
【0007】
本発明はかかる点に着目してなされたものであり、その目的は、簡単な構成により、移動車が誘導エリアの外方に脱出してしまうことを確実に回避することが可能となる移動車の誘導制御装置を提供する点にある。
【0008】
【課題を解決するための手段】
請求項1に記載の特徴構成によれば、地上側において、電流が供給される電線が、その長手方向が前記誘導エリアの外周縁に沿う状態で設置され、前記移動車に、前記電流により形成される磁界であって且つ上下方向に沿う磁界の強さを検出する磁界検出手段と、車体走行距離を検出する距離検出手段と、磁界検出手段にて検出される磁界の強さが、ピーク値を越えた後に減少するとき、車体が単位距離だけ走行したときの磁界の強さの減少量が、設定値より大きい状態が検出されることに基づいて、車体が前記誘導エリアの外周縁の近くに至ったことを判別する脱出状態判別手段と、この脱出状態判別手段により車体が外周縁の近くに至ったことが判別されるに伴って、前記移動車の走行を停止させる走行停止手段とが備えられる。
【0009】
つまり、前記電線に供給される電流により形成される磁界の等強度線は、電線に対する同芯円筒状に形成されることになる。従って、電線から離間している箇所では、磁界の上下方向に沿う成分の割合が大きく、しかも、その強度が電線との離間距離の2乗に反比例する。従って、磁界検出手段によって検出される磁界の強さが電線に近づくほど大きな値になるが、電線に近づくに従って磁界の上下方向の成分の割合が小さくなり、電線の真上においては磁界の上下方向に沿う成分がほぼ零となる箇所がある。
その結果、移動車が例えば、所定の誘導経路から外れて誘導エリアの外周縁に近くなると、磁界検出手段により検出される磁界の強さは、徐々に大きくなり、電線の上部近くまで達すると、急激に小さい値に減少することになる。
【0010】
従って、検出される磁界の強さが、ピーク値を越えた後に減少するとき、車体が単位距離だけ走行したときの磁界の強さの減少量が、設定値より大きい状態が検出されると、脱出状態判別手段によって車体が誘導エリアの外周縁の近くに至ったことを判別することになるのである。
【0011】
このように、車体が誘導エリアの外周縁の近くに至ったことが判別されると、車体の走行が停止させるので、エリア外部に脱出して制御が不能になってしまう等の不利を未然に回避できる。
【0012】
電線により形成される磁界は、移動車が存在する地上空間の全ての領域に存在するから確実に検出できるものであり、光線によって検出する場合や、無線情報によって距離を演算する場合に較べて、車体が誘導エリアの外周縁の近くに至ったことを精度よく検出することができる。
しかも、電流が供給される電線を地上側に設置し、移動車に磁界検出手段を備えるだけの簡単な構成で対応できて、誘導制御装置の全体構成を複雑化させて、コスト高を招くことも無い。
【0013】
請求項2に記載の特徴構成によれば、前記脱出状態判別手段により車体が外周縁の近くに至ったことが判別された後に、前記磁界検出手段の検出情報並びに前記距離検出手段による検出情報に基づいて、車体と前記電線までの離間距離を演算する距離演算手段が設けられているから、車体が停止した状態において、車体と誘導エリアの外周縁との間の距離を判別できて、その後の誘導制御を円滑に行わせることが可能となる。
【0014】
請求項3に記載の特徴構成によれば、前記移動車に、車体向きを変更操作自在な操向操作手段と、予め定められた走行経路に沿わせるように走行させるべく、前記磁界検出手段の検出値が、予め設定された目標値になるように前記操向操作手段を制御する操向制御手段とが設けられているから、磁界検出手段の検出情報を操向制御にも有効利用することで、検出手段の兼用化により誘導制御装置全体の構成を簡素化できるものとなる。
【0015】
請求項4に記載の特徴構成によれば、前記電線が、矩形形状に設けられた前記誘導エリアにおける各走行経路に沿う方向の外周縁に沿って設置される誘導用電線と、誘導エリアにおける各走行経路と交差する方向に沿う外周縁に沿って設置される経路終端用電線とで構成され、誘導用電線により形成される磁界の強さを検出する誘導用の磁界検出部と、経路終端用電線により形成される磁界の強さを検出する終端検出用の磁界検出部とにより、移動車側の磁界検出手段が構成される。
又、前記操向制御手段は、誘導用の磁界検出部の検出情報に基づいて、各走行経路に沿わせて車体を誘導走行させるように操向操作手段を制御し、且つ、終端検出用の磁界検出部の検出情報に基づいて、各走行経路の終端部に達したことを検出すると、車体を旋回させるべく操向操作手段を制御する。
そして、前記脱出状態検出手段は、終端検出用の磁界検出部の検出情報に基づいて、車体が誘導エリアの外周縁の近くに至ったことを判別するのである。
【0016】
従って、誘導用の磁界検出部の検出情報に基づいて、移動車を走行経路に沿う状態で誘導走行させて、終端検出用の磁界検出部の検出情報に基づいて各走行経路の終端部に達したことを検出する際に、その検出が正常に行われず、旋回走行が行われない状態で走行を続行してしまうような場合に、終端検出用の磁界検出部の検出情報に基づいて、車体が誘導エリアの外周縁の近くに至ったことを判別することで、移動車が誘導エリアの外方に脱出してしまうのを未然に防止できる。
【0017】
【発明の実施の形態】
以下、本発明に係る移動車の誘導制御装置について説明する。
図1に示すように、誘導エリアの一例としての矩形形状の圃場1内において、移動車の一例としての作業車Vを圃場1の長手方向に沿って互いに平行な複数の走行経路kの夫々において、無人状態で誘導走行させることができるように構成されている。
【0018】
圃場1の外周部における各辺(畦)には、夫々、畦の長さとほぼ同じ長さに設定された、誘導用電線としての誘導線2が畦に沿わせる状態で設置され、各誘導線2には夫々各別に電流供給手段としての電流供給源3により所定周波数の交流電流が供給される。つまり、圃場1の長尺方向に沿う両側の畦に沿って設置される各誘導線2a,2c(誘導用電線の一例)には、各電流供給源3により周波数fa(Hz)及び周波数fc(Hz)の交流電流が夫々供給され、短尺方向に沿う両側の畦に設置される各誘導線2b,2d(経路終端用電線の一例)には、各電流供給源3により周波数fb(Hz)及び周波数fd(Hz)の交流電流が夫々供給される。尚、周波数は、数百Hz〜数十KHz程度に設定されている。
【0019】
前記各誘導線2は、図2に示すように、地中に打ち込まれた導通材料からなる複数の杭4を介して地中を経由して前記電流が通流するように構成され、誘導線が長い距離にわたって設置される場合であっても、長手方向両側部で杭4を打ち込むだけで簡単に設置が行えるように構成されている。尚、地中においては、比較的電気抵抗の高い地表層G1でなく、比較的電気抵抗の低い下層の粘土層G2を通して電流が流れるように、杭4の打ち込み深さを設定している。
【0020】
上述したように設置された誘導線に電流が流れると、その電流によって磁界が形成されるが、誘導線からの離間距離に対する磁界の強さの理論値は演算にて求めることができ、その磁界の強さは誘導線からの離間距離の2乗に反比例する。従って、供給される電流値が一定であれば、図3に示すように、誘導線からの離間距離に対する磁界の強さの変化特性が定まることになり、圃場1内でのある地点での磁界の強さはほぼ一定の大きさになる。
【0021】
前記作業車Vは、四輪型の走行車体5の後部に対地作業装置としてのロータリー耕耘装置6が備えられ、走行しながら圃場1の対地作業(耕耘作業)を行うことができるようになっている。走行車体5にはエンジンが搭載され、このエンジンの動力が、前後進切換機構7を備えた変速装置及び電磁操作式走行クラッチ8を介して各車輪に伝えられて車体が走行するように構成され、エンジンの動力がロータリー耕耘装置6に伝えられるようになっている。又、左右の前輪が操向操作手段としての電動モータ9により操向操作可能に設けられている。
【0022】
前記作業車Vには、前記各誘導線に供給される交流電流により形成される磁界の強さを検出する磁界検出手段GK,車軸の回転数を検出することで車体の走行距離を検出するための例えばロータリーエンコーダ等から成る距離検出手段としての走行距離センサ10、車体の方位を検出する方位検出手段としての方位センサ11、前記前後進切換機構7や操向用電動モータ9等の動作を制御するマイクロコンピュータ利用の制御装置12等が備えられている。
【0023】
又、前記磁界検出手段GKは、走行車体5の前部に車体横幅方向に沿って並設される状態で設けられ、前記各誘導線に供給される交流電流により形成される磁界の強さを検出する3個の磁界センサにて構成され、このうち、左右両側に位置する側部磁界センサ13R,13Lは、周波数fa及び周波数fcの交流電流により形成される磁界の強さを検出するように構成され、左右中央側に位置する中央磁界センサ14は、周波数fb及び周波数fdの交流電流により形成される磁界の強さを検出するように構成されている。従って、側部磁界センサ13R,13Lにより誘導用の磁界検出部13が構成され、中央磁界センサ14により終端検出用の磁界検出部が構成される。
そして、前記制御装置12は、各側部磁界センサ13R,13Lによる検出情報に基づいて、複数の走行経路kの夫々において、作業車Vを各走行経路kに沿って誘導走行させる誘導走行制御を実行し、且つ、中央磁界センサ14による検出情報に基づいて、各走行経路kの終端部又は始端部に達したことを検出し、終端部に達したことを検出すると、作業車Vを回向走行させて隣接する次回の走行経路に進入誘導させる旋回制御を実行するように構成されている。従って、この制御装置12を利用して走行制御手段100が構成されることになる。
【0024】
つまり、図4に示すように、各側部磁界センサ13R,13L、中央磁界センサ14の出力が夫々、信号処理部15にて処理された後に制御装置12に与えられ、これらの磁界検出情報に基づいて、各走行経路kに沿って誘導走行されるように操向用電動モータ9を制御すると共に、走行経路kの終端部においては、磁界検出情報及び方位センサ11並びに走行距離センサ10の検出情報に基づいて、旋回走行すべく操向用電動モータ9、前後進切換機構7、走行クラッチ8等を制御するように構成されている。
【0025】
前記各磁界センサ13R,13L,14は、図5に示すように、誘導線に流れる交流電流により形成される交番磁界によって誘導起電力が発生する検出コイル16と、この検出コイル16の出力を所定のレベルまで増幅する増幅器17と、検出コイル16の出力のうち前記各誘導線に流れる電流の周波数に対応する出力のみ通過させる周波数フィルターとしてのバンドパスフィルターBPF、このバンドパスフィルターBPFの出力を増幅する増幅器18等を備えて構成されている。
【0026】
従って、各側部磁界センサ13R,13Lによる検出情報には、中央側磁界センサ14による検出情報が混入することがバンドパスフィルターBPFにより抑制されることになり、このバンドパスフィルターBPFが情報混入抑制手段を構成することになる。
【0027】
尚、前記検出コイル16は、図示はしないが、夫々、そのコイル軸芯が上下方向に沿う状態となるように作業車Vに取付けられ、誘導線に供給される電流により形成される磁界のうち上下方向に沿う磁界の強さを検出するように構成されている。
【0028】
このように、各側部磁界センサ13R,13Lは、夫々、周波数fa及び周波数fcの夫々に対応する検出情報が出力され、中央磁界センサ14は、夫々、周波数fb及び周波数fdの夫々に対応する検出情報が出力されるようになっているが、信号処理部15において、それらのうち、検出レベルが高い方、即ち、作業車Vが該当する誘導線に近い方の検出情報が選択的に出力されるようになっている。
信号処理部15は、図6に示すように、前記各磁界センサ13R,13L,14の出力を直流信号に変換する直流変換回路DCが夫々設けられ、その変換出力が制御装置12に入力され、制御装置12は各磁界センサ13R,13L,14における異なる周波数の出力のうち、検出レベルの高い側の出力を判別して、その出力を選択するように3個のアナログスイッチAS1,AS2,AS3 に選択信号を与えるように構成されている。
【0029】
制御装置12は、中央磁界センサ14の検出情報に基づいて、短尺方向に沿う畦に設置される誘導線2b,2dのうちいずれかの検出レベルの高い側の誘導線からの離間距離を算出して、その離間距離が設定値になると、作業車Vが前記各走行経路kの端部位置に達したことを判別するように構成されている。
尚、短尺方向に沿う畦に設置される誘導線2b,2dは、図7に示すように、両側端部を圃場1内方側に向けて略L字形に屈曲させた状態で設置されている。このように構成すると、誘導線2b,2dの中間部tからの離間距離が設定距離にある地点で誘導線2b,2dの全長にわたってほぼ同一の磁界の強さになるので、この地点を走行経路kの端部位置として設定している。この端部位置は、端部屈曲部の長さLよりも設定距離だけ圃場1内方側によった地点となる。因みに、本出願人の実験によれば、端部屈曲部の長さHが例えば3mであれば、端部位置は誘導線から5mの離間距離の位置となる。
【0030】
このように、走行経路kの端部位置を圃場1の端部よりも内方側に設定する理由は、図1に示すように、有限長の誘導線により形成される磁界において、離間距離が同一の地点における磁界強度分布は、誘導線の端部付近においては、離間距離に対する磁界の強さの関係が直線的でなく、磁界の強さに基づく誘導制御が良好に行えないおそれがあるからである。
【0031】
又、短尺方向に沿う畦に設置される誘導線には、図8に示すように、長尺方向に沿う畦に設置される誘導線2a,2cに流れる電流が地中を通して流入することを抑制する電流抑制手段の一例である周波数フィルターとしての、当該誘導線2a,2cに供給される電流の周波数のみの通過を許容するバンドパスフィルター19が設けられている。このバンドパスフィルター19は、コイル19aとコンデンサ19bを直列接続した共振回路にて構成され、その共振周波数が前記電流の周波数に対応するように構成されている。従って、他の誘導線から地中を通して異なる周波数の電流が流れ込んでも、誘導線にはその流入電流が通流することが抑制され、各磁界センサが誤った情報を検出するおそれを極力少なくさせている。
【0032】
前記各側部磁界センサ13R,13Lの検出情報に対応する各アナログスイッチAS1,AS3 の出力を増幅するための増幅ゲインは、制御装置12からの切り換え情報に基づいて複数段階(4段階)に変更調整するように構成されている。つまり、夫々増幅ゲインの異なる4個の増幅器21,22,23,23の出力のうちのいずれかを制御装置12に入力させるためのアナログスイッチAS4,AS5 に対して、制御装置12が選択内容を指令するように構成されている。
誘導線に供給される電流により形成される磁界の強さは、上述したように離間距離の変化に対して大きく変化するものであり、増幅ゲインを一定に維持した場合には、全範囲にわたって適正な分解能で検出することが難しく、検出精度が低下してしまうおそれがあるので、制御装置12に対する入力レベルが、例えば図9に示すように、前記誘導線からの離間距離が単位距離変化したときに適切な磁界の強さの変化が識別可能となるように、言い換えると、適切な分解能を有する適正出力範囲になるように増幅ゲインを自動調整するのである。
【0033】
前記各側部磁界センサ13R,13Lは、車体横幅方向に設定間隔を隔てて設置されており、そのいずれか一方の側部磁界センサが、作業車Vが、複数の走行経路kのうちの1つに沿って走行するときに、その走行中の走行経路kに沿う誘導制御を実行するために磁界の強さを検出するための現走行経路用の磁界検出部GK1 として機能し、他方の側部磁界センサが、隣接する次の走行経路kに沿って作業車を走行させた際に前記現走行経路用の磁界検出部GK1 にて検出されることになる磁界の強さを検出する次走行経路用の磁界検出部GK2 として機能するように構成されている。
つまり、他方の側部磁界センサは、現走行経路kを走行しながら次走行経路kの磁界を逐次検出するようになっており、この検出情報は、前記走行距離センサ10により検出される距離情報と対応付けた状態で、記憶手段としてのメモリ25に逐次記憶されるように構成されている。
【0034】
制御装置12は、磁界検出情報が記憶されている次走行経路kにおいて、メモリ25に記憶されている磁界検出情報と、走行距離センサ10により検出される走行経路kの端部位置からの走行距離情報とに基づいて、当該走行経路k上の各地点における磁界の強さの目標値を求め、その目標値と、現走行経路用の磁界検出部GK1 として機能する側部磁界センサの検出値との偏差に基づいて、走行用電動モータ9を駆動制御する誘導走行制御を実行するように構成されている。
【0035】
又、制御装置12は、メモリ25に記憶されている磁界検出情報に基づいて、次走行経路kにおいて誘導走行される際における現走行経路用の磁界検出部GK1 の出力ゲインの目標値を設定すると共に、次走行経路kにおける誘導走行に先立って、出力ゲインを目標値に自動調整するように構成されている。具体的には、メモリ25に記憶されている磁界の強さの最大値が、ゲイン調整用設定上限値を越えていれば、現行のゲインよりも1段低いゲインの増幅器が選択され、前記最大値が、ゲイン調整用設定下限値を下回っていれば、現行のゲインよりも1段高いゲインの増幅器が選択されるように、アナログスイッチAS4,AS5 に対して選択信号を指令するようになっている。尚、各アナログスイッチAS4,AS5 のゲインは常に同じ値に調整されるようになっている。
前記ゲイン調整用の設定上限値及び設定下限値は、アナログ値としての出力変化の直線性が保障される上下限範囲として設定される。
【0036】
又、制御装置12は、現走行経路用の磁界検出部GK1 として機能する側部磁界センサの検出値と、前記目標値との偏差に制御定数を乗じて操向操作量、つまり、電動モータの目標作動量を求めるように構成されている。そして、次走行経路用の磁界検出部GK2 にて検出される磁界の強さの検出情報に基づいて、次走行経路を走行する際における、前記制御定数を、前記操作量が適正範囲になるように補正するように構成されている。
具体的には、前記次走行経路用の磁界検出部GK2 にて検出される磁界の強さの最大値が定数補正用設定上限値を越えると、現走行経路における終端部に達したときに、そのときの制御定数より小さい制御定数に補正し、次走行経路用の磁界検出部GK2 にて検出される磁界の強さの最大値が定数補正用設定下限値を下回ると、現走行経路における終端部に達したときに、そのときの制御定数より大きい制御定数に補正するように構成されている。
尚、定数補正用設定上限値は、ゲイン調整用設定上限値よりも小さい値であり、定数補正用設定下限値は、ゲイン調整用設定下限値よりも大きい値に設定されることになる。
【0037】
更に、制御装置12は、磁界検出手段GKにて検出される磁界の強さが、ピーク値を越えた後に減少するとき、車体が単位距離だけ走行したときの磁界の強さの減少量が、設定値より大きい状態が検出されることに基づいて、車体が誘導エリアの外周縁の近くに至ったことを判別するように構成されると共に、車体が外周縁の近くに至ったことが判別されるに伴って、作業車の走行を停止させるように構成されている。
【0038】
詳述すると、車体が走行経路の終端位置で旋回せずそのまま直進して、誘導エリアの外周縁の近くに到ると、図13に示すように、誘導線2に近づくので、中央磁界センサ14により検出値は徐々に大きな値になるが、誘導線2の上部あたりまで近接すると、図13に示すように、ピーク値を越えた後、急激に小さい値に減少していくことになる。これは、中央磁界センサ14が上下方向の磁界の強さを検出する構成であるが、誘導線2により形成される磁界は誘導線2を中心とする円状になるので、その真上部では上下方向の成分はほぼ零となるからである。
そこで、このような磁界検出情報に基づいて、車体が誘導エリアの外周縁の近くに至ったことを判別することができるのである。
【0039】
従って、制御装置12を利用して、目標ゲイン設定手段101、ゲイン調整手段102、制御定数補正手段103、脱出状態判別手段104、走行停止手段105の夫々が構成されることになる。
【0040】
次に、制御装置12の制御動作について説明する。
圃場1内において作業車Vを誘導走行させる場合、制御装置12による自動誘導制御に先立って、初回の走行経路kにおいては、適正な走行経路kに沿わせる状態で手動操縦により作業車Vを走行させる。そのとき、走行経路kの始端位置から、走行を開始させるに伴って、次走行経路側の側部磁界センサ(図1の場合には右側のセンサ13R)の検出情報並びに走行距離センサ10の検出情報とを対応させた状態で、メモリ25に逐次書き込み記憶させておく。
【0041】
そして、次の走行経路kより自動誘導制御が開始され、図10に示すように、先ず、その作業状態に応じて前記出力ゲイン、及び、現走行経路用の磁界検出部GK1 として機能する側部磁界センサ(図1の場合には左側のセンサ13L)を初期設定する(ステップ1)と共に、前記メモリ25に書き込み記憶されている次走行経路側の側部磁界センサの検出値の最大値に基づいて、前記制御定数を初期設定する。尚、これらの初期設定は図示しない入力手段にて手動にて設定されるが、設定用の判別情報を予め記憶させておいて、検出情報より自動で設定させる構成としてもよい。
【0042】
そして、作業用の走行速度で作業車Vを走行させながら、前記メモリ25に記憶される磁界検出情報と、走行距離センサ10の検出情報とに基づいて、走行経路k上の現時点における磁界の強さの目標値を求めて、現走行経路用の磁界検出部GK1 として機能する側部磁界センサ13Lの検出値と前記目標値との偏差に制御定数を乗じて操向操作量を求め、この操向操作量になるように、操向用電動モータ9を駆動制御する(ステップ2)。
この誘導走行制御が実行される際に、次走行経路用の磁界検出部GK2 として機能する次走行経路側の側部磁界センサ(図1の場合には右側のセンサ13R)の検出情報を走行距離センサ10の検出情報と対応させた状態で、メモリ25に逐次書き込み記憶させる(ステップ3)。
【0043】
中央磁界センサ14の検出情報に基づいて、走行経路kの終端部に達したことが検出されると、走行経路数Nをカウントアップし(ステップ4,5)、カウント値が圃場1内での設定経路数NSに達していなければ(ステップ6)、前記メモリ25に書き込み記憶された磁界の強さの最大値Xmが、ゲイン調整用設定上限値SGMを越えていれば、現行のゲインよりも1段低いゲインの増幅器が選択されるようにアナログスイッチAS4,AS5 に対して選択信号を指令して、出力ゲインが下げ側に変更される(ステップ7,8)。前記最大値Xmが、ゲイン調整用設定下限値SGLを下回っていれば、現行のゲインよりも1段高いゲインの増幅器が選択されるように、アナログスイッチAS4,AS5 に対して選択信号を指令して、出力ゲインが上げ側に変更される(ステップ9,10)。
【0044】
このとき、メモリ25に記憶されている磁界の強さの最大値Xmが、ゲイン調整用設定上限値SGMを越えていず、ゲイン調整用設定下限値SGLも下回っていなければ、出力ゲインは変更することなく、そのままの値が用いられるが、このような場合であっても、メモリ25に記憶されている磁界の強さの最大値Xmが、定数補正用設定上限値SHMを越えていれば、そのときの制御定数より小さい制御定数(例えば、3割程度低い値)に補正し(ステップ11,12)、前記最大値Xmが、定数補正用設定下限値SHLを下回っていれば、そのときの制御定数より大きい制御定数(例えば、3割程度高い値)に補正する(ステップ13,14)。
【0045】
尚、ステップ8,10にて出力ゲインが変更された場合には、その後、変更状況に応じて制御定数を適宜補正することになる。つまり、出力ゲインが下げられたときは、制御定数を前経路における値より大きい値に補正し(ステップ8,14)、出力ゲインが上げられたときは、前経路における値より小さい値に補正する(ステップ10,12)。
このようにして、磁界の強さの検出値や出力ゲインの変更状況に応じて、常に適切な制御定数にて電動モータを駆動制御するようにして、制御のハンチングや検出誤差の発生を極力、抑制するようにしている。
【0046】
次に、現走行経路用の磁界検出部GK1 として機能する側部磁界センサを、反対側のもの(右側のセンサ13R)に切り換える(ステップ15)。車体の向きの変化によりそれらの位置関係が反転するからである。
【0047】
次に、車体を次走行経路kの始端部に位置させるべく回向走行させる旋回制御を実行する(ステップ16)。
図12(イ)に示すように、走行経路kの終端位置から設定距離だけ操向操作を中立状態に維持したままで直進走行させた後に、方位センサ11をリセットして、車体の方位が180度反転したことが検出されるまで、最大切れ角にて旋回走行させ、その後、中央磁界センサ14の検出情報に基づいて走行経路kの始端部に達するまで直進走行させる。
更に、図12(ロ)に示すように、現走行経路用の磁界検出部GK1 として機能する側部磁界センサの検出情報と、前記メモリ25に記憶されている記憶情報とに基づいて、次走行経路に沿う状態になるように車体を旋回しながら前進させて幅寄せを行う。その後、その走行経路に沿わせる状態で誘導走行制御を実行する。
【0048】
このとき、走行経路の始端部に達した後においては、次走行経路用の磁界検出部GK2 として機能する側部磁界センサ(図12においては右側センサ13R)による上記したような記憶動作が実行されるので、経路始端部においては、幅寄せによる検出誤差が発生することになるので、このような誤差を補正して適正な基準情報になるようにしている。
【0049】
つまり、走行経路kの終端部においては前記誘導走行制御が適正に実行され、適正な基準情報として記憶されることになるので、そのときの記憶値と、前記経路始端部において走行距離情報に対応付けて逐次記憶される情報との差異を求めることで、上述したような誤差によるずれ量を求めることができる。但し、これらの情報は、補正が実行される走行経路よりも以前の走行経路における情報であり、しかも、磁界の強さは図3に示すように、走行経路が異なる毎に非線形に変化するので、このような非線形特性に起因した誤差をも少なくさせるようにしている。尚、幅寄せによる走行距離情報の誤差は、操向操作量に基づいて適宜補正することになる。
即ち、走行経路kの終端部における記憶値と、経路始端部において距離情報に対応して逐次記憶される記憶値との差異Δαに対して、補正すべき走行経路における左右の側部磁界センサ13R,13Lの検出値の差分値Aと、前走行経路における左右の側部磁界センサ13R,13Lの検出値の差分値Bとの比を掛け合わせることで、非線形による誤差を少なくさせて、走行距離情報に対応した基準情報の補正値Δβを求めるのである。
【0050】
このようにして、その後の誘導走行において、走行経路の終端部付近での基準情報が上述したような誤差が少なく、ほぼ走行経路に沿う状態で設定できることになり、経路終端部にて作業車Vが蛇行してしまう不利を未然に回避できるものとなる。
【0051】
以後、上述したような誘導走行制御を実行するが、このとき、ステップ8にてゲインが変更されていれば、メモリ25に記憶されている検出情報に対しても、変化量に対応したゲインを掛けて走行用目標値を求めることになる。
そして、正常な動作を続行していれば、ステップ2〜16を繰り返して、各走行経路kに沿わせて順次、作業車Vを誘導走行させ、設定経路数NSに達すると制御が終了する(ステップ6)。
【0052】
そして、例えば、走行経路に沿わせて誘導走行しているときに、経路終端部に達したことの検出が良好に行われず、旋回制御が実行されずに、そのまま走行を続行したような場合には、図13に示すように、中央磁界センサにより検出される磁界の強さが、徐々に大きくなり、ピーク値を越えた後に、急激に減少することになる。そこで、ピーク値を越えた後に減少するとき、車体が単位距離だけ走行したときの磁界の強さの減少量が設定値より大きく、急激に減少している状態が検出されることに基づいて、車体が圃場の外周縁の近くに至ったか否かを判別することができるのである(ステップ17,18)。そして、外周縁近くに至ったことが判別されると、走行クラッチ8をOFFにして車体の走行を非常停止させるのである(ステップ19)。
このようにして、圃場外へ作業車Vは脱出してしまうことを未然に防止できることになる。
【0053】
尚、現走行経路kにおいては、前走行経路kを走行する際に記憶されている磁界の強さと現走行経路kでの検出磁界とが同じになるように制御され、しかも、前記各側部磁界センサ13R,13Lの設置間隔は、ロータリー耕耘装置6の対地作業幅よりも幅狭に設定されているので、ロータリー耕耘装置6による作業領域が各走行経路kでラップすることになり、未作業領域が発生しないようになっている。
【0054】
又、各側部磁界センサ13R,13Lの設置間隔を変更調整自在に構成されており、その設置間隔を変更させることで、例えば、制御装置の目標値算出用の演算情報等を変更させることなく、圃場の状況等に応じて各走行経路kの間隔を変更させることができる。
【0055】
〔別実施形態〕
(1)上記実施形態では、誘導対象エリアの左右両側に誘導線が設置される場合を例示したが、片側にのみ誘導線が設置される構成としてもよく、この場合において、誘導走行制御は、誘導線に近い方の走行経路から順次、遠い側の経路に誘導させてもよく、誘導線に遠い方の走行経路から順次、近い側の経路に誘導させてもよい。
【0056】
(2)上記実施形態では、経路終端用電線に供給される電流により形成される磁界の、中央磁界センサによる検出情報に基づいて、脱出状態を判別するように構成したが、このような構成に限らず、誘導用電線に供給される電流により形成される磁界の、側部磁界センサによる検出情報に基づいて、脱出状態を判別するように構成するものであってもよく、それらを共に備える構成であってもよい。
【0057】
(3)上記実施形態では、車体が圃場の外周縁の近くに至ったことが判別されると、単に車体の走行を停止させるだけの構成としたが、このように走行を停止させると共に、磁界センサの検出情報より、前記ピーク値を越えた後に減少するとき、検出値がほぼ零になるまで走行させずに、その途中で、車体が単位距離だけ走行したときの磁界の強さの減少量、つまり、図13に示す検出特性の傾斜角度から誘導線(圃場の外周縁)までの距離を演算にて求める距離演算手段を備えさせて、途中で走行を停止させて、その後、誘導用走行経路に自動制御にて復帰させるように構成するものであってもよい。
尚、図13に示す検出特性において、ピーク値が発生する地点と、電線までの距離は、磁界検出手段における電線との間の上下方向の距離(取付け高さ)に応じて変化するものであるが、移動車に対する磁界検出手段の取付け高さが設定されると、一定の値として設定されることになる。
【0058】
(4)上記実施形態では、移動車を誘導線に供給される電流により形成される磁界の強さの検出情報に基づいて、走行経路に沿わせて誘導走行するように構成したが、このような構成に限らず、例えば、走行経路に沿ってレーザー光線を投射させて、この光線を検出するように誘導制御させてもよく、又、無線情報にて別途設けられた管理制御装置から誘導制御する等、各種の誘導制御形態で実施してもよい。
【0059】
(5)上記実施形態では、移動車として、対地作業装置としてのロータリー耕耘装置を備える構成としたが、このような構成に代えて、例えば、苗植付装置や刈取収穫機を備えた作業車であってもよく、建設機械や清掃作業等の作業車であってもよい。又、作業を行わない運搬車等の移動車であってもよい。
【0060】
尚、特許請求の範囲の項に図面との対照を容易にするために符号を記すが、該記入により本発明は添付図面の構成に限定されるものではない。
【図面の簡単な説明】
【図1】誘導状態を示す平面図
【図2】誘導線の設置状態を示す側面図
【図3】磁界強度分布を示す図
【図4】制御ブロック図
【図5】磁界検出手段の構成図
【図6】信号処理部の構成図
【図7】誘導線の設置状態を示す平面図
【図8】誘導線の電気回路図
【図9】ゲインを切り換えた場合の出力特性を示す図
【図10】制御動作のフローチャート
【図11】移動車の平面図
【図12】旋回制御状態を示す平面図
【図13】外周縁端部における磁界検出状態を示す図
【符号の説明】
2 電線
2a,2c 誘導用電線
2b,2d 経路終端用電線
9 操向操作手段
10 距離検出手段
13 誘導用の磁界検出部
14 終端検出用の磁界検出部
100 走行制御手段
104 脱出状態判別手段
105 走行停止手段
GK 磁界検出手段
V 移動車[0001]
TECHNICAL FIELD OF THE INVENTION
The present invention relates to a mobile vehicle guidance control device configured to guide a mobile vehicle in a predetermined guidance area.
[0002]
[Prior art]
The guidance control device for a mobile vehicle having the above configuration, for example, guides a mobile vehicle along a laser beam projected along a set route in a predetermined guidance area, or transmits radio information from a fixed management control device. And guidance control such as guiding a mobile vehicle to travel on the basis of a command from the mobile terminal.
[0003]
By the way, in such a guidance control device, while the mobile vehicle is guided along the set route, the guidance control is not properly performed due to some abnormality, and the mobile vehicle is not guided. There is a possibility that the vehicle will continue running even after reaching the end position of. If the vehicle continues traveling in a state deviating from the guidance setting route in this way, the traveling vehicle may escape to the outside of the guidance area, and the traveling control may be disabled.
[0004]
Therefore, conventionally, when the vehicle continues to travel beyond the end position of the guidance setting route, the arrival at the outer periphery of the guidance area is determined by, for example, a light beam such as a laser beam along the outer periphery of the guidance area. When the moving vehicle blocks the light beam, the moving vehicle is stopped emergencyly, or based on the separation distance from the management control device to the moving vehicle, whether or not the moving vehicle has reached the outer peripheral edge. And the like for discriminating.
[0005]
[Problems to be solved by the invention]
However, among the above-mentioned conventional configurations, in the configuration for detecting that the moving vehicle has reached the outer peripheral edge of the guidance area by the laser beam, the device for projecting the laser beam is complicated in configuration, and disadvantageously increases the cost. The detection range of the light beam is narrow, and it is not always possible to accurately detect the passing state of the moving vehicle with accuracy, and the detection accuracy is disadvantageously deteriorated.
[0006]
Further, in the case of detecting the separation distance from the management control device, processing time for calculating the separation distance is required to detect the separation distance by wireless information, and a response delay may occur. However, when the guidance area is large and the distance between the mobile vehicle and the management control device is large, there is a disadvantage that the detection may not be performed accurately.
[0007]
The present invention has been made in view of such a point, and an object of the present invention is to provide a mobile vehicle capable of reliably preventing a mobile vehicle from escaping outside a guidance area with a simple configuration. The present invention provides a guidance control device.
[0008]
[Means for Solving the Problems]
According to the characteristic configuration of the first aspect, on the ground side, the electric wire to which the current is supplied is installed in a state where the longitudinal direction thereof is along the outer peripheral edge of the guidance area, and the electric wire is formed on the moving vehicle by the current. Magnetic field detecting means for detecting the strength of a magnetic field along the vertical direction, a distance detecting means for detecting a vehicle running distance, and a peak value of the magnetic field strength detected by the magnetic field detecting means. When the vehicle body travels a unit distance, the amount of decrease in the magnetic field strength when the vehicle body travels for a unit distance is greater than a set value. Escape state determination means for determining that the vehicle has reached, and travel stop means for stopping travel of the moving vehicle as the escape state determination means determines that the vehicle body has reached near the outer peripheral edge. Be provided.
[0009]
That is, the equal strength line of the magnetic field formed by the current supplied to the electric wire is formed in a concentric cylindrical shape with respect to the electric wire. Therefore, at a position apart from the electric wire, the proportion of the component of the magnetic field along the vertical direction is large, and the strength is inversely proportional to the square of the distance from the electric wire. Therefore, the strength of the magnetic field detected by the magnetic field detecting means becomes larger as it approaches the electric wire, but the proportion of the component of the magnetic field in the vertical direction decreases as it approaches the electric wire. There is a point where the component along is almost zero.
As a result, for example, when the moving vehicle deviates from the predetermined guidance route and approaches the outer peripheral edge of the guidance area, the strength of the magnetic field detected by the magnetic field detection means gradually increases, and when it reaches near the upper part of the electric wire, It will suddenly decrease to a small value.
[0010]
Therefore, when the strength of the detected magnetic field decreases after exceeding the peak value, and when the amount of decrease in the strength of the magnetic field when the vehicle body travels a unit distance is detected as a state greater than the set value, The escape state determining means determines that the vehicle body has reached near the outer peripheral edge of the guidance area.
[0011]
As described above, when it is determined that the vehicle body has reached the vicinity of the outer peripheral edge of the guidance area, the vehicle body stops traveling, so that the vehicle escapes outside the area and becomes uncontrollable. Can be avoided.
[0012]
The magnetic field formed by the electric wire can be reliably detected because it exists in all areas of the ground space where the moving vehicle exists, compared to the case where it is detected by a light beam or the case where the distance is calculated by wireless information, It is possible to accurately detect that the vehicle body has reached near the outer peripheral edge of the guidance area.
In addition, the electric current supply line is installed on the ground side, and the moving vehicle can be coped with with a simple configuration having only the magnetic field detecting means. This complicates the entire configuration of the guidance control device, resulting in high cost. Not even.
[0013]
According to the characteristic configuration described in
[0014]
According to the characteristic configuration of the third aspect, the moving vehicle is provided with a steering operation means capable of changing the vehicle body direction and a magnetic field detection means for causing the mobile vehicle to travel along a predetermined traveling route. Since steering control means for controlling the steering operation means so that the detected value becomes a preset target value is provided, the detection information of the magnetic field detecting means is also effectively used for steering control. Thus, the configuration of the entire guidance control device can be simplified by sharing the detection means.
[0015]
According to the characteristic configuration described in
Further, the steering control means controls the steering operation means to guide the vehicle body along each traveling route based on the detection information of the guidance magnetic field detection unit, and further includes a terminal detection terminal. When it is detected based on the detection information of the magnetic field detection unit that the end of each traveling route has been reached, the steering operation means is controlled to turn the vehicle body.
Then, the escape state detecting means determines that the vehicle body has reached near the outer peripheral edge of the guidance area based on the detection information of the magnetic field detector for detecting the terminal.
[0016]
Therefore, based on the detection information of the guidance magnetic field detection unit, the mobile vehicle is guided to travel along the traveling route, and reaches the end of each traveling route based on the detection information of the termination detection magnetic field detection unit. When such a situation is detected, the detection is not performed normally, and the vehicle continues to travel without turning, the vehicle body is detected based on the detection information of the magnetic field detector for detecting the terminal. Is determined to have reached near the outer peripheral edge of the guidance area, it is possible to prevent the moving vehicle from escaping outside the guidance area.
[0017]
BEST MODE FOR CARRYING OUT THE INVENTION
Hereinafter, a guidance control device for a mobile vehicle according to the present invention will be described.
As shown in FIG. 1, in a
[0018]
On each side (ridge) in the outer peripheral portion of the
[0019]
As shown in FIG. 2, each of the
[0020]
When a current flows through the guide wire installed as described above, a magnetic field is formed by the current, but the theoretical value of the magnetic field strength with respect to the distance from the guide wire can be obtained by calculation, and the magnetic field Is inversely proportional to the square of the distance from the guide line. Therefore, if the supplied current value is constant, as shown in FIG. 3, the change characteristic of the strength of the magnetic field with respect to the distance from the induction wire is determined, and the magnetic field at a certain point in the
[0021]
The work vehicle V is provided with a
[0022]
The work vehicle V has a magnetic field detecting means GK for detecting the strength of a magnetic field formed by the alternating current supplied to each of the induction wires, and a traveling distance of the vehicle body by detecting the rotation speed of the axle. Controls the operation of a
[0023]
The magnetic field detecting means GK is provided in front of the traveling
Then, the
[0024]
That is, as shown in FIG. 4, the outputs of the respective side
[0025]
As shown in FIG. 5, each of the
[0026]
Therefore, the bandpass filter BPF suppresses the detection information from the side
[0027]
Although not shown, the detection coils 16 are attached to the work vehicle V such that their respective coil axes are aligned with the up-down direction, and each of the detection coils 16 includes a magnetic field formed by a current supplied to an induction wire. It is configured to detect the strength of the magnetic field along the vertical direction.
[0028]
As described above, the detection information corresponding to each of the frequency fa and the frequency fc is output from each of the side
As shown in FIG. 6, the
[0029]
The
As shown in FIG. 7, the
[0030]
As described above, the reason why the end position of the traveling route k is set on the inner side than the end of the
[0031]
In addition, as shown in FIG. 8, the current flowing through the
[0032]
The amplification gain for amplifying the output of each of the analog switches AS 1 and AS 3 corresponding to the detection information of the respective side
As described above, the strength of the magnetic field formed by the current supplied to the induction wire greatly changes with the change in the separation distance, and when the amplification gain is kept constant, the strength is appropriate over the entire range. Since it is difficult to detect with a high resolution and the detection accuracy may be reduced, when the input level to the
[0033]
Each of the side
In other words, the other side magnetic field sensor sequentially detects the magnetic field of the next traveling route k while traveling on the current traveling route k, and this detection information is the distance information detected by the
[0034]
The
[0035]
The
The set upper limit value and the set lower limit value for the gain adjustment are set as upper and lower limit ranges in which the linearity of the output change as an analog value is guaranteed.
[0036]
The
Specifically, when the maximum value of the intensity of the magnetic field detected by the magnetic field detector GK 2 for the next running path exceeds a constant compensation for setting an upper limit value, when it reaches the end portion in the current traveling route , corrects the control constants smaller control constant of the time, the maximum value of the intensity of the magnetic field detected by the magnetic field detector GK 2 for the next travel path is below a constant compensation for setting a lower limit value, the current driving route When the end point is reached, the control constant is corrected to a control constant larger than the control constant at that time.
The set upper limit for constant correction is a value smaller than the set upper limit for gain adjustment, and the set lower limit for constant correction is set to a value larger than the set lower limit for gain adjustment.
[0037]
Further, when the strength of the magnetic field detected by the magnetic field detecting means GK decreases after exceeding the peak value, the
[0038]
More specifically, when the vehicle body goes straight without turning at the end position of the travel route and approaches the outer peripheral edge of the guidance area, it approaches the
Therefore, based on such magnetic field detection information, it can be determined that the vehicle body has reached near the outer peripheral edge of the guidance area.
[0039]
Therefore, each of the target gain setting means 101, the gain adjustment means 102, the control constant correction means 103, the escape state determination means 104, and the traveling stop means 105 is configured using the
[0040]
Next, the control operation of the
When the work vehicle V is guided to travel in the
[0041]
The automatic guidance control than the next travel path k is started, as shown in FIG. 10, first, the output gain according to the working state, and functions as a magnetic field detector GK 1 for the current travel route side The magnetic field sensor (the
[0042]
Then, based on the magnetic field detection information stored in the
When the guided travel control is performed, the traveling information detected lateral magnetic field sensor following the travel path side that functions as the magnetic field detecting unit GK 2 for the next travel path (right side of the
[0043]
When it is detected based on the detection information of the central
[0044]
In this case, the maximum value Xm of the intensity of the magnetic field stored in the
[0045]
If the output gain is changed in
In this way, the drive control of the electric motor is always performed with an appropriate control constant in accordance with the detection value of the magnetic field strength and the change situation of the output gain, so that the occurrence of control hunting and detection errors is minimized. I try to suppress it.
[0046]
Then, the side magnetic field sensor which serves as a magnetic field detector GK 1 for the current travel route is switched to that of the opposite side (the right side of the
[0047]
Next, a turning control for turning the vehicle in a turning direction so as to be positioned at the start end of the next traveling route k is executed (step 16).
As shown in FIG. 12A, after the vehicle is driven straight ahead while maintaining the steering operation in the neutral state for a set distance from the end position of the travel route k, the
Furthermore, as shown in FIG. 12 (b), based on the storage information stored and detection information of the side magnetic field sensor which serves as a magnetic field detector GK 1 for the current travel route in the
[0048]
In this case, after reaching the starting end of the travel path, execution store operation as described above by (
[0049]
That is, at the end of the traveling route k, the guidance traveling control is properly executed and stored as appropriate reference information. Therefore, the stored value at that time corresponds to the traveling distance information at the beginning of the route. By calculating the difference between the information and the information sequentially stored, the shift amount due to the above-described error can be obtained. However, such information is information on a traveling route before the traveling route on which the correction is performed, and furthermore, as shown in FIG. 3, the strength of the magnetic field changes non-linearly each time the traveling route is different. The error caused by such non-linear characteristics is also reduced. The error in the traveling distance information due to the width shift is appropriately corrected based on the steering operation amount.
That is, for the difference Δα between the stored value at the end of the traveling route k and the stored value sequentially stored corresponding to the distance information at the beginning of the route, the left and right side
[0050]
In this way, in the subsequent guided traveling, the reference information near the end of the traveling route can be set in a state substantially along the traveling route with a small error as described above. Can be avoided beforehand.
[0051]
Thereafter, the above-described guided traveling control is executed. At this time, if the gain has been changed in
If the normal operation is continued, steps 2 to 16 are repeated to guide the work vehicle V sequentially along each traveling route k, and when the number of the set routes NS is reached, the control is terminated ( Step 6).
[0052]
Then, for example, when the vehicle is guided along the travel route, it is difficult to detect that the vehicle has reached the end of the route, the turning control is not executed, and the vehicle continues to travel. As shown in FIG. 13, the intensity of the magnetic field detected by the central magnetic field sensor gradually increases, and after the peak value is exceeded, sharply decreases. Therefore, when the value decreases after exceeding the peak value, the amount of decrease in the strength of the magnetic field when the vehicle body travels a unit distance is larger than the set value, and based on the fact that the state of the sudden decrease is detected, It is possible to determine whether the vehicle body has reached near the outer peripheral edge of the field (steps 17 and 18). Then, when it is determined that the vehicle is near the outer peripheral edge, the traveling
In this way, the work vehicle V can be prevented from escaping out of the field.
[0053]
The current traveling route k is controlled so that the strength of the magnetic field stored when traveling on the preceding traveling route k is the same as the detected magnetic field on the current traveling route k. Since the installation intervals of the
[0054]
Further, the installation intervals of the side
[0055]
[Another embodiment]
(1) In the above embodiment, the case where the guide lines are installed on both the left and right sides of the guidance target area has been exemplified. However, a configuration in which the guide lines are installed only on one side may be adopted. The travel route closer to the guide line may be sequentially guided to a route farther away, or the travel route farther to the guide line may be sequentially guided to a route closer to the guide line.
[0056]
(2) In the above embodiment, the escape state is determined based on the detection information of the magnetic field formed by the current supplied to the route terminating wire by the central magnetic field sensor. The present invention is not limited thereto, and may be configured to determine the escape state based on information detected by a side magnetic field sensor of a magnetic field formed by a current supplied to an induction wire, and a configuration including both of them. It may be.
[0057]
(3) In the above embodiment, when it is determined that the vehicle body has reached the vicinity of the outer peripheral edge of the field, the running of the vehicle body is simply stopped. According to the detection information of the sensor, when the value decreases after exceeding the peak value, the vehicle does not travel until the detected value becomes substantially zero, and the amount of decrease in the strength of the magnetic field when the vehicle travels a unit distance on the way. In other words, the vehicle is provided with distance calculating means for calculating the distance from the inclination angle of the detection characteristic shown in FIG. 13 to the guide line (the outer peripheral edge of the field) by calculation, and stops running halfway, and thereafter, runs for guidance. It may be configured to return to the route by automatic control.
In the detection characteristics shown in FIG. 13, the distance between the point where the peak value occurs and the electric wire changes according to the vertical distance (mounting height) between the electric wire and the electric wire in the magnetic field detecting means. Is set as a constant value when the mounting height of the magnetic field detecting means to the mobile vehicle is set.
[0058]
(4) In the above embodiment, the mobile vehicle is guided to travel along the travel route based on the detection information of the strength of the magnetic field formed by the current supplied to the guide line. Not limited to such a configuration, for example, a laser beam may be projected along a traveling route, and guidance control may be performed so as to detect this beam, or guidance control is performed from a management control device separately provided by wireless information. For example, the present invention may be implemented in various guidance control modes.
[0059]
(5) In the above embodiment, the moving vehicle is provided with the rotary tilling device as the ground working device. However, instead of such a configuration, for example, a working vehicle provided with a seedling planting device or a reaper and harvester Or a construction vehicle or a work vehicle for cleaning work or the like. Further, a mobile vehicle such as a transport vehicle that does not perform the work may be used.
[0060]
Incidentally, reference numerals are written in the claims to facilitate comparison with the drawings, but the present invention is not limited to the configuration of the attached drawings by the entry.
[Brief description of the drawings]
FIG. 1 is a plan view showing a guiding state. FIG. 2 is a side view showing an installation state of a guiding wire. FIG. 3 is a diagram showing a magnetic field intensity distribution. FIG. 4 is a control block diagram. FIG. FIG. 6 is a configuration diagram of a signal processing unit. FIG. 7 is a plan view showing an installation state of a guide wire. FIG. 8 is an electric circuit diagram of a guide wire. FIG. 9 is a diagram showing output characteristics when a gain is switched. 10 Flow chart of control operation FIG. 11 Plan view of mobile vehicle FIG. 12 Plan view showing turning control state FIG. 13 View showing magnetic field detection state at outer peripheral edge
2
Claims (4)
地上側において、電流が供給される電線(2)が、その長手方向が前記誘導エリアの外周縁に沿う状態で設置され、
前記移動車(V)に、
前記電流により形成される磁界であって且つ上下方向に沿う磁界の強さを検出する磁界検出手段(GK)と、
車体走行距離を検出する距離検出手段(10)と、
前記磁界検出手段(GK)にて検出される磁界の強さが、ピーク値を越えた後に減少するとき、車体が単位距離だけ走行したときの磁界の強さの減少量が、設定値より大きい状態が検出されることに基づいて、車体が前記誘導エリアの外周縁の近くに至ったことを判別する脱出状態判別手段(104)と、
この脱出状態判別手段(104)により車体が外周縁の近くに至ったことが判別されるに伴って、前記移動車(V)の走行を停止させる走行停止手段(105)とが備えられている移動車の誘導制御装置。A guidance control device for a mobile vehicle configured to guide a mobile vehicle (V) in a predetermined guidance area,
On the ground side, an electric wire (2) to be supplied with electric current is installed with its longitudinal direction along the outer peripheral edge of the guidance area,
In the moving vehicle (V),
A magnetic field detecting means (GK) for detecting the strength of the magnetic field formed by the current and along the vertical direction;
Distance detecting means (10) for detecting a vehicle running distance;
When the strength of the magnetic field detected by the magnetic field detecting means (GK) decreases after exceeding the peak value, the amount of decrease in the strength of the magnetic field when the vehicle body travels a unit distance is larger than a set value. Escape state determination means (104) for determining that the vehicle body has reached near the outer peripheral edge of the guidance area based on the detection of the state;
A running stop means (105) for stopping the running of the moving vehicle (V) when the escape state determining means (104) determines that the vehicle body has reached the vicinity of the outer peripheral edge is provided. Guidance control device for mobile vehicles.
車体向きを変更操作自在な操向操作手段(9)と、
予め定められた走行経路に沿わせるように走行させるべく、前記磁界検出手段(GK)の検出値が、予め設定された目標値になるように前記操向操作手段(9)を制御する操向制御手段(100)とが設けられている請求項1又は2記載の移動車の誘導制御装置。In the moving vehicle (V),
A steering operation means (9) capable of changing the vehicle body orientation;
Steering for controlling the steering operation means (9) so that the detection value of the magnetic field detection means (GK) becomes a preset target value so as to travel along a predetermined traveling route. The guidance control device for a mobile vehicle according to claim 1 or 2, further comprising control means (100).
矩形形状に設けられた前記誘導エリアにおける前記各走行経路に沿う方向の外周縁に沿って設置される誘導用電線(2a),(2c)と、
前記誘導エリアにおける前記各走行経路と交差する方向に沿う外周縁に沿って設置される経路終端用電線(2b),(2d)とで構成され、
前記磁界検出手段(GK)が、
前記誘導用電線(2a),(2c)により形成される磁界の強さを検出する誘導用の磁界検出部(13)と、
前記経路終端用電線(2b),(2d)により形成される磁界の強さを検出する終端検出用の磁界検出部(14)とを備えて構成され、
前記操向制御手段(100)は、
前記誘導用の磁界検出部(13)の検出情報に基づいて、前記各走行経路に沿わせて車体を誘導走行させるように前記操向操作手段(9)を制御し、
且つ、前記終端検出用の磁界検出部(14)の検出情報に基づいて、前記各走行経路の終端部に達したことを検出すると、車体を旋回させるべく前記操向操作手段(9)を制御するように構成され、
前記脱出状態検出手段(104)、前記終端検出用の磁界検出部(14)の検出情報に基づいて、車体が前記誘導エリアの外周縁の近くに至ったことを判別するように構成されている請求項3記載の移動車の誘導制御装置。The electric wire (2)
Guide wires (2a) and (2c) installed along an outer peripheral edge of the guide area provided in a rectangular shape along a direction along each of the traveling paths;
Route termination wires (2b) and (2d) installed along an outer peripheral edge along a direction intersecting with each of the traveling routes in the guidance area,
The magnetic field detecting means (GK)
An induction magnetic field detector (13) for detecting the intensity of a magnetic field formed by the induction wires (2a) and (2c);
A magnetic field detecting unit (14) for detecting a termination which detects the strength of a magnetic field formed by the electric wires (2b) and (2d) for terminating the path;
The steering control means (100) includes:
Controlling the steering operation means (9) based on the detection information of the guidance magnetic field detection unit (13) so as to guide the vehicle along the respective traveling routes;
When it is detected that the vehicle has reached the end of each of the traveling paths based on the detection information of the magnetic field detector for end detection, the control unit controls the steering operation means to turn the vehicle body. Is configured to
The escape state detecting means (104) is configured to determine that the vehicle body has reached near the outer peripheral edge of the guidance area based on the detection information of the magnetic field detecting section (14) for detecting the terminal. The guidance control device for a mobile vehicle according to claim 3.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP11227296A JP3599478B2 (en) | 1996-05-07 | 1996-05-07 | Guidance control device for mobile vehicles |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP11227296A JP3599478B2 (en) | 1996-05-07 | 1996-05-07 | Guidance control device for mobile vehicles |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH09297618A JPH09297618A (en) | 1997-11-18 |
JP3599478B2 true JP3599478B2 (en) | 2004-12-08 |
Family
ID=14582560
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP11227296A Expired - Fee Related JP3599478B2 (en) | 1996-05-07 | 1996-05-07 | Guidance control device for mobile vehicles |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3599478B2 (en) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100690669B1 (en) * | 2005-05-17 | 2007-03-09 | 엘지전자 주식회사 | Position-reconizing system for a self-moving robot |
CN108536136B (en) * | 2017-03-06 | 2021-03-16 | 苏州宝时得电动工具有限公司 | Automatic walking equipment and boundary distance detection method, device and system |
-
1996
- 1996-05-07 JP JP11227296A patent/JP3599478B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JPH09297618A (en) | 1997-11-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP0658467B1 (en) | Guidewire controls for a manned, material handling vehicle | |
JPH1185269A (en) | Guide control device for moving vehicle | |
MX2013009769A (en) | Object tracking and steer maneuvers for materials handling vehicles. | |
JP3599478B2 (en) | Guidance control device for mobile vehicles | |
US5144130A (en) | Method for the electrical adjustment of an optical row of sensors | |
US4160488A (en) | Extended width sensor | |
JPH1056817A (en) | Position detecting apparatus for movable vehicle and guidance and control device using the same | |
JP3596977B2 (en) | Guidance control device for mobile vehicles | |
JP3173987B2 (en) | Guidance control device for mobile vehicles | |
JP3538503B2 (en) | Guidance control device for mobile vehicles | |
JP3361280B2 (en) | Three-wheel steering automatic guided vehicle | |
JP3226818B2 (en) | Guidance control device for mobile vehicles | |
JP3236494B2 (en) | Guidance control device for mobile vehicles | |
JP3599498B2 (en) | Guidance control device for mobile vehicles | |
JPH09212235A (en) | Guide controller for moving vehicle | |
JPH09297617A (en) | Guidance controller for moving vehicle | |
JPH1056816A (en) | Working vehicle leading controller | |
JPH09297615A (en) | Guidance controller for moving vehicle | |
JPH09212237A (en) | Guidance controller for moving vehicle | |
JP3281759B2 (en) | Guidance control device for mobile vehicles | |
JPH11288313A (en) | Guidance controller for moving vehicle | |
JPH08286738A (en) | Guidance controller for moving vehicle | |
JP3281758B2 (en) | Guidance control device for mobile vehicles | |
WO1994020325A1 (en) | Drive control device for a vehicle, in particular for a wheelchair, and vehicle provided with such a drive control device | |
JPH1185270A (en) | Guidance control unit for moving vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20040511 |
|
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: 20040826 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20040914 |
|
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 |