JPS637705A - 自動走行作業車の走行制御装置 - Google Patents
自動走行作業車の走行制御装置Info
- Publication number
- JPS637705A JPS637705A JP61150429A JP15042986A JPS637705A JP S637705 A JPS637705 A JP S637705A JP 61150429 A JP61150429 A JP 61150429A JP 15042986 A JP15042986 A JP 15042986A JP S637705 A JPS637705 A JP S637705A
- Authority
- JP
- Japan
- Prior art keywords
- travel
- distance
- stroke
- traveling
- aircraft
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000001514 detection method Methods 0.000 claims description 16
- 238000000034 method Methods 0.000 description 62
- 239000000126 substance Substances 0.000 description 13
- 230000005540 biological transmission Effects 0.000 description 8
- 238000005507 spraying Methods 0.000 description 6
- 239000006185 dispersion Substances 0.000 description 3
- 239000003814 drug Substances 0.000 description 3
- 235000013399 edible fruits Nutrition 0.000 description 3
- 230000008929 regeneration Effects 0.000 description 3
- 238000011069 regeneration method Methods 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
- 241001124569 Lycaenidae Species 0.000 description 1
- 230000003213 activating effect Effects 0.000 description 1
- 230000001186 cumulative effect Effects 0.000 description 1
- 238000013016 damping Methods 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
- 238000003825 pressing Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
Landscapes
- Guiding Agricultural Machines (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
〔産業上の利用分野〕
本発明は、複数個の直線行程と、直線行程の終端部から
次の直線行程の始端部へ機体を移動させる複数個の回向
行程との夫々において、機体を自動走行させる自動走行
制御手段と、送信機からの指示情報に基づいて前記機体
の走行を制御する遠隔操縦手段とを、前記送信機側から
切り換え自在に構成すると共に、前記直線行程の始端部
からの走行距離を検出する走行距離検出手段を設け、前
記自動走行制御手段を、前記走行距離検出手段による検
出走行距離が、前記直線行程の長さに基づいて設定され
た所定距離に達するに伴って、前記回向行程を自動走行
させる回向制御を開始すべく構成してある自動走行作業
車の走行制御装置に関する。
次の直線行程の始端部へ機体を移動させる複数個の回向
行程との夫々において、機体を自動走行させる自動走行
制御手段と、送信機からの指示情報に基づいて前記機体
の走行を制御する遠隔操縦手段とを、前記送信機側から
切り換え自在に構成すると共に、前記直線行程の始端部
からの走行距離を検出する走行距離検出手段を設け、前
記自動走行制御手段を、前記走行距離検出手段による検
出走行距離が、前記直線行程の長さに基づいて設定され
た所定距離に達するに伴って、前記回向行程を自動走行
させる回向制御を開始すべく構成してある自動走行作業
車の走行制御装置に関する。
上記この種の自動走行作業車の走行制御装置は、直線行
程の長さに基づいて設定された所定距離を換向するに伴
って、次の直線行程へ自動的に移動するように、直線行
程及び回向行程の夫々において機体の走行を制御する自
動走行制御手段を設けて、所定の作業を行いながら、機
体が所定の作業行程に沿って自動走行できるようにする
と共に、機体が自動走行し難い作業地や、搭乗して操縦
するには危険な傾斜地等での作業を、安全な箇所から遠
隔操作できるように遠隔操縦手段を併設したちのである
。そして、自動走行中に走行前方側の障害物を人為的に
回避したり、自動走行による作業終了後に離れた箇所に
ある機体を移動させたりする際に便利なように、遠隔操
縦手段と自動走行手段とを、遠隔操縦用の送信機側から
切り換えられるようにしてある。
程の長さに基づいて設定された所定距離を換向するに伴
って、次の直線行程へ自動的に移動するように、直線行
程及び回向行程の夫々において機体の走行を制御する自
動走行制御手段を設けて、所定の作業を行いながら、機
体が所定の作業行程に沿って自動走行できるようにする
と共に、機体が自動走行し難い作業地や、搭乗して操縦
するには危険な傾斜地等での作業を、安全な箇所から遠
隔操作できるように遠隔操縦手段を併設したちのである
。そして、自動走行中に走行前方側の障害物を人為的に
回避したり、自動走行による作業終了後に離れた箇所に
ある機体を移動させたりする際に便利なように、遠隔操
縦手段と自動走行手段とを、遠隔操縦用の送信機側から
切り換えられるようにしてある。
ところで、従来では、機体の走行距離を検出する走行距
離検出手段が、自動走行制御手段が作動している間のみ
、機体の走行距離を検出するように構成され、遠隔操縦
手段に切り換えた場合には、非作動状態となるように、
あるいは、遠隔操縦中における検出距離の変化を無視す
るようにしてあった。
離検出手段が、自動走行制御手段が作動している間のみ
、機体の走行距離を検出するように構成され、遠隔操縦
手段に切り換えた場合には、非作動状態となるように、
あるいは、遠隔操縦中における検出距離の変化を無視す
るようにしてあった。
しかしながら、上述した自動走行作業車の走行制御装置
においては、自動走行制御手段と遠隔操縦手段とを、送
信機側から切り換え自在に構成してあることから、自動
走行中に、自動走行制御手段による不都合、例えば、走
行前方側の障害物を回避すべく、−時的に遠隔操縦手段
に切り換えた後、遠隔操縦手段を非作動状態に切り換え
るに伴って、その時点から継続して自動走行させること
が可能である。ところが、上述したようにこの種の自動
走行作業車の走行制御装置においては、直線行程での走
行制振と回向行程での走行制御との切り換えを、直線行
程における機体の走行距離に基づいて自動切り換えする
ようにしてあることから、遠隔操縦に切り換えた前後の
走行距離分の誤差が生じることとなり、走行距離検出手
段が、直線行程の長さに基づいて設定された距離分を検
出しても、その地点が、適正な回向開始地点からずれて
いる虞れがある。
においては、自動走行制御手段と遠隔操縦手段とを、送
信機側から切り換え自在に構成してあることから、自動
走行中に、自動走行制御手段による不都合、例えば、走
行前方側の障害物を回避すべく、−時的に遠隔操縦手段
に切り換えた後、遠隔操縦手段を非作動状態に切り換え
るに伴って、その時点から継続して自動走行させること
が可能である。ところが、上述したようにこの種の自動
走行作業車の走行制御装置においては、直線行程での走
行制振と回向行程での走行制御との切り換えを、直線行
程における機体の走行距離に基づいて自動切り換えする
ようにしてあることから、遠隔操縦に切り換えた前後の
走行距離分の誤差が生じることとなり、走行距離検出手
段が、直線行程の長さに基づいて設定された距離分を検
出しても、その地点が、適正な回向開始地点からずれて
いる虞れがある。
本発明は、上記実情に鑑みてなされたものであって、そ
の目的は、自動走行制御手段と遠隔操縦手段とを自動走
行中に切り換えても、所望通り直線行程の終端部にて回
向させることができるようにすることにある。
の目的は、自動走行制御手段と遠隔操縦手段とを自動走
行中に切り換えても、所望通り直線行程の終端部にて回
向させることができるようにすることにある。
本発明による自動走行作業車の走行制御装置の特徴構成
は、前記走行距離検出手段を、前記自動走行制御手段と
遠隔操縦手段の何れが作動している場合でも、走行距離
を継続して検出するように構成してある点にあり、その
作用並びに効果は以下の通りである。
は、前記走行距離検出手段を、前記自動走行制御手段と
遠隔操縦手段の何れが作動している場合でも、走行距離
を継続して検出するように構成してある点にあり、その
作用並びに効果は以下の通りである。
すなわち、走行距離検出手段を、前記自動走行制御手段
と遠隔操縦手段の何れが作動している場合でも、直線行
程の走行距離を継続して検出するように構成してあるの
で、自動走行中に、遠隔操縦手段に切り換えて人為的な
操作を行ったとしても、検出走行距離に誤差が生じない
ようにできる。
と遠隔操縦手段の何れが作動している場合でも、直線行
程の走行距離を継続して検出するように構成してあるの
で、自動走行中に、遠隔操縦手段に切り換えて人為的な
操作を行ったとしても、検出走行距離に誤差が生じない
ようにできる。
従って、自動走行制御手段と遠隔操縦手段の何れによっ
て機体の走行が制御されている場合であっても、′m継
続に走行距離を検出するので、直線行程における検出走
行距離に誤差が生じないものにできる。もって、自動走
行中に遠隔操縦手段に切り換えても、回向開始地点に誤
差が生じないようにできた。
て機体の走行が制御されている場合であっても、′m継
続に走行距離を検出するので、直線行程における検出走
行距離に誤差が生じないものにできる。もって、自動走
行中に遠隔操縦手段に切り換えても、回向開始地点に誤
差が生じないようにできた。
以下、本発明の実施例を図面の簡単な説明する。
第3図及び第4図に示すように、自動走行、遠隔操縦(
ラジコン)、並びに、搭乗操縦(手動)の何れをも可能
な機体(V)の前方側に、エンジン(IE)及び搭乗操
縦部(1)を設けると共に、機体(V)の後方側に、外
装カバー(2a)を備えた薬剤タンク(2)を搭載して
ある。そして、機体(V)下部に設けたポンプ(4)に
よって前記薬剤タンク(2)から供給される薬剤を多数
のノズル(5)から噴出させ、ブロア(6)による送風
によって飛散させる薬剤散布装置(7)を、前記薬剤タ
ンク(2)の後方側に付設して、主に果樹園等にて果樹
間を走行しながら薬剤散布を行うための作業車を構成し
てあり、第2図に示すように、各直線状の作業行程の端
部に位置する樹木の外側にて隣接する次の直線状の作業
行程の方向に回向させながら樹木間を往復走行して、薬
剤散布を行うようにしてある。尚、第3図及び第4図中
、()l)は、前記搭乗操縦部(1)に設けられた搭乗
操縦用のステアリングハンドル(H)である。
ラジコン)、並びに、搭乗操縦(手動)の何れをも可能
な機体(V)の前方側に、エンジン(IE)及び搭乗操
縦部(1)を設けると共に、機体(V)の後方側に、外
装カバー(2a)を備えた薬剤タンク(2)を搭載して
ある。そして、機体(V)下部に設けたポンプ(4)に
よって前記薬剤タンク(2)から供給される薬剤を多数
のノズル(5)から噴出させ、ブロア(6)による送風
によって飛散させる薬剤散布装置(7)を、前記薬剤タ
ンク(2)の後方側に付設して、主に果樹園等にて果樹
間を走行しながら薬剤散布を行うための作業車を構成し
てあり、第2図に示すように、各直線状の作業行程の端
部に位置する樹木の外側にて隣接する次の直線状の作業
行程の方向に回向させながら樹木間を往復走行して、薬
剤散布を行うようにしてある。尚、第3図及び第4図中
、()l)は、前記搭乗操縦部(1)に設けられた搭乗
操縦用のステアリングハンドル(H)である。
前記機体(V)の構成について説明すれば、第4図に示
すように、前記機体(V)前部に設けられたバンバ(8
)の前面側に、非接触式の障害物センサとしての超音波
センサ(S+)の3個を、各障害物感知範囲が互いに隣
接する状態で、左右及び中央の夫々に設けである。但し
、左右に位置する超音波センサ(S+)、 (S+)夫
々は、その障害物感知情報を、機体(V)に対して左右
両側に位置する樹木(F)の間を機体(V)が走行する
ための操向制御用の情報として利用できるようにするた
め、前記左右両側の樹木(F)夫々に対する距離を感知
できるようにすると共に、その障害物感知範囲を、機体
幅よりも外側に拡がるように設定してある。
すように、前記機体(V)前部に設けられたバンバ(8
)の前面側に、非接触式の障害物センサとしての超音波
センサ(S+)の3個を、各障害物感知範囲が互いに隣
接する状態で、左右及び中央の夫々に設けである。但し
、左右に位置する超音波センサ(S+)、 (S+)夫
々は、その障害物感知情報を、機体(V)に対して左右
両側に位置する樹木(F)の間を機体(V)が走行する
ための操向制御用の情報として利用できるようにするた
め、前記左右両側の樹木(F)夫々に対する距離を感知
できるようにすると共に、その障害物感知範囲を、機体
幅よりも外側に拡がるように設定してある。
又、前記薬剤タンク(2)の上部には、地磁気を感知す
ることによって絶対方位を検出する方位センサ(Sりを
設けてあり、作業行程に対する機体(V)向きを検出で
きるようにしてある。
ることによって絶対方位を検出する方位センサ(Sりを
設けてあり、作業行程に対する機体(V)向きを検出で
きるようにしてある。
又、第2図に示すように、樹木(F)の間を機体(V)
が直線的に走行する直線行程の終端部を表示すべく、こ
の直線行程の終端部に位置する樹木同士の間に、鉄等の
磁性材にて形成したマーカ(m)を埋設すると共に、前
記マーカ(m)を検出する磁気感知式の近接センサ(S
3)を、前記機体(V)の前端部下方に設けである。
が直線的に走行する直線行程の終端部を表示すべく、こ
の直線行程の終端部に位置する樹木同士の間に、鉄等の
磁性材にて形成したマーカ(m)を埋設すると共に、前
記マーカ(m)を検出する磁気感知式の近接センサ(S
3)を、前記機体(V)の前端部下方に設けである。
前記機体(V)の走行系の構成について説明すれば、第
1図に示すように、左右−対の前輪(3F)及び後輪(
3R)を設けると共に、それら−対の前後輪(3F)
、 (3R)を各別に操作するステアリング操作用の油
圧シリンダ(9F) 、 (9R) 、及び、それに対
する制御弁(IOF) i (IOR)を設けてあり、
前記前輪(3F)及び後輪(3R)が、共に操向車輪と
して機能するようにしてある。
1図に示すように、左右−対の前輪(3F)及び後輪(
3R)を設けると共に、それら−対の前後輪(3F)
、 (3R)を各別に操作するステアリング操作用の油
圧シリンダ(9F) 、 (9R) 、及び、それに対
する制御弁(IOF) i (IOR)を設けてあり、
前記前輪(3F)及び後輪(3R)が、共に操向車輪と
して機能するようにしてある。
又、前後進切り換え自在で且つ前進変速並びに後進変速
自在な油圧式無段変速装置(11)を、前記エンジン(
E)に連動連結すると共に、前記変速装置(11)の出
力にて、前記前後輪(3F) 、 (3R)を同時に駆
動するように構成してある。そして、搭乗操縦用の変速
ペダル(12)及び遠隔操縦用の変速アクチュエータと
しての変速モータ(13)を、その何れによっても変速
操作可能に、前記変速装置(11)の変速アーム(14
)に連動連結してある。
自在な油圧式無段変速装置(11)を、前記エンジン(
E)に連動連結すると共に、前記変速装置(11)の出
力にて、前記前後輪(3F) 、 (3R)を同時に駆
動するように構成してある。そして、搭乗操縦用の変速
ペダル(12)及び遠隔操縦用の変速アクチュエータと
しての変速モータ(13)を、その何れによっても変速
操作可能に、前記変速装置(11)の変速アーム(14
)に連動連結してある。
又、走行距離を検出する走行距離検出手段を構成する距
離センサ(S4)を、前記変速装置(11)の出力に連
動連結してある。
離センサ(S4)を、前記変速装置(11)の出力に連
動連結してある。
前記距離センサ(S、)は、前記変速装置(11)の出
力によって回転駆動されて、パルス信号を出力するパル
ス発生器(27)と、このパルス発生器(27)から発
生されるパルス数をカウントすることにより機体(v)
の走行距離をそのカウント値(CNTP1)として検出
するカウンタ(28)とを備え、機体(V)が自動走行
しているか、遠隔操縦にて走行しているかに拘らず、継
続して走行距離を計測するように構成してある。但し、
前記カウンタ(28)の初期値は、制御装置(A)によ
って設定自在にすると共に、前進時には検出走行距離と
してのカウント値(CNTP1)を自動的に加算し、後
進時には減算するようにしてあり、詳しくは後述するが
、機体(V)が自動走行中に、自動走行制御手段(A)
と遠隔操縦手段(B)とを切り換えても、検出走行距離
に誤差が生じないようにしてある。
力によって回転駆動されて、パルス信号を出力するパル
ス発生器(27)と、このパルス発生器(27)から発
生されるパルス数をカウントすることにより機体(v)
の走行距離をそのカウント値(CNTP1)として検出
するカウンタ(28)とを備え、機体(V)が自動走行
しているか、遠隔操縦にて走行しているかに拘らず、継
続して走行距離を計測するように構成してある。但し、
前記カウンタ(28)の初期値は、制御装置(A)によ
って設定自在にすると共に、前進時には検出走行距離と
してのカウント値(CNTP1)を自動的に加算し、後
進時には減算するようにしてあり、詳しくは後述するが
、機体(V)が自動走行中に、自動走行制御手段(A)
と遠隔操縦手段(B)とを切り換えても、検出走行距離
に誤差が生じないようにしてある。
前記−対の前後輪(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) 、 (3R)夫
々のステアリング角度を検出するステアリング角度検出
用ポテンショメータ(R,)、(1’h)を設けである
。又、前記変速装置(11)の変速位置を検出する変速
位置検出用ポテンショメータ(R3)を、前記変速アー
ム(14)の回動操作に連動するように設けである。そ
して、前記各ポテンショメータ(R,)〜(R3)によ
る検出信号を自動走行制御手段(A)、遠隔操縦手段(
B)、並びに、搭乗操縦手段の夫々を構成する制御装置
(15)に入力してある。又、上記各操縦手段の何れに
よって機体(V)の走行を制御するかを選択する操縦モ
ード選択用スイッチ(16)を設けである。但し、詳し
くは後述するが、前記自動走行制御手段が作動する自動
操縦モードにおいては、前記操縦モード選択用スイッチ
(16)を操作することなく、前記遠隔操縦手段(B)
を、自動走行制御手段(A)に優先して作動させる状態
に切り換えられるように構成してある。
ステアリング角度検出用ポテンショメータ(Ro)を、
前記ステアリングハンドル(H)にて回動操作するよう
に設けると共に、前記前後輪(3F) 、 (3R)夫
々のステアリング角度を検出するステアリング角度検出
用ポテンショメータ(R,)、(1’h)を設けである
。又、前記変速装置(11)の変速位置を検出する変速
位置検出用ポテンショメータ(R3)を、前記変速アー
ム(14)の回動操作に連動するように設けである。そ
して、前記各ポテンショメータ(R,)〜(R3)によ
る検出信号を自動走行制御手段(A)、遠隔操縦手段(
B)、並びに、搭乗操縦手段の夫々を構成する制御装置
(15)に入力してある。又、上記各操縦手段の何れに
よって機体(V)の走行を制御するかを選択する操縦モ
ード選択用スイッチ(16)を設けである。但し、詳し
くは後述するが、前記自動走行制御手段が作動する自動
操縦モードにおいては、前記操縦モード選択用スイッチ
(16)を操作することなく、前記遠隔操縦手段(B)
を、自動走行制御手段(A)に優先して作動させる状態
に切り換えられるように構成してある。
次に、前記各操縦手段の構成について詳述する。
搭乗操縦手段の構成について説明すれば、第1図に示す
ように、前記ステアリング形式選択用スイッチ(17)
の情報、及び、前記搭乗操縦時の目標ステアリング位置
を検出する目標ステアリング位置検出用のポテンショメ
ータ(Ro)に基づいて、前記ステアリング用油圧シリ
ンダ(9F)。
ように、前記ステアリング形式選択用スイッチ(17)
の情報、及び、前記搭乗操縦時の目標ステアリング位置
を検出する目標ステアリング位置検出用のポテンショメ
ータ(Ro)に基づいて、前記ステアリング用油圧シリ
ンダ(9F)。
(9R)の制御弁(IOF) 、 (IOR)の作動を
制御して、前記前後B (3F) 、 (3R)を指示
されたステアリング形式で且つ前記ステアリングハンド
ル(11)による目標ステアリング角度に操作すること
となる。但し、搭乗操縦時における前記変速装置(11
)の変速位置つまり車速の調整は、前記変速ペダル(1
2)にて前記変速アーム(14)を直接操作して行うこ
とになる。
制御して、前記前後B (3F) 、 (3R)を指示
されたステアリング形式で且つ前記ステアリングハンド
ル(11)による目標ステアリング角度に操作すること
となる。但し、搭乗操縦時における前記変速装置(11
)の変速位置つまり車速の調整は、前記変速ペダル(1
2)にて前記変速アーム(14)を直接操作して行うこ
とになる。
遠隔操縦の構成について説明すれば、遠隔操縦用の送信
機(18)から与えられる指示情報を受信する受信機(
19)を設けると共に、その受信情報に基づいて、前記
ステアリング用油圧シリンダ(9F) 、 (9R)の
制御弁(IOF) 、 (IOR)及び変速モータ(1
3)夫々の作動、並びに、前記ノズル(5)の制御弁(
5a)、ブロア(6)等の作動を制御することにより、
機体m の走行並びに前記薬剤散布装置(7)の作動を
、遠隔操作するようにしてある。
機(18)から与えられる指示情報を受信する受信機(
19)を設けると共に、その受信情報に基づいて、前記
ステアリング用油圧シリンダ(9F) 、 (9R)の
制御弁(IOF) 、 (IOR)及び変速モータ(1
3)夫々の作動、並びに、前記ノズル(5)の制御弁(
5a)、ブロア(6)等の作動を制御することにより、
機体m の走行並びに前記薬剤散布装置(7)の作動を
、遠隔操作するようにしてある。
前記送信機(18)の構成について説明すれば、第1図
に示すように、前後動によって前記変速装置(11)の
目標変速位置を指示する変速レバー(20)、及び、前
後動によってステアリング形式を指示し、且つ、左右動
によって前記前後輪(3F) 、 (3R)の目標ステ
アリング角度を指示するステアリングレバー(21)を
設けると共に、前記薬剤散布装置(7)のブロア(6)
の回転・停止を指示するブロアスイッチ(22)、前記
ノズル(5)からの薬剤噴出の作動・停止を指示するノ
ズルスイッチ(23)、機体(v)を非常停止させるた
めの指示を行う非常停止用スイッチ(24)、及び、前
記機体(V)が自動走行している時に、この送信機(1
8)に設けた前記各レバー(20) 、 (21)及び
スイッチ(22) 、 (23) 、 (24)にて機
体(V)の走行並びに薬剤散布装置(7)の作動を遠隔
操縦すべく、遠隔操縦手段(B)が自動走行制御手段(
A)に優先して作動する状態に切り換える制御切り換え
指示手段としての割り込みスイッチ(25)を設けであ
る。
に示すように、前後動によって前記変速装置(11)の
目標変速位置を指示する変速レバー(20)、及び、前
後動によってステアリング形式を指示し、且つ、左右動
によって前記前後輪(3F) 、 (3R)の目標ステ
アリング角度を指示するステアリングレバー(21)を
設けると共に、前記薬剤散布装置(7)のブロア(6)
の回転・停止を指示するブロアスイッチ(22)、前記
ノズル(5)からの薬剤噴出の作動・停止を指示するノ
ズルスイッチ(23)、機体(v)を非常停止させるた
めの指示を行う非常停止用スイッチ(24)、及び、前
記機体(V)が自動走行している時に、この送信機(1
8)に設けた前記各レバー(20) 、 (21)及び
スイッチ(22) 、 (23) 、 (24)にて機
体(V)の走行並びに薬剤散布装置(7)の作動を遠隔
操縦すべく、遠隔操縦手段(B)が自動走行制御手段(
A)に優先して作動する状態に切り換える制御切り換え
指示手段としての割り込みスイッチ(25)を設けであ
る。
つまり、機体(V)が自動走行制御手段(A)にて自動
走行している時に、例えば、前記超音波センサ(Sl)
や接触センサ(So)が車体(V)前方にある障害物を
怒知したり誤動作して、機体(V)が自動停止したよう
な場合に、作業者が機体(V)の停止位置まで行くこと
なく、前記割り込みスイッチ(25)を操作すれば、そ
の後は、前記送信Ja(18)による遠隔操縦にて、そ
の障害物を回避させることができる。又、詳しくは後述
するが、前記割り込みスイッチ(25)を切れば、自動
走行モードに自動的に復帰して、引き続き機体(V)を
自動走行させることができるようにしてある。
走行している時に、例えば、前記超音波センサ(Sl)
や接触センサ(So)が車体(V)前方にある障害物を
怒知したり誤動作して、機体(V)が自動停止したよう
な場合に、作業者が機体(V)の停止位置まで行くこと
なく、前記割り込みスイッチ(25)を操作すれば、そ
の後は、前記送信Ja(18)による遠隔操縦にて、そ
の障害物を回避させることができる。又、詳しくは後述
するが、前記割り込みスイッチ(25)を切れば、自動
走行モードに自動的に復帰して、引き続き機体(V)を
自動走行させることができるようにしてある。
次に、自動走行制御手段(A)の構成について、前記制
御装置(15)の動作を説明しながら詳述する。
御装置(15)の動作を説明しながら詳述する。
先ず、自動走行制御時における機体走行の概略を説明す
れば、第2図に示すように、作業行程の開始地点(ST
)と、この開始地点(ST)に対向する他端側に位置す
る果樹(F)の間とを結ぶ直線状の第1行程(i)、前
記他端側に位置する果樹(F)の外方側を回向して前記
直線状の第1行程(i)に対して180度逆方向に向か
う直線状の第3行程(iii )へと移動する第2行程
(ii )、及び、前記第3行程(iii )の終了後
に、前記第1行程(i)と同一方向に向かう直線状の作
業行程方向に方向転換させるために、前記第2行程(i
i)と同様にして回向させる第4行程(iv)の4つの
作業行程夫々を、前記搭乗操縦手段又は遠隔操縦手段に
て操縦しながら、各行程における前記方位センサ(S2
)、距離センサ(S4)、及び、ステアリング角度検出
用ポテンショメータ(R,)、 (+?2)によるステ
アリング角度等の検出情報に基づいて、前記4つの各行
程(i)〜(iv)夫々をティーチングする。但し、本
実施例においては、第1行程(i)及び第3行程(ii
i )の直線行程では、この直線行程の開始地点から前
記近接センサ(S3)が作動するまでの実際の走行距離
(DLENGn)−1,!つまり直線行程の長さと、検
出方位を平均した基準方位(BASDRn)n−+、z
とを、直線行程の走行制御用情報として記憶し、第2行
程(ii)及び第4行程(iv)の回向行程では、前記
ステアリング角度検出用ポテンショメーク(R1)、(
RZ)による検出ステアリング角度を、設定距離間隔(
本実施例では、約20cmに設定してある)毎にサンプ
リングすると共に、その値を、各回向行程(ii)。
れば、第2図に示すように、作業行程の開始地点(ST
)と、この開始地点(ST)に対向する他端側に位置す
る果樹(F)の間とを結ぶ直線状の第1行程(i)、前
記他端側に位置する果樹(F)の外方側を回向して前記
直線状の第1行程(i)に対して180度逆方向に向か
う直線状の第3行程(iii )へと移動する第2行程
(ii )、及び、前記第3行程(iii )の終了後
に、前記第1行程(i)と同一方向に向かう直線状の作
業行程方向に方向転換させるために、前記第2行程(i
i)と同様にして回向させる第4行程(iv)の4つの
作業行程夫々を、前記搭乗操縦手段又は遠隔操縦手段に
て操縦しながら、各行程における前記方位センサ(S2
)、距離センサ(S4)、及び、ステアリング角度検出
用ポテンショメータ(R,)、 (+?2)によるステ
アリング角度等の検出情報に基づいて、前記4つの各行
程(i)〜(iv)夫々をティーチングする。但し、本
実施例においては、第1行程(i)及び第3行程(ii
i )の直線行程では、この直線行程の開始地点から前
記近接センサ(S3)が作動するまでの実際の走行距離
(DLENGn)−1,!つまり直線行程の長さと、検
出方位を平均した基準方位(BASDRn)n−+、z
とを、直線行程の走行制御用情報として記憶し、第2行
程(ii)及び第4行程(iv)の回向行程では、前記
ステアリング角度検出用ポテンショメーク(R1)、(
RZ)による検出ステアリング角度を、設定距離間隔(
本実施例では、約20cmに設定してある)毎にサンプ
リングすると共に、その値を、各回向行程(ii)。
(iv)での走行制?71用情報として記憶するように
してある(以下において〔ティーチング〕と呼称する)
。
してある(以下において〔ティーチング〕と呼称する)
。
そして、上述した〔ティーチング〕を終了9ると、機体
(V)を−旦前記作業行程の開始地点(ST)まで移動
させて、前記〔ティーチング〕にて記憶された第1行程
(i)〜第4行程(iv)の各行程での記憶情報に基づ
いて機体(V)の走行を制御しながら、各行程での走行
を設定回数繰り返すことにより、各直線行程の端部にて
自動回向しながら、果樹(F)の間を往復走行させて、
所定範囲の果樹園内における薬剤散布作業を自動的に行
わせるようにしてある。つまり、上述した〔ティーチン
グ〕にてティーチングされた走行制御用情報Gこ基づい
て機体(V)の走行を制御する走行制御手段並びに作業
行程に沿って自動走行させるための自動走行制御手段(
A)を構成してあり、その制御のための処理を以下にお
いて、〔再生〕と呼称する。
(V)を−旦前記作業行程の開始地点(ST)まで移動
させて、前記〔ティーチング〕にて記憶された第1行程
(i)〜第4行程(iv)の各行程での記憶情報に基づ
いて機体(V)の走行を制御しながら、各行程での走行
を設定回数繰り返すことにより、各直線行程の端部にて
自動回向しながら、果樹(F)の間を往復走行させて、
所定範囲の果樹園内における薬剤散布作業を自動的に行
わせるようにしてある。つまり、上述した〔ティーチン
グ〕にてティーチングされた走行制御用情報Gこ基づい
て機体(V)の走行を制御する走行制御手段並びに作業
行程に沿って自動走行させるための自動走行制御手段(
A)を構成してあり、その制御のための処理を以下にお
いて、〔再生〕と呼称する。
以下、上述した〔再生〕の処理について詳述する。
第5図に示すように、先ず、全走行行程数を、前記直線
行程の個数(KNtlM)として入力して設定する(ス
テツブ1100)。
行程の個数(KNtlM)として入力して設定する(ス
テツブ1100)。
そして、前記〔ティーチング〕にて記憶された基準方位
(BASDRn)、この基準方位(BASDRn)に対
して設定許容差以上ずれると操向操作するための不感帯
(FXAN2)、及び、前記超音波センサ(S+)の感
知距離区分を予め設定した区分距離(DIVL) (本
実施例では、1m以内、2m、3m。
(BASDRn)、この基準方位(BASDRn)に対
して設定許容差以上ずれると操向操作するための不感帯
(FXAN2)、及び、前記超音波センサ(S+)の感
知距離区分を予め設定した区分距離(DIVL) (本
実施例では、1m以内、2m、3m。
4m以上の4つの距離間隔に区分してある)に夫々上・
7トした後、前記〔ティーチング〕にて記憶された基準
距離(DLENGn)に所定距離を減算した前エリア(
KOTE IF)、前記基準距離(DLENGn)に所
定距離を加算した後エリア(KOTEIB)、及び、回
向を確実に行うために減速操作するための減速開始地点
に対応する減速距離(KOT[EI2)、の夫々を算出
して設定し、そして、実際の走行距離を計測する前記距
離センサ(S4)のカウンタ(28)の値(CNTP1
)を“0”にリセツトして各走行制御情報を初期化して
、現走行行程が前記第1〜第4行程の何れの行程である
かを示す行程フラグ(CFLAG)を、第1行程(i)
を示す“l”にセノ トする(ステフブ#101〜ステ
フブ!+103)。
7トした後、前記〔ティーチング〕にて記憶された基準
距離(DLENGn)に所定距離を減算した前エリア(
KOTE IF)、前記基準距離(DLENGn)に所
定距離を加算した後エリア(KOTEIB)、及び、回
向を確実に行うために減速操作するための減速開始地点
に対応する減速距離(KOT[EI2)、の夫々を算出
して設定し、そして、実際の走行距離を計測する前記距
離センサ(S4)のカウンタ(28)の値(CNTP1
)を“0”にリセツトして各走行制御情報を初期化して
、現走行行程が前記第1〜第4行程の何れの行程である
かを示す行程フラグ(CFLAG)を、第1行程(i)
を示す“l”にセノ トする(ステフブ#101〜ステ
フブ!+103)。
前記ステツブ#103にて行程フラグ(CFLAG)が
セットされると、前記変速位置検出用のポテンショメー
タ(R3)の検出値に基づいて前記変速装置(11)を
操作して設定走行速度となるようにして走行を開始し、
前記ステツブ#100にて入力された行程数(KNUM
)をチエツクすることにより、全行程を走行したか否か
を判別する(ステツブ11104)。
セットされると、前記変速位置検出用のポテンショメー
タ(R3)の検出値に基づいて前記変速装置(11)を
操作して設定走行速度となるようにして走行を開始し、
前記ステツブ#100にて入力された行程数(KNUM
)をチエツクすることにより、全行程を走行したか否か
を判別する(ステツブ11104)。
次に、前記受信機(19)の受信情報に基づいて、前記
送信機(18)に設けた割り込みスイッチ(25)がO
N操作されたか否かをチエツクすることにより、自動走
行中に遠隔操縦モードに切り換えるためのラジコン割り
込みがあったか否かを判別すると共に、後述する直線行
程の終了を判別する〔直線終了〕の処理にてセントされ
た行程フラグ(CFLAG)の値が、前記第2行程(i
i)又は第4行程(iv)の回向行程の値(2又は4)
にセットされているか否かを判別する(ステフブ#10
5.ステフブ暮106)。
送信機(18)に設けた割り込みスイッチ(25)がO
N操作されたか否かをチエツクすることにより、自動走
行中に遠隔操縦モードに切り換えるためのラジコン割り
込みがあったか否かを判別すると共に、後述する直線行
程の終了を判別する〔直線終了〕の処理にてセントされ
た行程フラグ(CFLAG)の値が、前記第2行程(i
i)又は第4行程(iv)の回向行程の値(2又は4)
にセットされているか否かを判別する(ステフブ#10
5.ステフブ暮106)。
但し、前記ラジコン割り込みがあった場合は、後述する
〔ラジコン割り込み〕の処理に分岐し、前記行程フラグ
(CFLAG)の値が“2”又は“4”にセットされて
いる場合は、後述する〔回向〕の処理に分岐して、その
後の処理を中断することとなる。
〔ラジコン割り込み〕の処理に分岐し、前記行程フラグ
(CFLAG)の値が“2”又は“4”にセットされて
いる場合は、後述する〔回向〕の処理に分岐して、その
後の処理を中断することとなる。
一方、全行程が終了せず、〔ラジコン割り込み〕も無(
、且つ、前記行程フラグ(CFLAG)が回向行程にセ
ットされていない場合は、前記方位センサ(S2)及び
超音波センサ(Sl)の各検出データに基づいて、前記
前後輪(3F) 、 (3R)を操向操作するためのス
テアリング操作量を決定して、前記ステアリング用油圧
シリンダ(9F) 、 (9R)の電磁弁(IOF)
、 (IOR)に制御信号を出力する〔操向ttdl
?n 〕 を行う (ステフプ#107.ステヮ加1
08)。
、且つ、前記行程フラグ(CFLAG)が回向行程にセ
ットされていない場合は、前記方位センサ(S2)及び
超音波センサ(Sl)の各検出データに基づいて、前記
前後輪(3F) 、 (3R)を操向操作するためのス
テアリング操作量を決定して、前記ステアリング用油圧
シリンダ(9F) 、 (9R)の電磁弁(IOF)
、 (IOR)に制御信号を出力する〔操向ttdl
?n 〕 を行う (ステフプ#107.ステヮ加1
08)。
その後は、前記近接センサ(S3)がONしたか否かを
チエツクすることにより、機体(V)が直線行程の終了
地点つまり回向行程の開始地点に達したか否かを判別す
ると共に、前記3つの超音波センサ(Sl)の何れか1
つでも走行前方側1m以内に障害物を感知したか否かを
チエツクする。そして、前記近接センサ(S3)がON
L ”il” L’る場合は、直線行程を終了して次
の直線行程に向けて回向するための〔直線終了〕の処理
に分岐し、前記超音波センサ(Sl)が1m以内に障害
物を感知した場合は、非常停止させると共に、その後の
回避を遠隔操縦にて行うために、後述する〔ラジコン要
求〕の処理に分岐する(ステフブ$1109.ステフブ
#110)。
チエツクすることにより、機体(V)が直線行程の終了
地点つまり回向行程の開始地点に達したか否かを判別す
ると共に、前記3つの超音波センサ(Sl)の何れか1
つでも走行前方側1m以内に障害物を感知したか否かを
チエツクする。そして、前記近接センサ(S3)がON
L ”il” L’る場合は、直線行程を終了して次
の直線行程に向けて回向するための〔直線終了〕の処理
に分岐し、前記超音波センサ(Sl)が1m以内に障害
物を感知した場合は、非常停止させると共に、その後の
回避を遠隔操縦にて行うために、後述する〔ラジコン要
求〕の処理に分岐する(ステフブ$1109.ステフブ
#110)。
次に、前記距離センサ(S、)のカウント値(CNTP
1)と前記減速距離(KOTEI2)とを比較すること
によって機体(V)が減速地点に達したか否かを判別し
、前記減速距離(KOTEI2)に達している場合は、
予め設定してある走行速度となるように減速操作を行っ
た後、前記方位センサ(S2)による検出情報に基づい
て判別された検出方位としての現在方位(NOWDIR
)が、現行程の基準方位(BASDRn)に対して予め
設定してある設定範囲(SFtlKAN) (本実施例
では約±20度に設定してある)以上ずれているか否か
を判別し、現在方位(NOWDIR)が基準方位(BA
SDRn)に対して設定範囲(SPt!KAN)以上ず
れている場合は、前記警告灯(26)を点灯して、機体
(v)の向きが設定範囲(SFUKAN)以上ずれたこ
とを報知すると共に、その後の機体向き修正等の操作を
遠隔操縦にて行うように要求するために、後述する〔ラ
ジコン要求〕の処理に分岐する。但し、前記距離センサ
(S4)のカウント値(CNTP1)が減速距離(KO
TEI2)に達していない場合や、機体(V)の向きが
前記設定範囲(SFtlKAN)以上ずれていない場合
は、前記ステツブ#104からの処理を繰り返すことと
なる(ステフブ#111〜ステフブ+1113)。
1)と前記減速距離(KOTEI2)とを比較すること
によって機体(V)が減速地点に達したか否かを判別し
、前記減速距離(KOTEI2)に達している場合は、
予め設定してある走行速度となるように減速操作を行っ
た後、前記方位センサ(S2)による検出情報に基づい
て判別された検出方位としての現在方位(NOWDIR
)が、現行程の基準方位(BASDRn)に対して予め
設定してある設定範囲(SFtlKAN) (本実施例
では約±20度に設定してある)以上ずれているか否か
を判別し、現在方位(NOWDIR)が基準方位(BA
SDRn)に対して設定範囲(SPt!KAN)以上ず
れている場合は、前記警告灯(26)を点灯して、機体
(v)の向きが設定範囲(SFUKAN)以上ずれたこ
とを報知すると共に、その後の機体向き修正等の操作を
遠隔操縦にて行うように要求するために、後述する〔ラ
ジコン要求〕の処理に分岐する。但し、前記距離センサ
(S4)のカウント値(CNTP1)が減速距離(KO
TEI2)に達していない場合や、機体(V)の向きが
前記設定範囲(SFtlKAN)以上ずれていない場合
は、前記ステツブ#104からの処理を繰り返すことと
なる(ステフブ#111〜ステフブ+1113)。
次に、前記ステップ#109にて近接センサ(S、)が
ONするに伴って分岐する〔直線終了〕の処理について
説明する。 。
ONするに伴って分岐する〔直線終了〕の処理について
説明する。 。
すなわち、第6図に示すように、前記距離センサ(S4
)のカウント値(CNTP1)が、前記前エリア(KO
TEIF)及び後エリア(KOTEIB)の間にあるか
否かを判別することにより、回向許可範囲内に機体(V
)があるか否かを判別し、回向許可範囲内に機体(V)
がない場合は、後述する〔ラジコン要求〕の処理に分岐
して、前記送信機(18)による遠隔操縦にて回向させ
るようにする(ステツブ1200)。
)のカウント値(CNTP1)が、前記前エリア(KO
TEIF)及び後エリア(KOTEIB)の間にあるか
否かを判別することにより、回向許可範囲内に機体(V
)があるか否かを判別し、回向許可範囲内に機体(V)
がない場合は、後述する〔ラジコン要求〕の処理に分岐
して、前記送信機(18)による遠隔操縦にて回向させ
るようにする(ステツブ1200)。
前記距離センサ(S4)のカウント値(CNTP1)が
回向許可範囲内にある場合は、前記行程フラグ(CFL
AG)の値に基づいて行程フラグ(CFLAG)の値を
、第2行程(ii)又は第4行程(iv)を示す値(“
2”又は“4”)に夫々セットして、回向行程の終了を
判別するための反転方位(BASDR2又はBASDR
1)を設定すると共に、前記行程数(KNUM)を減算
して、前記ステyプ#104以降の操向制御B処理に復
帰する(ステフプ#201〜ステフブ+1206)。
回向許可範囲内にある場合は、前記行程フラグ(CFL
AG)の値に基づいて行程フラグ(CFLAG)の値を
、第2行程(ii)又は第4行程(iv)を示す値(“
2”又は“4”)に夫々セットして、回向行程の終了を
判別するための反転方位(BASDR2又はBASDR
1)を設定すると共に、前記行程数(KNUM)を減算
して、前記ステyプ#104以降の操向制御B処理に復
帰する(ステフプ#201〜ステフブ+1206)。
従って、上述した処理により前記行程フラグ(CFLA
G)の値は直線行程を示す1″又は“3″から回向行程
を示す“2”又は“4”に変わっていることから、前記
ステツブ#106の回向判別処理では、自動的に〔回向
〕の処理に分岐することとなる。
G)の値は直線行程を示す1″又は“3″から回向行程
を示す“2”又は“4”に変わっていることから、前記
ステツブ#106の回向判別処理では、自動的に〔回向
〕の処理に分岐することとなる。
もって、上述した〔直線終了〕の処理にて、直線行程の
長さに基づいて設定された所定距離に達するに伴って、
回向行程を自動走行させる回向制御を、自動的に開始す
る手段を構成してある。
長さに基づいて設定された所定距離に達するに伴って、
回向行程を自動走行させる回向制御を、自動的に開始す
る手段を構成してある。
前記〔回向〕の処理について説明すれば、前記〔直線終
了〕の処理にてセットされた行程フラグ(CFLAG)
の値に基づいて、前記〔ティーチング〕にて記憶された
第2行程(ii)又は第4行程(iv)の何れかの記憶
ステアリング角度の情報を所定距離毎に順次読み出して
、そのステアリング角度となるように前記前後輪(3F
) 、 (3R)を操作して、ティーチングされた走行
経路に沿って機体(V)を次の直線行程の始端部に向け
て自動的に回向させるのである。但し、ティーチングさ
れたステアリング角度の情報を全て出力した後は、前記
距離センサ(S4)のカウント値(CNTP1)を0゛
にリセットすると共に、基準方位(BASDRn)や行
程フラグ(CFLAG)等の走行制御情報を、再設定す
ることとなる。
了〕の処理にてセットされた行程フラグ(CFLAG)
の値に基づいて、前記〔ティーチング〕にて記憶された
第2行程(ii)又は第4行程(iv)の何れかの記憶
ステアリング角度の情報を所定距離毎に順次読み出して
、そのステアリング角度となるように前記前後輪(3F
) 、 (3R)を操作して、ティーチングされた走行
経路に沿って機体(V)を次の直線行程の始端部に向け
て自動的に回向させるのである。但し、ティーチングさ
れたステアリング角度の情報を全て出力した後は、前記
距離センサ(S4)のカウント値(CNTP1)を0゛
にリセットすると共に、基準方位(BASDRn)や行
程フラグ(CFLAG)等の走行制御情報を、再設定す
ることとなる。
次に、前記〔ラジコン割り込み〕の処理について詳述す
る。
る。
第7図に示すように、この〔ラジコン割り込み〕の処理
が起動されるに伴って、前記機体(V)の上部に設けら
れた警告灯(26)を点灯させて、この〔ラジコンν1
り込み〕の処理が起動されたことを報知すると共に、前
記行程フラグ(CFLAG)の値に基づいて、現在の走
行行程が直線行程であるか回向行程であるかを判別する
(ステ7ブ11400゜ステツブ#401)。
が起動されるに伴って、前記機体(V)の上部に設けら
れた警告灯(26)を点灯させて、この〔ラジコンν1
り込み〕の処理が起動されたことを報知すると共に、前
記行程フラグ(CFLAG)の値に基づいて、現在の走
行行程が直線行程であるか回向行程であるかを判別する
(ステ7ブ11400゜ステツブ#401)。
そして、現在の走行行程が直線行程である場合は、前記
受信1ffl(19)を介して入力される前記割り込み
スイフチ(25)の状態に基づいて、この〔ラジコン割
り込み〕の処理が終了したか否かを判別し、処理が終了
している場合は、機体(V)の向きが直線行程の基準方
位(RASDRn)に対して設定範囲内に復帰している
か否かを判別するための不惑帯(本実施例では、前記ス
テツブ#115にて機体向きが基準方位(BASDRn
)からずれたか否かを判別するための設定範囲(SFU
KAN)と同一の約±20度に設定してある)内にある
か否かを判別する。
受信1ffl(19)を介して入力される前記割り込み
スイフチ(25)の状態に基づいて、この〔ラジコン割
り込み〕の処理が終了したか否かを判別し、処理が終了
している場合は、機体(V)の向きが直線行程の基準方
位(RASDRn)に対して設定範囲内に復帰している
か否かを判別するための不惑帯(本実施例では、前記ス
テツブ#115にて機体向きが基準方位(BASDRn
)からずれたか否かを判別するための設定範囲(SFU
KAN)と同一の約±20度に設定してある)内にある
か否かを判別する。
現在方位(NOWDIR)が、前記不惑帯(SFUKA
N)内にある場合は、自動走行を再開すべく、前記警告
灯(26)を消灯して、前記〔再生〕の処理ルーチンの
全行程終了の判別処理(ステップ11105)に復帰し
、前記不感帯(SFUKAN)外である場合は、再度、
前記警告灯(26)を作動させて、前記送信機(18)
による遠隔操縦を継続すべく作業者に報知させるために
、後述する〔ラジコン要求〕の処理に分岐スる(ステフ
ブ#402〜ステフブ#405)。
N)内にある場合は、自動走行を再開すべく、前記警告
灯(26)を消灯して、前記〔再生〕の処理ルーチンの
全行程終了の判別処理(ステップ11105)に復帰し
、前記不感帯(SFUKAN)外である場合は、再度、
前記警告灯(26)を作動させて、前記送信機(18)
による遠隔操縦を継続すべく作業者に報知させるために
、後述する〔ラジコン要求〕の処理に分岐スる(ステフ
ブ#402〜ステフブ#405)。
そして、前記ステップ#402にて割り込み処理が終了
していない場合は、前記近接センサ(S3)がONした
か否か、つまり、直線行程が終了したか否かを判別し、
前記近接センサ(S3)がONしていない場合は、前記
ステップ#401の割り込み処理終了の判別処理を繰り
返し、近接センサ(S3)がCNしている場合は、前記
〔再生〕ルーチン同様に、前記距離センサ(S4)のカ
ウント値(CNTP1)が、前記回向許可距離(KOT
EIF≦CNTPI≦KOTEIB)に達しているか否
かを判別する(ステップ11406.ステツプ1140
7)。
していない場合は、前記近接センサ(S3)がONした
か否か、つまり、直線行程が終了したか否かを判別し、
前記近接センサ(S3)がONしていない場合は、前記
ステップ#401の割り込み処理終了の判別処理を繰り
返し、近接センサ(S3)がCNしている場合は、前記
〔再生〕ルーチン同様に、前記距離センサ(S4)のカ
ウント値(CNTP1)が、前記回向許可距離(KOT
EIF≦CNTPI≦KOTEIB)に達しているか否
かを判別する(ステップ11406.ステツプ1140
7)。
前記距離センサ(S4)のカウント値(CNTP1)が
回向許可路^Uに達している場合は、前記行程フラグ(
CFLAG)の値に基づいて、次に起動すべき回向行程
が前記第2行程(ii)であるか第4行程(iv)であ
るかを判別して、行程フラグ(CFLAG)を対応する
値にセントすると共に、回向終了を判別するための反転
方位(BASDRI又はBASDR2)を設定して、行
程数(KNtlM)を減算した後、前記ステップ#40
0からの現行程が直線行程であるか回向行程であるかの
判別処理を繰り返す(ステフfl$408〜ステフブ#
413)。
回向許可路^Uに達している場合は、前記行程フラグ(
CFLAG)の値に基づいて、次に起動すべき回向行程
が前記第2行程(ii)であるか第4行程(iv)であ
るかを判別して、行程フラグ(CFLAG)を対応する
値にセントすると共に、回向終了を判別するための反転
方位(BASDRI又はBASDR2)を設定して、行
程数(KNtlM)を減算した後、前記ステップ#40
0からの現行程が直線行程であるか回向行程であるかの
判別処理を繰り返す(ステフfl$408〜ステフブ#
413)。
一方、現走行行程が、回向行程である場合は、前記基準
方位(RASDRn)に対する不感帯を回向行程での不
感帯(KFUKAN)に設定すると共に、前記ス5)ブ
#402の処理と同様の処理にて、この〔ラジコン割り
込み〕の処理が終了するまで待機する(ステフブ#41
4.ステップ#415)。
方位(RASDRn)に対する不感帯を回向行程での不
感帯(KFUKAN)に設定すると共に、前記ス5)ブ
#402の処理と同様の処理にて、この〔ラジコン割り
込み〕の処理が終了するまで待機する(ステフブ#41
4.ステップ#415)。
そして、〔ラジコン割り込み〕の処理が終了するに伴っ
て、前記現在方位(NOWDTI?)が判別方位(RA
SDIR)に対して前記不惑帯(KFUKAN)内に一
致したか否かに基づいて機体(v)向きが次の行程方向
に変化したか否かを判別し、方位が反転すると、直線行
程での基準データを再設定する〔初期化ルーチン〕の処
理を行った後、前記ステップ#400の現行程が直線行
程であるか回向行程であるかの判別処理に復帰する。−
方、〔ラジコン割り込み〕の処理が終了していても、前
記現在方位(NOWDTR)の方位が反転していない場
合は、回向行程の走行が終了するまで遠隔操縦する前記
ステップ#404の〔ラジコン要求〕の処理に分岐する
こ ととなる(ステップ11416.ステツプ#417
)。
て、前記現在方位(NOWDTI?)が判別方位(RA
SDIR)に対して前記不惑帯(KFUKAN)内に一
致したか否かに基づいて機体(v)向きが次の行程方向
に変化したか否かを判別し、方位が反転すると、直線行
程での基準データを再設定する〔初期化ルーチン〕の処
理を行った後、前記ステップ#400の現行程が直線行
程であるか回向行程であるかの判別処理に復帰する。−
方、〔ラジコン割り込み〕の処理が終了していても、前
記現在方位(NOWDTR)の方位が反転していない場
合は、回向行程の走行が終了するまで遠隔操縦する前記
ステップ#404の〔ラジコン要求〕の処理に分岐する
こ ととなる(ステップ11416.ステツプ#417
)。
前記〔ラジコン要求〕の処理について説明すれば、第8
図に示すように、前記機体(v)を非常停止させると共
に、機体(v)の上部に設けられた警告灯(26) (
第3図、第4図参照)を点灯させて、作業者に報知する
と共に、前記〔ラジコン割り込み〕の処理同様に、割り
込みが発生するまで待機する。そして、割り込みが発生
するに伴って、前記〔ラジコン割り込み〕のステップ#
400に分岐することとなる。
図に示すように、前記機体(v)を非常停止させると共
に、機体(v)の上部に設けられた警告灯(26) (
第3図、第4図参照)を点灯させて、作業者に報知する
と共に、前記〔ラジコン割り込み〕の処理同様に、割り
込みが発生するまで待機する。そして、割り込みが発生
するに伴って、前記〔ラジコン割り込み〕のステップ#
400に分岐することとなる。
従って、自動走行中に、誤動作が発生したり障害物を感
知して、機体(v)が直線行程や回向行程の途中で停止
したり、機体(V)の向きが基準方位(BASDRn)
に対して設定範囲(SFUKAN)以上ずれた場合は、
前記警告灯(26)が点灯するので、その後は、前記送
信機(18)の割り込みスイッチ(25)をONすれば
、遠隔操縦にて走行を!!:続できると共に、上述した
所定の条件を満たせば、自動走行モードに自動的に復帰
させることができるのである。尚、前記〔ラジコン割り
込み〕の処理は、正常に自動走行中であっても、前記送
信機(18)の割り込みスイッチ(25)をON操作す
れば、自動的に起動されて、遠隔操縦することができる
のは、勿論である。
知して、機体(v)が直線行程や回向行程の途中で停止
したり、機体(V)の向きが基準方位(BASDRn)
に対して設定範囲(SFUKAN)以上ずれた場合は、
前記警告灯(26)が点灯するので、その後は、前記送
信機(18)の割り込みスイッチ(25)をONすれば
、遠隔操縦にて走行を!!:続できると共に、上述した
所定の条件を満たせば、自動走行モードに自動的に復帰
させることができるのである。尚、前記〔ラジコン割り
込み〕の処理は、正常に自動走行中であっても、前記送
信機(18)の割り込みスイッチ(25)をON操作す
れば、自動的に起動されて、遠隔操縦することができる
のは、勿論である。
上記実施例では、走行距離検出手段を構成するに、変速
装置(11)の出力回転数を検出することにより走行距
離を検出する構成の距離センサ(S4)を設けるように
した場合を例示したが、例えば、車輪(3F) 、 (
3R)の回転数を検出したり、従動輪を設けて、その従
動輪の積算回転数に基づいて走行距離を検出するように
してもよく、走行距離検出手段の具体構成は各種変更で
きる。
装置(11)の出力回転数を検出することにより走行距
離を検出する構成の距離センサ(S4)を設けるように
した場合を例示したが、例えば、車輪(3F) 、 (
3R)の回転数を検出したり、従動輪を設けて、その従
動輪の積算回転数に基づいて走行距離を検出するように
してもよく、走行距離検出手段の具体構成は各種変更で
きる。
又、上記実施例では、直線行程を往復走行するぺ(18
0度回向するように構成した場合を例示したが、本発明
は、90度交差する直線行程を順次回り走行させるよう
な場合にも適用できるものであって、直線行程並びに回
向行程夫々での具体的な形態は、各種変更できる。
0度回向するように構成した場合を例示したが、本発明
は、90度交差する直線行程を順次回り走行させるよう
な場合にも適用できるものであって、直線行程並びに回
向行程夫々での具体的な形態は、各種変更できる。
又、上記実施例においては、作業車を薬剤散布作業車に
構成した場合を例示したが、本発明は、その他のコンバ
インや芝刈り作業車等の各種作業車にも適用できるもの
であって、操縦手段や制御手段並びに各種センサ等の各
部の具体構成は、本発明を適用する作業車の形態や走行
形態に応じて各種変更することになるものであって、本
実施例に限定されるものではない。
構成した場合を例示したが、本発明は、その他のコンバ
インや芝刈り作業車等の各種作業車にも適用できるもの
であって、操縦手段や制御手段並びに各種センサ等の各
部の具体構成は、本発明を適用する作業車の形態や走行
形態に応じて各種変更することになるものであって、本
実施例に限定されるものではない。
図面は本発明に係る自動走行作業車の走行制御装置の実
施例を示し、第1図は制御システムの概略構成を示すブ
ロック図、第2図は作業行程の説明図、第3図は薬剤散
布作業車の全体側面図、第4図はその平面図、第5図は
再生のフローチャート、第6図は直線終了判別のフロー
チャート、第7図はラジコン割り込み処理のフローチャ
ート、第8図はラジコン要求のフローチャートである。 (18)・・・・・・送信機、(V)・・・・・・機体
、(A)・・・・・・自動走行制御手段、(B)・・・
・・・遠隔操縦手段、(S4)・・・・・・走行距離検
出手段、(CNTP1)・・・・・・検出走行距離、(
DLENGn)・・・・・・直線行程の長さ。
施例を示し、第1図は制御システムの概略構成を示すブ
ロック図、第2図は作業行程の説明図、第3図は薬剤散
布作業車の全体側面図、第4図はその平面図、第5図は
再生のフローチャート、第6図は直線終了判別のフロー
チャート、第7図はラジコン割り込み処理のフローチャ
ート、第8図はラジコン要求のフローチャートである。 (18)・・・・・・送信機、(V)・・・・・・機体
、(A)・・・・・・自動走行制御手段、(B)・・・
・・・遠隔操縦手段、(S4)・・・・・・走行距離検
出手段、(CNTP1)・・・・・・検出走行距離、(
DLENGn)・・・・・・直線行程の長さ。
Claims (1)
- 【特許請求の範囲】 [1]複数個の直線行程と、直線行程の終端部から次の
直線行程の始端部へ機体(V)を移動させる複数個の回
向行程との夫々において、機体(V)を自動走行させる
自動走行制御手段(A)と、送信機(18)からの指示
情報に基づいて前記機体(V)の走行を制御する遠隔操
縦手段(B)とを、前記送信機(18)側から切り換え
自在に構成すると共に、前記直線行程の始端部からの走
行距離を検出する走行距離検出手段(S_4)を設け、
前記自動走行制御手段(A)を、前記走行距離検出手段
(S_4)による検出走行距離(CNTP1)が、前記
直線行程の長さ(DLENGn)に基づいて設定された
所定距離に達するに伴って、前記回向行程を自動走行さ
せる回向制御を開始すべく構成してある自動走行作業車
の走行制御装置であって、前記走行距離検出手段(S_
4)を、前記自動走行制御手段(A)と遠隔操縦手段(
B)の何れが作動している場合でも、走行距離を継続し
て検出するように構成してある自動走行作業車の走行制
御装置。 [2]前記走行距離検出手段(S_4)が、前記検出走
行距離(CNTP1)を機体(V)の前進時には加算し
、且つ、後進時には減算するように構成されている特許
請求の範囲第1項に記載の自動走行作業車の走行制御装
置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP61150429A JPS637705A (ja) | 1986-06-26 | 1986-06-26 | 自動走行作業車の走行制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP61150429A JPS637705A (ja) | 1986-06-26 | 1986-06-26 | 自動走行作業車の走行制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPS637705A true JPS637705A (ja) | 1988-01-13 |
JPH0570403B2 JPH0570403B2 (ja) | 1993-10-05 |
Family
ID=15496732
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP61150429A Granted JPS637705A (ja) | 1986-06-26 | 1986-06-26 | 自動走行作業車の走行制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS637705A (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2021045061A (ja) * | 2019-09-18 | 2021-03-25 | 井関農機株式会社 | 移植機 |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101528879B (zh) | 2006-10-23 | 2012-09-05 | 巴斯夫欧洲公司 | 包含(甲基)丙烯酸c10烷基酯的压敏粘合剂 |
-
1986
- 1986-06-26 JP JP61150429A patent/JPS637705A/ja active Granted
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2021045061A (ja) * | 2019-09-18 | 2021-03-25 | 井関農機株式会社 | 移植機 |
Also Published As
Publication number | Publication date |
---|---|
JPH0570403B2 (ja) | 1993-10-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JPS633711A (ja) | 自動走行作業車の走行制御装置 | |
JPS637705A (ja) | 自動走行作業車の走行制御装置 | |
JPS637706A (ja) | 自動走行作業車の走行制御装置 | |
JPH061407B2 (ja) | 自動走行作業車の走行制御装置 | |
JPS63157908A (ja) | 樹木間走行作業車の操向制御装置 | |
JP2662946B2 (ja) | 自立走行する車両の走行制御方法 | |
JPS62259110A (ja) | 自動走行作業車の走行制御装置 | |
JPH0218490B2 (ja) | ||
JPS62285114A (ja) | 自動走行作業車の走行制御装置 | |
JPS633710A (ja) | 自動走行作業車の走行制御装置 | |
JPS63204A (ja) | 自動走行作業車の走行制御装置 | |
JPS62297909A (ja) | 自動走行作業車の走行制御装置 | |
JPS62296805A (ja) | 自動走行作業車の走行制御装置 | |
JPS62269769A (ja) | 薬剤散布作業車の走行制御装置 | |
JPS62294003A (ja) | 自動走行作業車の走行制御装置 | |
JPS63153605A (ja) | 自動走行作業車の操向制御装置 | |
JP3533575B2 (ja) | 作業車 | |
JPH0584921B2 (ja) | ||
JPS63158152A (ja) | 薬剤散布作業車の走行制御装置 | |
JP3602592B2 (ja) | 自動薬剤散布機の回行角度検出装置 | |
JPS62265906A (ja) | 自動走行作業車の操向制御装置 | |
JPS63158153A (ja) | 薬剤散布作業車の走行制御装置 | |
JP3265404B2 (ja) | 移動農機の操向制御装置 | |
JP3430476B2 (ja) | 作業車 | |
JPH03241407A (ja) | 自動走行作業車の操向制御装置 |