JPS633710A - 自動走行作業車の走行制御装置 - Google Patents
自動走行作業車の走行制御装置Info
- Publication number
- JPS633710A JPS633710A JP61147458A JP14745886A JPS633710A JP S633710 A JPS633710 A JP S633710A JP 61147458 A JP61147458 A JP 61147458A JP 14745886 A JP14745886 A JP 14745886A JP S633710 A JPS633710 A JP S633710A
- Authority
- JP
- Japan
- Prior art keywords
- aircraft
- stroke
- control means
- turning
- travel
- 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 21
- 239000000126 substance Substances 0.000 description 13
- 230000005540 biological transmission Effects 0.000 description 8
- 238000005507 spraying Methods 0.000 description 7
- 230000007935 neutral effect Effects 0.000 description 4
- 230000008929 regeneration Effects 0.000 description 4
- 238000011069 regeneration method Methods 0.000 description 4
- 238000010586 diagram Methods 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
- 239000006185 dispersion Substances 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
- 206010011878 Deafness Diseases 0.000 description 1
- 241001124569 Lycaenidae Species 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
- 230000005389 magnetism Effects 0.000 description 1
- 230000007257 malfunction Effects 0.000 description 1
- 238000012544 monitoring process 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
【発明の詳細な説明】
〔産業上の利用分野〕
本発明は、複数個の直線行程と、直線行程の終端部から
次の直線行程の始端部へ機体を移動させる複数個の回向
行程との夫々において、機体を自動走行させる自動走行
制御手段と、送信機からの指示情報に基づいて機体の走
行を遠隔操縦する遠隔操縦手段とを、前記送信機側から
切り換え自在に構成すると共に、前記自動走行制御手段
が、前記回向行程において、予め記憶された操向制御情
報に基づいて機体を自立走行させるように構成してある
自動走行作業車の走行制御装置に関する。
次の直線行程の始端部へ機体を移動させる複数個の回向
行程との夫々において、機体を自動走行させる自動走行
制御手段と、送信機からの指示情報に基づいて機体の走
行を遠隔操縦する遠隔操縦手段とを、前記送信機側から
切り換え自在に構成すると共に、前記自動走行制御手段
が、前記回向行程において、予め記憶された操向制御情
報に基づいて機体を自立走行させるように構成してある
自動走行作業車の走行制御装置に関する。
上記この種の自動走行作業車の走行制御装置は、各種作
業を自動的に行えるように、機体を作業行程に沿って自
動走行させるべく、複数個の直線行程と、直線行程の終
端部から次の直線行程の始端部へ機体を移動させる複数
個の回向行程との夫々において、機体を自動走行させる
自動走行制御手段と、機体を自動走行し難い作業地や作
業者が搭乗して操縦するには危険な傾斜地での作業等を
安全な箇所から人為的な操作で行えるようにしたり、作
業終了後に離れた箇所にある機体を移動させる際に便利
なように、機体の走行を遠隔操作する遠隔操縦手段とを
併設したものである。
業を自動的に行えるように、機体を作業行程に沿って自
動走行させるべく、複数個の直線行程と、直線行程の終
端部から次の直線行程の始端部へ機体を移動させる複数
個の回向行程との夫々において、機体を自動走行させる
自動走行制御手段と、機体を自動走行し難い作業地や作
業者が搭乗して操縦するには危険な傾斜地での作業等を
安全な箇所から人為的な操作で行えるようにしたり、作
業終了後に離れた箇所にある機体を移動させる際に便利
なように、機体の走行を遠隔操作する遠隔操縦手段とを
併設したものである。
ところで、上記直線行程では、−般的に各種の作業を行
いながら自動走行させるために、その作業行程である直
線行程に対して機体の走行経路がずれないようにするた
めに、例えば、直線行程の始端部から終端部に至る長さ
やその方向等を走行制御情報として記憶させると共に、
それらの情報に対する機体の位置や向きの偏位を検出す
るセンサを設けて、それらセンサによる検出情報に基づ
いて、機体が直線行程に沿って自動走行するように操向
制御する手段等が、従来より採用されている。
いながら自動走行させるために、その作業行程である直
線行程に対して機体の走行経路がずれないようにするた
めに、例えば、直線行程の始端部から終端部に至る長さ
やその方向等を走行制御情報として記憶させると共に、
それらの情報に対する機体の位置や向きの偏位を検出す
るセンサを設けて、それらセンサによる検出情報に基づ
いて、機体が直線行程に沿って自動走行するように操向
制御する手段等が、従来より採用されている。
一方、回向行程では、機体を一つの直線行程の終端部か
ら次の直線行程の始端部へと移動させるために、機体の
向きが大きく変わることとなる。従って、上述した直線
行程のように、行程に対する機***置や向きの偏位を検
出するセンサを設けたとしても、その検出情報Gこよる
制御が、直線行程を走行させる場合よりも複雑になる。
ら次の直線行程の始端部へと移動させるために、機体の
向きが大きく変わることとなる。従って、上述した直線
行程のように、行程に対する機***置や向きの偏位を検
出するセンサを設けたとしても、その検出情報Gこよる
制御が、直線行程を走行させる場合よりも複雑になる。
そこで、従来では、回向行程での操向制御を簡単にする
ために、例えば、回向行程での機体の走行経路を、所定
距離毎のステアリング操作角度の情報として予めティー
チングしたり、機体の移動経路を予めパターン化した操
向制御情報を記憶させ、これら記憶された操向制御情報
を再生することにより、機体を自立走行させる手段が用
いられている。
ために、例えば、回向行程での機体の走行経路を、所定
距離毎のステアリング操作角度の情報として予めティー
チングしたり、機体の移動経路を予めパターン化した操
向制御情報を記憶させ、これら記憶された操向制御情報
を再生することにより、機体を自立走行させる手段が用
いられている。
しかしながら、回向行程を、予め記憶された操向制御情
報に基づいて自立走行させる場合は、スリ7プ等により
、記憶された操向制御情報に対する適正走行経路に対し
て機体の走行経路がずれでも、それに対するずれを検出
して補正することができないものであり、例えば、回向
行程の開始位置が適正位置から太き(ずれた状態で開始
したり、回向行程途中で機体の向きが大きくずれると、
次の直線行程の始端部に対する適正位置より大きくずれ
た位置に機体が移動する虞れがある。ところで、上述し
たように、自動走行制御手段と遠隔操縦手段とを送信機
側で切り換えできるので、このような場合には、作業者
は、回向中の機体の走行状態を監視しながら、機体の走
行経路が適正状態からずれるに伴って、自動走行制御手
段から遠隔送受手段に切り換えて、機体の位置や向きを
修正することができるのであるが、その修正が終了した
時点で、自動走行を中断した位置に機体を戻すことは非
常に困難であり、遠隔操縦により機体の位置や向きの修
正が終了した地点から自動走行に復帰させても、残りの
回向行程を予め設定した適正経路に沿って自動走行させ
ることができなくなる。従って、回向行程の途中で、遠
隔操縦手段から自動走行制御手段に復帰させると、回向
後の機***置が次の直線行程の始端部から大きくずれた
状態となり、直線行程での自動走行を適正位置から始め
られなくなる虞れがあった。
報に基づいて自立走行させる場合は、スリ7プ等により
、記憶された操向制御情報に対する適正走行経路に対し
て機体の走行経路がずれでも、それに対するずれを検出
して補正することができないものであり、例えば、回向
行程の開始位置が適正位置から太き(ずれた状態で開始
したり、回向行程途中で機体の向きが大きくずれると、
次の直線行程の始端部に対する適正位置より大きくずれ
た位置に機体が移動する虞れがある。ところで、上述し
たように、自動走行制御手段と遠隔操縦手段とを送信機
側で切り換えできるので、このような場合には、作業者
は、回向中の機体の走行状態を監視しながら、機体の走
行経路が適正状態からずれるに伴って、自動走行制御手
段から遠隔送受手段に切り換えて、機体の位置や向きを
修正することができるのであるが、その修正が終了した
時点で、自動走行を中断した位置に機体を戻すことは非
常に困難であり、遠隔操縦により機体の位置や向きの修
正が終了した地点から自動走行に復帰させても、残りの
回向行程を予め設定した適正経路に沿って自動走行させ
ることができなくなる。従って、回向行程の途中で、遠
隔操縦手段から自動走行制御手段に復帰させると、回向
後の機***置が次の直線行程の始端部から大きくずれた
状態となり、直線行程での自動走行を適正位置から始め
られなくなる虞れがあった。
本発明は、上記実情に鑑みてなされたものであって、そ
の目的は、回向行程の途中で、自動走行から遠隔操縦に
切り換えても、次の直線行程以降の行程を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)を非常停止させ
るようにしてある。
V)の前部に、接触式の障害物センサ兼用のバンパ(8
)を、障害物に接触するに伴って機体(V)後方側へ引
退して衝撃を吸収するように設けると共に、その引退作
動によってON操作されるリミットスイッチを用いた接
触センサ(So)を設けてあり、この接触センサ(So
)がON作動するに伴って、機体(V)を非常停止させ
るようにしてある。
更に、前記バンバ(8)の前面側に、非接触式の障害物
センサとしての超音波センサ(Soの3個を、第4図に
示すように、各障害物感知範囲が互いに隣接する状態で
、左右及び中央の夫々に設けてある。但し、左右に位置
する超音波センサ(S、)、(S、)夫々は、その障害
物感知情報を、機体(V)に対して左右両側に位置する
樹木(F)の間を機体(V)が走行するための操向制御
用の情報として利用できるようにするため、前記左右両
側°の樹木(F)夫々に対する距離を感知できるように
すると共に、その障害物感知範囲を、機体幅よりも外側
に拡がるように設定してある。
センサとしての超音波センサ(Soの3個を、第4図に
示すように、各障害物感知範囲が互いに隣接する状態で
、左右及び中央の夫々に設けてある。但し、左右に位置
する超音波センサ(S、)、(S、)夫々は、その障害
物感知情報を、機体(V)に対して左右両側に位置する
樹木(F)の間を機体(V)が走行するための操向制御
用の情報として利用できるようにするため、前記左右両
側°の樹木(F)夫々に対する距離を感知できるように
すると共に、その障害物感知範囲を、機体幅よりも外側
に拡がるように設定してある。
又、前記薬剤タンク(2)の上部には、地磁気を感知す
ることによって絶対方位を検出する方位センサ(S2)
を設けてあり、作業行程に対する機体(V)向きを検出
できるようにしてある。
ることによって絶対方位を検出する方位センサ(S2)
を設けてあり、作業行程に対する機体(V)向きを検出
できるようにしてある。
又、第2図に示すように、樹木(F)の間を機体(V)
が直線的に走行する直線行程の終端部を表示すべく、こ
の直線行程の終端部に位置する樹木同士の間に、鉄等の
磁性材にて形成したマーカ(a+)を埋設すると共に、
前記マーカ(m)を検出する磁気感知式の近接センサ(
S3)を、前記機体(V)の前端部下方に設けてある。
が直線的に走行する直線行程の終端部を表示すべく、こ
の直線行程の終端部に位置する樹木同士の間に、鉄等の
磁性材にて形成したマーカ(a+)を埋設すると共に、
前記マーカ(m)を検出する磁気感知式の近接センサ(
S3)を、前記機体(V)の前端部下方に設けてある。
前記機体(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
)に連動連結してある。
又、搭乗操縦用のステアリングハンドル()I)を、前
記搭乗操縦部(1)に設けてある。尚、第1図中、(S
、)は、前記変速装置(11)の出力回転数を検出する
ことにより走行距離を検出する距離センサである。
記搭乗操縦部(1)に設けてある。尚、第1図中、(S
、)は、前記変速装置(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) 、 (3R)夫
々のステアリング角度を検出するステアリング角度検出
用ポテンショメータ(R,)、(RZ)を設けてある。
ステアリング角度検出用ポテンショメータ(Ro)を、
前記ステアリングハンドル(H)にて回動操作するよう
に設けると共に、前記前後輪(3F) 、 (3R)夫
々のステアリング角度を検出するステアリング角度検出
用ポテンショメータ(R,)、(RZ)を設けてある。
又、前記変速装置(11)の変速位置を検出する変速位
置検出用ポテンショメータ(R1)を、前記変速アーム
(14)の回動操作に連動するように設けてある。そし
て、前記各ポテンショメータ(Ro)〜(R3)による
検出信号を自動走行制御手段(100)、遠隔操縦手段
(101)、並びに、搭乗操縦手段の夫々を構成する制
御装置(15)に入力してある。又、上記各操縦手段の
何れによって機体(V)の走行を制御するかを選択する
操縦モード選択用スイッチ(16)を設けてある。但し
、詳しくは後述するが、前記自動走行制御手段(100
)が作動する自動操縦モードにおいては、前記操縦モー
ド選択用スイッチ(16)を操作することなく、前記遠
隔操縦手段(101)を、自動走行制御手段(100)
に優先して作動させる状態に切り換えられるように構成
してある。
置検出用ポテンショメータ(R1)を、前記変速アーム
(14)の回動操作に連動するように設けてある。そし
て、前記各ポテンショメータ(Ro)〜(R3)による
検出信号を自動走行制御手段(100)、遠隔操縦手段
(101)、並びに、搭乗操縦手段の夫々を構成する制
御装置(15)に入力してある。又、上記各操縦手段の
何れによって機体(V)の走行を制御するかを選択する
操縦モード選択用スイッチ(16)を設けてある。但し
、詳しくは後述するが、前記自動走行制御手段(100
)が作動する自動操縦モードにおいては、前記操縦モー
ド選択用スイッチ(16)を操作することなく、前記遠
隔操縦手段(101)を、自動走行制御手段(100)
に優先して作動させる状態に切り換えられるように構成
してある。
次に、前記各操縦手段の構成について詳述する。
搭乗操縦手段の構成について説明すれば、第1図に示す
ように、前記ステアリング形式選択用スイッチ(■7)
の情報、及び、前記搭乗操縦時の目標ステアリング位置
を検出する目標ステアリング位置検出用のポテンショメ
ータ(Ro)に基づいて、前記ステアリング用油圧シリ
ンダ(9F)。
ように、前記ステアリング形式選択用スイッチ(■7)
の情報、及び、前記搭乗操縦時の目標ステアリング位置
を検出する目標ステアリング位置検出用のポテンショメ
ータ(Ro)に基づいて、前記ステアリング用油圧シリ
ンダ(9F)。
(9R)の制御弁Cl0F) 、 (IOR)の作動を
制御して、前記前後! (3F) 、 (3R)を指示
されたステアリング形式で且つ前記ステアリングハンド
ル()りに、よる目標ステアリング角度に操作すること
となる。但し、搭乗操縦時における前記変速装置(11
)の変速位置つまり車速の調整は、前記変速ペダル(1
2)にて前記変速アーム(14)を直接操作して行うこ
とになる。又、安全のために、前記変速ペダル(12)
の操作を止めると、前記変速装置(11)の変速位置が
自動的に中立状態つまり走行停止位置である変速ニュー
トラル位置(N)に復帰するように付勢して設けてある
。
制御して、前記前後! (3F) 、 (3R)を指示
されたステアリング形式で且つ前記ステアリングハンド
ル()りに、よる目標ステアリング角度に操作すること
となる。但し、搭乗操縦時における前記変速装置(11
)の変速位置つまり車速の調整は、前記変速ペダル(1
2)にて前記変速アーム(14)を直接操作して行うこ
とになる。又、安全のために、前記変速ペダル(12)
の操作を止めると、前記変速装置(11)の変速位置が
自動的に中立状態つまり走行停止位置である変速ニュー
トラル位置(N)に復帰するように付勢して設けてある
。
遠隔操縦の構成について説明すれば、遠隔操縦用の送信
機(18)から与えられる指示情報を受信する受信機(
19)を設けると共に、その受信情報に基づいて、前記
ステアリング用油圧シリンダ(9F) 、 (9R)の
制御弁(IOF) 、 (IOR)及び変速モータ(1
3)夫々の作動、並びに、前記ノズル(5)の制御弁(
5a)、ブロア(6)等の作動を制?ff1lすること
により、機体(V)の走行並びに前記薬剤散布装置(7
)の作動を、遠隔操作するようにしてある。
機(18)から与えられる指示情報を受信する受信機(
19)を設けると共に、その受信情報に基づいて、前記
ステアリング用油圧シリンダ(9F) 、 (9R)の
制御弁(IOF) 、 (IOR)及び変速モータ(1
3)夫々の作動、並びに、前記ノズル(5)の制御弁(
5a)、ブロア(6)等の作動を制?ff1lすること
により、機体(V)の走行並びに前記薬剤散布装置(7
)の作動を、遠隔操作するようにしてある。
前記送信1(18)の構成について説明すれば、第1図
に示すように、前後動によって前記変速装置(11)の
目標変速位置を指示する変速レバー(20)、及び、前
後動によってステアリング形式を指示し、且つ、左右動
によって前記前後輪(3F) 、 (3R)の目標ステ
アリング角度を指示するステアリングレバー(21)を
設けると共に、前記薬剤散布装置(7)のブロア(6)
の回転・停止を指示するプロアスイッチ(22)、前記
ノズル(5)からの薬剤噴出の作動・停止を指示するノ
ズルスイッチ(23)、機体(V)を非常停止させるた
めの指示を行う非常停止用スイッチ(24)、及び、前
記機体(V)が自動走行している時に、この送信機(1
8)に設けた前記各レバー(20) 、 (21)及び
スイッチ(22) 、 (23) 、 (24)にて機
体(V)の走行並びに薬剤散布装置(7)の作動を遠隔
操縦すべく、遠隔操縦手段(101)が自動走行制御手
段(100)に優先して作動する状態に切り換える制御
切り換え指示手段としての割り込みスイッチ(25)を
設けてある。
に示すように、前後動によって前記変速装置(11)の
目標変速位置を指示する変速レバー(20)、及び、前
後動によってステアリング形式を指示し、且つ、左右動
によって前記前後輪(3F) 、 (3R)の目標ステ
アリング角度を指示するステアリングレバー(21)を
設けると共に、前記薬剤散布装置(7)のブロア(6)
の回転・停止を指示するプロアスイッチ(22)、前記
ノズル(5)からの薬剤噴出の作動・停止を指示するノ
ズルスイッチ(23)、機体(V)を非常停止させるた
めの指示を行う非常停止用スイッチ(24)、及び、前
記機体(V)が自動走行している時に、この送信機(1
8)に設けた前記各レバー(20) 、 (21)及び
スイッチ(22) 、 (23) 、 (24)にて機
体(V)の走行並びに薬剤散布装置(7)の作動を遠隔
操縦すべく、遠隔操縦手段(101)が自動走行制御手
段(100)に優先して作動する状態に切り換える制御
切り換え指示手段としての割り込みスイッチ(25)を
設けてある。
つまり、機体(V)が自動走行制御手段(100)にて
自動走行している時に、例えば、前記超音波センサ(S
oや接触センサ(So)が車体(V)前方にある障害物
を感知したり誤動作して、機体(V)が自動停止したよ
うな場合に、作業者が機体(V)の停止位置まで行くこ
となく、前記割り込みスイッチ(25)を操作すれば、
その後は、前記送信機(18)による遠隔操縦にて、そ
の障害物を回避させることができる。又、詳しくは後述
するが、前記割り込みスイッチ(25)を切れば、自動
走行モードに自動的に復帰して、引き続き機体(V)を
自動走行させることができるようにしてある。
自動走行している時に、例えば、前記超音波センサ(S
oや接触センサ(So)が車体(V)前方にある障害物
を感知したり誤動作して、機体(V)が自動停止したよ
うな場合に、作業者が機体(V)の停止位置まで行くこ
となく、前記割り込みスイッチ(25)を操作すれば、
その後は、前記送信機(18)による遠隔操縦にて、そ
の障害物を回避させることができる。又、詳しくは後述
するが、前記割り込みスイッチ(25)を切れば、自動
走行モードに自動的に復帰して、引き続き機体(V)を
自動走行させることができるようにしてある。
但し、回向行程の途中で、自動走行制御手段(100)
から遠隔操縦手段(101)に切り換えられた場合は、
その回向行程が終了するまでは、自動走行側・御手段(
100)への復帰を禁止するようにしてある。
から遠隔操縦手段(101)に切り換えられた場合は、
その回向行程が終了するまでは、自動走行側・御手段(
100)への復帰を禁止するようにしてある。
又、安全のために、前記変速レバー(20)は、その操
作を止めると自動的に中立状態つまり変速位置が走行停
止位1である変速ニュートラル位置(N)に復帰するよ
うに付勢して設けてある。
作を止めると自動的に中立状態つまり変速位置が走行停
止位1である変速ニュートラル位置(N)に復帰するよ
うに付勢して設けてある。
次に、自動走行制御手段(100)の構成について、前
記制御装置(15)の動作を説明しながら詳述する。尚
、前記制御装置(15)は、図示を省略するが、主に、
前記超音波センサ(Sl)及び方位センサ(SZ)の検
出情報を処理する第1プロセツサ(以下、CPUIと呼
称する)、及び、前記CPUIにより処理された検出情
報や各種センサによる検出情報、並びに、前記受信機(
19)による受信情報や予め記憶設定された走行側?1
1情報等に基づいて、各種アクチュエータの作動を制御
する第2プロセツサ(以下、CPU2と呼称する)の2
つのプロセッサによって構成してある。
記制御装置(15)の動作を説明しながら詳述する。尚
、前記制御装置(15)は、図示を省略するが、主に、
前記超音波センサ(Sl)及び方位センサ(SZ)の検
出情報を処理する第1プロセツサ(以下、CPUIと呼
称する)、及び、前記CPUIにより処理された検出情
報や各種センサによる検出情報、並びに、前記受信機(
19)による受信情報や予め記憶設定された走行側?1
1情報等に基づいて、各種アクチュエータの作動を制御
する第2プロセツサ(以下、CPU2と呼称する)の2
つのプロセッサによって構成してある。
先ず、自動走行制御時における機体走行の概略を説明す
れば、第2図に示すように、作業行程の開始地点(ST
)と、この開始地点(ST)に対向する他端側に位置す
る果樹(F)の間とを結ぶ直線状の第1行程(i)、前
記他端側に位置する果樹(F)の外方側を回向して前記
直線状の第1行程(i)に対して180度逆方向に向か
う直線状の第3行程(iii )へと移動する第2行程
(+1)、及び、前記第3行程(iii )の終了後に
、前記第1行程(i)と同一方向に向かう直線状の作業
行程方向に方向転換させるために、前記第2行程(ii
)と同様にして回向させる第4行程(iw)の4つの
作業行程夫々を、前記搭乗操縦手段又は遠隔操縦手段に
て操縦しながら、各行程における前記方位センサ(SZ
)、距離センサ(S、)、及び、ステアリング角度検出
用ポテンショメータ(R,)、 (R2)によるステア
リング角度等の検出情報に基づいて、前記4つの各行程
(i)〜(iv)夫々をティーチングする。但し、本実
施例においては、第1行程(i)及び第3行程(iii
)の直線行程では、この直線行程の開始地点から前記
近接センサ(S、)が作動するまでの実際の走行距離(
DLENGn) 、1.1,2及び検出方位を平均した
基準方位(BASDRn)n−+、 zのみを、直線行
程の走行制御用情報として記憶し、第2行程(1)及び
第4行程(iv)の回向行程では、前記ステアリング角
度検出用ポテンショメータ(Il+)、(RZ)による
検出ステアリング角度を、設定距離間隔(本実施例では
、約20CI11に設定してある)毎にサンプリングす
ると共に、その値を、各回向行程(ii)、(iv)で
の走行制御用情報として記憶するようにしてある(以下
において〔ティーチング〕と呼称する)。
れば、第2図に示すように、作業行程の開始地点(ST
)と、この開始地点(ST)に対向する他端側に位置す
る果樹(F)の間とを結ぶ直線状の第1行程(i)、前
記他端側に位置する果樹(F)の外方側を回向して前記
直線状の第1行程(i)に対して180度逆方向に向か
う直線状の第3行程(iii )へと移動する第2行程
(+1)、及び、前記第3行程(iii )の終了後に
、前記第1行程(i)と同一方向に向かう直線状の作業
行程方向に方向転換させるために、前記第2行程(ii
)と同様にして回向させる第4行程(iw)の4つの
作業行程夫々を、前記搭乗操縦手段又は遠隔操縦手段に
て操縦しながら、各行程における前記方位センサ(SZ
)、距離センサ(S、)、及び、ステアリング角度検出
用ポテンショメータ(R,)、 (R2)によるステア
リング角度等の検出情報に基づいて、前記4つの各行程
(i)〜(iv)夫々をティーチングする。但し、本実
施例においては、第1行程(i)及び第3行程(iii
)の直線行程では、この直線行程の開始地点から前記
近接センサ(S、)が作動するまでの実際の走行距離(
DLENGn) 、1.1,2及び検出方位を平均した
基準方位(BASDRn)n−+、 zのみを、直線行
程の走行制御用情報として記憶し、第2行程(1)及び
第4行程(iv)の回向行程では、前記ステアリング角
度検出用ポテンショメータ(Il+)、(RZ)による
検出ステアリング角度を、設定距離間隔(本実施例では
、約20CI11に設定してある)毎にサンプリングす
ると共に、その値を、各回向行程(ii)、(iv)で
の走行制御用情報として記憶するようにしてある(以下
において〔ティーチング〕と呼称する)。
そして、上述した〔ティーチング〕を終了すると、機体
(V)を−旦前記作業行程の開始地点(ST)まで移動
させて、前記【ティーチング)にて記憶された第1行程
(i)〜第4行程(iv )の各行程での記憶情報に基
づいて機体(V)の走行を制御しながら、各行程での走
行を設定回数繰り返すことにより、各直線行程の端部に
て自動回向しながら、果樹(F)の間を往復走行させて
、所定範囲の果樹園内における薬剤散布作業を自動的に
行わせるようにしてある。つまり、上述した〔ティーチ
ング〕にてティーチングされた走行制御用情報に基づい
て機体(V)の走行を制御する自動走行制御手段(10
0)を構成してあり、その制御のための処理を以下にお
いて、〔再生〕と呼称する。
(V)を−旦前記作業行程の開始地点(ST)まで移動
させて、前記【ティーチング)にて記憶された第1行程
(i)〜第4行程(iv )の各行程での記憶情報に基
づいて機体(V)の走行を制御しながら、各行程での走
行を設定回数繰り返すことにより、各直線行程の端部に
て自動回向しながら、果樹(F)の間を往復走行させて
、所定範囲の果樹園内における薬剤散布作業を自動的に
行わせるようにしてある。つまり、上述した〔ティーチ
ング〕にてティーチングされた走行制御用情報に基づい
て機体(V)の走行を制御する自動走行制御手段(10
0)を構成してあり、その制御のための処理を以下にお
いて、〔再生〕と呼称する。
以下、上述した〔再生〕の処理について詳述する。
第5図(イ)に示すように、前記CPLJ2よりCPU
Iに対して再生モードの開始キーワードを転送すると共
に、全走行行程数を、前記直線行程の個数(KNUM)
として入力する(ステフflloo、ステフブ1110
1)。
Iに対して再生モードの開始キーワードを転送すると共
に、全走行行程数を、前記直線行程の個数(KNUM)
として入力する(ステフflloo、ステフブ1110
1)。
そして、前記〔ティーチング〕にて記憶された基準方位
(BASDRn)、この基準方位(BASDRn)に対
して設定許容差以上ずれると操向操作するための不惑帯
(FKAN2)、及び、前記超音波センサ(S、)の感
知距離区分を予め設定した区分距離(DIVL)(本実
施例では、1m以内、2m、3m。
(BASDRn)、この基準方位(BASDRn)に対
して設定許容差以上ずれると操向操作するための不惑帯
(FKAN2)、及び、前記超音波センサ(S、)の感
知距離区分を予め設定した区分距離(DIVL)(本実
施例では、1m以内、2m、3m。
4m以上の4つの距離間隔に区分してある)に夫々セン
トした後、前記〔ティーチング〕にて記憶された基準路
jiI(DLENGn)に所定距離を減算した前エリア
(KOTEIF)、前記基準距離(DLENGn)に所
定距離を加算した後エリア(KOTEIB)、及び、回
向を確実に行うために減速操作するための減速開始地点
に対応する減速距離(KOTEI2)、の夫々を算出し
て設定し、そして、実際の走行距離を計測する距離カウ
ンタの値(CNTPI)を“O”にリセットして各走行
制御情報を初期化して、現走行行程が前記第1〜第4行
程の何れの行程であるかを示す行程フラグ(CFLAG
)を、第1行程(i)を示す“1”にセントする(ステ
フブ#102〜ステフブ11104)。
トした後、前記〔ティーチング〕にて記憶された基準路
jiI(DLENGn)に所定距離を減算した前エリア
(KOTEIF)、前記基準距離(DLENGn)に所
定距離を加算した後エリア(KOTEIB)、及び、回
向を確実に行うために減速操作するための減速開始地点
に対応する減速距離(KOTEI2)、の夫々を算出し
て設定し、そして、実際の走行距離を計測する距離カウ
ンタの値(CNTPI)を“O”にリセットして各走行
制御情報を初期化して、現走行行程が前記第1〜第4行
程の何れの行程であるかを示す行程フラグ(CFLAG
)を、第1行程(i)を示す“1”にセントする(ステ
フブ#102〜ステフブ11104)。
前記ステツブ#104にて行程フラグ(CFLAG)が
セットされると、前記変速位置検出用のポテンショメー
タ(R3)の検出値に基づいて前記変速装置(11)を
操作して設定走行速度となるようにして走行を開始し、
前記ス??ブ#101にて入力された行程数(KNUM
)をチエツクすることにより、全行程を走行したか否か
を判別する(ステツブ#105)。
セットされると、前記変速位置検出用のポテンショメー
タ(R3)の検出値に基づいて前記変速装置(11)を
操作して設定走行速度となるようにして走行を開始し、
前記ス??ブ#101にて入力された行程数(KNUM
)をチエツクすることにより、全行程を走行したか否か
を判別する(ステツブ#105)。
次に、前記受信機(19)の受信情報に基づいて、前記
送信機(18)に設けた割り込みスイッチ(25)がO
N操作されたか否かをチエツクすることにより、自動走
行中に遠隔操縦モードに切り換えるためのラジコン割り
込みがあったか否かを判別すると共に、後述する直線行
程の終了を判別する〔直線終了〕の処理にてセットされ
た行程フラグ(CFLAG)の値が、前記第2行程(i
i)又は第4行程(iv)の回向行程の値(2又は4)
にセットされているか否かを判別する(ステフブ#10
6.ステフ加io’7L 但し、前記ラジコン割り込みがあった場合は、後述する
〔ラジコン割り込み〕の処理に分岐し、前記行程フラグ
(CFLAG)の値が“2”又は“4”にセントされて
いる場合は、後述する〔回向〕の処理に分岐して、前記
ス5フブ#106以降の処理を中断することとなる。
送信機(18)に設けた割り込みスイッチ(25)がO
N操作されたか否かをチエツクすることにより、自動走
行中に遠隔操縦モードに切り換えるためのラジコン割り
込みがあったか否かを判別すると共に、後述する直線行
程の終了を判別する〔直線終了〕の処理にてセットされ
た行程フラグ(CFLAG)の値が、前記第2行程(i
i)又は第4行程(iv)の回向行程の値(2又は4)
にセットされているか否かを判別する(ステフブ#10
6.ステフ加io’7L 但し、前記ラジコン割り込みがあった場合は、後述する
〔ラジコン割り込み〕の処理に分岐し、前記行程フラグ
(CFLAG)の値が“2”又は“4”にセントされて
いる場合は、後述する〔回向〕の処理に分岐して、前記
ス5フブ#106以降の処理を中断することとなる。
一方、全行程が終了せず、〔ラジコン割り込み〕も無く
、且つ、前記行程フラグ(CFLAG)が回向行程にセ
ントされていない場合は、前記CPU1から転送される
方位センサ(S2)及び超音波センサ(S+)の各検出
データの更新を確認すると共に、その検出データに基づ
いて、前記前後輪(3F) 、 (3R)を操向操作す
るためのステアリング操作量を決定して、前記ステアリ
ング用油圧シリンダ(9F) 、 (9R)の電磁弁(
IOF) 、 Cl0R)に制御信号を出力する〔操向
制御〕を行う(ス5フブ1108〜ステフブ5HO)。
、且つ、前記行程フラグ(CFLAG)が回向行程にセ
ントされていない場合は、前記CPU1から転送される
方位センサ(S2)及び超音波センサ(S+)の各検出
データの更新を確認すると共に、その検出データに基づ
いて、前記前後輪(3F) 、 (3R)を操向操作す
るためのステアリング操作量を決定して、前記ステアリ
ング用油圧シリンダ(9F) 、 (9R)の電磁弁(
IOF) 、 Cl0R)に制御信号を出力する〔操向
制御〕を行う(ス5フブ1108〜ステフブ5HO)。
その後は、前記近接センサ(S、)がONL、たか否か
をチエツクすることにより、機体(V)が直線行程の終
了地点つまり回向行程の開始地点に達したか否かを判別
すると共に、前記3つの超音波センサ(Sl)の何れか
1つでも走行前方側1m以内に障害物を感知したか否か
をチエツクする。そして、前記近接センサ(S3)がO
Nしている場合は、直線行程を終了して次の直線行程に
向けて回向するための〔直線終了〕の処理に分岐し、前
記超音波センサ(S+)が1m以内に障害物を感知した
場合は、非常停止させると共に、その後の回避を遠隔操
縦にて行うために、後述する〔ラジコン要求〕の処理に
分岐する(ステツブ11111、ステツブH12)。
をチエツクすることにより、機体(V)が直線行程の終
了地点つまり回向行程の開始地点に達したか否かを判別
すると共に、前記3つの超音波センサ(Sl)の何れか
1つでも走行前方側1m以内に障害物を感知したか否か
をチエツクする。そして、前記近接センサ(S3)がO
Nしている場合は、直線行程を終了して次の直線行程に
向けて回向するための〔直線終了〕の処理に分岐し、前
記超音波センサ(S+)が1m以内に障害物を感知した
場合は、非常停止させると共に、その後の回避を遠隔操
縦にて行うために、後述する〔ラジコン要求〕の処理に
分岐する(ステツブ11111、ステツブH12)。
次に、前記距離センサ(S、)の検出情報に基づいて走
行距離をカウントする距離カウンタの値(CNTPl)
と前記減速路41 (KOTEI2)とを比較すること
によって減速地点に達したか否かを判別し、前記減速路
fi (KOTEI2)に達している場合は、予め設定
してある走行速度となるように減速操作を行った後、前
記方位センサ(S2)による検出情報に基づいて前記C
PU 1にて判別された検出方位としての現在方位(N
OWDIR)が、現行程の基準方位(BASDRn)に
対して予め設定してある設定範囲(SFUKAN) (
本実施例では約±20度に設定してある)以上ずれてい
るか否かを判別し、現在方位(NOWDIR)が基準方
位(BASDRn)に対して設定範囲(SFIJKAN
)以上ずれている場合は、前記警告灯(26)を点灯し
て、機体(V)の向きが設定範囲(SFUKAN)以上
ずれたことを報知すると共に、その後の機体向き修正等
の操作を遠隔操縦にて行うように要求するために、後述
する〔ラジコン要求〕の処理に分岐する。但し、前記距
離カウンタの値(CNTPI)が減速距離(KOTEI
2)に達していない場合や、機体(V)の向きが前記設
定範囲(SFUKAN)以上ずれていない場合は、前記
ス5フブ1105からの処理を繰り返すこととなる(ス
テフブ#113〜ステフブ$115)。
行距離をカウントする距離カウンタの値(CNTPl)
と前記減速路41 (KOTEI2)とを比較すること
によって減速地点に達したか否かを判別し、前記減速路
fi (KOTEI2)に達している場合は、予め設定
してある走行速度となるように減速操作を行った後、前
記方位センサ(S2)による検出情報に基づいて前記C
PU 1にて判別された検出方位としての現在方位(N
OWDIR)が、現行程の基準方位(BASDRn)に
対して予め設定してある設定範囲(SFUKAN) (
本実施例では約±20度に設定してある)以上ずれてい
るか否かを判別し、現在方位(NOWDIR)が基準方
位(BASDRn)に対して設定範囲(SFIJKAN
)以上ずれている場合は、前記警告灯(26)を点灯し
て、機体(V)の向きが設定範囲(SFUKAN)以上
ずれたことを報知すると共に、その後の機体向き修正等
の操作を遠隔操縦にて行うように要求するために、後述
する〔ラジコン要求〕の処理に分岐する。但し、前記距
離カウンタの値(CNTPI)が減速距離(KOTEI
2)に達していない場合や、機体(V)の向きが前記設
定範囲(SFUKAN)以上ずれていない場合は、前記
ス5フブ1105からの処理を繰り返すこととなる(ス
テフブ#113〜ステフブ$115)。
一方、前記CPUIは、第5図(il+)に示すように
、再生モードの開始キーワードを受は取ると、〔再生〕
の処理モードにセットされ、前記3つの超音波センサ(
S+)及び方位センサ(S2)からの検出情報を設定時
間間隔(本実施例では約0.1秒に設定してある)毎に
サンプリングして現在方位(NOWDIR)を更新する
と共に、その現在方位(NOWDIR)と前記ティーチ
ングされた基準方位及び反転方位に基づいて設定された
判別方位(RASDIR)とを比較して、その偏差が前
記設定不惑帯(FLIKAN2)外にあれば、前記前後
輪(3F) 、 (3R)を操向操作するための処理又
は回向終了を判別するための処理を実行するための方位
フラグ(HFLAG)をセラ トする(ステップ115
0〜ステツプ154)。
、再生モードの開始キーワードを受は取ると、〔再生〕
の処理モードにセットされ、前記3つの超音波センサ(
S+)及び方位センサ(S2)からの検出情報を設定時
間間隔(本実施例では約0.1秒に設定してある)毎に
サンプリングして現在方位(NOWDIR)を更新する
と共に、その現在方位(NOWDIR)と前記ティーチ
ングされた基準方位及び反転方位に基づいて設定された
判別方位(RASDIR)とを比較して、その偏差が前
記設定不惑帯(FLIKAN2)外にあれば、前記前後
輪(3F) 、 (3R)を操向操作するための処理又
は回向終了を判別するための処理を実行するための方位
フラグ(HFLAG)をセラ トする(ステップ115
0〜ステツプ154)。
更に、前記3つの超音波センサ(Sl)夫々の検出信号
を、前記区分距離(DIVL)に基づいて障害物からの
距離に対応するデータ(C)iODAT)に換算して、
〔再生〕の終了を判別する(スff)加55.ステフブ
156)。
を、前記区分距離(DIVL)に基づいて障害物からの
距離に対応するデータ(C)iODAT)に換算して、
〔再生〕の終了を判別する(スff)加55.ステフブ
156)。
但し、前記ステツブ霊56にて、〔再生〕モードが終了
していない場合は、前記ステップ1152〜ステフプ1
56の処理を繰り返し行い、再生モードが終了している
場合は、前記動作モードの選択処理に復帰することとな
る。
していない場合は、前記ステップ1152〜ステフプ1
56の処理を繰り返し行い、再生モードが終了している
場合は、前記動作モードの選択処理に復帰することとな
る。
次に、前記ス5tプ11111にて近接センサ(S、)
がONするに伴って分岐する〔直線終了〕の処理につい
て説明する。
がONするに伴って分岐する〔直線終了〕の処理につい
て説明する。
すなわち、第6図に示すように、前記距離カウンタの値
(CNTPI)が前エリアCKOTEIF)及び後エリ
ア(KOTEIB)の間にあるか否かを判別することに
より、回向許可範囲内に機体(v)があるか否かを判別
し、回向許可範囲内に機体(V)がない場合は、後述す
る〔ラジコン要求〕の処理に分岐して、前記送信機(1
8)による遠隔操縦にて回向させるようにする(ステツ
ブ+1200)。
(CNTPI)が前エリアCKOTEIF)及び後エリ
ア(KOTEIB)の間にあるか否かを判別することに
より、回向許可範囲内に機体(v)があるか否かを判別
し、回向許可範囲内に機体(V)がない場合は、後述す
る〔ラジコン要求〕の処理に分岐して、前記送信機(1
8)による遠隔操縦にて回向させるようにする(ステツ
ブ+1200)。
前記距離カウンタの値(CNTPI)が回向許可範囲内
にある場合は、前記行程フラグ(CFLAG)の値に基
づいて行程フラグ(CFLAG)の値を第2行程(11
)又は第4行程(iv)を示す値(“2゛又は“4”)
に夫々セントして、回向行程の終了を判別するための反
転方位(BASDR2又はBASDRI)を設定すると
共に、前記行程数(KNOW)を減算して、前記ステツ
ブl105以降の操向制御処理に復帰する(ステフブ#
201〜ステフブ1206)。
にある場合は、前記行程フラグ(CFLAG)の値に基
づいて行程フラグ(CFLAG)の値を第2行程(11
)又は第4行程(iv)を示す値(“2゛又は“4”)
に夫々セントして、回向行程の終了を判別するための反
転方位(BASDR2又はBASDRI)を設定すると
共に、前記行程数(KNOW)を減算して、前記ステツ
ブl105以降の操向制御処理に復帰する(ステフブ#
201〜ステフブ1206)。
従って、上述した処理により前記行程フラグ(CFLA
G)の値は直線行程を示す“1”又は“3”から回向行
程を示す“2”又は“4”に変わっていることから、前
記ステップ11107の回向判別処理では、自動的に〔
回向〕の処理に分岐することとなる。
G)の値は直線行程を示す“1”又は“3”から回向行
程を示す“2”又は“4”に変わっていることから、前
記ステップ11107の回向判別処理では、自動的に〔
回向〕の処理に分岐することとなる。
次に、前記〔回向〕の処理について詳述する。
第7図に示すように、前記〔直線終了〕にてセットされ
た行程フラグ(CFLAG)の値に基づいて、前記〔テ
ィーチング〕にて記憶された第2行程(ii)又は第4
行程(iv)の何れかの記憶ステアリング角度の情報を
読み出すように設定すると共に、各回向行程での終了を
判別するための反転方位(BASDRI又はBASDI
li2)、方位の不感帯(FUKAN2)、及び、前記
超音波センサ(S+)の区分距離(DIVL)の夫々を
再設定する(ステフブ#300〜ステフブ11304)
。
た行程フラグ(CFLAG)の値に基づいて、前記〔テ
ィーチング〕にて記憶された第2行程(ii)又は第4
行程(iv)の何れかの記憶ステアリング角度の情報を
読み出すように設定すると共に、各回向行程での終了を
判別するための反転方位(BASDRI又はBASDI
li2)、方位の不感帯(FUKAN2)、及び、前記
超音波センサ(S+)の区分距離(DIVL)の夫々を
再設定する(ステフブ#300〜ステフブ11304)
。
そして、前記CPUIによる方位センサ(S2)および
超音波センサ(Sl)夫々の検出データ更新を確認した
後、その更新された各データつまり現在方位(NOWD
IR)、感知距離のデータ(CHODAT)、及び、方
位フラグ(HFLAG)を受は取る(ステツブ#305
゜ステツブ+1306)。
超音波センサ(Sl)夫々の検出データ更新を確認した
後、その更新された各データつまり現在方位(NOWD
IR)、感知距離のデータ(CHODAT)、及び、方
位フラグ(HFLAG)を受は取る(ステツブ#305
゜ステツブ+1306)。
その後、前記ステアリング位置検出用ポテンショメータ
(Rυ、 (R2)の値をサンプリングしたか否かを確
認した後、目標ステアリング角度である前記ステアリン
グ操作のティーチングデータを更新する(スラフブ聾3
07.ステフブ1I308)。
(Rυ、 (R2)の値をサンプリングしたか否かを確
認した後、目標ステアリング角度である前記ステアリン
グ操作のティーチングデータを更新する(スラフブ聾3
07.ステフブ1I308)。
次に、前記ステアリング操作用のティーチングデータを
全て出力したか否かを判別すると共に、前記方位フラグ
(HFLAG)がセントされているか否かに基づいて、
機体(v)向きが次行程方向に反転したか否かを判別す
る。そして、全ティーチングデータが出力されたか、又
は、方位フラグ()IFLAG)がセントされている場
合には、後述するステツブ1313〜ステを加319の
次の直線行程に対する各種データのセットを行う〔初期
化ルーチン〕に分岐し、前記全ティーチングデータの出
力が終了せず、且つ、前記方位フラグ(IIFLAG)
がセットされていない場合は、前記直線行程におけるラ
ジコン割り込みの有無、及び、超音波センサ(Sl)が
1m以内に障害物を感知したか否かを判別して、前記ス
テツブl305以降のティーチングデータの再生処理を
繰り返すこととなる(ステツブ1309〜ステフブ13
12)。
全て出力したか否かを判別すると共に、前記方位フラグ
(HFLAG)がセントされているか否かに基づいて、
機体(v)向きが次行程方向に反転したか否かを判別す
る。そして、全ティーチングデータが出力されたか、又
は、方位フラグ()IFLAG)がセントされている場
合には、後述するステツブ1313〜ステを加319の
次の直線行程に対する各種データのセットを行う〔初期
化ルーチン〕に分岐し、前記全ティーチングデータの出
力が終了せず、且つ、前記方位フラグ(IIFLAG)
がセットされていない場合は、前記直線行程におけるラ
ジコン割り込みの有無、及び、超音波センサ(Sl)が
1m以内に障害物を感知したか否かを判別して、前記ス
テツブl305以降のティーチングデータの再生処理を
繰り返すこととなる(ステツブ1309〜ステフブ13
12)。
前記〔初期化ルーチン〕について説明すれば、前記〔再
生〕の処理ルーチンのステップ1102〜ステフブ#1
04と同様の処理にて、前記行程フラグ(CFLAG)
の値に基づいて、走行予定距離(DLENGI、DLE
NG2)を基準に前エリア(KOTEIF)、後エリア
(KOTEIB)、及び、減速距離(KOTEI2)の
夫々を設定すると共に、前記距離カウンタの値(CNT
PI)を“0”のリセットし、次の直線行程の方向に基
づいて、前記行程フラグ(CFLAG)の値を“1”又
は“3”にセ ッ トする(ステフブ#313〜ステフ
ブD17)。
生〕の処理ルーチンのステップ1102〜ステフブ#1
04と同様の処理にて、前記行程フラグ(CFLAG)
の値に基づいて、走行予定距離(DLENGI、DLE
NG2)を基準に前エリア(KOTEIF)、後エリア
(KOTEIB)、及び、減速距離(KOTEI2)の
夫々を設定すると共に、前記距離カウンタの値(CNT
PI)を“0”のリセットし、次の直線行程の方向に基
づいて、前記行程フラグ(CFLAG)の値を“1”又
は“3”にセ ッ トする(ステフブ#313〜ステフ
ブD17)。
そして、回向行程の走行終了時における機体(V)の向
きである前記現在方位(NOWDIR)が次の直線行程
の基準方位(BASDRn)に対して設定範囲(KFt
LKAN) (本実施例では約±20度に設定してある
)内にあるか否かを判別し、現在方位(NOWDIR)
が基準方位(BASDRn)に対して設定範囲(KFU
KAN)内にある場合は、次の直線行程の基準方位(B
ASDRn)、その基準方位(RASDRn)に対する
不惑帯(FUKAN2)、及び、前記超音波センサ(S
、)に対する感知距離の区分距離(DIVL)の夫々を
設定して、前述した〔再生〕ルーチンの全行程終了の判
別処理(ステツガ105)に復帰する。但し、現在方位
(NOWDIR)が基準方位(BASDRn)に対して
設定範囲(KFUKAN)以上ずれている場合は、機体
(V)の向きが基準方位(BASDRn)からずれてい
ることを報知すると共に、その後の向き修正等を遠閑操
縦手段(B)にて行うように要求すべ(、後述する〔ラ
ジコン要求〕の処理に分岐することとなる(ステフブ#
313〜ステフブ#319)。
きである前記現在方位(NOWDIR)が次の直線行程
の基準方位(BASDRn)に対して設定範囲(KFt
LKAN) (本実施例では約±20度に設定してある
)内にあるか否かを判別し、現在方位(NOWDIR)
が基準方位(BASDRn)に対して設定範囲(KFU
KAN)内にある場合は、次の直線行程の基準方位(B
ASDRn)、その基準方位(RASDRn)に対する
不惑帯(FUKAN2)、及び、前記超音波センサ(S
、)に対する感知距離の区分距離(DIVL)の夫々を
設定して、前述した〔再生〕ルーチンの全行程終了の判
別処理(ステツガ105)に復帰する。但し、現在方位
(NOWDIR)が基準方位(BASDRn)に対して
設定範囲(KFUKAN)以上ずれている場合は、機体
(V)の向きが基準方位(BASDRn)からずれてい
ることを報知すると共に、その後の向き修正等を遠閑操
縦手段(B)にて行うように要求すべ(、後述する〔ラ
ジコン要求〕の処理に分岐することとなる(ステフブ#
313〜ステフブ#319)。
次に、前記〔ラジコン割り込み〕の処理について詳述す
る。
る。
第8図に示すように、この〔ラジコン割り込み〕の処理
が起動されるに伴って、前記機体(V)の上部に設けて
ある警告灯(26)を点灯させて、この〔ラジコン割り
込み〕の処理が起動されたことを報知すると共に、前記
行程フラグ(CFLAG)の値に基づいて、現在の走行
行程が直線行程であるか回向行程であるかを判別する(
ステツブ11400゜ステツブ1401)。
が起動されるに伴って、前記機体(V)の上部に設けて
ある警告灯(26)を点灯させて、この〔ラジコン割り
込み〕の処理が起動されたことを報知すると共に、前記
行程フラグ(CFLAG)の値に基づいて、現在の走行
行程が直線行程であるか回向行程であるかを判別する(
ステツブ11400゜ステツブ1401)。
そして、現在の走行行程が直線行程である場合は、前記
受信機(19)を介して入力される前記割り込みスイッ
チ(25)の状態に基づいて、この(ラジコン割り込み
)の処理が終了したか否かを判別し、処理が終了してい
る場合は、機体(V)の向きが直線行程の基準方位(R
ASDRn)に対して設定範囲内に復帰しているか否か
を判別するための不惑帯(本実施例では、前記ス’yフ
ブ婁115にて機体向きが基準方位(RASDRn)か
らずれたか否かを判別するための設定範囲(SFtlK
AN)と同一の約±20度に設定してある)内にあるか
否かを判別する。
受信機(19)を介して入力される前記割り込みスイッ
チ(25)の状態に基づいて、この(ラジコン割り込み
)の処理が終了したか否かを判別し、処理が終了してい
る場合は、機体(V)の向きが直線行程の基準方位(R
ASDRn)に対して設定範囲内に復帰しているか否か
を判別するための不惑帯(本実施例では、前記ス’yフ
ブ婁115にて機体向きが基準方位(RASDRn)か
らずれたか否かを判別するための設定範囲(SFtlK
AN)と同一の約±20度に設定してある)内にあるか
否かを判別する。
現在方位(NOWD IR)が、前記不感帯(SFUK
AN)内にある場合は、自動走行を再開すべく、前記警
告灯(26)を消灯して、前記〔再生〕の処理ルーチン
の全行程終了の判別処理(ステツブ11105)に復帰
し、前記不感帯(SPUKAN)外である場合は、再度
、前記警告灯(26)を作動させて、前記送信機(18
)による遠隔操縦を継続すべく作業者に報知させるため
に、〔ラジコン要求〕の処理に分岐する(ステツブ14
02〜ステフプ1405)。
AN)内にある場合は、自動走行を再開すべく、前記警
告灯(26)を消灯して、前記〔再生〕の処理ルーチン
の全行程終了の判別処理(ステツブ11105)に復帰
し、前記不感帯(SPUKAN)外である場合は、再度
、前記警告灯(26)を作動させて、前記送信機(18
)による遠隔操縦を継続すべく作業者に報知させるため
に、〔ラジコン要求〕の処理に分岐する(ステツブ14
02〜ステフプ1405)。
そして、前記ステツブ1402にて割り込み処理が終了
していないことを判別した場合は、前記近接センサ(S
3)がONしたか否か、つまり、直線行程が終了したか
否かを判別し、前記近接センサ(S3)がONL、てい
ない場合は、前記ステツブ11402の割り込み処理終
了の判別処理を繰り返し、近接センサ(S3)がONし
ている場合は、前記〔再生〕ルーチン同様に、前記距離
カウンタの値(CNTPI)が回向許可距離(KOTE
IF≦CNTPI≦KOTEIB)に達しているか否か
を判別する(ステップ+1406.ステフブ11407
)。
していないことを判別した場合は、前記近接センサ(S
3)がONしたか否か、つまり、直線行程が終了したか
否かを判別し、前記近接センサ(S3)がONL、てい
ない場合は、前記ステツブ11402の割り込み処理終
了の判別処理を繰り返し、近接センサ(S3)がONし
ている場合は、前記〔再生〕ルーチン同様に、前記距離
カウンタの値(CNTPI)が回向許可距離(KOTE
IF≦CNTPI≦KOTEIB)に達しているか否か
を判別する(ステップ+1406.ステフブ11407
)。
前記距離カウンタの値(CNTPI)が回向許可距離に
達している場合は、前記行程フラグ(CFLAG)の値
に基づいて、次に起動すべき回向行程が前記第2行程(
ii)であるか第4行程(iv)であるかを判別して、
前記行程フラグ(CFLAG)を対応する値にセントす
ると共に、反転方位(BASDRI又はBASDR2)
を設定して、行程数(KNUM)を減算した後、前記ス
テツブ+1400の現行程が直線行程であるか回向行程
であるかの判別処理を繰り返す(ステツブ1408〜ス
テフブ1413)。
達している場合は、前記行程フラグ(CFLAG)の値
に基づいて、次に起動すべき回向行程が前記第2行程(
ii)であるか第4行程(iv)であるかを判別して、
前記行程フラグ(CFLAG)を対応する値にセントす
ると共に、反転方位(BASDRI又はBASDR2)
を設定して、行程数(KNUM)を減算した後、前記ス
テツブ+1400の現行程が直線行程であるか回向行程
であるかの判別処理を繰り返す(ステツブ1408〜ス
テフブ1413)。
−方、現走行行程が、回向行程である場合は、前記基準
方位(BASDRn)に対する不感帯を回向行程での不
感帯(本実施例では、前記ステツブ#318にて機体向
きが基準方位(BASDRn)からずれたか否かを判別
するための設定範囲(KFIIKAN)と同一の約士約
20度に設定してある)に設定すると共に、前記X??
プI402の処理と同様の処理にて、この〔ラジコン割
り込み〕の処理が終了するまで待機する(ステフプ#4
14.ステフブI$415)。
方位(BASDRn)に対する不感帯を回向行程での不
感帯(本実施例では、前記ステツブ#318にて機体向
きが基準方位(BASDRn)からずれたか否かを判別
するための設定範囲(KFIIKAN)と同一の約士約
20度に設定してある)に設定すると共に、前記X??
プI402の処理と同様の処理にて、この〔ラジコン割
り込み〕の処理が終了するまで待機する(ステフプ#4
14.ステフブI$415)。
そして、〔ラジコン割り込み〕の処理が終了するに伴っ
て、前記現在方位(NOWDIR)が判別方位(RAS
DIR)に対して前記不感帯(KFUKAN)内に一致
したか否かに基づいて機体(V)向きが次の行程方向に
変化したか否かを判別し、方位が反転すると、前記〔回
向〕ルーチンにおけるスラップl313〜ス’y−yブ
#319に示す直線行程での基準データを設定する〔初
期化ルーチン〕の処理を行った後、前記ス5y加400
からの現行程が直線行程であるか回向行程であるかの判
別処理に復帰する。
て、前記現在方位(NOWDIR)が判別方位(RAS
DIR)に対して前記不感帯(KFUKAN)内に一致
したか否かに基づいて機体(V)向きが次の行程方向に
変化したか否かを判別し、方位が反転すると、前記〔回
向〕ルーチンにおけるスラップl313〜ス’y−yブ
#319に示す直線行程での基準データを設定する〔初
期化ルーチン〕の処理を行った後、前記ス5y加400
からの現行程が直線行程であるか回向行程であるかの判
別処理に復帰する。
−方、〔ラジコン割り込み〕の処理が終了していても、
前記現在方位(NOWD IR)の方位が反転していな
い場合、つまり、機体mの向きが次の直線行程の基準方
位(BASDRn)に対して設定範囲(KFuKAN)
以上ずれている場合は、回向行程の走行が終了していな
いものと判別し、この回向行程の走行が終了するまで遠
隔操縦にて機体(V)の走行を制御すべく要求するため
に、前記ステツブ1404の〔ラジコン要求〕の処理に
分岐することとなる(ステツブ+1416.ステフブ1
417)。
前記現在方位(NOWD IR)の方位が反転していな
い場合、つまり、機体mの向きが次の直線行程の基準方
位(BASDRn)に対して設定範囲(KFuKAN)
以上ずれている場合は、回向行程の走行が終了していな
いものと判別し、この回向行程の走行が終了するまで遠
隔操縦にて機体(V)の走行を制御すべく要求するため
に、前記ステツブ1404の〔ラジコン要求〕の処理に
分岐することとなる(ステツブ+1416.ステフブ1
417)。
もって、回向行程において、自動走行制御手段(100
)から遠隔操縦手段(101)に切り換えられた場合に
、この回向行程が終了するまでは、遠隔操縦手段(10
1)から自動走行制御手段(100)への復帰を禁止す
る切り換え禁止手段(102)を構成してある。
)から遠隔操縦手段(101)に切り換えられた場合に
、この回向行程が終了するまでは、遠隔操縦手段(10
1)から自動走行制御手段(100)への復帰を禁止す
る切り換え禁止手段(102)を構成してある。
前記〔ラジコン要求〕の処理について説明すれば、第9
図に示すように、前記機体(V)を非常停止させると共
に、機体(V)の上部に設けられた警告灯(2B) (
第3図、第4図参照)を点灯させて、機体(V)の向き
が設定方向から大きくずれたり、走行前方側に障害物が
あってそのままでは自動走行できないために、機体(V
)の走行を遠隔操縦に切り換えるべく、作業者に報知す
ると共に、前記〔ラジコン割り込み〕の処理同様に、割
り込みが発生するまで待機する。そして、割り込みが発
生するに伴って、前記〔ラジコン割り込み〕のステツブ
#400に分岐することとなる。
図に示すように、前記機体(V)を非常停止させると共
に、機体(V)の上部に設けられた警告灯(2B) (
第3図、第4図参照)を点灯させて、機体(V)の向き
が設定方向から大きくずれたり、走行前方側に障害物が
あってそのままでは自動走行できないために、機体(V
)の走行を遠隔操縦に切り換えるべく、作業者に報知す
ると共に、前記〔ラジコン割り込み〕の処理同様に、割
り込みが発生するまで待機する。そして、割り込みが発
生するに伴って、前記〔ラジコン割り込み〕のステツブ
#400に分岐することとなる。
従って、自動走行中に、誤動作が発生したり障害物を感
知して、機体(v)が直線行程や回向行程の途中で停止
したり、直線行程途中や回向行程終了時の機体(V)の
向きが基準方位(BASDRn)に対して設定範囲以上
ずれた場合は、前記警告灯(26)が点灯するので、そ
の後は、前記送信機(18)の割り込みスイッチ(25
)をONすれば、遠隔操縦にて走行を継続できると共に
、上述した所定の条件を満たせば、自動走行モードに自
動的に復帰させることができるのである。
知して、機体(v)が直線行程や回向行程の途中で停止
したり、直線行程途中や回向行程終了時の機体(V)の
向きが基準方位(BASDRn)に対して設定範囲以上
ずれた場合は、前記警告灯(26)が点灯するので、そ
の後は、前記送信機(18)の割り込みスイッチ(25
)をONすれば、遠隔操縦にて走行を継続できると共に
、上述した所定の条件を満たせば、自動走行モードに自
動的に復帰させることができるのである。
ちなみに、回向行程において、自動走行から遠隔操縦に
切り換えた場合に、この回向行程が終了するまで自動走
行への切り換えを禁止する手順について詳述すれば、第
1O図に示すように、機体(V)は、前記直線行程の終
端部つまり回向行程の開始地点(a)に埋設されたマー
カ(m)を感知するに伴って、予めティーチングされた
回向行程でのステアリング角度を、設定距離毎に順次再
生する〔回向〕の処理が起動されて、回向行程の走行が
開始される。そして、例えば、機体(V)が、このティ
ーチングされた回向行程の適正経路からスリップ等によ
りずれた場合に、それを修正すべく第1地点(b)にて
遠隔操縦に切り換えて、機体(V)を遠隔操縦して移動
させ、その後、回向行程途中の第2地点(c)や第3地
点(d)で、前記送信機(18)の割り込みスイッチ(
25)をOFFしても、これらの地点(c) 、 (d
)では、機体(V)の向きが次の直線行程の方向に変化
したことを判別する判別方位(RASDIR)に対して
設定不惑帯(KFUKAN)外であるために、上述した
〔ラジコン割り込み〕の処理が終了せず、自動走行制御
手段(100)への切り換えが禁止されるのである。そ
して、機体(V)の向きが次の直線行程の方向に変化し
たことを判別する判別方位(RASDIR)に対して設
定不惑帯(KFUKAN)内となる回向終了地点とみな
して問題がない第4地点(e)まで移動して、その状態
で前記送信機(18)の割り込みスイッチ(25)をO
FFすれば、自動的に、次の直線行程での走行が開始さ
れ、その後は、直線行程と回向行程とを自動的に交互に
自動走行させることができるのである。
切り換えた場合に、この回向行程が終了するまで自動走
行への切り換えを禁止する手順について詳述すれば、第
1O図に示すように、機体(V)は、前記直線行程の終
端部つまり回向行程の開始地点(a)に埋設されたマー
カ(m)を感知するに伴って、予めティーチングされた
回向行程でのステアリング角度を、設定距離毎に順次再
生する〔回向〕の処理が起動されて、回向行程の走行が
開始される。そして、例えば、機体(V)が、このティ
ーチングされた回向行程の適正経路からスリップ等によ
りずれた場合に、それを修正すべく第1地点(b)にて
遠隔操縦に切り換えて、機体(V)を遠隔操縦して移動
させ、その後、回向行程途中の第2地点(c)や第3地
点(d)で、前記送信機(18)の割り込みスイッチ(
25)をOFFしても、これらの地点(c) 、 (d
)では、機体(V)の向きが次の直線行程の方向に変化
したことを判別する判別方位(RASDIR)に対して
設定不惑帯(KFUKAN)外であるために、上述した
〔ラジコン割り込み〕の処理が終了せず、自動走行制御
手段(100)への切り換えが禁止されるのである。そ
して、機体(V)の向きが次の直線行程の方向に変化し
たことを判別する判別方位(RASDIR)に対して設
定不惑帯(KFUKAN)内となる回向終了地点とみな
して問題がない第4地点(e)まで移動して、その状態
で前記送信機(18)の割り込みスイッチ(25)をO
FFすれば、自動的に、次の直線行程での走行が開始さ
れ、その後は、直線行程と回向行程とを自動的に交互に
自動走行させることができるのである。
尚、前記〔ラジコン割り込み〕の処理は、正常に自動走
行中であっても、前記送信機(18)の割り込みスイッ
チ(25)をON操作すれば、自動的に起動されて、遠
隔操縦することができるのは、勿論である。
行中であっても、前記送信機(18)の割り込みスイッ
チ(25)をON操作すれば、自動的に起動されて、遠
隔操縦することができるのは、勿論である。
上記実施例では、報知手段として、警告灯を、設けた場
合を例示したが、警報器等を設けてもよい。又、遠隔操
縦用の送信機側に報知手段を設けて、機体向きがずれた
ことを報知するようにしてもよく、報知手段の具体構成
は各種変更できる。
合を例示したが、警報器等を設けてもよい。又、遠隔操
縦用の送信機側に報知手段を設けて、機体向きがずれた
ことを報知するようにしてもよく、報知手段の具体構成
は各種変更できる。
又、上記実施例では、直線行程を往復走行するべく18
0度回向するように構成した場合を例示したが、本発明
は、90度交差する直線行程を順次回り走行させるよう
な場合にも適用できるものであって、直線行程並びに回
向行程夫々での具体的な形態は、各種変更できる。
0度回向するように構成した場合を例示したが、本発明
は、90度交差する直線行程を順次回り走行させるよう
な場合にも適用できるものであって、直線行程並びに回
向行程夫々での具体的な形態は、各種変更できる。
又、上記実施例においては、作業車を薬剤散布作業車に
構成した場合を例示したが、本発明は、その他のコンバ
インや芝刈り作業車等の各種作業車にも適用できるもの
であって、操縦手段や制御手段並びに各種センサ等の各
部の具体構成は、本発明を適用する作業車の形態や走行
形態に応じて各種変更することになるものであって、本
実施例に限定されるものではない。
構成した場合を例示したが、本発明は、その他のコンバ
インや芝刈り作業車等の各種作業車にも適用できるもの
であって、操縦手段や制御手段並びに各種センサ等の各
部の具体構成は、本発明を適用する作業車の形態や走行
形態に応じて各種変更することになるものであって、本
実施例に限定されるものではない。
図面は本発明に係る自動走行作業車の走行制御装置の実
施例を示し、第1図は制御システムの概略構成を示すプ
ロ7り図、第2図は作業行程の説明図、第3図は薬剤散
布作業車の全体側面図、第4図はその平面図、第5図(
() 、 (Il+)は再生のフローチャート、第6図
は直線終了判別のフローチャート、第7図は回向処理の
フローチャート、第8図はラジコン割り込み処理のフロ
ーチャート、第9図はラジコン要求のフローチャート、
第10図はラジコン割り込み処理の説明図である。 (18)・・・・・・送信機、(V)・・・・・・機体
、(100)・・・・・・自動走行制御手段、(101
)・・・・・・遠隔操縦手段、(102)・・・・・・
切り換え禁止手段。
施例を示し、第1図は制御システムの概略構成を示すプ
ロ7り図、第2図は作業行程の説明図、第3図は薬剤散
布作業車の全体側面図、第4図はその平面図、第5図(
() 、 (Il+)は再生のフローチャート、第6図
は直線終了判別のフローチャート、第7図は回向処理の
フローチャート、第8図はラジコン割り込み処理のフロ
ーチャート、第9図はラジコン要求のフローチャート、
第10図はラジコン割り込み処理の説明図である。 (18)・・・・・・送信機、(V)・・・・・・機体
、(100)・・・・・・自動走行制御手段、(101
)・・・・・・遠隔操縦手段、(102)・・・・・・
切り換え禁止手段。
Claims (1)
- 複数個の直線行程と、直線行程の終端部から次の直線行
程の始端部へ機体(V)を移動させる複数個の回向行程
との夫々において、機体(V)を自動走行させる自動走
行制御手段(100)と、送信機(18)からの指示情
報に基づいて機体(V)の走行を遠隔操縦する遠隔操縦
手段(101)とを、前記送信機(18)側から切り換
え自在に構成すると共に、前記自動走行制御手段(10
0)が、前記回向行程において、予め記憶された操向制
御情報に基づいて機体(V)を自立走行させるように構
成してある自動走行作業車の走行制御装置であって、前
記回向行程において、前記機体(V)の走行制御が、自
動走行制御手段(100)から遠隔操縦手段(101)
に切り換えられた場合は、前記回向行程が終了するまで
は、前記遠隔操縦手段(101)から自動走行制御手段
(100)への切り換えを禁止する切り換え禁止手段(
102)を設けてある自動走行作業車の走行制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP61147458A JPS633710A (ja) | 1986-06-24 | 1986-06-24 | 自動走行作業車の走行制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP61147458A JPS633710A (ja) | 1986-06-24 | 1986-06-24 | 自動走行作業車の走行制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPS633710A true JPS633710A (ja) | 1988-01-08 |
Family
ID=15430817
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP61147458A Pending JPS633710A (ja) | 1986-06-24 | 1986-06-24 | 自動走行作業車の走行制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS633710A (ja) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0386410U (ja) * | 1989-12-16 | 1991-09-02 | ||
JP2022085684A (ja) * | 2020-11-27 | 2022-06-08 | 株式会社クボタ | 作業機 |
-
1986
- 1986-06-24 JP JP61147458A patent/JPS633710A/ja active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0386410U (ja) * | 1989-12-16 | 1991-09-02 | ||
JP2022085684A (ja) * | 2020-11-27 | 2022-06-08 | 株式会社クボタ | 作業機 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US5079706A (en) | Control system for self-propelled working vehicle including vehicle course correction means | |
JPS633711A (ja) | 自動走行作業車の走行制御装置 | |
JPS633710A (ja) | 自動走行作業車の走行制御装置 | |
JPS637706A (ja) | 自動走行作業車の走行制御装置 | |
JPS62259110A (ja) | 自動走行作業車の走行制御装置 | |
JPS63157908A (ja) | 樹木間走行作業車の操向制御装置 | |
JPS62296805A (ja) | 自動走行作業車の走行制御装置 | |
JPS637705A (ja) | 自動走行作業車の走行制御装置 | |
JPH0218490B2 (ja) | ||
JPH061407B2 (ja) | 自動走行作業車の走行制御装置 | |
JPS62285114A (ja) | 自動走行作業車の走行制御装置 | |
JPS63204A (ja) | 自動走行作業車の走行制御装置 | |
JPS62265906A (ja) | 自動走行作業車の操向制御装置 | |
JPS63153605A (ja) | 自動走行作業車の操向制御装置 | |
JPS62297909A (ja) | 自動走行作業車の走行制御装置 | |
JPS62294003A (ja) | 自動走行作業車の走行制御装置 | |
JPS62269769A (ja) | 薬剤散布作業車の走行制御装置 | |
JPS62248011A (ja) | 作業車の走行制御装置 | |
JP3602592B2 (ja) | 自動薬剤散布機の回行角度検出装置 | |
JPS63158153A (ja) | 薬剤散布作業車の走行制御装置 | |
JP2571238B2 (ja) | 自動走行式芝刈り作業車の操向制御装置 | |
JPS63153608A (ja) | 作業車の操向制御装置 | |
JP3005151B2 (ja) | ビーム光誘導式作業車の走行制御装置 | |
JPS63298114A (ja) | 作業車用の測距装置 | |
JPH01109413A (ja) | 自動走行作業車の操向制御装置 |