JPS62248011A - 作業車の走行制御装置 - Google Patents

作業車の走行制御装置

Info

Publication number
JPS62248011A
JPS62248011A JP61092840A JP9284086A JPS62248011A JP S62248011 A JPS62248011 A JP S62248011A JP 61092840 A JP61092840 A JP 61092840A JP 9284086 A JP9284086 A JP 9284086A JP S62248011 A JPS62248011 A JP S62248011A
Authority
JP
Japan
Prior art keywords
control
control means
stroke
steering
remote control
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
Application number
JP61092840A
Other languages
English (en)
Other versions
JPH0584921B2 (ja
Inventor
Tetsuo Yamaguchi
哲雄 山口
Katsumi Ito
勝美 伊藤
Shingo Yoshimura
吉村 慎吾
Shigeaki Okuyama
奥山 恵昭
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Kubota Corp
Original Assignee
Kubota Corp
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Kubota Corp filed Critical Kubota Corp
Priority to JP61092840A priority Critical patent/JPS62248011A/ja
Publication of JPS62248011A publication Critical patent/JPS62248011A/ja
Publication of JPH0584921B2 publication Critical patent/JPH0584921B2/ja
Granted legal-status Critical Current

Links

Landscapes

  • Steering Controls (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。

Description

【発明の詳細な説明】 〔産業上の利用分野〕 本発明は、機体を作業行程に沿って自動走行させる自動
走行制御手段と、送信機からの指示情報に基づいて前記
機体の走行を制御する遠隔操縦手段とを、切り換え自在
に設けた作業車の走行制御装置に関する。
〔従来の技術〕
上記この種の作業車の走行制御装置は、例えば、自走式
コンバインや自動芝刈り作業車等のように、圃場に植立
された茎稈や未刈り芝等の作業対象に沿って自動走行し
なから刈取作業を行ったり、又、薬剤散布作業車等のよ
うに作業者が搭乗して運転するには薬害が問題となるよ
うな悪い作業環境での作業を、作業対象の樹木に沿って
自動走行させることによって自動的に行えるようにする
ために、作業車を作業行程に沿って自動走行させる自動
走行制御手段を設けると共に、例えば、機体転倒の虞れ
がある傾斜地等の作業者が搭乗して運転し難い状況では
あるが、同時に、自動走行させ難い場合等に対応するた
めに、作業者が搭乗することなく作業車の走行を制御で
きる遠隔操縦手段を併設したものである。
そして、上記自動走行制御手段と遠隔操縦手段の何れの
手段によって作業車の走行を制御するかを切り換えるに
、従来では、例えば、作業車の操作パネルに切り換えス
インチ等を設けて、何れか一方の手段を択一的に選択使
用するようにしていた。
〔発明が解決しようとする問題点〕
しかしながら、上記作業車においては、例えば、予め設
定した走行制御情報や作業行程を検出するセンサ等の情
報Gこ基づいて自動走行させることから、自動走行中の
安全性を確保するために、自動走行中は外部から作業車
を操作できないようにすると共に、上記センサ等が誤動
作したり走行経路の前方に障害物があると、自動走行制
御を停止させて機体が自動停止するようにしである。従
って、機体が自動停止した後は自動走行制御手段によっ
ては、走行を継続させることができないので、停止原因
となった異常や障害を除いたり、作業車側の切り換えス
イッチを操作して自動走行から遠隔操縦へ切り換え操作
するためには、作業者が機体の停止位置まで行く必要が
生じる。ところが、機体は自動走行していることから、
作業者位置と機体位置とが離れていることが多く、上記
自動停止した作業車の走行を再開させるまでに時間が掛
かり作業効率が低下する不利がある。
本発明は、上記実情に鑑みてなされたものであって、そ
の目的は、自動走行制御手段と遠隔操縦手段の切り換え
操作の操作性を改善することによって、作業車の走行制
御を効率良く行えるようにすることにある。
〔問題点を解決するための手段〕
本発明による作業車の走行制御装置の特徴構成は、前記
自動走行制御手段と遠隔操縦手段との切り換えを指示す
る制御切り換え指示手段を、前記送信機側に設けてある
点にあり、その作用並びに効果は以下の通りである。
〔作 用〕
すなわち、自動走行制御手段と遠隔操縦手段との切り換
えを指示する制御切り換え指示手段を、遠隔操縦用の送
信機側に設けてあるので、自動走行と遠隔操縦の何れの
手段で作業車の走行を制御するかを、作業車から離れた
位置から切り換えることができる。
〔発明の効果〕
従って、制御手段の切り換え操作を移動車から離れた位
置から行うことができるので、例えば、単なる誤動作や
人為的な操作であれば容易に回避できる障害物等によっ
て作業車が自動停止したり、誤動作により所定の作業行
程から走行方向がずれたりしたような場合、その自動停
止した作業車を再発進させて移動させたり、走行方向を
修正したりするための操作を、機体から離れた位置から
、容易に且つ効率良く行うことができる。
〔実施例〕
以下、本発明の実施例を図面に基づいて説明する。
第4図及び第5図に示すように、自動走行、遠隔操縦(
ラジコン)、並びに、搭乗操縦(手動)の何れをも可能
な機体(V)の前方側に、エンジン(E)及び搭乗操縦
部(1)を設けると共に、機体(V)の後方側に、外装
カバー(2a)を備えた薬剤タンク(2)を搭載しであ
る。そして、機体(V)下部に設けたポンプ(4)によ
って前記薬剤タンク(2)から供給される薬剤を多数の
ノズル(5)から噴出させ、ブロア(6)による送風に
よって飛散させる薬剤散布装置(7)を、前記薬剤タン
ク(2)の後方側に付設して、主に果樹園等にて果樹間
を走行しながら薬剤散布を行うための作業車を構成して
あり、第6図に示すように、各直線状の作業行程の端部
に位置する樹木の外側にて隣接する次の直線状の作業行
程の方向に回向させながら樹木間を往復走行して、薬剤
散布を行うようにしである。
前記機体(V)の構成について説明すれば、前記機体(
V)の前部に、接触式の障害物センサ兼用のバンパ(8
)を、障害物に接触するに伴って機体(V)後方側へ引
退して衝撃を吸収するように設けると共に、その引退作
動によってON操作されるリミットスイッチを用いた接
触センサ(So)を設けてあり、この接触センサ(So
)がON作動するに伴って、機体(V)を非常停止させ
るようにしである。
更に、前記パンパ(8)の前面側に、非接触式の障害物
センサとしての超音波センサ(Sl)の3個を、第5図
に示すように、各障害物感知範囲が互いに隣接する状態
で、左右及び中央の夫々に設けてある。但し、左右に位
置する超音波センサ(Sυ、(S+)夫々は、その障害
物感知情報を、機体(V)に対して左右両側に位置する
樹木(F)の間を機体(V)が走行するための操向制御
用の情報として利用できるようにするため、前記左右両
側の樹木(F)夫々に対する距離を感知できるようにす
ると共に、その障害物感知範囲を、機体幅よりも左右に
拡がるように設定しである。
又、前記薬剤タンク(2)の上部には、90度交差して
巻回された2つのコイルによって地磁気を感知すること
により絶対方位を検出する方位センサ(St)を設けて
あり、作業行程に対する機体(V)向きを検出できるよ
うにしである。
又、第6図に示すように、樹木CF)の間を機体(V)
が直線的に走行する直線行程の終端部を表示すべく、こ
の直線行程の終端部に位置する樹木同士の間に、鉄等の
磁性材にて形成したマーカ(m)を埋設すると共に、前
記マーカ(m)を検出する磁気恩知式の近接センサ(S
3)を、前記機体(V)の前端部下方に設けてある。
前記機体(V)の走行系の構成について説明すれば、第
3図に示すように、左右一対の前輪(3F)及び後輪(
3R)を設けると共に、それら一対の前後輪(3F) 
、 (31?)を各別に操作するステアリング操作用の
油圧シリンダ(9F) 、 (9R) 、及び、それに
対する制御弁(IOP) 、 (IOR)を設けてある
又、前後進切り換え自在で且つ前進変速並びに後進変速
自在な油圧式無段変速装置(11)を、前記エンジン(
E)に連動連結すると共に、前記変速装置(11)の出
力にて、前記前後輪(3F) 、 (3R)を同時に駆
動するように構成しである。そして、搭乗操縦用の変速
ペダル(12)及び遠隔操縦用の変速アクチュエータと
しての変速モータ(13)を、その何れによっても変速
操作可能に、前記変速装置(11)の変速アーム(14
)に連動連結しである。
又、搭乗操縦用のステアリングハンドル(11)を、前
記搭乗操縦郡部(1)に設けてある。尚、第3図中、(
S4)は、前記変速装置(11)の出力回転数を検出す
ることにより走行距離を検出する距離センサである。
前記一対の前後輪(3F) 、 (3R)を向き変更さ
せて操向させるに、前後輪(3F) 、 (3R)を同
一方向に操向操作して機体(V)を平行移動させる平行
ステアリング形式、前後輪(3F) 、 (3R)を逆
方向に操向操作して機体(V)を急旋回させる4輪ステ
アリング形式、通常の自動車同様に前輪(3F)のみを
操向操作する2輪ステアリング形式を選択使用できるよ
うに構成しである。
そして、遠隔操縦時には、前記平行ステアリング形式と
4輪ステアリング形式とを選択できるように、且つ、搭
乗操縦時には、平行ステアリング形式、4輪ステアリン
グ形式、及び、2輪ステアリング形式の何れかを選択で
きるように構成しである。但し、自動走行時には、前記
各ステアリング形式の切り換えは自動的に行われると共
に、前後輪(3F) 、 (3R)の操向量に差を付け
て操向することにより、機体(V)向きを変えながら平
行移動させることもできるようにしである。
又、搭乗操縦時の目標ステアリング角度を検出する目標
ステアリング角度検出用ポテンショメータ(Ro)を、
前記ステアリングハンドル(H)にて回動操作するよう
に設けると共に、前記前後輪(3F) 、 (3R)夫
々のステアリング角度を検出するステアリング角度検出
用ポテンショメータ(R+)、(Rz)を設けてある。
又、前記変速装置(11)の変速位置を検出する変速位
置検出用ポテンショメータ(R3)を、前記変速アーム
(14)の回動操作に連動するように設けてある。そし
て、前記各ポテンショメータ(Re)〜(R8)による
検出信号を自動走行制御手段(^)、遠隔操縦手段(B
)、並びに、搭乗操縦手段の夫々を構成する制御装置(
15)に入力しである。又、上記各操縦手段の何れによ
って機体(ν)の走行を制御するかを選択する操縦モー
ド選択用スイッチ(16)を設けてある。但し、詳しく
は後述するが、前記自動走行制御手段(A)が作動する
自動操縦モードにおいては、前記操縦モード選択用スイ
ッチ(16)を操作することなく、前記遠隔操縦手段(
B)を、自動走行制御手段(八)に優先して作動させる
状態に切り換えられるように構成しである。
前記制御装置(15)の構成について説明すれば、第1
図(イ)に示すように、主に、前記3つの超音波センサ
(Sl)、及び、方位センサ(S2)による検出情報に
基づいて、作業行程に対する機体(V)の位置や向きに
関する情報を判別処理する第1プロセツサ(28) (
以下、CP U 1 (28)と呼称する)と、前記各
種センサ(So)〜(S4)による検出情報、遠隔操縦
用の送信機(18)からの指示情報を受信する受信機(
19)の受信情報、前記CPU1(2帥にて判別処理さ
れた情報、及び、予め記憶設定された各種走行制御情報
に基づいて、機体(V)の走行を制御する第2プロセツ
サ(29) (以下、CP U 2 (29)と呼称す
る)の2つのプロセッサを設けてあり、これら2つのプ
ロセッサ間で情報交換させながら、前記ステアリング用
油圧シリンダ(9F) 、 (9R)の制御弁(10F
) 、 (IOR)、ノズル(5)の開閉用制御弁(5
a)、プロア(6)の駆動回路(6a)、前記ノズル(
5)の開閉用制御弁(5a)が閉じている場合に前記ポ
ンプ(4)から送出される薬液を薬剤タンク(2)に戻
すための戻し弁(30)、及び、前記変速モータ(13
)等の各種アクチュエータを自動的に操作するように構
成しである。
又、前記方位センサ(S2)の出力信号をA/D変換し
ながら、設定時間毎に検出方位をサンプリングして前記
CP U 1 (28)に入力するA/D変換器(31
)、及び、設定時間毎に繰り返し前記3つの超音波セン
サ(Sυ夫々の超音波発信用の送信器(a)の駆動を行
うと共に、反射超音波を受信する受信機(、b)の受信
信号を処理して、障害物までの距離情報に変換する第1
カウンタ(32)を設けると共に、設定時間経過毎に、
前記CP U 1 (28)及びCP U 2 (29
)の両方に、夫々の処理情報を交換したり、前記各セン
サ(So)〜(S4)による検出信号のサンプリング処
理を起動したりするための時間割り込み信号を送出する
と共に、前記距離センサ(S4)による検出情報に基づ
いて走行距離に対応する情報に変換する第2カウンタ(
33)、及び、前記CP U 1 (2B)及びCP 
tJ 2 (29)の間で情報を交換するための一対の
データ転送用インターフェース(34) 、 (34)
の夫々を設けてある。
又、前記送信機(18)からの指示情報を受信する受信
機(19)から出力される各チャネルの信号を復調する
F/V変換器(35)、前記受信機(19)の受信状態
を監視して受信レベルが設定レベル以下に低下する等の
受信異常が発生すると受信異常信号(Pa)を出力する
受信異常検出回路(36)、及び、前記F/V変換器(
35)の出力をA/D変換すると共に、前記ステアリン
グハンドル(T()以外の各ポテンショメータ(R1)
〜(R1)の出力をA/D変換するA/D変換器(37
)を設けてある。
そして、前記CP U 2 (29)では、前記一対の
データ転送用インター・フェース(34) 、 (34
)を介して伝達されるC P U 1 (28)からの
情報、前記F/V変換器(35)に接続されたA/D変
換器(37)やスイッチ入力インターフェース(38)
を介して入力される前記搭乗操縦部(1)に設けられた
前記操縦モード選択用スイッチ(16)やステアリング
形式選択用スイッチ(17)等の各種操作スイッチから
の情報、前記接触センサ(So)や近接センサ(S、)
からの検出情報、及び、予め記憶設定された情報に基づ
いて、機体(V)の操作状態を判別して、D/A変換器
(39)を介して前記変速モータ(13)を駆動する信
号を出力すると共に、前記各種アクチュエータの作動を
制御するための各種制御信号を、自動用出力インターフ
ェース(40)を介して出力するように構成しである。
又、第1図(ハ)に示すように1、前記油圧シリンダ(
9F) 、 (9R)の制御弁(IOF) 、 (IO
R)、走行ブレーキ作動用制御弁(42)、前記後輪(
3R)の差動回転を停止させるデフロック用制御弁(4
3)の夫々を、前記自動走行制御手段(A)、遠隔操縦
手段(B)、及び、搭乗操縦手段の何れによって操作す
るかを、前記自動用出力インターフェース(40)を介
して出力される制御信号に基づいて切り換える走行系ア
クチュエータの切り換え回路(41)を設けてあり、前
記受信異常検出回路(36)から受信異常信号(Pa)
が出力された場合や、前記接触センサ(So)が作動し
たり超音波センサ(Sl)が設定距離(本実施例では約
1mに設定しである)以内に障害物を感知した場合に非
常停止信号(Pb)が出力された場合に、ORゲート(
G2)を介して出力される禁止信号(Pc)にて、前記
各アクチエータの作動を走行停止側の安全状態に切り換
えられるようにしである。
又、第1図([1)に示すように、前記走行系アクチュ
エータの切り換え回路(41)と同様にして、前記ノズ
ル(5)の制御弁(5a)、プロア(6)の駆動回路(
6a)、及び、戻し弁(30)等の各作業装置系アクチ
ュエータの夫々を、前記自動走行制御手段(A)、遠隔
操縦手段CB)、及び、搭乗操縦手段の何れによって操
作するかを、前記自動用出力インターフェース(40)
を介して出力される制御信号に基づいて切り換えると共
に、前記ORゲ−) (G2)を介して出力される禁止
信号(Pc)が入力されると、前記各作業装置系アクチ
ュエータの夫々を、安全側の停止状態に切り換えるため
の作業装置系アクチュエータの切り換え回路(44)を
設けてある。
但し、前記ノズル(5)の制御弁(5a)は、搭乗操縦
時には、機体(V)に対して左右及び上部の各3方向に
位置するノズル(5)の開閉を、各別に行えるように、
且つ、遠隔操縦時及び自動走行時には、全てのノズル(
5)を同時に開閉操作するようにしである。そして、前
記ノズル(5)の制御弁(5a)全てがOFF状態にあ
る時には、前記戻し弁(30)が自動的にONするよう
に、前記ノズル(5)の制御弁(5a)を駆動する各信
号出力を、NORゲー)(GOを介して前記戻し弁(3
0)の駆動信号入力側に接続しである。
尚、第1図(イ)中、(45)は、前記変速モータ(1
3)の駆動回路であって、前記変速位置検出用のポテン
ショメータ(R3)の出力と、前記D/A変換器(39
)又は前記F/V変換器(35)から出力される目標変
速位置の指示情報とを比較して偏差を演算する差動増幅
器(A1)、及び、その偏差に基づいて電源をパルス幅
変調方式(PWM方式)にて変調して前記モータ(10
)に供給する電力増幅器(46)、及び、前記差動増幅
器(^、)への目標変速位置情報を、自動走行及び遠隔
操縦夫々に対応して切り換えると共に、非常時等に自動
的に走行停止させるための変速ニュートラル電圧に切り
換えるための変速切り換え回路(47)を設けてある。
又、(48)は、前記変速位置検出用のポテンショメー
タ(R3)の出力に基づいて、前記変速装置(11)が
変速ニュートラル位置(N)に対して設定許容差内にあ
るか否かを判別して、設定許容差内にある場合に機体(
V)が移動しないように強制停止させるべく、前記走行
ブレーキ作動用の電磁弁(42)を作動させるニュート
ラル判別回路である。
又、(49F)は、前記前輪側のステアリング用油圧シ
リンダ(9F)の電磁弁(IOF)を駆動するための前
輪用電磁弁駆動回路であって、目標ステアリング角度と
、前記前輪(3F)のステアリング角度検出用ポテンシ
ョメータ(R1)の出力信号とを比較してその偏差を演
算する差動増幅器(A、)と、その偏差が設定許容差外
になるに伴って、前記油圧シリンダ(9F)を左右に操
作するための制御信号を出力する一対のコンパレータ(
At) 。
(At)を設けてある。但し、前記差動増幅器(A1)
に入力される目標ステアリング角度情報は、前輪用ステ
アリング切り換え回路(50F)にて、前記CP U 
2 (29)より自動用出力インターフェース(40)
を介して出力される切り換え信号に基づいて、搭乗操縦
時には前記ステアリングハンドル(H)の操作位置を検
出するポテンショメータ(Ro)からの情報に、°且つ
、遠隔操縦時には前記F/V変換器(35)を介して出
力される情報に、夫々自動的に切り換えられるようにし
である。
又、(49R)は、前記前輪用電磁弁駆動回路(49F
)と同様の構成になる後輪用電磁弁駆動回路であって、
後輪用ステアリング切り換え回路(50R)にて切り換
え出力される目標ステアリング角度情報と後輪用のステ
アリング角度検出用ポテンショメータ(R2)の出力と
を比較して、後輪用電磁弁(IOR)を駆動する信号を
出力すべ(構成しである。但し、この後輪用電磁弁駆動
回路(49R)は、ステアリング形式が4輪ステアリン
グ形式を選択された場合は、前記後輪用ステアリング切
り換え回路(50R)から出力される目標ステアリング
角度情報を、反転増幅器(^3)にてニュートラル位置
に対する極性を反転して入力するようにしである。そし
て、前記後輪用ステアリング切り換え回路(50R)は
、2輪ステアリング形弐の場合には、前記後輪(3R)
を中立位置つまりニュートラル位置に固定すべく、目標
ステアリング角度情報がニュートラル位置に対応する情
報に切り換えられるようにしである。
又、(51)は、前記ニュートラル判別回路(48)と
同様構成になるデフロツタ判別回路であって、前記前輪
(3F)のステアリング角度が、操向中立位置に対して
設定許容差内にある場合に、前記デフロック用制御弁(
43)を作動させて、前記後輪(3R)の差動回転を停
止させるように構成しである。
次に、前記各操縦手段の構成について詳述する。
搭乗操縦手段の構成について説明すれば、第1図及び第
3図に示すように、前記ステアリング形式選択用スイッ
チ(17)の情報、及び、前記搭乗操縦時の目標ステア
リング位置を検出する目標ステアリング位置検出用のポ
テンショメータ(Ro)に基づいて、前記ステアリング
用油圧シリンダ(9F) 、 (9R)の制御弁(IO
F) 、 (IOR)の作動を制御して、前記前後輪(
3F) 、 (3R)を指示されたステアリング形式で
且つ前記ステアリングハンドル(H)による目標ステア
リング角度に操作することとなる。但し、搭乗操縦時に
おける前記変速装置(11)の変速位置つまり車速の調
整は、前記変速ペダル(12)にて前記変速アーム(1
4)を直接操作して行うことになる。又、安全のために
、前記変速ペダル(12)の操作を止めると、前記変速
装置(11)の変速位置が自動的に中立状態つまり走行
停止位置である変速ニュートラル位置(N)に復帰する
ように付勢して設けてある。
遠隔操縦の構成について説明すれば、前記送信機(18
)から与えられる指示情報を、前記受信機(19)及び
F/V変換器(35)を介して、前記制御装置(15)
に伝達すると共に、前記変速モータ(10)の駆動回路
(45)、前輪用及び後輪用の電磁弁駆動回路(49F
) 、 (49R)等に直接伝達することにより、前記
ステアリング用油圧シリンダ(9F) 。
(9R)の制御弁(IOF) 、 (IOR)及び変速
モータ(13)夫々の作動、並びに、前記ノズル(5)
の制御弁(5a)、ブロア(6)等の作動を制御して、
機体(V)の走行並びに前記薬剤散布装置(7)の作動
を、遠隔操作するようにしである。
前記送信機(18)の構成について説明すれば、第2図
に示すように、前後動によって前記変速装置(11)の
目標変速位置を指示する変速レバー(20)、及び、前
後動によってステアリング形式を指示し、且つ、左右動
によって前記前後輪(3F) 、 (3R)の目標ステ
アリング角度を指示するステアリングレバー(21)を
設けると共に、前記薬剤散布袋W(7)のブロア(6)
の回転・停止を指示するブロアスイッチ(22)、前記
ノズル(5)からの薬剤噴出の作動・停止を指示するノ
ズルスイッチ(23)、機体(V)を非常停止させるた
めの指示を行う非常停止用スイッチ(24)、及び、前
記機体(V)が自動走行制御手段(A)にて自動走行し
ている時に、この送信機(18)に設けた前記各レバー
(20) 、 (21)及びスイッチ(22) 、 (
23) 、 (24)にて機体(V)の走行並びに薬剤
散布装置(7)の作動を遠隔操縦すべく、遠隔操縦手段
(B)が自動走行制御手段(A)に優先して作動する状
態に切り換える制御切り換え指示手段としての割り込み
スイッチ(25)を設けてある。
そして、第1図に示すように、前記各レバー(20) 
、 (21)の操作位置を検出するポテンショメータ(
Rv)、 (Rt) 、 (Rs)を設けてあり、これ
らのポテンショメータ(Rv) 、 (Rt) 、 (
Rs)による検出情報並びに前記各スイッチ(22)〜
(25)の状態を、予め設定された各チャネルに夫々割
り当てるように変調して前記受信機(19)に向けて送
信する送信部(18a)を設けてある。従って、機体(
V)が自動走行制御手段(A)にて自動走行している時
に、例えば、前記超音波センサ(Sl)や接触センサ(
So)が車体(V)前方にある障害物を感知したり誤動
作して、機体(V)が自動停止したような場合に、作業
者が機体(V)の停止位置まで行くことなく、前記割り
込みスイッチ(25)を操作すれば、その後は、前記送
信機(18)による遠隔操縦にて、その障害物を回避さ
せることができる。
又、詳しくは後述するが、前記割り込みスイッチ(25
)を切れば、自動走行モードに自動的に復帰して、引き
続き機体(V)を自動走行させることができるようにし
である。
尚、安全のために、前記変速レバー(20)は、その操
作を止めると自動的に中立状態つまり変速位置が走行停
止位置である変速ニュートラル位置(N)に復帰するよ
うに付勢して設けてある。
又、第2図中、(26)は、前記送信機(18)の電源
スィッチ、(27)は、この送信機(18)の電源電圧
監視用のパンテリメータである。
次に、自動走行側′4′lII手段(八)の構成につい
て、前記制御装置(15)を構成するC P U 1 
(28)及びCP U 2 (29)の動作を説明しな
がら詳述する。
先ず、自動走行制御時における機体走行の概略を説明す
れば、第6図に示すように、作業行程の開始地点(ST
)において、例えば、4輪ステアリング形式等にて、機
体(V)を一回転させながら、その間の前記方位センサ
(S2)の検出方位をサンプリングすると共に、その検
出方位を平均することにより、前記方位センサ(S2)
の検出方位を補正する処理を行って、検出方位の精度が
全方位に亘って偏らないようにしである(以下において
〔全周ティーチング〕と呼称する)。
次に、前記作業行程の開始地点(ST)と、この開始地
点(ST)に対向する他端側に位置する果樹(F)の間
とを結ぶ直線状の第1行程(i)、前記他端側に位置す
る果樹(F)の外方側を回向して前記直線状の第1行程
(i)に対して180度逆方向に向かう直線状の第3行
程(iii )へと移動する第2行程(ii )、及び
、前記第3行程(iii )の終了後に、前記第1行程
(i)と同一方向に向かう直線状の作業行程方向に方向
転換させるために、前記第2行程(ii )と同様にし
て回向させる第4行程(iv)の4つの作業行程夫々を
、前記搭乗操縦手段又は遠隔操縦手段CB)にて操縦し
ながら、各行程における前記方位センサ(S2)、距離
センサ(S、)、及び、ステアリング角度検出用ポテン
ショメータ(R1) 、 (RZ)によるステアリング
角度等の検出情報に基づいて、前記4つの行程(i)〜
(iv)夫々をティーチングする。但し、本実施例にお
いては、第1行程(i)及び第3行程(iii )の直
線行程では、走行距離(DL−ENGn)−+、 s及
び検出方位を平均した基準方位(BASDRn)n−+
、 zのみを記憶し、第2行程(ii)及び第4行程(
iv )の回向行程では、前記ステアリング角度検出用
ポテンショメータ(Rυ、 (lh)による検出ステア
リング角度を、所定距離間隔(SAMTI) (本実施
例では、約20C11に設定しである)毎にサンプリン
グすると共に、その値を、各回向行程(ii)、(iv
)での走行経路情報として記憶するようにしである(以
下において、外周ティーチング〕と呼称する)。
そして、上述した〔外周ティーチング〕を終了すると、
機体(V)を一旦前記作業行程の開始地点(ST)まで
移動させて、前記〔外周ティーチング〕にて記憶された
第1行程(i)〜第4行程(iv)の各行程での記憶情
報に基づいて機体(V)の走行を制御しながら、各行程
での走行を設定回数繰り返すことにより、各直線行程の
端部にて自動回向しながら、果樹(F)の間を往復走行
させて、所定範囲の果樹園内における薬剤散布作業を自
動的に行わせるようにしである(以下において、〔再生
〕°と呼称する)。
従って、自動走行制御においては、機体(V)の走行を
開始する前に、上述した〔全周ティーチング〕、〔外周
ティーチング〕、及び、〔再生〕の何れのモードで走行
させるかを、予め選訳することとなる。
つまり、第7図に示すように、前記CP U 1(28
)及びCP U 2 (29)は、夫々電源ONと共に
待機状態となり、前記スイッチ入力インターフェース(
38)を介して入力される動作モード選択用スイッチ(
図示せず)の操作状態に基づいて、前記CP U 2 
(29)が動作モードを判別して、その判別結果に基づ
いて必要なプログラムを選択すると共に、前記データ転
送用インターフェース(34) 、 (34)を介して
前記CP U 1 (28)に前記動作モードをキーワ
ードとして転送する。尚、キーボードモードは、前記搭
乗操縦部(1)に設けられたキーボード(52) (第
1図参照)を操作して前記CP U 1 (28)及び
CP U 2 (29)の動作を直接指示したり、動作
状態をモニタするための動作モードであって、通常作業
時には使用しない。
以下、上記各動作モードについて詳述する。
前記〔全周ティーチング〕について説明すれば、前記c
 p U 2 (29)は、第8図に示すように、〔全
周ティーチング〕を示すキーワードを前記方位センサ(
St)の検出信号を処理するCPU 1(28)に転送
すると共に、その処理が終了するまで待機状態となる。
一方、前記CP U 1 (28)は、前記〔全周ティ
ーチング〕を示すキーワードを受は取ると、〔全周ティ
ーチング〕のだめの処理を開始し、前記第2カウンタ(
33)から出力される距離センサ(S4)の検出距離が
、設定距離に達する毎に、前記方位センサ(S2)によ
る検出方位を、機体(v)が一回転するまで、機体前後
方向に沿うX軸及び機体横幅方向に沿うY軸の値(Xs
、Ys)としてサンプリングし、その最大値(Xmax
、 Ymax)及び最小値(Xmin、 Ymin)を
求める。そして、前記最大値(Xmax、 Ymax)
及び最小値(xmin、 Ymin)の夫々を加算及び
減算して夫々2することにより、方位演算式を補正する
ための情報として、検出信号の絶対零に対する検出方位
の偏位、つまり、実際の検出方位の中心(xAv、YA
v)、及び、振幅つまり検出感度(XAM、YA、4)
を求め、前記CPU2 (29)に対して終了キーワー
ドを転送して処理を終了する。
前記〔外周ティーチング〕について説明すれば、前記C
P U 2 (29)は、第9図(イ)に示すように、
前記〔全周ティーチング〕と同様に、〔外周ティーチン
グ〕の処理を開始するための開始キーワードを、前記C
P U 1 (28)に転送する(ステツブ1110)
一方、前記CP U 1 (28)は、第9図(a)に
示すように、前記〔外周ティーチング〕の開始キーワー
ドを受は取ると、前記方位センサ(s2)の検出方位の
サンプリングを開始すべく、処理モードを〔外周ティー
チング〕に設定する(ステツブ舘1、ステツブ#2)。
そして、第6図に示すように、人為的な操縦により、機
体(V)を走行開始地点(ST)から前記マーカ(m)
を埋設した樹木(I’)までの間の第1行程(i)を直
進させながら、所定時間(本実施例では約0.1秒に設
定しである)毎に、前記方位センサ(S、)の検出方位
である現在方位(NOWDIR)を計算すると共に更新
しながら、後述する反転方位に基づいて設定される判別
方位(RASDIR)と比較して、その偏差が、予め設
定しである不惑帯(本実施例では約±20度に設定しで
ある)内にあるか否かをチェックし、不感帯外にある場
合には、機体(V)が走行方向を反転したか否かを判別
するための方位フラグ(I(FLAG)をセットして、
〔外周ティーチング〕の処理が終了しているか否かを確
認する(ステフブ#3〜ステップ#5)。但し、〔外周
ティーチング〕の処理が終了していない場合は、前記ス
テフブ#3〜ステフブ#5の処理を繰り返し行うと共に
、終了している場合は、前記第7図に示す各動作モード
の設定処理に復帰して待機状態となる。
一方、前記CP U 2 (29)は、前記開始キーワ
ードを前記CP U 1 (2B)に転送した後は、前
記距離センサ(S4)による検出情報に基づいて走行距
離(LOCNT)のカウントを開始すると共に、設定距
離走行した後において、前記CP U 1 (28)に
より演算された現在方位(NOWDII?)を平均する
ことにより第1行程(i)の基準方位(BASDRI)
を求める平均方位算出処理を開始する(ステフブ#11
〜ステップ#13)。
すなわち、前記CP U 1 (28)により算出され
る現在方位(No−旧R)の更新が終了したか否かを確
認した後、そのデータの転送を受けると共に、前記近接
センサ(S3)が直線行程の終了地点を示すマーカ(m
)を感知したか否かを判別し、前記近接センサ(S3)
がマーカ(m)を感知するまで、前記CP U 1 (
28)から転送される現在方位(NOWDII?)の更
新処理並びに平均方位の算出処理を繰り返す(ステップ
#14〜ステップ#16)。
そして、前記近接センサ(S3)がマーカ(m)を惑知
すると、第1直線行程(i)のティーチングが終了した
ものと判別して、前記カウントした走行路M(LOCN
T)を、第1行程(i)の基準距離(OLENGI)と
して記憶すると共に、前記平均方位を、第1行程(1)
の基準方位(RASDPI)として記憶した後、この基
準方位(RASDPI)を反転した反転方位を、次行程
へ回向するための第2行程(ii)の終了を判別するた
めの判別方位(BASDIR)として前記CP U 1
 (28)に転送して、第1行程(i)のティーチング
を終了し、第2行程(11)のティーチングを開始する
(ステップ#17.ステップ#18)。
第2行程(11)のティーチングが開始されると、走行
距離が、予め設定した所定距離間p (SAMTI)(
本実施例では約20cmに設定しである)に達する毎に
、前記前後輪(3F) 、 (3R)のステアリング角
度を検出するポテンショメータ(R,)、(R2)夫々
の値を繰り返しサンプリングして記憶すると共に、前記
第1行程(i)のティーチング同様に、前記CP U 
1 (280:よる現在方位(NOWDIR) (7)
更新を確認した後、その値及び前記方位フラグ(IIF
LAG)のデータ転送を受けると共に、前記方位フラグ
(HPLAG)がセントされているか否かを判別するこ
とにより、機体(V)の向きが前記第1行程(i)の基
準方位(RASDPI)を反転した判別方位(RASD
IR)に対して設定不感帯内にあるが否か、つまり、機
体(V)が第2行程(ii)の終端部に達したか否かを
判別する(ステフブ#19〜ステップ#22)。
前記ス?7ブ#22にて、前記方位フラグ(HFLAG
)がセットされていることを判別すると、更に、次の第
3行程(iii)方向に機体(V)が完全に向くまでに
要する所定距離(本実施例では約2mに設定しである)
走行するまで、前記ステツブ#19と同一の処理を行っ
た後、第2行程(ii )のティーチングを終了する(
ステツブ#23)。
前記第2行程(ii)のティーチングが終了すると、前
記ステップ付11〜ステフブ#18に示す第1行程(i
)のティーチングと同一の処理を行うことによって、前
記第1行程(i)に対して反対方向に直進する第3行程
(iii )のティーチングを行う。つまり、前記近接
センサ(S、)がマーカ(m)を惑知するまで走行路i
X’I(LOCNT)及び平均方位の算出を行うと共に
、その結果を第3行程(iii )の基準距離(OLE
NG2)及び基準方位(nAsDR2)として記憶した
後、前記基準方位(BASDR2)を反転した方位を、
次の回向行程である第4行程(iv )の開始確認用の
判別方位(BAS[1IR)としてセントする(ステフ
ブ#24〜ステフブ#27)。
前記第3行程(iit)のティーチングが終了すると、
前記ステフブ#19〜ステップ#23に示す第2行程(
ii )のティーチングと同一の処理を行うことによっ
て、前記第2行程(ii)に対して反対方向に回向する
第4行程(iv)のティーチングを行った後、〔外周テ
ィーチング〕の処理終了を示す終了キーワードを、前記
CP U 1 (28)に転送して、前記動作モードの
選択処理に復帰する(ス’y)i1t28゜ステツブ#
29) 。
つまり、上述した〔外周ティーチング〕においては、第
1行程(i)及び第3行程(iii )の直線行程では
、その直線行程の方向を示す基準方位(BASDRn)
、l80.3と、行程長としての基準距離(DLENG
n) 、1− + 、 3 とをティーチングデータと
して記憶し、第2行程(ii)及び第4行程(iv)の
各回向行程では、その回向行程を設定距離間隔(SAM
TI)毎に区分した位置における実際のステアリング操
作角度を走行経路を示す操向制御用情報として記憶する
ことになる。
従って、後述する〔再生〕においては、直線行程では、
前記記tなされた基準方位(IllASDRn)の方向
に走行するように、前記方位センサ(S2)による検出
方位と、前記超音波センサ(Sl)による走行前方側の
機体(V)両側に位置する樹木(F)夫々に対する距離
検出結果に基づいて操向制御しながら、前記距離センサ
(S4)による検出距離が前記基準距離(DLENGn
)に達するまで樹木(F)の間を直進させることとなる
。一方、回向行程では、前記設定距離間隔毎に記憶した
ステアリング角度を順次読み出すと共に、その読み出さ
れた情報に基づいて前記前後輪(3F) 、 (3R)
をステアリング操作することによりティーチングされた
走行経路に沿って回向させることとなる。
前記〔再生〕のモードについて説明すれば、第10図(
イ)に示すように、前記〔全周ティーチング〕や〔外周
ティーチング〕と同様に、前記CP U 2 (29)
よりCP U 1 (2g)に対して再生モードの開始
キーワードを転送すると共に、全走行行程数を、前記直
線行程の個数(KNUM)として入カスる(ステフブ!
1100.ステップ5101)。
そして、前記〔外周ティーチング〕にて記憶された基準
方位(BASDRn)、この基準方位(BASDRn)
に対して設定許容差以上ずれると操向操作するための不
感帯(FKAN2)、及び、前記超音波センサ(S、)
の感知距離区分を予め設定した区分距離(DIVL) 
(本実施例では、1m以内、2m、3m、4m以上の4
つの距離間隔に区分しである)に夫々セットした後、走
行予定距離を、前記〔外周ティーチング〕にて記憶され
た基準距離(DLENGn)に所定距離を減算した前エ
リア(KOTEIF)、前記基準距離(DLENGn)
に所定距離を加算した後エリア(KOTEIB)、及び
、回向を確実に行うために、走行速度を低下させるため
の減速開始地点に対応する減速距離(KOTEI2)、
の夫々を算出して設定し、そして、実際の走行距離を計
測する距離カウンタの値(CNTPI)を“0”にリセ
フトして各走行制御V!報を初期化して、現走行行程が
前記第1〜第4行程の何れの行程であるかを示す行程フ
ラグ(CFLAG)を、第1行程(i)を示す1”にセ
ントする(ステ・2ブ#102〜ステツプ#104)。
前記ステdtlLO4にて行程フラグ(CFLAG)が
セットされると、前記変速位置検出用のポテンショメー
タ(R1)の検出値に基づいて前記変速装置(11)の
変速位置を操作して設定走行速度となるようにして走行
を開始し、前記ステツブ#101にて入力された行程数
(KNUM)をチェックすることにより、全行程を走行
したか否かを判別する(ステフッ#105)。
但し、全行程の走行が終了していると〔再生〕モードを
終了して、前記動作モードを選択する処理に復帰して全
処理を終了することとなる。
次に、前記F/V変換器(35)及びA/D変換器(3
7)を介して入力される前記受信機(19)の受信情報
に基づいて、前記送信機(18)に設けた割り込みスイ
ッチ(25)がON操作されたか否かをチェックするこ
とにより、自動走行中に遠隔操縦モードに切り換えるた
めのラジコン割り込みがあったか否かを判別すると共に
、後述する直線行程の終了を判別する〔直線終了〕の処
理にてセットされた行程フラグ(CFLAG)の値が、
前記第2行程(ii )又は第4行程(iv)の回向行
程の値(2又は4)にセットされているか否かを判別す
る(ステツブ11106.ステフブ#107)。
但し、前記ラジコン割り込みがあった場合は、後述する
〔ラジコン割り込み〕の処理に分岐し、前記行程フラグ
(CFLAG)の値が“2”又は“4”にセットされて
いる場合は、後述する〔回向〕の処理に分岐して、前記
ステフブ#106以降の処理を中断することとなる。
一方、全行程が終了せず、〔ラジコン割り込み〕も無く
、且つ、前記行程フラグ(CFLAG)が回向行程にセ
ットされていない場合は、前記CP U 1 (28)
から転送される方位センサ(S2)及び超音波センサ(
Sl)の各検出データの更新を確認すると共に、その検
出データに基づいて、前記前後輪(3F) 、 (3R
)を操向操作するためのステアリング操作量を決定して
、前記ステアリング用油圧シリンダ(9F) 、 (9
R)の電磁弁(IOF) 、 (IOR)に制御信号を
出力する〔操向制御〕を行う(ステップ#108〜ステ
ップ#110)。
その後は、前記近接センサ(S3)がONしたか否かを
チェックすることにより、機体(v)が直線行程の終了
地点つまり回向行程の開始地点に達したか否かを判別す
ると共に、前記3つの超音波センサ(S、)の何れか1
つでも走行前方側1m以内に障害物を惑知したか否かを
チェックする。そして、前記近接センサ(S3)がON
している場合は、直線行程を終了して次の直線行程に向
けて回向するための〔直線終了〕の処理に分岐し、前記
超音波センサ(S、)が走行前方側1m以内に障害物を
惑知した場合は、非常停止させるとともに、その後の回
避を前記〔ラジコン割り込み〕により遠隔操縦にて行う
ために後述する〔ラジコン要求〕の処理に分岐する(ス
テップ#111、ステップItl12)。
次に、前記距離センサ(S4)の検出情報Gこ基づいて
走行距離をカウントする距離カウンタの値(CNTPI
)と前記減速距離(KOTEI2)とを比較することに
よって減速地点に達したか否かを判別し、前記減速距f
4(KOTEI2)に達している場合は、予め設定しで
ある走行速度となるように減速操作を行い、減速距離(
KOTEI2)に達していない場合はそのままで、前記
ステシブ#105からの処理に復帰する(ステシブ11
13.ステップ#114)。
一方、前記CP U 1 (28)は、第10図(Il
)に示すように、再生モードの開始キーワードを受は取
ると、〔再生〕の処理モードにセットされ、前記3つの
超音波センサ(Sl)及び方位センサ(S2)からの検
出情報を設定時間間隔(本実施例では、約0.1秒に設
定しである)毎にサンプリングして現在方位(NOWD
IR)を更新すると共に、その現在方位(NOWDIR
)と前記ティーチングされた基準方位及び反転方位に基
づいて設定される判別方位(RASDIR)とを比較し
て、その偏差が前記設定不怒帯(FUKAN2)外にあ
れば、前記前後輪(3F) 、 (3R)を操向操作す
るための処理又は回向終了を判別するための処理を実行
するための方位フラグ(l(FLAG)  をセソ ト
する(ステフブ#50〜ステフブ1154)。
更に、前記3つの超音波センサ(S、)夫々の検出信号
を、前記区分距離(DIVL)に基づいて障害物からの
距離に対応するデータ(CIIODAT)に喚算して、
〔再生〕の終了を判別する(ステフプ#55.ステyブ
#56)。
但し、前記ステップ#56にて、〔再生〕モードが終了
していない場合は、前記ステフ加52〜ステフブ#56
の処理を繰り返し行い、再生モードが終了している場合
は、前記動作モードの選択処理に復帰することとなる。
次に、前記ステシブ#111にて近接センサ(S、)が
ONするに伴って分岐する〔直線終了〕の処理について
説明する。
すなわち、第11図に示すように、前記距離カウンタノ
値(CNTPI)が前! IJ 7 (KOTEIP)
及び後エリア(KOTEIB)の間にあるか否かを判別
することにより、回向許可範囲内に機体(V)があるが
否かを判別し、回向許可範囲内に機体(V)がない場合
は、後述する〔ラジコン要求〕の処理に分岐して、前記
送信機(18)にて遠隔操縦にて回向させるようにする
(ステシブIt200)。
前記距離カウンタの値(CNTPI)が回向許可範囲内
にある場合は、前記行程フラグ(CFLAG)の値に基
づいて行程フラグ(CFLAG)の値を第2行程(“2
”)又は第4行程(“4”)を示す値に夫々セットして
、回向行程の終了を判別するための反転方位(BASD
R2又はBASDRI)を設定すると共に、前記行程数
(KNUM)を減算して、前記ステップ#105以降の
操向制御処理に復帰する(ステップ#201〜ステップ
#206)。
従って、上述した処理により前記行程フラグ(CFLA
G)の値は直線行程を示す“1”又は“3”から回向行
程を示す2”又は′4”に変わっていることから、前記
ステシブ#107の回向判別処理では、自動的に〔回向
〕の処理に分岐することとなる。
次に、前記〔回向〕の処理について詳述する。
第12図に示すように、前記〔直線終了〕にてセットさ
れた行程フラグ(CFLAG)の値に基づいて、前記〔
外周ティーチング〕にて記憶された第2行程(ii)又
は第4行程(iv)の何れかの記憶ステアリング角度の
情報を読み出すように設定すると共に、各回向行程での
終了を判別するための反転方位(BASDRl又はBA
SDR2)、方位の不感帯(FUKAN2)、及び、前
記超音波センサ(Sl)の区分距離(DIVL)の夫々
を再設定する(ステップ#300〜ステップ#304)
そして、前記CP U 1 (28)による方位センサ
(S2)および超音波センサ(S、)夫々の検出データ
更新を確認した後、その更新された各データつまり現在
方位(No匈DIR)、感知路i!!I(CIIODA
T)、及び、方位フラグ(HI’LAG)を受は取る(
ステップ+1305゜ステップ11306)。
その後、前記ステアリング位置検出用ポテンショメータ
(R1)、(Ih)のイ直をサンプリングしたか否かを
確認した後、目標ステアリング角度である前記ステアリ
ング操作のティーチングデータを更新する(ステフブ#
307〜ステフブ#309)。
次に、前記ステアリング操作用のティーチングデータを
全て出力されたか否かを判別すると共に、前記方位フラ
グ(HFLAG)がセットされているか否かに基づいて
、機体(v)向きが次行程方向に反転したか否かを判別
する。そして、全ティーチングデータが出力されたか、
又は、方位フラグ(IIFLAG)がセットされている
場合には、後述するステフ加313〜ステ・ツブ113
18の次の直線行程に対する各種データのセントを行う
〔初期化ルーチン〕に分岐し、全ティーチングデータが
出力されず、且つ、前記方位フラグ()IT’LAG)
がセットされていない場合は、前記直線行程におけるラ
ジコン割り込みの有無、及び、超音波センサ(St)が
1m以内に障害物を感知したか否かを判別して、前記ス
テップ#305以降のティーチングデータの再生処理を
繰り返すこととなる(ステフブ#310〜ステッ加31
2)。
前記〔初期化ルーチン〕について説明すれば、前記〔再
生〕の処理ルーチンのス’y−)ブ#102〜ステップ
11104と同様の処理にて、前記行程フラグ(CFL
AG)の値に基づいて、走行予定距離(DLENGI、
 DLHNG2)を基準に前エリア(KOTEIF)、
後エリア(KOTEIB)、及び、減速距離(XOTE
I2)の夫々を設定すると共に、前記距離カウンタの値
(CNTPI)を“0”のリセットし、次の直線行程の
方向に基づいて、前記行程フラグ(CFLAG)の値を
“1”又は“3”にセントする。そして、基準方位(B
ASDRn)、その基準方位(BASDRn)に対する
不惑帯(FtlKAN2)、及び、前記超音波センサ(
S +)に対する感知距離の区分距離(DIVL)の夫
々を設定して、前述した〔再生〕ルーチンの全行程終了
の判別処理(ステップ#105)に復帰することとなる
(ステフブ#313〜ステフブ#318)。
次に、前記〔ラジコン割り込み〕の処理について詳述す
る。
第13図に示すように、先ず、前記行程フラグ(CFL
AG)の値に基づいて、現在の走行行程が直線行程であ
るか回向行程であるかを判別する(ステップ#400)
そして、現在の走行行程が直線行程である場合は、前記
F/V変換器(35)及びA/D変換器(37)を介し
て入力される前記割り込みスイッチ(25)の状態に基
づいて、この〔ラジコン割り込み〕の処理が終了したか
否かを判別し、処理が終了している場合は、現走行行程
の基準方位(BASDRn)に対して予め設定しである
不感帯(SFUKAN) (本実施例では、約士約2度
に設定しである)内にあるか否かを判別する。そして、
現在方位(NOWDIR)が、前記不感帯(SFtlK
AN)内にある場合は、自動走行を継続すべく、前記〔
再生〕の処理ルーチンの全行程終了の判別処理(ステッ
プ+1105)に復帰し、前記不感帯(SFUKAN)
外である場合は、再度、前記送信機(18)による遠隔
操縦を継続すべく作業者に報知させる後述する〔ラジコ
ン要求〕の処理に分岐する(ステップ#401〜ステフ
ブ1t403)。
そして、前記ステップ#401にて割り込み処理が終了
していない場合は、前記近接センサ(S3)がONした
か否か、つまり、直線行程が終了したか否かを判別し、
前記近接センサ(S3)がONしていない場合は、前記
ステップ#401の割り込み処理終了の判別処理を繰り
返し、近接センサ(S3)がONしている場合は、前記
〔再生〕ルーチン同様に、前記距離カウンタの値(CN
TPI)が回向許可距M (KOTEIF≦CNTPI
≦KOTEIB)に達しているか否かを判別する(ステ
・フプ$1404.ステフブl$405)。
前記距離カウンタの値(CNTPI)が回向許可距離に
達している場合は、前記行程フラグ(CFLAG)の値
に基づいて、次に起動すべき回向行程が前記第2行程(
ii)であるか第4行程(iv)であるかを判別して、
前記行程フラグ(CFLAG)を対応する値にセットす
ると共に、反転方位(BASDRI又はBASDR2)
を設定して、行程数(KNUM)を減算した後、前記ス
テツブ#400の現行程が直線行程であるか回向行程で
あるかの判別処理を繰り返す(ステフブ#406〜ステ
・ノブ#411)。
一方、現走行行程が、回向行程である場合は、前記基準
方位(BASDRn)に対する不感帯を回向行程での不
惑帯(KFUKAN)に設定すると共に、前記ステツブ
#401の処理と同様の処理にて、この〔ラジコン割り
込み〕の処理が終了するまで待機する(ステツブ+14
12.ステツプ1413)。
そして、〔ラジコン割り込み〕の処理が終了するに伴っ
て、前記現在方位(NOWDIR)が反転方位(BAS
DR)に対して前記不惑帯(KFtlKAN)内に一敗
したか否かに基づいて機体(v)向きが次の行程方向に
変化したか否かを判別し、方位が反転すると、前記〔回
向〕ルーチンにおけるステップ付312〜フテフブ#3
17に示す直線行程での基準データを設定する〔初期化
ルーチン〕の処理を行った後、前記ス’yフブ#400
の現行程が直線行程であるか回向行程であるかの判別処
理に復帰する。一方、〔ラジコン割り込み〕の処理が終
了していても、前記現在方位(NOWD IR)の方位
が反転していない場合は、回向行程の走行が終了するま
で遠隔操縦する前記ステップ#403の〔ラジコン要求
〕の処理に分岐することとなる(ステフプ#413〜ス
テフプ1415)。
前記〔ラジコン要求〕の処理について説明すれば、第1
4図に示すように、前記機体(V)を非常停止させると
共に、機体(V)の上部に設けられた警告灯(53) 
(第4図、第5図参照)を点灯させて、遠隔操縦にて機
体(V)の走行を操縦するように、作業者に報知すると
共に、前記〔ラジコン割り込み〕の処理同様に、割り込
みが発生するまで待機する。そして、割り込みが発生す
るに伴って、前記警告灯(53)を清澄して、前記〔ラ
ジコン割り込み〕のステツブ11400に分岐すること
となる。
従って、自動走行中に、誤動作が発生したり障害物を感
知して、機体(V)が、直線行程や回向行程の途中で停
止しても、前記送信機(18)の割り込みスイッチ(2
5)をONすれば、遠隔操縦にて走行をm続できると共
に、上述した所定の条件を満たせば、自動走行モードに
自動的に復帰させることができるのである。尚、前記〔
ラジコン割り込み〕の処理は、正常に自動走行中であっ
ても、前記送信機(18)の割り込みスイッチ(25)
をON操作すれば、自動的に起動されて、遠隔操縦する
ことができるのは、勿論である。
〔別実施例〕
上記実施例においては、作業車を薬剤散布作業車に構成
した場合を例示したが、本発明は、その他のコンバイン
や芝刈り作業車等の各種作業車にも適用できるものであ
って、操縦手段や制御手段並びに各種センサ等の各部の
具体構成は、本発明を適用する作業車の形態や走行形態
に応じて各種変更することになるものであって、本実施
例に限定されるものではない。
【図面の簡単な説明】
図面は本発明に係る作業車の走行制御装置の実施例を示
し、第1図C4) 、 (II+) 、 (ハ)は制御
装置の構成を示すブロック図、第2図は送信機の概略構
成を示す平面図、第3図は制御システムの概略構成を示
すブロック図、第4図は薬剤散布作業車の全体側面図、
第5図は超音波センサの障害物恩知エリア及び薬剤散布
作業車の概略構成を示す平面図、第6図は作業車の走行
行程の説明図、第7図はCPUI及びCPU2の動作を
示すメインフローチャート、第8図は全周ティーチング
のフローチャート、第9図(イ)は外周ティーチングに
おけるCPU2の動作を示すフローチャート、同図(r
l)はCPUIの動作を示すフローチャート、第10図
(イ)は再生つまり自動走行時のCPU2の動作を示す
フローチャート、同図(ロ)はCPUIの動作を示すフ
ローチャート、第11図は直線終了判別のフローチャー
ト、第12図は回向処理のフローチャー1・、第13図
はラジコン割り込み処理のフローチャート、第14図は
ラジコン要求のフローチャートである。 (V)・・・・・・機体、(A)・・・・・・自動走行
制御手段、(B)・・・・・・遠隔操縦手段、(18)
・・・・・・送信機、(25)・・・・・・制御切り換
え指示手段。

Claims (1)

    【特許請求の範囲】
  1. 機体(V)を作業行程に沿って自動走行させる自動走行
    制御手段(A)と、送信機(18)からの指示情報に基
    づいて前記機体(V)の走行を制御する遠隔操縦手段(
    B)とを、切り換え自在に設けた作業車の走行制御装置
    であって、前記自動走行制御手段(A)と遠隔操縦手段
    (B)との切り換えを指示する制御切り換え指示手段(
    25)を、前記送信機(18)側に設けてある作業車の
    走行制御装置。
JP61092840A 1986-04-22 1986-04-22 作業車の走行制御装置 Granted JPS62248011A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP61092840A JPS62248011A (ja) 1986-04-22 1986-04-22 作業車の走行制御装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP61092840A JPS62248011A (ja) 1986-04-22 1986-04-22 作業車の走行制御装置

Publications (2)

Publication Number Publication Date
JPS62248011A true JPS62248011A (ja) 1987-10-29
JPH0584921B2 JPH0584921B2 (ja) 1993-12-03

Family

ID=14065628

Family Applications (1)

Application Number Title Priority Date Filing Date
JP61092840A Granted JPS62248011A (ja) 1986-04-22 1986-04-22 作業車の走行制御装置

Country Status (1)

Country Link
JP (1) JPS62248011A (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63308608A (ja) * 1987-06-10 1988-12-16 Kubota Ltd 自動走行作業車の走行制御装置
JP2020166881A (ja) * 2017-03-28 2020-10-08 ヤンマーパワーテクノロジー株式会社 リモコン

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5794807A (en) * 1980-12-03 1982-06-12 Omron Tateisi Electronics Co Steering controller of tractor

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5794807A (en) * 1980-12-03 1982-06-12 Omron Tateisi Electronics Co Steering controller of tractor

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63308608A (ja) * 1987-06-10 1988-12-16 Kubota Ltd 自動走行作業車の走行制御装置
JP2020166881A (ja) * 2017-03-28 2020-10-08 ヤンマーパワーテクノロジー株式会社 リモコン

Also Published As

Publication number Publication date
JPH0584921B2 (ja) 1993-12-03

Similar Documents

Publication Publication Date Title
JP2944814B2 (ja) 障害物センサ付き自動走行車両
JPS62248011A (ja) 作業車の走行制御装置
JPS633711A (ja) 自動走行作業車の走行制御装置
JPS62259110A (ja) 自動走行作業車の走行制御装置
JPS63157908A (ja) 樹木間走行作業車の操向制御装置
JPS62296805A (ja) 自動走行作業車の走行制御装置
JPH061407B2 (ja) 自動走行作業車の走行制御装置
JPS62285114A (ja) 自動走行作業車の走行制御装置
JPS62269769A (ja) 薬剤散布作業車の走行制御装置
JP3533575B2 (ja) 作業車
JPS62294003A (ja) 自動走行作業車の走行制御装置
JPS62297909A (ja) 自動走行作業車の走行制御装置
JPH0570404B2 (ja)
JPS637705A (ja) 自動走行作業車の走行制御装置
JPS633710A (ja) 自動走行作業車の走行制御装置
JPH0570402B2 (ja)
JPS63204A (ja) 自動走行作業車の走行制御装置
JPS63158152A (ja) 薬剤散布作業車の走行制御装置
JP3430476B2 (ja) 作業車
JPS63158153A (ja) 薬剤散布作業車の走行制御装置
JP3265404B2 (ja) 移動農機の操向制御装置
JPH057604Y2 (ja)
JPH0423012A (ja) 走行車
JPH0330884Y2 (ja)
JPH0542881B2 (ja)