JPS62294003A - 自動走行作業車の走行制御装置 - Google Patents
自動走行作業車の走行制御装置Info
- Publication number
- JPS62294003A JPS62294003A JP61138794A JP13879486A JPS62294003A JP S62294003 A JPS62294003 A JP S62294003A JP 61138794 A JP61138794 A JP 61138794A JP 13879486 A JP13879486 A JP 13879486A JP S62294003 A JPS62294003 A JP S62294003A
- Authority
- JP
- Japan
- Prior art keywords
- steering
- aircraft
- stroke
- orientation
- vehicle
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 claims description 78
- 238000001514 detection method Methods 0.000 description 20
- 238000012545 processing Methods 0.000 description 16
- 239000000126 substance Substances 0.000 description 14
- 230000005540 biological transmission Effects 0.000 description 7
- 238000005507 spraying Methods 0.000 description 7
- 230000007935 neutral effect Effects 0.000 description 4
- 201000007750 congenital bile acid synthesis defect Diseases 0.000 description 3
- 239000006185 dispersion Substances 0.000 description 3
- 239000003814 drug Substances 0.000 description 3
- 235000013399 edible fruits Nutrition 0.000 description 3
- XEEYBQQBJWHFJM-UHFFFAOYSA-N Iron Chemical compound [Fe] XEEYBQQBJWHFJM-UHFFFAOYSA-N 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 229940079593 drug Drugs 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 239000003550 marker Substances 0.000 description 2
- 239000002420 orchard Substances 0.000 description 2
- 102100031033 CCR4-NOT transcription complex subunit 3 Human genes 0.000 description 1
- 101000919663 Homo sapiens CCR4-NOT transcription complex subunit 3 Proteins 0.000 description 1
- 241001124569 Lycaenidae Species 0.000 description 1
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000003213 activating effect Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 229910052742 iron Inorganic materials 0.000 description 1
- 239000000696 magnetic material Substances 0.000 description 1
- 230000007257 malfunction Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000008929 regeneration Effects 0.000 description 1
- 238000011069 regeneration method Methods 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
Landscapes
- Guiding Agricultural Machines (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
3、発明の詳細な説明
〔産業上の利用分野〕
本発明は、作業行程の長さ方向に基づいて設定された基
準方位に対する機体の向きを検出するセンサを備え、機
体を前記作業行程に沿って自動走行させるべく、前記セ
ンサによる検出方位に基づいて、操向車輪を自動的に操
向操作する自動操向制御手段を備えると共に、前記操向
車輪の操向操作を送信機からの指示情報に基づいて遠隔
操作する遠隔操縦手段を備えた自動走行作業車の走行制
御装置に関する。
準方位に対する機体の向きを検出するセンサを備え、機
体を前記作業行程に沿って自動走行させるべく、前記セ
ンサによる検出方位に基づいて、操向車輪を自動的に操
向操作する自動操向制御手段を備えると共に、前記操向
車輪の操向操作を送信機からの指示情報に基づいて遠隔
操作する遠隔操縦手段を備えた自動走行作業車の走行制
御装置に関する。
上記この種の自動走行作業車の走行制御装置は、機体に
備えたセンサによる検出方位に基づいて、この検出方位
が設定された基準方位に対して許容差内に維持されるよ
うに、操向車輪を自動的に操向操作することにより、機
体が作業行程に沿って自動走行するようにすると共に、
機体を自動走行し難い作業地や、作業終了後に離れた箇
所にある機体を移動させる際に便利なように、遠隔操縦
することもできるようにしたものである。
備えたセンサによる検出方位に基づいて、この検出方位
が設定された基準方位に対して許容差内に維持されるよ
うに、操向車輪を自動的に操向操作することにより、機
体が作業行程に沿って自動走行するようにすると共に、
機体を自動走行し難い作業地や、作業終了後に離れた箇
所にある機体を移動させる際に便利なように、遠隔操縦
することもできるようにしたものである。
そして、機体を作業行程に沿って自動走行させるに、従
来では、例えば、スリップが生じたり、走行前方の障害
物を自動的に回避するための制御作動が行われることに
起因して、機体向きが基準方位に対して大きくずれたよ
うな場合であっても、単に基準方位に対する検出方位の
ずれが大きくなっただけと判別して、機体向きが基準方
位に対して設定された許容差内に維持されるように、操
向車輪を操向操作する処理を41続して行うようにして
あった。
来では、例えば、スリップが生じたり、走行前方の障害
物を自動的に回避するための制御作動が行われることに
起因して、機体向きが基準方位に対して大きくずれたよ
うな場合であっても、単に基準方位に対する検出方位の
ずれが大きくなっただけと判別して、機体向きが基準方
位に対して設定された許容差内に維持されるように、操
向車輪を操向操作する処理を41続して行うようにして
あった。
しかしながら、上記従来構成においては、機体の向きが
基準方位に対して大きくずれたままで操向制御を′m続
すると、そのずれを修正するまでに時間がかかって、そ
の間に作業行程近傍にある他物に機体を衝突させる戊れ
がある。特に、自動走行作業車を薬剤散布作業車等のよ
うに、機体の左右に障害物となる樹木が位置する状態で
自動走行させる形式の作業車においては、機体が、樹木
に衝突したり、走行方向に並ぶ横木の間を通過して隣の
作業行程に移動してしまう虞れもある。しかも、機体が
自動走行していることから、機体と作業者との距離が離
れていると、そのずれの状態を確認し難り、機体の異常
走行状態の発見が遅れる虞れがある。
基準方位に対して大きくずれたままで操向制御を′m続
すると、そのずれを修正するまでに時間がかかって、そ
の間に作業行程近傍にある他物に機体を衝突させる戊れ
がある。特に、自動走行作業車を薬剤散布作業車等のよ
うに、機体の左右に障害物となる樹木が位置する状態で
自動走行させる形式の作業車においては、機体が、樹木
に衝突したり、走行方向に並ぶ横木の間を通過して隣の
作業行程に移動してしまう虞れもある。しかも、機体が
自動走行していることから、機体と作業者との距離が離
れていると、そのずれの状態を確認し難り、機体の異常
走行状態の発見が遅れる虞れがある。
本発明は、上記実情に鑑みてなされたものであって、そ
の目的は、機体向きが作業行程に対して設定された基準
方位に対して大きくずれたような場合に、そのずれを容
易に確認できるようにすることにある。
の目的は、機体向きが作業行程に対して設定された基準
方位に対して大きくずれたような場合に、そのずれを容
易に確認できるようにすることにある。
本発明による自動走行作業車の走行制御装置の特徴構成
は、前記センサによる検出方位が、前記基準方位に対し
て設定範囲以上ずれた場合に、機体の向きが前記基準方
位からずれたことを報知する報知手段を備えた点にあり
、その作用並びに効果は以下の通りである。
は、前記センサによる検出方位が、前記基準方位に対し
て設定範囲以上ずれた場合に、機体の向きが前記基準方
位からずれたことを報知する報知手段を備えた点にあり
、その作用並びに効果は以下の通りである。
すなわち、機体向きが基準方位に対して設定範囲以上ず
れたか否かを、報知手段が作動したか否かによって、離
れた箇所から容易に確認できる。
れたか否かを、報知手段が作動したか否かによって、離
れた箇所から容易に確認できる。
従って、機体向きが基準方位に対して設定範囲内に維持
されているか否かを、離れた箇所から容易に確認できる
ので、例えば、機体向きが大きくずれたような場合には
、機体の操向操作を自動操向制御手段から遠隔操縦手段
に切り換えて、人為的に修正する等の処置を的確に行う
ことができる。
されているか否かを、離れた箇所から容易に確認できる
ので、例えば、機体向きが大きくずれたような場合には
、機体の操向操作を自動操向制御手段から遠隔操縦手段
に切り換えて、人為的に修正する等の処置を的確に行う
ことができる。
又、その遠隔操縦にて修正した機体向きが、作業行程の
向きである基準方位に対して設定範囲内に修正できたか
否かを、同じ報知手段にて確認するようにすることもで
きる。
向きである基準方位に対して設定範囲内に修正できたか
否かを、同じ報知手段にて確認するようにすることもで
きる。
以下、本発明の実施例を図面に基づいて説明する。
第3図及び第4図に示すように、自動走行、遠隔操縦(
ラジコン)、並びに、搭乗操縦(手動)の何れをも可能
な機体(V)の前方側に、エンジン(E)及び搭乗操縦
部(1)を設けると共に、機体(V)の後方側に、外装
カバー(2a)を備えた薬剤タンク(2)を搭載しであ
る。そして、機体(V)下部に設けたポンプ(4)によ
って前記薬剤タンク(2)から供給される薬剤を多数の
ノズル(5)から噴出させ、ブロア(6)による送風に
よって飛散させる薬剤散布装置(7)を、前記薬剤タン
ク(2)の後方側に付設して、主に果樹園等にて果樹間
を走行しながら薬剤散布を行うための作業車を構成して
あり、第2図に示すように、各直線状の作業行程の端部
に位置する樹木の外側にて隣接する次の直線状の作業行
程の方向に回向させながら樹木間を往復走行して、薬剤
散布を行うようにしである。
ラジコン)、並びに、搭乗操縦(手動)の何れをも可能
な機体(V)の前方側に、エンジン(E)及び搭乗操縦
部(1)を設けると共に、機体(V)の後方側に、外装
カバー(2a)を備えた薬剤タンク(2)を搭載しであ
る。そして、機体(V)下部に設けたポンプ(4)によ
って前記薬剤タンク(2)から供給される薬剤を多数の
ノズル(5)から噴出させ、ブロア(6)による送風に
よって飛散させる薬剤散布装置(7)を、前記薬剤タン
ク(2)の後方側に付設して、主に果樹園等にて果樹間
を走行しながら薬剤散布を行うための作業車を構成して
あり、第2図に示すように、各直線状の作業行程の端部
に位置する樹木の外側にて隣接する次の直線状の作業行
程の方向に回向させながら樹木間を往復走行して、薬剤
散布を行うようにしである。
前記機体(V)の構成について説明すれば、前記機体(
V)の前部に、接触式の障害物センサ兼用のバンバ(8
)を、障害物に接触するに伴って機体(V)後方側へ引
退して衝撃を吸収するように設けると共に、その引退作
動によってON操作されるリミットスイッチを用いた接
触センサ(So)を設けてあり、この接触センサ(So
)がON作動するに伴って、機体(ν)を非常停止させ
るようにしである。
V)の前部に、接触式の障害物センサ兼用のバンバ(8
)を、障害物に接触するに伴って機体(V)後方側へ引
退して衝撃を吸収するように設けると共に、その引退作
動によってON操作されるリミットスイッチを用いた接
触センサ(So)を設けてあり、この接触センサ(So
)がON作動するに伴って、機体(ν)を非常停止させ
るようにしである。
更に、前記バンバ(8)の前面側に、非接触式の障害物
センサとしての超音波センサ(S、)の3個を、第4図
に示すように、各障害物感知範囲が互いに隣接する状態
で、左右及び中央の夫々に設けである。但し、左右に位
置する超音波センサ(S+)、(S+)夫々は、その障
害物感知情報を、機体(V)に対して左右両側に位置す
る樹木(F)の間を機体(V)が走行するための操向制
御用の情報として利用できるようにするため、前記左右
両側の樹木(F)夫々に対する距離を感知できるように
すると共に、その障害物感知範囲を、機体幅よりも外側
に拡がるように設定しである。
センサとしての超音波センサ(S、)の3個を、第4図
に示すように、各障害物感知範囲が互いに隣接する状態
で、左右及び中央の夫々に設けである。但し、左右に位
置する超音波センサ(S+)、(S+)夫々は、その障
害物感知情報を、機体(V)に対して左右両側に位置す
る樹木(F)の間を機体(V)が走行するための操向制
御用の情報として利用できるようにするため、前記左右
両側の樹木(F)夫々に対する距離を感知できるように
すると共に、その障害物感知範囲を、機体幅よりも外側
に拡がるように設定しである。
又、前記薬剤タンク(2)の上部には、地磁気を感知す
ることによって絶対方位を検出する方。
ることによって絶対方位を検出する方。
位センサ(S2)を設けてあり、作業行程に対する機体
(V)向きを検出できるようにしである。
(V)向きを検出できるようにしである。
又、第2図に示すように、樹木(F)の間を機体(V)
が直線的に走行する直線行程の終端部を表示すべく、こ
の直線行程の終端部に位置する樹木同士の間に、鉄等の
磁性材にて形成したマーカ(m)を埋設すると共に、前
記マーカ(m)を検出する磁気感知式の近接センサ(S
、)を、前記機体(ν)の前端部下方に設けである。
が直線的に走行する直線行程の終端部を表示すべく、こ
の直線行程の終端部に位置する樹木同士の間に、鉄等の
磁性材にて形成したマーカ(m)を埋設すると共に、前
記マーカ(m)を検出する磁気感知式の近接センサ(S
、)を、前記機体(ν)の前端部下方に設けである。
前記機体(V)の走行系の構成について説明すれば、第
1図に示すように、左右一対の前輪(3F)及び後輪(
3R)を設けると共に、それら一対の前後輪(3F)
、 (3R)を各別に操作するステアリング操作用の油
圧シリンダ(9F) 、 (9R) 、及び、それに対
する制御弁(IOF) 、 (IOR)を設けてあり、
前記前輪(3F)及び後輪(3R)が、共に操向車輪と
して機能するようにしである。
1図に示すように、左右一対の前輪(3F)及び後輪(
3R)を設けると共に、それら一対の前後輪(3F)
、 (3R)を各別に操作するステアリング操作用の油
圧シリンダ(9F) 、 (9R) 、及び、それに対
する制御弁(IOF) 、 (IOR)を設けてあり、
前記前輪(3F)及び後輪(3R)が、共に操向車輪と
して機能するようにしである。
又、前後進切り換え自在で且つ前進変速並びに後進変速
自在な油圧式無段変速装置(11)を、前記エンジン(
E)に連動連結すると共に、前記変速装置(11)の出
力にて、前記前後輪(3F) 、 (3R)を同時に駆
動するように構成しである。そして、搭乗操縦用の変速
ペダル(12)及び遠隔操縦用の変速アクチュエータと
しての変速モータ(13)を、その何れによっても変速
操作可能に、前記変速装置(11)の変速アーム(14
)に連動連結しである。
自在な油圧式無段変速装置(11)を、前記エンジン(
E)に連動連結すると共に、前記変速装置(11)の出
力にて、前記前後輪(3F) 、 (3R)を同時に駆
動するように構成しである。そして、搭乗操縦用の変速
ペダル(12)及び遠隔操縦用の変速アクチュエータと
しての変速モータ(13)を、その何れによっても変速
操作可能に、前記変速装置(11)の変速アーム(14
)に連動連結しである。
又、搭乗操縦用のステアリングハンドル(H)を、前記
搭乗操縦部(1)に設けである。尚、第1図中、(S4
)は、前記変速装置(11)の出力回転数を検出するこ
とにより走行距離を検出する距離センサである。
搭乗操縦部(1)に設けである。尚、第1図中、(S4
)は、前記変速装置(11)の出力回転数を検出するこ
とにより走行距離を検出する距離センサである。
前記一対の前後輪(3F) 、 (3R)を向き変更さ
せて操向させるに、前後輪(3F) 、 (3R)を同
一方向に操向操作し−て機体(V)を平行移動させる平
行ステアリング形式、前後輪(3F) 、 (3R)を
逆方向に操向操作して機体(V)を急旋回させる4輪ス
テアリング形式、通常の自動車同様に前輪(3F)のみ
を操向操作する2輪ステアリング形式を選択使用できる
ように構成しである。
せて操向させるに、前後輪(3F) 、 (3R)を同
一方向に操向操作し−て機体(V)を平行移動させる平
行ステアリング形式、前後輪(3F) 、 (3R)を
逆方向に操向操作して機体(V)を急旋回させる4輪ス
テアリング形式、通常の自動車同様に前輪(3F)のみ
を操向操作する2輪ステアリング形式を選択使用できる
ように構成しである。
そして、遠隔操縦時には、前記平行ステアリング形式と
4輪ステアリング形式とを選択できるように、且つ、搭
乗操縦時には、平行ステアリング形式、4輪ステアリン
グ形式、及び、2輪ステアリング形式の何れかを選択で
きるように構成しである。但し、自動走行時には、前記
各ステアリング形式の切り換えは自動的に行われると共
に、前後輪(3F) 、 (3R)の操向量に差を付け
て操向することにより、機体(V)向きを変えながら平
行移動させることもできるようにしである。
4輪ステアリング形式とを選択できるように、且つ、搭
乗操縦時には、平行ステアリング形式、4輪ステアリン
グ形式、及び、2輪ステアリング形式の何れかを選択で
きるように構成しである。但し、自動走行時には、前記
各ステアリング形式の切り換えは自動的に行われると共
に、前後輪(3F) 、 (3R)の操向量に差を付け
て操向することにより、機体(V)向きを変えながら平
行移動させることもできるようにしである。
又、搭乗操縦時の目標ステアリング角度を検出する目標
ステアリング角度検出用ポテンショメータ(RO)を、
前記ステアリングハンドル(H)にて回動操作するよう
に設けると共に、前記前後輪(3F) 、 (3I?)
夫々のステアリング角度を検出するステアリング角度検
出用ポテンショメータ(R,)、(R1)を設けである
。又、前記変速装置(11)の変速位置を検出する変速
位置検出用ポテンショメータ(R3)を、前記変速アー
ム(14)の回動操作に連動するように設けである。そ
して、前記各ポテンショメータ(Ro)〜(R3)によ
る検出信号を自動走行制御手段及び自動操向制御手段(
A)、遠隔操縦手段(B)、並びに、搭乗操縦手段の夫
々を構成する制御装置(15)に入力しである。又、上
記各操縦手段の何れによって機体(V)の走行を制御す
るかを選択する操縦モード選択用スイッチ(16)を設
けである。但し、詳しくは後述するが、前記自動走行制
御手段が作動する自動操縦モードにおいては、前記操縦
モード選択用スイッチ(16)を操作することなく、前
記遠隔操縦手段(B)を、自動操向制御手段(A)に優
先して作動させる状態に切り換えられるように構成しで
ある。
ステアリング角度検出用ポテンショメータ(RO)を、
前記ステアリングハンドル(H)にて回動操作するよう
に設けると共に、前記前後輪(3F) 、 (3I?)
夫々のステアリング角度を検出するステアリング角度検
出用ポテンショメータ(R,)、(R1)を設けである
。又、前記変速装置(11)の変速位置を検出する変速
位置検出用ポテンショメータ(R3)を、前記変速アー
ム(14)の回動操作に連動するように設けである。そ
して、前記各ポテンショメータ(Ro)〜(R3)によ
る検出信号を自動走行制御手段及び自動操向制御手段(
A)、遠隔操縦手段(B)、並びに、搭乗操縦手段の夫
々を構成する制御装置(15)に入力しである。又、上
記各操縦手段の何れによって機体(V)の走行を制御す
るかを選択する操縦モード選択用スイッチ(16)を設
けである。但し、詳しくは後述するが、前記自動走行制
御手段が作動する自動操縦モードにおいては、前記操縦
モード選択用スイッチ(16)を操作することなく、前
記遠隔操縦手段(B)を、自動操向制御手段(A)に優
先して作動させる状態に切り換えられるように構成しで
ある。
次に、前記各操縦手段の構成について詳述する。
搭乗操縦手段の構成について説明すれば、第1図に示す
ように、前記ステアリング形式選択用スイッチ(17)
の情報、及び、前記搭乗操縦時の目標ステアリング位置
を検出する目標ステアリング位置検出用のポテンショメ
ータ(Ro)に基づいて、前記ステアリング用油圧シリ
ンダ(9F)。
ように、前記ステアリング形式選択用スイッチ(17)
の情報、及び、前記搭乗操縦時の目標ステアリング位置
を検出する目標ステアリング位置検出用のポテンショメ
ータ(Ro)に基づいて、前記ステアリング用油圧シリ
ンダ(9F)。
(9R)の制御弁(IOF) 、 (10i?)の作動
を制御して、前記前後輪(3F) 、 (3R)を指示
されたステアリング形式で且つ前記ステアリングハンド
ル(H)による目標ステアリング角度に操作することと
なる。但し、搭乗操縦時における前記変速装置(11)
の変速位置つまり車速の調整は、前記変速ペダル(12
)にて前記変速アーム(14)を直接操作して行うこと
になる。又、安全のために、前記変速ペダル(12)の
操作を止めると、前記変速装置(11)の変速位置が自
動的に中立状態つまり走行停止位置である変速ニュート
ラル位置(N)に復帰するように付勢して設けである。
を制御して、前記前後輪(3F) 、 (3R)を指示
されたステアリング形式で且つ前記ステアリングハンド
ル(H)による目標ステアリング角度に操作することと
なる。但し、搭乗操縦時における前記変速装置(11)
の変速位置つまり車速の調整は、前記変速ペダル(12
)にて前記変速アーム(14)を直接操作して行うこと
になる。又、安全のために、前記変速ペダル(12)の
操作を止めると、前記変速装置(11)の変速位置が自
動的に中立状態つまり走行停止位置である変速ニュート
ラル位置(N)に復帰するように付勢して設けである。
遠隔操縦の構成について説明すれば、遠隔操縦用の送信
機(18)から与えられる指示情報を受信する受信機(
19)を設けると共に、その受信情報に基づいて、前記
ステアリング用油圧シリンダ(9F) 、 (9R)の
制御弁(IOF) 、 (101?)及び変速モータ(
13)夫々の作動、並びに、前記ノズル(5)の制御弁
(5a)、ブロア(6)等の作動を制御することにより
、機体(V)の走行並びに前記薬剤散布装置(7)の作
動を、遠隔操作するようにしである。
機(18)から与えられる指示情報を受信する受信機(
19)を設けると共に、その受信情報に基づいて、前記
ステアリング用油圧シリンダ(9F) 、 (9R)の
制御弁(IOF) 、 (101?)及び変速モータ(
13)夫々の作動、並びに、前記ノズル(5)の制御弁
(5a)、ブロア(6)等の作動を制御することにより
、機体(V)の走行並びに前記薬剤散布装置(7)の作
動を、遠隔操作するようにしである。
前記送信機(I8)の構成について説明すれば、第1図
に示すように、前後動によって前記変速装置(11)の
目標変速位置を指示する変速レバー(20)、及び、前
後動によってステアリング形式を指示し、且つ、左右動
によって前記前後輪(3F) 、 (3R)の目標ステ
アリング角度を指示するステアリングレバー(21)を
設けると共に、前記薬剤散布装置(7)のブロア(6)
の回転・停止を指示するブロアスイッチ(22)、前記
ノズル(5)からの薬剤噴出の作動・停止を指示するノ
ズルスイッチ(23)、機体(V)を非常停止させるた
めの指示を行う非常停止用スイッチ(24)、及び、前
記機体(ν)が自動走行している時に、この送信機(1
8)に設けた前記各レバー(20) 、 (21)及び
スイッチ(22) 、 (23) 、 (24)にて機
体(V)の走行並びに薬剤散布装置(7)の作動を遠隔
操縦すべく、遠隔操縦手段(B)が自動操向制御手段(
A)に優先して作動する状態に切り換える制御切り換え
指示手段としての割り込みスイッチ(25)を設けであ
る。
に示すように、前後動によって前記変速装置(11)の
目標変速位置を指示する変速レバー(20)、及び、前
後動によってステアリング形式を指示し、且つ、左右動
によって前記前後輪(3F) 、 (3R)の目標ステ
アリング角度を指示するステアリングレバー(21)を
設けると共に、前記薬剤散布装置(7)のブロア(6)
の回転・停止を指示するブロアスイッチ(22)、前記
ノズル(5)からの薬剤噴出の作動・停止を指示するノ
ズルスイッチ(23)、機体(V)を非常停止させるた
めの指示を行う非常停止用スイッチ(24)、及び、前
記機体(ν)が自動走行している時に、この送信機(1
8)に設けた前記各レバー(20) 、 (21)及び
スイッチ(22) 、 (23) 、 (24)にて機
体(V)の走行並びに薬剤散布装置(7)の作動を遠隔
操縦すべく、遠隔操縦手段(B)が自動操向制御手段(
A)に優先して作動する状態に切り換える制御切り換え
指示手段としての割り込みスイッチ(25)を設けであ
る。
つまり、機体(V)が自動走行制御手段並びに自動操向
制御手段(1)にて自動走行している時に、例えば、前
記超音波センサ(Sl)や接触センサ(So)が車体(
V)前方にある障害物を感知したり誤動作して、機体(
V)が自動停止したような場合に、作業者が機体(V)
の停止位置まで行(ことなく、前記割り込みスイッチ(
25)を操作すれば、その後は、前記送信機(1B)に
よる遠隔操縦にて、その障害物を回避させることができ
る。
制御手段(1)にて自動走行している時に、例えば、前
記超音波センサ(Sl)や接触センサ(So)が車体(
V)前方にある障害物を感知したり誤動作して、機体(
V)が自動停止したような場合に、作業者が機体(V)
の停止位置まで行(ことなく、前記割り込みスイッチ(
25)を操作すれば、その後は、前記送信機(1B)に
よる遠隔操縦にて、その障害物を回避させることができ
る。
又、詳しくは後述するが、前記割り込みスイッチ(25
)を切れば、自動走行モードに自動的に復帰して、引き
続き機体(V)を自動走行させることができるようにし
である。
)を切れば、自動走行モードに自動的に復帰して、引き
続き機体(V)を自動走行させることができるようにし
である。
尚、安全のために、前記変速レバー(20)は、その操
作を止めると自動的に中立状態つまり変速位置が走行停
止位置である変速ニュートラル位置(N)に復帰するよ
うに付勢して設けである。
作を止めると自動的に中立状態つまり変速位置が走行停
止位置である変速ニュートラル位置(N)に復帰するよ
うに付勢して設けである。
次に、自動走行制御手段並びに自動操向制御手段(A)
の構成について、前記制御装置(15)の動作を説明し
ながら詳述する。尚、前記制御装置(15)は、図示を
省略するが、主に、前記超音波センサ(S+)及び方位
センサ(S2)の検出情報を処理する第1プロセツサ(
以下、CPUIと呼称する)、及び、前記CPUIによ
り処理された検出情報や各種センサによる検出情報、並
びに、前記受信機(19)による受信情報や予め記憶設
定された走行制御情報等に基づいて、各種アクチュエー
タの作動を制御する第2プロセツサ(以下、CPU2と
呼称する)の2つのプロセッサによって構成しである。
の構成について、前記制御装置(15)の動作を説明し
ながら詳述する。尚、前記制御装置(15)は、図示を
省略するが、主に、前記超音波センサ(S+)及び方位
センサ(S2)の検出情報を処理する第1プロセツサ(
以下、CPUIと呼称する)、及び、前記CPUIによ
り処理された検出情報や各種センサによる検出情報、並
びに、前記受信機(19)による受信情報や予め記憶設
定された走行制御情報等に基づいて、各種アクチュエー
タの作動を制御する第2プロセツサ(以下、CPU2と
呼称する)の2つのプロセッサによって構成しである。
先ず、自動走行制御時における機体走行の概略を説明す
れば、第2図に示すように、作業行程の開始地点(ST
)と、この開始地点(ST)に対向する他端側に位置す
る果樹(F)の間とを結ぶ直線状の第1行程(i)、前
記他端側に位置する果樹(F)の外方側を回向して前記
直線状の第1行程(i)に対して180度逆方向に向か
う直線状の第3行程(iii )へと移動する第2行程
(ii)、及び、前記第3行程(iii )の終了後に
、前記第1行程(i)と同一方向に向かう直線状の作業
行程方向に方向転換させるために、前記第2行程(ii
)と同様にして回向させる第4行程(iv)の4つの
作業行程夫々を、前記搭乗操縦手段又は遠隔操縦手段に
て操縦しながら、各行程における前記方位センサ(S2
)、距離センサ(S4)、及び、ステアリング角度検出
用ポテンショメータ(R1) 、 (R2)によるステ
アリング角度等の検出情報に基づいて、前記4つの各行
程(i)〜(iv)夫々をティーチングする。但し、本
実施例においては、第1行程(i)及び第3行程(ii
i )の直線行程では、この直線行程の開始地点から前
記近接センサ(S3)が作動するまでの実際の走行距離
(DLENGn) n−1+ z及び検出方位を平均し
た基準方位(BASDRn) fij++ 2のみを、
直線行程の走行制御用情報として記憶し、第2行程(i
i )及び第4行程(iv)の回向行程では、前記ステ
アリング角度検出用ポテンショメータ(R1)、(R2
)による検出ステアリング角度を、設定距離間隔(本実
施例では、約20cmに設定しである)毎にサンプリン
グすると共に、その値を、各回向行程(ii)、(iv
)での走行制御用情報として記憶するようにしである(
以下において〔ティーチング〕と呼称する)。
れば、第2図に示すように、作業行程の開始地点(ST
)と、この開始地点(ST)に対向する他端側に位置す
る果樹(F)の間とを結ぶ直線状の第1行程(i)、前
記他端側に位置する果樹(F)の外方側を回向して前記
直線状の第1行程(i)に対して180度逆方向に向か
う直線状の第3行程(iii )へと移動する第2行程
(ii)、及び、前記第3行程(iii )の終了後に
、前記第1行程(i)と同一方向に向かう直線状の作業
行程方向に方向転換させるために、前記第2行程(ii
)と同様にして回向させる第4行程(iv)の4つの
作業行程夫々を、前記搭乗操縦手段又は遠隔操縦手段に
て操縦しながら、各行程における前記方位センサ(S2
)、距離センサ(S4)、及び、ステアリング角度検出
用ポテンショメータ(R1) 、 (R2)によるステ
アリング角度等の検出情報に基づいて、前記4つの各行
程(i)〜(iv)夫々をティーチングする。但し、本
実施例においては、第1行程(i)及び第3行程(ii
i )の直線行程では、この直線行程の開始地点から前
記近接センサ(S3)が作動するまでの実際の走行距離
(DLENGn) n−1+ z及び検出方位を平均し
た基準方位(BASDRn) fij++ 2のみを、
直線行程の走行制御用情報として記憶し、第2行程(i
i )及び第4行程(iv)の回向行程では、前記ステ
アリング角度検出用ポテンショメータ(R1)、(R2
)による検出ステアリング角度を、設定距離間隔(本実
施例では、約20cmに設定しである)毎にサンプリン
グすると共に、その値を、各回向行程(ii)、(iv
)での走行制御用情報として記憶するようにしである(
以下において〔ティーチング〕と呼称する)。
そして、上述した〔ティーチング〕を終了すると、機体
(V)を一旦前記作業行程の開始地点(ST)まで移動
させて、前記〔ティーチング〕にて記憶された第1行程
(i)〜第4行程(iv)の各行程での記憶情報に基づ
いて機体(ν)の走行を制御しながら、各行程での走行
を設定回数繰り返すことにより、各直線行程の端部にて
自動回向しながら、果樹(F)の間を往復走行させて、
所定範囲の果樹園内における薬剤散布作業を自動的に行
わせるようにしである。つまり、上述した〔ティーチン
グ〕にてティーチングされた走行制御手段弗に基づいて
機体<V)の走行を制御する走行制御手段並びに作業行
程に沿って自動走行させるための自動操向制御手段(A
)を構成してあり、その制御のための処理を以下におい
て、〔再生〕と呼称する。
(V)を一旦前記作業行程の開始地点(ST)まで移動
させて、前記〔ティーチング〕にて記憶された第1行程
(i)〜第4行程(iv)の各行程での記憶情報に基づ
いて機体(ν)の走行を制御しながら、各行程での走行
を設定回数繰り返すことにより、各直線行程の端部にて
自動回向しながら、果樹(F)の間を往復走行させて、
所定範囲の果樹園内における薬剤散布作業を自動的に行
わせるようにしである。つまり、上述した〔ティーチン
グ〕にてティーチングされた走行制御手段弗に基づいて
機体<V)の走行を制御する走行制御手段並びに作業行
程に沿って自動走行させるための自動操向制御手段(A
)を構成してあり、その制御のための処理を以下におい
て、〔再生〕と呼称する。
以下、上述した〔再生〕の処理について詳述する。
第5図(イ)に示すように、前記CPU2よりCPUI
に対して再生モードの開始キーワードを転送すると共に
、全走行行程数を、前記直線行程の個数(KNUM)と
して入力する(ステフブ#100.ステフブ+1101
)。
に対して再生モードの開始キーワードを転送すると共に
、全走行行程数を、前記直線行程の個数(KNUM)と
して入力する(ステフブ#100.ステフブ+1101
)。
そして、前記〔ティーチング〕にて記憶された基準方位
(BASDRn)、この基準方位(BASDRn)に対
して設定許容差以上ずれると操向操作するための不感帯
(FKAN2)、及び、前記超音波センサ(Sl)の感
知距離区分を予め設定した区分距離(DIVL)(本実
施例では、1m以内、2m、3m。
(BASDRn)、この基準方位(BASDRn)に対
して設定許容差以上ずれると操向操作するための不感帯
(FKAN2)、及び、前記超音波センサ(Sl)の感
知距離区分を予め設定した区分距離(DIVL)(本実
施例では、1m以内、2m、3m。
4m以上の4つの距離間隔に区分しである)に夫々セン
トした後、前記〔ティーチング〕にて記憶された基準距
離(DLENGn)に所定距離を減算した前エリア(K
OTEIF)、前記基準距離(DLENGn)に所定距
離を加算した後エリア(KOTEIB)、及び、回向を
確実に行うために減速操作するための減速開始地点に対
応する減速距離(KOTEI2)、の夫々を算出して設
定し、そして、実際の走行距離を計測する距離カウンタ
の値(CNTPI)を′0”にリセットして各走行制御
情報を初期化して、現走行行程が前記第1〜第4行程の
何れの行程であるかを示す行程フラグ(CFLAG)を
、第1行程(i)を示す“1”にセットする(ステフブ
#102〜ステフブ#104)。
トした後、前記〔ティーチング〕にて記憶された基準距
離(DLENGn)に所定距離を減算した前エリア(K
OTEIF)、前記基準距離(DLENGn)に所定距
離を加算した後エリア(KOTEIB)、及び、回向を
確実に行うために減速操作するための減速開始地点に対
応する減速距離(KOTEI2)、の夫々を算出して設
定し、そして、実際の走行距離を計測する距離カウンタ
の値(CNTPI)を′0”にリセットして各走行制御
情報を初期化して、現走行行程が前記第1〜第4行程の
何れの行程であるかを示す行程フラグ(CFLAG)を
、第1行程(i)を示す“1”にセットする(ステフブ
#102〜ステフブ#104)。
前記ステップ#104にて行程フラグ(CFLAG)が
セットされると、前記変速位置検出用のポテンショメー
タ(R3)の検出値に基づいて前記変速装置(11)を
操作して設定走行速度となるようにして走行を開始し、
前記ステップ#101にて入力された行程数(KNUM
)をチェックすることにより、全行程を走行したか否か
を判別する(ステップ#105)。
セットされると、前記変速位置検出用のポテンショメー
タ(R3)の検出値に基づいて前記変速装置(11)を
操作して設定走行速度となるようにして走行を開始し、
前記ステップ#101にて入力された行程数(KNUM
)をチェックすることにより、全行程を走行したか否か
を判別する(ステップ#105)。
次に、前記受信機(19)の受信情報に基づいて、前記
送信機(18)に設けた割り込みスイッチ(25)がO
N操作された′か否かをチェックすることにより、自動
走行中に遠隔操縦モードに切り換えるためのラジコン割
り込みがあったか否かを判別すると共に、後述する直線
行程の終了を判別する〔直線終了〕の処理にてセットさ
れた行程フラグ(CFLAG)の値が、前記第2行程(
ii)又は第4行程(iv)の回向行程の値(2又は4
)にセットされているか否かを判別する(ステフブ#1
06.ステフブ#107)。
送信機(18)に設けた割り込みスイッチ(25)がO
N操作された′か否かをチェックすることにより、自動
走行中に遠隔操縦モードに切り換えるためのラジコン割
り込みがあったか否かを判別すると共に、後述する直線
行程の終了を判別する〔直線終了〕の処理にてセットさ
れた行程フラグ(CFLAG)の値が、前記第2行程(
ii)又は第4行程(iv)の回向行程の値(2又は4
)にセットされているか否かを判別する(ステフブ#1
06.ステフブ#107)。
但し、前記ラジコン割り込みがあった場合は、後述する
〔ラジコン割り込み〕の処理に分岐し、前記行程フラグ
(CFLAG)の値が“2”又は“4”にセントされて
いる場合は、後述する〔回向〕の処理に分岐して、前記
ステフブ#106以降の処理を中断することとなる。
〔ラジコン割り込み〕の処理に分岐し、前記行程フラグ
(CFLAG)の値が“2”又は“4”にセントされて
いる場合は、後述する〔回向〕の処理に分岐して、前記
ステフブ#106以降の処理を中断することとなる。
一方、全行程が終了せず、〔ラジコン割り込み〕も無(
、且つ、前記行程フラグ(CPLAG)が回向行程にセ
ットされていない場合は、前記CPUIから転送される
方位センサ(S2)及び超音波センサ(Sl)の各検出
データの更新を確認すると共に、その検出データに基づ
いて、前記前後輪(3F) 、 (3R)を操向操作す
るためのステアリング操作量を決定して、前記ステアリ
ング用油圧シリンダ(9F) 、 (9R)の電磁弁(
IOF) 、 (IOR)に制御信号を出力する〔操向
制御〕を行う(ステフブ#108〜ステフブ#110)
。
、且つ、前記行程フラグ(CPLAG)が回向行程にセ
ットされていない場合は、前記CPUIから転送される
方位センサ(S2)及び超音波センサ(Sl)の各検出
データの更新を確認すると共に、その検出データに基づ
いて、前記前後輪(3F) 、 (3R)を操向操作す
るためのステアリング操作量を決定して、前記ステアリ
ング用油圧シリンダ(9F) 、 (9R)の電磁弁(
IOF) 、 (IOR)に制御信号を出力する〔操向
制御〕を行う(ステフブ#108〜ステフブ#110)
。
その後は、前記近接センサ(S3)がONしたか否かを
チェックすることにより、機体(V)が直線行程の終了
地点つまり回向行程の開始地点に達したか否かを判別す
ると共に、前記3つの超音波センサ(S、)の何れか1
つでも走行前方側1m以内に障害物を感知したか否かを
チェックする。そして、前記近接センサ(S3)がON
L、ている場合は、直線行程を終了して次の直線行程に
向けて回向するための〔直線終了〕の処理に分岐し、前
記超音波センサ(S+)が1m以内に障害物を感知した
場合は、非常停止させると共に、その後の回避を遠隔操
縦にて行うために、後述する〔ラジコン要求〕の処理に
分岐する(ステップ41111、ステップ#112)。
チェックすることにより、機体(V)が直線行程の終了
地点つまり回向行程の開始地点に達したか否かを判別す
ると共に、前記3つの超音波センサ(S、)の何れか1
つでも走行前方側1m以内に障害物を感知したか否かを
チェックする。そして、前記近接センサ(S3)がON
L、ている場合は、直線行程を終了して次の直線行程に
向けて回向するための〔直線終了〕の処理に分岐し、前
記超音波センサ(S+)が1m以内に障害物を感知した
場合は、非常停止させると共に、その後の回避を遠隔操
縦にて行うために、後述する〔ラジコン要求〕の処理に
分岐する(ステップ41111、ステップ#112)。
次に、前記距離センサ(S4)の検出情報に基づいて走
行距離をカウントする距離カウンタの値(CNTPI)
と前記減速路i@(KOTEI2)とを比較することに
よって減速地点に達したか否かを判別し、前記減速距離
(NOTEI2)に達している場合は、予め設定しであ
る走行速度となるように減速操作を行った後、前記方位
センサ(S2)による検出情報に基づいて前記CPUI
にて判別された検出方位としての現在方位(NOWDI
R)が、現行程の基準方位(RASDRn)に対して予
め設定しである設定範囲(SFUKAN) (本実施例
では約±20度に設定しである)以上ずれているか否か
を判別し、現在方位(NOWDIR)が基準方位(BA
SDRn)に対して設定範囲(SFUKAN)以上ずれ
ている場合は、前記警告灯(26)を点灯して、機体(
V)の向きが設定範囲(SFtlKAN)以上ずれたこ
とを報知すると共に、その後の機体向き修正等の操作を
遠隔操縦にて行うように要求するために、後述する〔ラ
ジコン要求〕の処理に分岐する。但し、前記距離カウン
タの値(CNTPI)が減速距離(KOTEI2)に達
していない場合や、機体(V)の向きが前記設定範囲(
SFUKAN)以上ずれていない場合は、前記ステップ
#105からの処理を繰り返すこととなる(ステフプ#
113〜ステフブ#115)。
行距離をカウントする距離カウンタの値(CNTPI)
と前記減速路i@(KOTEI2)とを比較することに
よって減速地点に達したか否かを判別し、前記減速距離
(NOTEI2)に達している場合は、予め設定しであ
る走行速度となるように減速操作を行った後、前記方位
センサ(S2)による検出情報に基づいて前記CPUI
にて判別された検出方位としての現在方位(NOWDI
R)が、現行程の基準方位(RASDRn)に対して予
め設定しである設定範囲(SFUKAN) (本実施例
では約±20度に設定しである)以上ずれているか否か
を判別し、現在方位(NOWDIR)が基準方位(BA
SDRn)に対して設定範囲(SFUKAN)以上ずれ
ている場合は、前記警告灯(26)を点灯して、機体(
V)の向きが設定範囲(SFtlKAN)以上ずれたこ
とを報知すると共に、その後の機体向き修正等の操作を
遠隔操縦にて行うように要求するために、後述する〔ラ
ジコン要求〕の処理に分岐する。但し、前記距離カウン
タの値(CNTPI)が減速距離(KOTEI2)に達
していない場合や、機体(V)の向きが前記設定範囲(
SFUKAN)以上ずれていない場合は、前記ステップ
#105からの処理を繰り返すこととなる(ステフプ#
113〜ステフブ#115)。
一方、前記CPUIは、第5図([1)に示すように、
再生モードの開始キーワードを受は取ると、〔再生〕の
処理モードにセットされ、前記3つの超音波センサ(S
、)及び方位センサ(s2)からの検出情報を設定時間
間隔(本実施例では約0.1秒に設定しである)毎にサ
ンプリングして現在方位(NOWDIR)を更新すると
共に、その現在方位(NOWDIR)と前記ティーチン
グされた基準方位及び反転方位に基づいて設定された判
別方位(RASDIR)とを比較して、その偏差が前記
設定不感帯(FUKAN2)外にあれば、前記前後輪(
3F) 、 (3R)を操向操作するための処理又は回
向終了を判別するための処理を実行するための方位フラ
グ(HFLAG)をセ ッ トする(ステフブ#50〜
ステフブ#54)。
再生モードの開始キーワードを受は取ると、〔再生〕の
処理モードにセットされ、前記3つの超音波センサ(S
、)及び方位センサ(s2)からの検出情報を設定時間
間隔(本実施例では約0.1秒に設定しである)毎にサ
ンプリングして現在方位(NOWDIR)を更新すると
共に、その現在方位(NOWDIR)と前記ティーチン
グされた基準方位及び反転方位に基づいて設定された判
別方位(RASDIR)とを比較して、その偏差が前記
設定不感帯(FUKAN2)外にあれば、前記前後輪(
3F) 、 (3R)を操向操作するための処理又は回
向終了を判別するための処理を実行するための方位フラ
グ(HFLAG)をセ ッ トする(ステフブ#50〜
ステフブ#54)。
更に、前記3つの超音波センサ(S+)夫々の検出信号
を、前記区分距離(DIVL)に基づいて障害物からの
距離に対応するデータ(CHODAT)に換算して、〔
再生〕の終了を判別する(ステフブ#55.ステフブ#
56)。
を、前記区分距離(DIVL)に基づいて障害物からの
距離に対応するデータ(CHODAT)に換算して、〔
再生〕の終了を判別する(ステフブ#55.ステフブ#
56)。
但し、前記ステツブ#56にて、〔再生〕モードが終了
していない場合は、前記スヲフブ#52〜スラフ加56
の処理を繰り返し行い、再生モードが終了している場合
は、前記動作モードの選択処理に復帰することとなる。
していない場合は、前記スヲフブ#52〜スラフ加56
の処理を繰り返し行い、再生モードが終了している場合
は、前記動作モードの選択処理に復帰することとなる。
次に、前記スyyブ#111にて近接センサ(S3)が
ONするに伴って分岐する〔直線終了〕の処理について
説明する。
ONするに伴って分岐する〔直線終了〕の処理について
説明する。
すなわち、第6図に示すように、前記距離カウンタの値
(CNTPI)が前エリア(KOTErF)及び後エリ
ア(KOTEIB)の間にあるか否かを判別することに
より、回向許可範囲内に機体(v)があるか否かを判別
し、回向許可範囲内に機体(V)がない場合は、後述す
る〔ラジコン要求〕の処理に分岐して、前記送信機(1
日)による遠隔操縦にて回向させるようにする(ステツ
ブ#200)。
(CNTPI)が前エリア(KOTErF)及び後エリ
ア(KOTEIB)の間にあるか否かを判別することに
より、回向許可範囲内に機体(v)があるか否かを判別
し、回向許可範囲内に機体(V)がない場合は、後述す
る〔ラジコン要求〕の処理に分岐して、前記送信機(1
日)による遠隔操縦にて回向させるようにする(ステツ
ブ#200)。
前記距離カウンタの値(CNTPI)が回向許可範囲内
にある場合は、前記行程フラグ(CFLAG)の値に基
づいて行程フラグ(CFLAG)の値を第2行程(ii
)又は第4行程(iv )を示す値じ2°又は“4”)
に夫々セントして、回向行程の終了を判別するための反
転方位(BASDR2又はBASDRI)を設定すると
共に、前記行程数(KNUM)を減算して、前記ステフ
プ#105以降の操向制御処理に復帰する(ステフブ#
201〜ステフブ#206)。
にある場合は、前記行程フラグ(CFLAG)の値に基
づいて行程フラグ(CFLAG)の値を第2行程(ii
)又は第4行程(iv )を示す値じ2°又は“4”)
に夫々セントして、回向行程の終了を判別するための反
転方位(BASDR2又はBASDRI)を設定すると
共に、前記行程数(KNUM)を減算して、前記ステフ
プ#105以降の操向制御処理に復帰する(ステフブ#
201〜ステフブ#206)。
従って、上述した処理により前記行程フラグ(CFLA
G)の値は直線行程を示す“1″又は“3”から回向行
程を示す“2”又は“4”に変わっていることから、前
記スfフブ#107の回向判別処理では、自動的に〔回
向〕の処理に分岐することとなる。
G)の値は直線行程を示す“1″又は“3”から回向行
程を示す“2”又は“4”に変わっていることから、前
記スfフブ#107の回向判別処理では、自動的に〔回
向〕の処理に分岐することとなる。
次に、前記〔回向〕の処理について詳述する。
第7図に示すように、前記〔直線終了〕にてセットされ
た行程フラグ(CFLAG)の値に基づいて、前記〔テ
ィーチング〕にて記憶された第2行程(ii)又は第4
行程(iv )の何れかの記憶ステアリング角度の情報
を読み出すように設定すると共に、各回向行程での終了
を判別するための反転方位(BASDRI又はBASD
R2)、方位の不感帯(FUKAN2)、及び、前記超
音波センサ(S+)の区分距離(DIVL)の夫々を再
設定する(ステフブ#300〜ステフブ#304)。
た行程フラグ(CFLAG)の値に基づいて、前記〔テ
ィーチング〕にて記憶された第2行程(ii)又は第4
行程(iv )の何れかの記憶ステアリング角度の情報
を読み出すように設定すると共に、各回向行程での終了
を判別するための反転方位(BASDRI又はBASD
R2)、方位の不感帯(FUKAN2)、及び、前記超
音波センサ(S+)の区分距離(DIVL)の夫々を再
設定する(ステフブ#300〜ステフブ#304)。
そして、前記CPUIによる方位センサ(S2)および
超音波センサ(Sl)夫々の検出データ更新を確認した
後、その更新された各データつまり現在方位(NOWD
IR)、感知距離のデータ(CIIODAT)、及び、
方位フラグ()IFLAG)を受は取る(ステツブ#3
05゜ステツブ$306)。
超音波センサ(Sl)夫々の検出データ更新を確認した
後、その更新された各データつまり現在方位(NOWD
IR)、感知距離のデータ(CIIODAT)、及び、
方位フラグ()IFLAG)を受は取る(ステツブ#3
05゜ステツブ$306)。
その後、前記ステアリング位置検出用ポテンショメータ
(R1)、(R2)の値をサンプリングしたか否かを確
認した後、目標ステアリング角度である前記ステアリン
グ操作のティーチングデータを更新する(ステフブ#3
07.ステフブ11308)。
(R1)、(R2)の値をサンプリングしたか否かを確
認した後、目標ステアリング角度である前記ステアリン
グ操作のティーチングデータを更新する(ステフブ#3
07.ステフブ11308)。
次に、前記ステアリング操作用のティーチングデータを
全て出力したか否かを判別すると共に、前記方位フラグ
(HFLAG)がセントされているか否かに基づいて、
機体(V)向きが次行程方向に反転したか否かを判別す
る。そして、全ティーチングデータが出力されたか、又
は、方位フラグ(HFLAG)がセットされている場合
には、後述するステフプ#313〜ステフブ#318の
次の直線行程に対する各種データのセントを行う〔初期
化ルーチン〕に分岐し、前記全ティーチングデータの出
力が終了せず、且つ、前記方位フラグ(HFLAG)が
セントされていない場合は、前記直線行程におけるラジ
コン割り込みの有無、及び、超音波センサ(S、)がI
n以内に障害物を感知したか否かを判別して、前記ステ
フブ#305以降のティーチングデータの再生処理を繰
り返すこととなる(ス?フブl309〜ステフプ#31
2)。
全て出力したか否かを判別すると共に、前記方位フラグ
(HFLAG)がセントされているか否かに基づいて、
機体(V)向きが次行程方向に反転したか否かを判別す
る。そして、全ティーチングデータが出力されたか、又
は、方位フラグ(HFLAG)がセットされている場合
には、後述するステフプ#313〜ステフブ#318の
次の直線行程に対する各種データのセントを行う〔初期
化ルーチン〕に分岐し、前記全ティーチングデータの出
力が終了せず、且つ、前記方位フラグ(HFLAG)が
セントされていない場合は、前記直線行程におけるラジ
コン割り込みの有無、及び、超音波センサ(S、)がI
n以内に障害物を感知したか否かを判別して、前記ステ
フブ#305以降のティーチングデータの再生処理を繰
り返すこととなる(ス?フブl309〜ステフプ#31
2)。
前記〔初期化ルーチン〕について説明すれば、前記〔再
生〕の処理ルーチンのステフブ#102〜ステクブ#1
04と同様の処理にて、前記行程フラグ(CFLAG)
の値に基づいて、走行予定距離(DLENGI 、 D
LENG2)を基準に前エリア(NOTEIF)、後エ
リア(NOTEIB)、及び、減速距離(KOTEI2
)の夫々を設定すると共に、前記距離カウンタの値(C
NTPI)を0”にリセットし、次の直線行程の方向に
基づいて、前記行程フラグ(CFLAG)の値を“1”
又は“3′にセントする。そして、基準方位(BASD
Rn)、その基準方位(8A5DRn)に対する不感帯
(FUKAN2)、及び、前記超音波センサ(S+)に
対する感知距離の区分距W’I(DIVL)の夫々を設
定して、前述した〔再生〕ルーチンの全行程終了の判別
処理(ステフッ#105)に復帰することとなる(ステ
フブ#313〜ステフブ#318)。
生〕の処理ルーチンのステフブ#102〜ステクブ#1
04と同様の処理にて、前記行程フラグ(CFLAG)
の値に基づいて、走行予定距離(DLENGI 、 D
LENG2)を基準に前エリア(NOTEIF)、後エ
リア(NOTEIB)、及び、減速距離(KOTEI2
)の夫々を設定すると共に、前記距離カウンタの値(C
NTPI)を0”にリセットし、次の直線行程の方向に
基づいて、前記行程フラグ(CFLAG)の値を“1”
又は“3′にセントする。そして、基準方位(BASD
Rn)、その基準方位(8A5DRn)に対する不感帯
(FUKAN2)、及び、前記超音波センサ(S+)に
対する感知距離の区分距W’I(DIVL)の夫々を設
定して、前述した〔再生〕ルーチンの全行程終了の判別
処理(ステフッ#105)に復帰することとなる(ステ
フブ#313〜ステフブ#318)。
次に、前記〔ラジコン割り込み〕の処理について詳述す
る。
る。
第8図に示すように、先ず、前記行程フラグ(CFLA
G)の値に基づいて、現在の走行行程が直線行程である
か回向行程であるかを判別する(ステップ11400)
。
G)の値に基づいて、現在の走行行程が直線行程である
か回向行程であるかを判別する(ステップ11400)
。
そして、現在の走行行程が直線行程である場合は、前記
受信機(19)を介して入力される前記割り込みスイッ
チ(25)の状態に基づいて、この〔ラジコン割り込み
〕の処理が終了したか否かを判別し、処理が終了してい
る場合は、機体(V)の向きが直線行程の基準方位(B
ASDRn)に対して設定範囲(SFKAN)内に復帰
しているか否かを判別するための不惑帯(本実施例では
、前記7.’yフブ#115にて機体向きが基準方位(
BASDRn)からずれたか否かを判別するための設定
範囲(SFUKAN)と同一の約±20度に設定しであ
る)内にあるか否かを判別する。
受信機(19)を介して入力される前記割り込みスイッ
チ(25)の状態に基づいて、この〔ラジコン割り込み
〕の処理が終了したか否かを判別し、処理が終了してい
る場合は、機体(V)の向きが直線行程の基準方位(B
ASDRn)に対して設定範囲(SFKAN)内に復帰
しているか否かを判別するための不惑帯(本実施例では
、前記7.’yフブ#115にて機体向きが基準方位(
BASDRn)からずれたか否かを判別するための設定
範囲(SFUKAN)と同一の約±20度に設定しであ
る)内にあるか否かを判別する。
現在方位(NOWDIR)が、前記不惑帯(SFUKA
N)内にある場合は、自動走行を継続すべく、前記〔再
生〕の処理ルーチンの全行程終了の判別処理(ステフッ
#105)に復帰し、前記不感帯(SFUKAN)外で
ある場合は、再度、前記警告灯(26)を作動させて、
前記送信機(18)による遠隔操縦を継続すべく作業者
に韻知させる後述する〔ラジコン要求〕の処理に分岐す
る(ステフブ#401〜ステフプ#403)。
N)内にある場合は、自動走行を継続すべく、前記〔再
生〕の処理ルーチンの全行程終了の判別処理(ステフッ
#105)に復帰し、前記不感帯(SFUKAN)外で
ある場合は、再度、前記警告灯(26)を作動させて、
前記送信機(18)による遠隔操縦を継続すべく作業者
に韻知させる後述する〔ラジコン要求〕の処理に分岐す
る(ステフブ#401〜ステフプ#403)。
そして、前記スftブ#401にて割り込み処理が終了
していない場合は、前記近接センサ(S3)がONした
か否か、つまり、直線行程が終了したか否かを判別し、
前記近接センサ(S3)がONしていない場合は、前記
ステツブ#401の割り込み処理終了の判別処理を繰り
返し、近接センサ(S3)がONしている場合は、前記
〔再生〕ルーチン同様に、前記距離カウンタの値(CN
TPI)が回向許可距離(KOTEIF≦CNTPI≦
KOTEIB)に達しているか歪力1を1J53りする
(ステツブ1404.ステフブ#405)。
していない場合は、前記近接センサ(S3)がONした
か否か、つまり、直線行程が終了したか否かを判別し、
前記近接センサ(S3)がONしていない場合は、前記
ステツブ#401の割り込み処理終了の判別処理を繰り
返し、近接センサ(S3)がONしている場合は、前記
〔再生〕ルーチン同様に、前記距離カウンタの値(CN
TPI)が回向許可距離(KOTEIF≦CNTPI≦
KOTEIB)に達しているか歪力1を1J53りする
(ステツブ1404.ステフブ#405)。
前記距離カウンタの値(CNTPI)が回向許可距離に
達している場合は、前記行程フラグ(CFLAG)の値
に基づいて、次に起動すべき回向行程が前記第2行程(
ii)であるか第4行程(iv)であるかを判別して、
前記行程フラグ(CFLAG)を対応する値にセットす
ると共に、反転方位(BASDRI又はBASDR2)
を設定して、行程数(KNU!1)を減算した後、前記
ス’yフブ#400の現行程が直線行程であるか回向行
程であるかの判別処理を繰り返す(ステフブ#406〜
ステフブ11411)。
達している場合は、前記行程フラグ(CFLAG)の値
に基づいて、次に起動すべき回向行程が前記第2行程(
ii)であるか第4行程(iv)であるかを判別して、
前記行程フラグ(CFLAG)を対応する値にセットす
ると共に、反転方位(BASDRI又はBASDR2)
を設定して、行程数(KNU!1)を減算した後、前記
ス’yフブ#400の現行程が直線行程であるか回向行
程であるかの判別処理を繰り返す(ステフブ#406〜
ステフブ11411)。
一方、現走行行程が、回向行程である場合は、前記基準
方位(BASDRn)に対する不惑帯を回向行程での不
惑帯(KFUKAN)に設定すると共に、前記ステツブ
#401の処理と同様の処理にて、この〔ラジコン割り
込み〕の処理が終了するまで待機する(ステフブ#41
2.スツフブ#413)。
方位(BASDRn)に対する不惑帯を回向行程での不
惑帯(KFUKAN)に設定すると共に、前記ステツブ
#401の処理と同様の処理にて、この〔ラジコン割り
込み〕の処理が終了するまで待機する(ステフブ#41
2.スツフブ#413)。
そして、〔ラジコン割り込み〕の処理が終了するに伴っ
て、前記現在方位(NOWDIR)が判別方位(RAS
DIR)に対して前記不感帯(KF[IKA:J)内に
−敗したか否かに基づいて機体(V)向きが次の行程方
向に変化したか否かを判別し、方位が反転すると、前記
〔回向〕ルーチンにおけるステップ#313〜ステフプ
#318に示す直線行程での基準データを設定する〔初
期化ルーチン〕の処理を行った後、前記ステップ#40
0の現行程が直線行程であるか回向行程であるかの判別
処理に復帰する。一方、〔ラジコン割り込み〕の処理が
終了していても、前記現在方位(NOWDIR)の方位
が反転していない場合は、回向行程の走行が終了するま
で遠隔操縦する前記ステップ#403の〔ラジコン要求
〕の処理に分岐することとなる(ステップ付413〜ス
テフブ$1415)。
て、前記現在方位(NOWDIR)が判別方位(RAS
DIR)に対して前記不感帯(KF[IKA:J)内に
−敗したか否かに基づいて機体(V)向きが次の行程方
向に変化したか否かを判別し、方位が反転すると、前記
〔回向〕ルーチンにおけるステップ#313〜ステフプ
#318に示す直線行程での基準データを設定する〔初
期化ルーチン〕の処理を行った後、前記ステップ#40
0の現行程が直線行程であるか回向行程であるかの判別
処理に復帰する。一方、〔ラジコン割り込み〕の処理が
終了していても、前記現在方位(NOWDIR)の方位
が反転していない場合は、回向行程の走行が終了するま
で遠隔操縦する前記ステップ#403の〔ラジコン要求
〕の処理に分岐することとなる(ステップ付413〜ス
テフブ$1415)。
前記〔ラジコン要求〕の処理について説明すれば、第9
図に示すように、前記機体(V)を非常停止させると共
に、機体(V)の上部に設けられた警告灯(26)(第
3図、第4図参照)を点灯させて、作業者に報知すると
共に、前記〔ラジコン割り込み〕の処理同様に、割り込
みが発生するまで待機する。そして、割り込みが発生す
るに伴って、前記警告灯(26)を消煙して、前記〔ラ
ジコン割り込み〕のステップ#400に分岐することと
なる。もって、機体(V)の向きが基準方位(BASD
Rn)に対して設定範囲(SFUKAN)以上ずれたこ
とを報知する報知手段(100)を構成しである。
図に示すように、前記機体(V)を非常停止させると共
に、機体(V)の上部に設けられた警告灯(26)(第
3図、第4図参照)を点灯させて、作業者に報知すると
共に、前記〔ラジコン割り込み〕の処理同様に、割り込
みが発生するまで待機する。そして、割り込みが発生す
るに伴って、前記警告灯(26)を消煙して、前記〔ラ
ジコン割り込み〕のステップ#400に分岐することと
なる。もって、機体(V)の向きが基準方位(BASD
Rn)に対して設定範囲(SFUKAN)以上ずれたこ
とを報知する報知手段(100)を構成しである。
従って、自動走行中に、誤動作が発生したり障害物を感
知して、機体(V)が直線行程や回向行程の途中で停止
したり、機体(V)の向きが基準方位(BASDRn)
に対して設定範囲(SFUKAN)以上ずれた場合は、
前記警告灯(26)が点灯するので、その後は、前記送
信機(18)の割り込みスイッチ(25)をONすれば
、遠隔操縦にて走行を継続できると共に、上述した所定
の条件を満たせば、自動走行モードに自動的に復帰させ
ることができるのである。尚、前記〔ラジコン割り込み
〕の処理は、正常に自動走行中であっても、前記送信機
(18)の割り込みスイッチ(25)をON操作すれば
、自動的に起動されて、遠隔操縦することができるのは
、勿論である。
知して、機体(V)が直線行程や回向行程の途中で停止
したり、機体(V)の向きが基準方位(BASDRn)
に対して設定範囲(SFUKAN)以上ずれた場合は、
前記警告灯(26)が点灯するので、その後は、前記送
信機(18)の割り込みスイッチ(25)をONすれば
、遠隔操縦にて走行を継続できると共に、上述した所定
の条件を満たせば、自動走行モードに自動的に復帰させ
ることができるのである。尚、前記〔ラジコン割り込み
〕の処理は、正常に自動走行中であっても、前記送信機
(18)の割り込みスイッチ(25)をON操作すれば
、自動的に起動されて、遠隔操縦することができるのは
、勿論である。
上記実施例では、報知手段として、警告灯を設けた場合
を例示したが、警報器等を設けてもよい。又、遠隔操縦
用の送信機側に報知手段を設けて、機体向きがずれたこ
とを報知するようにしてもよく、報知手段の具体構成は
各種変更できる。
を例示したが、警報器等を設けてもよい。又、遠隔操縦
用の送信機側に報知手段を設けて、機体向きがずれたこ
とを報知するようにしてもよく、報知手段の具体構成は
各種変更できる。
又、上記実施例では、直線行程を往復走行するべり18
0度回向するように構成した場合を例示したが、本発明
は、90度交差する直線行程を順次回り走行させるよう
な場合にも適用できるものであって、直線行程並びに回
向行程夫々での具体的な形態は、各種変更できる。
0度回向するように構成した場合を例示したが、本発明
は、90度交差する直線行程を順次回り走行させるよう
な場合にも適用できるものであって、直線行程並びに回
向行程夫々での具体的な形態は、各種変更できる。
又、上記実施例においては、作業車を薬剤散布作業車に
構成した場合を例示したが、本発明は、その他のコンバ
インや芝刈り作業車等の各種作業車にも適用できるもの
であって、操縦手段や制御手段並びに各種センサ等の各
部の具体構成は、本発明を適用する作業車の形態や走行
形態に応じて各種変更することになるものであって、本
実施例に限定されるものではない。
構成した場合を例示したが、本発明は、その他のコンバ
インや芝刈り作業車等の各種作業車にも適用できるもの
であって、操縦手段や制御手段並びに各種センサ等の各
部の具体構成は、本発明を適用する作業車の形態や走行
形態に応じて各種変更することになるものであって、本
実施例に限定されるものではない。
図面は本発明に係る自動走行作業車の走行制御装置の実
施例を示し、第1図は制御システムの概略構成を示すブ
ロック図、第2図は作業行程の説明図、第3図は薬剤散
布作業車の全体側面図、第4図はその平面図、第5図C
4) 、 ([7)は再生のフローチャート、第6図は
直線終了判別のフローチャート、第7図は回向処理のフ
ローチャート、第8図はラジコン割り込み処理のフロー
チャート、第9図はラジコン要求のフローチャートであ
る。 (3F) 、 (3R)・・・・・・操向車輪、(18
)・・・・・・送信機、(V)・・・・・・機体、(S
2)・・・・・・センサ、(BASDRn)・・・・・
・基準方位、(NOWDIR)・・・・・・検出方位、
(SFUKAN)・・・・・・設定範囲、(100)・
・・・・・報知手段。
施例を示し、第1図は制御システムの概略構成を示すブ
ロック図、第2図は作業行程の説明図、第3図は薬剤散
布作業車の全体側面図、第4図はその平面図、第5図C
4) 、 ([7)は再生のフローチャート、第6図は
直線終了判別のフローチャート、第7図は回向処理のフ
ローチャート、第8図はラジコン割り込み処理のフロー
チャート、第9図はラジコン要求のフローチャートであ
る。 (3F) 、 (3R)・・・・・・操向車輪、(18
)・・・・・・送信機、(V)・・・・・・機体、(S
2)・・・・・・センサ、(BASDRn)・・・・・
・基準方位、(NOWDIR)・・・・・・検出方位、
(SFUKAN)・・・・・・設定範囲、(100)・
・・・・・報知手段。
Claims (1)
- 作業行程の長さ方向に基づいて設定された基準方位(B
ASDRn)に対する機体(V)の向きを検出するセン
サ(S_z)を備え、機体(V)を前記作業行程に沿っ
て自動走行させるべく、前記センサ(S_2)による検
出方位(NOWDIR)に基づいて、操向車輪(3F)
、(3R)を自動的に操向操作する自動操向制御手段(
A)を備えると共に、前記操向車輪(3F)、(3R)
の操向操作を送信機(18)からの指示情報に基づいて
遠隔操作する遠隔操縦手段(B)を備えた自動走行作業
車の走行制御装置であって、前記センサ(S_z)によ
る検出方位(NOWDIR)が、前記基準方位(BAS
DRn)に対して設定範囲(SFUKAN)以上ずれた
場合に、機体(V)の向きが前記基準方位(BASDR
n)からずれたことを報知する報知手段(100)を備
えた自動走行作業車の走行制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP61138794A JPS62294003A (ja) | 1986-06-14 | 1986-06-14 | 自動走行作業車の走行制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP61138794A JPS62294003A (ja) | 1986-06-14 | 1986-06-14 | 自動走行作業車の走行制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPS62294003A true JPS62294003A (ja) | 1987-12-21 |
Family
ID=15230374
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP61138794A Pending JPS62294003A (ja) | 1986-06-14 | 1986-06-14 | 自動走行作業車の走行制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS62294003A (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0443916U (ja) * | 1990-08-20 | 1992-04-14 |
-
1986
- 1986-06-14 JP JP61138794A patent/JPS62294003A/ja active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0443916U (ja) * | 1990-08-20 | 1992-04-14 | ||
JP2538503Y2 (ja) * | 1990-08-20 | 1997-06-18 | ヤンマー農機株式会社 | 農作業機における樹木識別装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US5079706A (en) | Control system for self-propelled working vehicle including vehicle course correction means | |
JPS633711A (ja) | 自動走行作業車の走行制御装置 | |
JPS63157908A (ja) | 樹木間走行作業車の操向制御装置 | |
JPS62294003A (ja) | 自動走行作業車の走行制御装置 | |
JPS62259110A (ja) | 自動走行作業車の走行制御装置 | |
JPH061407B2 (ja) | 自動走行作業車の走行制御装置 | |
JPS62296805A (ja) | 自動走行作業車の走行制御装置 | |
JPS637706A (ja) | 自動走行作業車の走行制御装置 | |
JP2723283B2 (ja) | 作業車両における制御装置 | |
JPS62297909A (ja) | 自動走行作業車の走行制御装置 | |
JPS63153605A (ja) | 自動走行作業車の操向制御装置 | |
JPS63204A (ja) | 自動走行作業車の走行制御装置 | |
JPS62285114A (ja) | 自動走行作業車の走行制御装置 | |
JPS637705A (ja) | 自動走行作業車の走行制御装置 | |
JPS633710A (ja) | 自動走行作業車の走行制御装置 | |
JPS62265906A (ja) | 自動走行作業車の操向制御装置 | |
JPS62269769A (ja) | 薬剤散布作業車の走行制御装置 | |
JPS62248011A (ja) | 作業車の走行制御装置 | |
JP3533575B2 (ja) | 作業車 | |
JPS63158153A (ja) | 薬剤散布作業車の走行制御装置 | |
JPH011010A (ja) | 自動走行作業車の走行制御装置 | |
JPS6230642B2 (ja) | ||
JPH0330884Y2 (ja) | ||
JPH0814767B2 (ja) | 自動走行作業車の操向制御装置 | |
JPS63308608A (ja) | 自動走行作業車の走行制御装置 |