JPS62265906A - 自動走行作業車の操向制御装置 - Google Patents
自動走行作業車の操向制御装置Info
- Publication number
- JPS62265906A JPS62265906A JP61108045A JP10804586A JPS62265906A JP S62265906 A JPS62265906 A JP S62265906A JP 61108045 A JP61108045 A JP 61108045A JP 10804586 A JP10804586 A JP 10804586A JP S62265906 A JPS62265906 A JP S62265906A
- Authority
- JP
- Japan
- Prior art keywords
- steering
- aircraft
- stroke
- travel
- orientation
- 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
- 238000000034 method Methods 0.000 description 62
- 238000001514 detection method Methods 0.000 description 31
- 239000000126 substance Substances 0.000 description 15
- 238000005507 spraying Methods 0.000 description 10
- 230000005540 biological transmission Effects 0.000 description 6
- 230000008929 regeneration Effects 0.000 description 6
- 238000011069 regeneration method Methods 0.000 description 6
- 230000007935 neutral effect Effects 0.000 description 5
- 239000003795 chemical substances by application Substances 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
- 230000007257 malfunction Effects 0.000 description 2
- 239000003550 marker Substances 0.000 description 2
- 239000002420 orchard Substances 0.000 description 2
- 244000025254 Cannabis sativa Species 0.000 description 1
- 101100285408 Danio rerio eng2a gene Proteins 0.000 description 1
- 241001124569 Lycaenidae Species 0.000 description 1
- 240000007594 Oryza sativa Species 0.000 description 1
- 235000007164 Oryza sativa Nutrition 0.000 description 1
- 101100172294 Saccharomyces cerevisiae (strain ATCC 204508 / S288c) ACF2 gene Proteins 0.000 description 1
- 101100172293 Schizosaccharomyces pombe (strain 972 / ATCC 24843) eng2 gene Proteins 0.000 description 1
- 239000008280 blood Substances 0.000 description 1
- 210000004369 blood Anatomy 0.000 description 1
- 201000007750 congenital bile acid synthesis defect Diseases 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
- 238000004519 manufacturing process Methods 0.000 description 1
- 235000009566 rice Nutrition 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000007790 scraping Methods 0.000 description 1
Landscapes
- Guiding Agricultural Machines (AREA)
- Platform Screen Doors And Railroad Systems (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
C産業上の利用分野〕
本発明は、前後輪の夫々を操向操作自在に構成された機
体を走行用ガイドに沿って自動走行させるべく、前記走
行用ガイドの長さ方向に基づいて設定した基準方位に対
する機体の向きを検出するセンサ及び前記走行用ガイド
に対する機体の横幅方向の位置を検出するセンサによる
検出情報に基づいて、前記前後輪夫々を自動的に操向操
作する操向制御手段を備えた自動走行作業車の操向制御
装置に関する。
体を走行用ガイドに沿って自動走行させるべく、前記走
行用ガイドの長さ方向に基づいて設定した基準方位に対
する機体の向きを検出するセンサ及び前記走行用ガイド
に対する機体の横幅方向の位置を検出するセンサによる
検出情報に基づいて、前記前後輪夫々を自動的に操向操
作する操向制御手段を備えた自動走行作業車の操向制御
装置に関する。
上記この種の自動走行作業車の操四制?Iil装置は、
機体の向きが設定基準方位から外れている場合は、例え
ば、前後輪を逆方向に操向して機体向きを修正すると共
に、走行用ガイドに対する機体の横幅方向の位置が設定
適正位置から外れている場合は、前後輪を同一方向に操
向して、機体向きが変わらないようにしながら、走行用
ガイドに対する機***置を修正することにより、機体が
走行用ガイドに沿って自動走行するようにしたものであ
る。
機体の向きが設定基準方位から外れている場合は、例え
ば、前後輪を逆方向に操向して機体向きを修正すると共
に、走行用ガイドに対する機体の横幅方向の位置が設定
適正位置から外れている場合は、前後輪を同一方向に操
向して、機体向きが変わらないようにしながら、走行用
ガイドに対する機***置を修正することにより、機体が
走行用ガイドに沿って自動走行するようにしたものであ
る。
そして、従来の操向制御手段においては、例えば、機体
向きを修正する処理を行った後横幅方向の位置を修正す
る処理を行うようにする等、向きの修正と位置の修正と
を、夫々各別に行うように構成してあった。
向きを修正する処理を行った後横幅方向の位置を修正す
る処理を行うようにする等、向きの修正と位置の修正と
を、夫々各別に行うように構成してあった。
ところで、上記走行用ガイドとしては、例えば、自走式
コンバインや自動芝刈り作業車等の場合には、圃場に植
立された茎稈や芝等の作業対象の未処理部の既処理部側
の端縁を利用でき、薬剤散布作業車等の場合には、列条
に並ぶ樹木を利用できる。又、田植機や各種土木作業機
等の場合には、例えば、レーザー光線等を走行用ガイド
として用いることができる。
コンバインや自動芝刈り作業車等の場合には、圃場に植
立された茎稈や芝等の作業対象の未処理部の既処理部側
の端縁を利用でき、薬剤散布作業車等の場合には、列条
に並ぶ樹木を利用できる。又、田植機や各種土木作業機
等の場合には、例えば、レーザー光線等を走行用ガイド
として用いることができる。
しかしながら、上記従来の操向制御手段においては、機
体向きと横幅方向の位置を修正するに、夫々各別に修正
するように構成してあったので、機体向きと横幅方向の
位置の両方が適正状態から外れている場合、両方を適正
状態にすることを迅速に行えないものであった。
体向きと横幅方向の位置を修正するに、夫々各別に修正
するように構成してあったので、機体向きと横幅方向の
位置の両方が適正状態から外れている場合、両方を適正
状態にすることを迅速に行えないものであった。
機体向きを先に修正する場合を例に挙げて説明を加える
と、機体向きの修正が完了しないと、横幅方向位置の修
正を行うことができなくなり、しかも、この向きの修正
を行っている間に、走行用ガイドから機***置が更に大
きくずれてしまう虞れがあり、その結果、薬剤散布作業
車では機体を樹木に衝突させてしまうトラブルをも招く
危険があった。
と、機体向きの修正が完了しないと、横幅方向位置の修
正を行うことができなくなり、しかも、この向きの修正
を行っている間に、走行用ガイドから機***置が更に大
きくずれてしまう虞れがあり、その結果、薬剤散布作業
車では機体を樹木に衝突させてしまうトラブルをも招く
危険があった。
本発明は、上記実情に鑑みてなされたものであって、そ
の目的は、機体向きと横幅方向の位置の両方のずれを速
く修正できるようにすることにある。
の目的は、機体向きと横幅方向の位置の両方のずれを速
く修正できるようにすることにある。
本発明による自動走行作業車の走行制御装置の特徴構成
は、前記操向制御手段を、機体の向きが設定基準方位か
ら外れ、且つ、前記走行用ガイドに対する機体の横幅方
向の位置が設定適正位置から外れている場合は、前記機
体の向き及び横幅方向の位置を同時に修正するステアリ
ング形式にて操向するように構成してある点にあり、そ
の作用並びに効果は以下の通りである。
は、前記操向制御手段を、機体の向きが設定基準方位か
ら外れ、且つ、前記走行用ガイドに対する機体の横幅方
向の位置が設定適正位置から外れている場合は、前記機
体の向き及び横幅方向の位置を同時に修正するステアリ
ング形式にて操向するように構成してある点にあり、そ
の作用並びに効果は以下の通りである。
すなわち、機体の向きと横幅方向の位置の両方が適正状
態から外れている場合には、機体の向き及び横幅方向の
位置を同時に変えることができるステアリング形式、例
えば、前後輪の掻向量に差を付ける状態で同一方向に向
けて操向操作するステアリング形式等で操向することに
より、機体の向きと横幅方向の位置とを同時に修正する
のである。
態から外れている場合には、機体の向き及び横幅方向の
位置を同時に変えることができるステアリング形式、例
えば、前後輪の掻向量に差を付ける状態で同一方向に向
けて操向操作するステアリング形式等で操向することに
より、機体の向きと横幅方向の位置とを同時に修正する
のである。
従って、機体の向きと横幅方向の位置の両方を同時に修
正することもできるので、機体を適正向き及び適正位置
に迅速に修正することができ、もって、走行用ガイドに
沿って適切に自動走行させることができるようになった
。
正することもできるので、機体を適正向き及び適正位置
に迅速に修正することができ、もって、走行用ガイドに
沿って適切に自動走行させることができるようになった
。
以下、本発明の実施例を図面に基づいて説明する。
第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)(第1図参照)を設けてあり、この接
触センサ(SO)がON作動するに伴って、機体(V)
を非常停止させるようにしてある。
V)の前部に、接触式の障害物センサ兼用のハンパ(8
)を、障害物に接触するに伴って機体(V)後方側へ引
退して衝撃を吸収するように設けると共に、その引退作
動によってON操作されるリミットスイッチを用いた接
触センサ(SO)(第1図参照)を設けてあり、この接
触センサ(SO)がON作動するに伴って、機体(V)
を非常停止させるようにしてある。
更に、前記バンパ(8)の前面側に、非接触式の障害物
センサとしての超音波センサ(Sl)の3個を、第4図
に示すように、各障害物感知範囲が互いに隣接する状態
で、左右及び中央の夫々に設けである。但し、左右に位
置する超音波センサ(S+)、(S+)夫々は、その障
害物感知情報を、機体(V)に対して左右両側に位置す
る樹木(I’)の間を機体(V)が走行するだめの操向
制御用の情報として利用できるようにするため、走行用
ガイドとしての前記左右両側の樹木(F)夫々に対する
距離つまり走行用ガイドに対する機体(V)横幅方向の
位置を、障害物までの距離(CIIODAT)として感
知できるようにすると共に、その障害物感知範囲を、機
体幅よりも外側に拡がるように設定してある。尚、中央
の超音波センサ(S+)は、1m以内の障害物存否のみ
を感知するようにしてある。
センサとしての超音波センサ(Sl)の3個を、第4図
に示すように、各障害物感知範囲が互いに隣接する状態
で、左右及び中央の夫々に設けである。但し、左右に位
置する超音波センサ(S+)、(S+)夫々は、その障
害物感知情報を、機体(V)に対して左右両側に位置す
る樹木(I’)の間を機体(V)が走行するだめの操向
制御用の情報として利用できるようにするため、走行用
ガイドとしての前記左右両側の樹木(F)夫々に対する
距離つまり走行用ガイドに対する機体(V)横幅方向の
位置を、障害物までの距離(CIIODAT)として感
知できるようにすると共に、その障害物感知範囲を、機
体幅よりも外側に拡がるように設定してある。尚、中央
の超音波センサ(S+)は、1m以内の障害物存否のみ
を感知するようにしてある。
又、前記薬剤タンク(2)の上部には、地磁気を感知す
ることによって絶対方位を検出する方位センサ(S2)
を設けてあり、走行用ガイドの長さ方向に基づいて設定
した基準方位に対する機体(V)の向きを検出できるよ
うにしてある。
ることによって絶対方位を検出する方位センサ(S2)
を設けてあり、走行用ガイドの長さ方向に基づいて設定
した基準方位に対する機体(V)の向きを検出できるよ
うにしてある。
又、第2図に示すように、樹木(F)の間を機体(V)
が直線的に走行する直線行程の終端部を表示すべく、こ
の直線行程の終端部に位置する樹木同士の間に、鉄等の
磁性材にて形成したマーカ(m)を埋設すると共に、前
記マーカ(m)を検出する磁気感知式の近接センサ(S
:l)を、前記機体(V)の前端部下方に設けである。
が直線的に走行する直線行程の終端部を表示すべく、こ
の直線行程の終端部に位置する樹木同士の間に、鉄等の
磁性材にて形成したマーカ(m)を埋設すると共に、前
記マーカ(m)を検出する磁気感知式の近接センサ(S
:l)を、前記機体(V)の前端部下方に設けである。
前記機体(V)の走行系の構成について説明すれば、第
1図に示すように、左右一対の前輪(3F)及び後輪(
3R)を設けると共に、それら一対の前後輪(3F)
、 (3R)を各別に操作するステアリング操作用の油
圧シリンダ(9F) 、 (9R) 、及び、それに対
する制御弁(IOF) 、 (IOR)を設けである。
1図に示すように、左右一対の前輪(3F)及び後輪(
3R)を設けると共に、それら一対の前後輪(3F)
、 (3R)を各別に操作するステアリング操作用の油
圧シリンダ(9F) 、 (9R) 、及び、それに対
する制御弁(IOF) 、 (IOR)を設けである。
又、前後進切り換え自在で且つ前進変速並びに後進変速
自在な油圧式無段変速装置(11)を、前記エンジン(
E)に連動連結すると共に、前記変速装置(11)の出
力にて、前記前後輪(3F) 、 (3R)を同時に駆
動するように構成してある。そして、搭乗操縦用の変速
ペダル(12)及び遠隔操縦用の変速アクチュエータと
しての変速モータ(13)を、その何れによっても変速
操作可能に、前記変速装置(11)の変速アーム(14
)に連動連結してある。
自在な油圧式無段変速装置(11)を、前記エンジン(
E)に連動連結すると共に、前記変速装置(11)の出
力にて、前記前後輪(3F) 、 (3R)を同時に駆
動するように構成してある。そして、搭乗操縦用の変速
ペダル(12)及び遠隔操縦用の変速アクチュエータと
しての変速モータ(13)を、その何れによっても変速
操作可能に、前記変速装置(11)の変速アーム(14
)に連動連結してある。
又、搭乗操縦用のステアリングハンドル(11)を、前
記搭乗操縦部(1)に設けである。尚、第1図中、(S
1)は、前記変速装置(11)の出力回転数を検出する
ことにより走行距離を検出する距離センサである。
記搭乗操縦部(1)に設けである。尚、第1図中、(S
1)は、前記変速装置(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)。
4輪ステアリング形式とを選択できるように、且つ、搭
乗操縦時には、平行ステアリング形式、4輪ステアリン
グ形式、及び、2輪ステアリング形式の何れかを選択で
きるように構成してある。但し、自動走行時には、前記
各ステアリング形式の切り換えは自動的に行われると共
に、この自動走行時には、前後輪(3F)。
(3R)の操向量に差を付けた状態で同一方向にステア
リング換作するステアリング形式にも切換えることがで
きるようにしてある。
リング換作するステアリング形式にも切換えることがで
きるようにしてある。
又、搭乗操縦時の目標ステアリング角度を検出する目標
ステアリング角度検出用ポテンショメータ(Ro)を、
前記ステアリングハンドル(H)にて回動操作するよう
に設けると共に、前記前後輪(3F) 、 (3R)夫
々のステアリング角度を検出するステアリング角度検出
用ポテンショメータ(R,)、(R2)を設けである。
ステアリング角度検出用ポテンショメータ(Ro)を、
前記ステアリングハンドル(H)にて回動操作するよう
に設けると共に、前記前後輪(3F) 、 (3R)夫
々のステアリング角度を検出するステアリング角度検出
用ポテンショメータ(R,)、(R2)を設けである。
又、前記変速装置(11)の変速位置を検出する変速位
置検出用ポテンショメータ(R1)を、前記変速アーム
(14)の回動操作に連動するように設けである。そし
て、前記各ポテンショメータ(Ro)〜(R3)による
検出信号を自動走行制御手段、遠隔操縦手段、並びに、
搭乗操縦手段の夫々を構成する制御装置(15)に入力
してある。又、上記各操縦手段の何れによって機体(V
)の走行を制御するかを選択する操縦モード選択用スイ
ッチ(16)、及び、搭乗操縦モード時におけるステア
リング形式選択用スイッチ(17)を設けである。但し
、詳しくは後述するが、前記自動走行制御手段が作動す
る自動操縦モードにおいては、前記操縦モード選択用ス
イッチ(16)を操作することなく、前記遠隔操縦手段
を、自動走行制御手段に優先して作動させる状態に切り
換えられるように構成してある。
置検出用ポテンショメータ(R1)を、前記変速アーム
(14)の回動操作に連動するように設けである。そし
て、前記各ポテンショメータ(Ro)〜(R3)による
検出信号を自動走行制御手段、遠隔操縦手段、並びに、
搭乗操縦手段の夫々を構成する制御装置(15)に入力
してある。又、上記各操縦手段の何れによって機体(V
)の走行を制御するかを選択する操縦モード選択用スイ
ッチ(16)、及び、搭乗操縦モード時におけるステア
リング形式選択用スイッチ(17)を設けである。但し
、詳しくは後述するが、前記自動走行制御手段が作動す
る自動操縦モードにおいては、前記操縦モード選択用ス
イッチ(16)を操作することなく、前記遠隔操縦手段
を、自動走行制御手段に優先して作動させる状態に切り
換えられるように構成してある。
次に、前記各操縦手段の構成について詳述する。
搭乗操縦手段の構成について説明すれば、第1図に示す
ように、前記ステアリング形式選択用スイッチ(17)
の情報、及び、前記搭乗操縦時の目標ステアリング位置
を検出する目標ステアリング位置検出用のポテンショメ
ータ(Ro)に基づいて、前記ステアリング用油圧シリ
ンダ(9F)。
ように、前記ステアリング形式選択用スイッチ(17)
の情報、及び、前記搭乗操縦時の目標ステアリング位置
を検出する目標ステアリング位置検出用のポテンショメ
ータ(Ro)に基づいて、前記ステアリング用油圧シリ
ンダ(9F)。
(9R)の制御弁(IOF) 、 (IOR)の作動を
制御して、前記前後輪(3F) 、 (3R)を指示さ
れたステアリング形式で且つ前記ステアリングハンドル
(H)による目標ステアリング角度に操作することとな
る。但し、搭乗操縦時における前記変速装置(11)の
変速位置つまり車速の調整は、前記変速ペダル(12)
にて前記変速アーム(14)を直接操作して行うことに
なる。又、安全のために、前記変速ペダル(12)の操
作を止めると、前記変速装置(11)の変速位置が自動
的に中立状態つまり走行停止位置である変速ニュートラ
ル位置(N)に復帰するように付勢して設けである。
制御して、前記前後輪(3F) 、 (3R)を指示さ
れたステアリング形式で且つ前記ステアリングハンドル
(H)による目標ステアリング角度に操作することとな
る。但し、搭乗操縦時における前記変速装置(11)の
変速位置つまり車速の調整は、前記変速ペダル(12)
にて前記変速アーム(14)を直接操作して行うことに
なる。又、安全のために、前記変速ペダル(12)の操
作を止めると、前記変速装置(11)の変速位置が自動
的に中立状態つまり走行停止位置である変速ニュートラ
ル位置(N)に復帰するように付勢して設けである。
遠隔操縦の構成について説明すれば、遠隔操縦用の送信
機(18)から与えられる指示情報を受信する受信機(
19)を設けると共に、その受信情報に基づいて、前記
ステアリング用油圧シリンダ(9F) 、−(9R)の
制御弁(IOF) 、 (IOR)及び変速モータ(1
3)夫々の作動、並びに、前記ノズル(5)の制御弁(
5a)、ブロア(6)等の作動を制御することにより、
機体(V)の走行並びに前記薬剤散布装置(7)の作動
を、遠隔操作するようにしてある。
機(18)から与えられる指示情報を受信する受信機(
19)を設けると共に、その受信情報に基づいて、前記
ステアリング用油圧シリンダ(9F) 、−(9R)の
制御弁(IOF) 、 (IOR)及び変速モータ(1
3)夫々の作動、並びに、前記ノズル(5)の制御弁(
5a)、ブロア(6)等の作動を制御することにより、
機体(V)の走行並びに前記薬剤散布装置(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)の作動を遠隔
操縦すべ(、遠隔操縦手段が自動走行制御手段に優先し
て作動する状態に切り換える制御切り換え指示手段とし
ての割り込みスイッチ(25)を設けである。
に示すように、前後動によって前記変速装置(11)の
目標変速位置を指示する変速レバー(20)、及び、前
後動によってステアリング形式を指示し、且つ、左右動
によって前記前後輪(3F) 、 (3R)の目標ステ
アリング角度を指示するステアリングレバー(21)を
設けると共に、前記薬剤散布装置(7)のブロア(6)
の回転・停止を指示するブロアスイッチ(22)、前記
ノズル(5)からの薬剤噴出の作動・停止を指示するノ
ズルスイッチ(23)、機体(V)を非常停止させるた
めの指示を行う非常停止用スイッチ(24)、及び、前
記機体(V)が自動走行している時に、この送信機(1
8)に設けた前記各レバー(20) 、 (21)及び
スイッチ(22) 、 (23) 、 (24)にて機
体(V)の走行並びに薬剤散布装置(7)の作動を遠隔
操縦すべ(、遠隔操縦手段が自動走行制御手段に優先し
て作動する状態に切り換える制御切り換え指示手段とし
ての割り込みスイッチ(25)を設けである。
つまり、機体(V)が自動走行制御手段にて自動走行し
ている時に、例えば、前記超音波センサ(S+)や接触
センサ(So)が車体(V)前方にある障害物を感知し
たり誤動作して、機体(V)が自動停止したような場合
に、作業者が機体(’it)の停止位置まで行くことな
く、前記割り込みスイッチ(25)を操作すれば、その
後は、前記送信機(18)による遠隔操縦にて、その障
害物を回避させることができる。又、前記割り込みスイ
ッチ(25)を切れば、自動走行モードに自動的に復帰
して、引き続き機体(V)を自動走行させることができ
るようにしてある。
ている時に、例えば、前記超音波センサ(S+)や接触
センサ(So)が車体(V)前方にある障害物を感知し
たり誤動作して、機体(V)が自動停止したような場合
に、作業者が機体(’it)の停止位置まで行くことな
く、前記割り込みスイッチ(25)を操作すれば、その
後は、前記送信機(18)による遠隔操縦にて、その障
害物を回避させることができる。又、前記割り込みスイ
ッチ(25)を切れば、自動走行モードに自動的に復帰
して、引き続き機体(V)を自動走行させることができ
るようにしてある。
尚、安全のために、前記変速レバー(20)は、その操
作を止めると自動的に中立状態つまり変速位置が走行停
止位置である変速ニュートラル位置(N)に復帰するよ
うに付勢して設けである。
作を止めると自動的に中立状態つまり変速位置が走行停
止位置である変速ニュートラル位置(N)に復帰するよ
うに付勢して設けである。
次に、自動走行制御手段の構成について、前記制御装置
(15)の動作を説明しながら詳述する。
(15)の動作を説明しながら詳述する。
尚、前記制御装置(15)は、図示を省略するが、前記
超音波センサ(S1)及び方位センサ(S2)の検出情
報を処理する第1プロセツサ(以下、CPU 1と呼称
する)、及び、前記CPUIにより処理された検出情報
や各種センサによる検出情報、並びに、前記受信機(1
9)による受信情報や予め記憶設定された走行制御情報
等に基づいて、各種アクチュエータの作動を制御する第
2プロセツサ(以下、CPU2と呼称する)の2つのプ
ロセッサによって構成してある。
超音波センサ(S1)及び方位センサ(S2)の検出情
報を処理する第1プロセツサ(以下、CPU 1と呼称
する)、及び、前記CPUIにより処理された検出情報
や各種センサによる検出情報、並びに、前記受信機(1
9)による受信情報や予め記憶設定された走行制御情報
等に基づいて、各種アクチュエータの作動を制御する第
2プロセツサ(以下、CPU2と呼称する)の2つのプ
ロセッサによって構成してある。
先ず、自動走行制御時における機体走行の概略を説明す
れば、第2図に示すように、作業行程の開始地点(ST
)と、この開始地点(ST)に対向する他端側に位置す
る果樹(F)の間とを結ぶ直線状の第1行程(i)、前
記他端側に位置する果樹(F)の外方側を回向して前記
直線状の第1行程(i)に対して180度逆方向に向か
う直線状の第3行程(iii)へと移動する第2行程(
ii)、及び、前記第3行程(iii )の終了後に、
前記第1行程(りと同一方向に向かう直線状の作業行程
方向に方向転換させるために、前記第2行程(ii)と
同様にして回向させる第4行程(1v)の4つの作業行
程夫々を、前記搭乗操縦手段又は遠隔操縦手段にて操縦
しながら、各行程における前記方位センサ(S2)、距
離センサ(S4)、及び、ステアリング角度検出用ポテ
ンショメータ(R+)、(th)によるステアリング角
度等の検出情報に基づいて、前記4つの各行程い)〜(
iv)夫々を、樹木(F)を走行用ガイドとしてティー
チングする。
れば、第2図に示すように、作業行程の開始地点(ST
)と、この開始地点(ST)に対向する他端側に位置す
る果樹(F)の間とを結ぶ直線状の第1行程(i)、前
記他端側に位置する果樹(F)の外方側を回向して前記
直線状の第1行程(i)に対して180度逆方向に向か
う直線状の第3行程(iii)へと移動する第2行程(
ii)、及び、前記第3行程(iii )の終了後に、
前記第1行程(りと同一方向に向かう直線状の作業行程
方向に方向転換させるために、前記第2行程(ii)と
同様にして回向させる第4行程(1v)の4つの作業行
程夫々を、前記搭乗操縦手段又は遠隔操縦手段にて操縦
しながら、各行程における前記方位センサ(S2)、距
離センサ(S4)、及び、ステアリング角度検出用ポテ
ンショメータ(R+)、(th)によるステアリング角
度等の検出情報に基づいて、前記4つの各行程い)〜(
iv)夫々を、樹木(F)を走行用ガイドとしてティー
チングする。
但し、本実施例においては、第1行程(i)及び第3行
程(iii )の直線行程では、この直線行程の開始地
点から前記近接センサ(S3)が作動するまでの実際の
走行距離(DLENGn) fi−1,3及び検出方位
を平均した基準方位(BASDRn)−+、 !のみを
、直線行程の走行用ガイドに対する走行制御用情報とし
て記憶し、第2行程(1)及び第4行程(iv)の回向
行程では、前記ステアリング角度検出用ポテンショメー
タ(R1)、(RZ)による検出ステアリング角度を、
設定距離間隔(本実施例では約20cmに設定してある
)毎にサンプリングすると共に、その値を、各回向行程
(ii)、(iv)の走行用ガイドに対する走行制御用
情報として記憶するように、してある(以下において〔
ティーチング〕と呼称する)。
程(iii )の直線行程では、この直線行程の開始地
点から前記近接センサ(S3)が作動するまでの実際の
走行距離(DLENGn) fi−1,3及び検出方位
を平均した基準方位(BASDRn)−+、 !のみを
、直線行程の走行用ガイドに対する走行制御用情報とし
て記憶し、第2行程(1)及び第4行程(iv)の回向
行程では、前記ステアリング角度検出用ポテンショメー
タ(R1)、(RZ)による検出ステアリング角度を、
設定距離間隔(本実施例では約20cmに設定してある
)毎にサンプリングすると共に、その値を、各回向行程
(ii)、(iv)の走行用ガイドに対する走行制御用
情報として記憶するように、してある(以下において〔
ティーチング〕と呼称する)。
そして、上述した〔ティーチング〕を終了すると、機体
(V)を一旦前記作業行程の開始地点(ST)まで移動
させて、前記〔ティーチング〕にて記憶された第1行程
(i)〜第4行程(iv)の各行程での記憶情報に基づ
いて機体(V)の走行を制御しながら、各行程での走行
を設定回数繰り返すことにより、各直線行程の端部にて
自動回向しながら、果樹(F)の間を往復走行させて、
所定範囲の果樹園内における薬剤散布作業を自動的に行
わせるようにしてある。つまり、上述した〔ティーチン
グ〕にて記憶された走行制御用情報に基づいて機体(V
)の走行を制御する処理にて走行制御手段並びに走行用
ガイドに沿って自動走行させるための操向制御手段(1
00)を構成してあり、その制御のための処理を以下に
おいて〔再生〕と呼称する。
(V)を一旦前記作業行程の開始地点(ST)まで移動
させて、前記〔ティーチング〕にて記憶された第1行程
(i)〜第4行程(iv)の各行程での記憶情報に基づ
いて機体(V)の走行を制御しながら、各行程での走行
を設定回数繰り返すことにより、各直線行程の端部にて
自動回向しながら、果樹(F)の間を往復走行させて、
所定範囲の果樹園内における薬剤散布作業を自動的に行
わせるようにしてある。つまり、上述した〔ティーチン
グ〕にて記憶された走行制御用情報に基づいて機体(V
)の走行を制御する処理にて走行制御手段並びに走行用
ガイドに沿って自動走行させるための操向制御手段(1
00)を構成してあり、その制御のための処理を以下に
おいて〔再生〕と呼称する。
以下、上述した〔再生〕について詳述する。
第5図(ロ)に示すように、〔再生〕の処理が開始され
ると、前記CPUIは、前記3つの超音波センサ(Sl
)及び方位センサ(S2)からの検出情報を設定時間間
隔(本実施例では約0.1秒に設定してある)毎にサン
プリングして機体(V)の現在の向きである現在方位(
NOWDIR)を更新すると共に、その現在方位(NO
WDIR)と、前記ティ−チングされた基準方位(BA
SDRn)に基づいて設定された方位ずれの有無や回向
終了を判別するための判別方位(RASDIR)とを比
較して、その偏差が設定不感帯(FUKAN2)外にあ
れば、走行用ガイドに対する機体(V)の向きずれとし
ての方位ずれの有無を示す方位フラグ(HF L A
G )をセットする(ステフブ#50〜ステフブ#52
)。
ると、前記CPUIは、前記3つの超音波センサ(Sl
)及び方位センサ(S2)からの検出情報を設定時間間
隔(本実施例では約0.1秒に設定してある)毎にサン
プリングして機体(V)の現在の向きである現在方位(
NOWDIR)を更新すると共に、その現在方位(NO
WDIR)と、前記ティ−チングされた基準方位(BA
SDRn)に基づいて設定された方位ずれの有無や回向
終了を判別するための判別方位(RASDIR)とを比
較して、その偏差が設定不感帯(FUKAN2)外にあ
れば、走行用ガイドに対する機体(V)の向きずれとし
ての方位ずれの有無を示す方位フラグ(HF L A
G )をセットする(ステフブ#50〜ステフブ#52
)。
そして、前記方位フラグ(HFLAG)がセットされた
か否かに基づいて、方位ずれの有無を判別すると共に、
そのずれ方向を示す方向フラグ(SFLAG)を、ずれ
た方向に対応してセットする(ステフプ#53〜ステフ
ブ#55)。
か否かに基づいて、方位ずれの有無を判別すると共に、
そのずれ方向を示す方向フラグ(SFLAG)を、ずれ
た方向に対応してセットする(ステフプ#53〜ステフ
ブ#55)。
次に、前記3つの超音波センサ(SI)夫々の検出信号
を、後述する区分距離(DIVL)に基づいて障害物か
らの距離に対応する距離データ(CIIODAT)に換
算すると共に、左右夫々の超音波センサ(Sl)の距離
データ(CHODAT)に基づいて、走行前方側に障害
物があるか否かを判別し、障害物が有る場合は、詳しく
は後述する距離データ(CHODAT) lご対応する
目標ステアリング角度を設定するためのステアリング角
度アドレスの値(a) 、 (b)の設定を行うように
してある。障害物が無い場合は、前記距離データ(CH
ODAT)が障害物感知の有りから無に変化した後、設
定距離走行したか否かを判別し、設定距離走行している
場合は、前記ステアリング角度アドレスのオフセット値
(a) 、 (b)を夫々“0”にセントした後、この
〔再生〕の処理モードが終了したか否かを判別して処理
を終了する(ステツブ#61)。
を、後述する区分距離(DIVL)に基づいて障害物か
らの距離に対応する距離データ(CIIODAT)に換
算すると共に、左右夫々の超音波センサ(Sl)の距離
データ(CHODAT)に基づいて、走行前方側に障害
物があるか否かを判別し、障害物が有る場合は、詳しく
は後述する距離データ(CHODAT) lご対応する
目標ステアリング角度を設定するためのステアリング角
度アドレスの値(a) 、 (b)の設定を行うように
してある。障害物が無い場合は、前記距離データ(CH
ODAT)が障害物感知の有りから無に変化した後、設
定距離走行したか否かを判別し、設定距離走行している
場合は、前記ステアリング角度アドレスのオフセット値
(a) 、 (b)を夫々“0”にセントした後、この
〔再生〕の処理モードが終了したか否かを判別して処理
を終了する(ステツブ#61)。
但し、前記ステツブ#61にて、〔再生〕モードが終了
していない場合は、前記ステフブ#50〜ステフ介60
の処理を繰り返し行うこととなる。
していない場合は、前記ステフブ#50〜ステフ介60
の処理を繰り返し行うこととなる。
尚、本実施例では、第6図に示すように、前記目標ステ
アリング角度データのアドレス値を、全体として16ビ
ツト長で指示するように構成してあり、その上位8ビツ
トの最下位ビット(ビット“0”)を前記方位フラグ(
IIFLAG)として、下位8ビツトの最上位ビット(
ビット“7”)を方位ずれの方向を示す方向フラグ(S
FLAG)として、夫々用いるようにしてある。又、前
記上位8ビツトのうちの前記方位フラグ(HFLAG)
としての最下位ビットを除く7ビソトを、目標ステアリ
ング角度データを記憶したメモリ (図示ぜず)の先頭
アドレスに対応する値にセットすると共に、下位8ビツ
トのビット“5”、“6”の2ビツトを、左側の超音波
センサ(S1)の検出距離データ(CHODAT)に対
応する目標ステアリング角度の前記先頭アドレスに対す
るオフセット値(a)として、下位8ビツトのビット“
1”。
アリング角度データのアドレス値を、全体として16ビ
ツト長で指示するように構成してあり、その上位8ビツ
トの最下位ビット(ビット“0”)を前記方位フラグ(
IIFLAG)として、下位8ビツトの最上位ビット(
ビット“7”)を方位ずれの方向を示す方向フラグ(S
FLAG)として、夫々用いるようにしてある。又、前
記上位8ビツトのうちの前記方位フラグ(HFLAG)
としての最下位ビットを除く7ビソトを、目標ステアリ
ング角度データを記憶したメモリ (図示ぜず)の先頭
アドレスに対応する値にセットすると共に、下位8ビツ
トのビット“5”、“6”の2ビツトを、左側の超音波
センサ(S1)の検出距離データ(CHODAT)に対
応する目標ステアリング角度の前記先頭アドレスに対す
るオフセット値(a)として、下位8ビツトのビット“
1”。
“2”の2ビツトを、右側の超音波センサ(SI)の検
出距離データ(CII OD A T )に対応する目
標ステアリング角度の前記先頭アドレスに対するオフセ
ット値(b)として、夫々示すようにしてあり、前記方
位フラグ(HFLAG)、方向フラグ(SFLAG)、
及び、左右両超音波センサ(Sυの検出距離データ(C
HODAT)の値から直ちに目標ステアリング角度を決
定できるようにしてある。
出距離データ(CII OD A T )に対応する目
標ステアリング角度の前記先頭アドレスに対するオフセ
ット値(b)として、夫々示すようにしてあり、前記方
位フラグ(HFLAG)、方向フラグ(SFLAG)、
及び、左右両超音波センサ(Sυの検出距離データ(C
HODAT)の値から直ちに目標ステアリング角度を決
定できるようにしてある。
前記ステツブ#58において、左右両超音波センサ(S
l)の検出距離データ(CHODAT)から目標ステア
リング角度アドレスのオフセット値(a) 、 (b>
を決定するに、下記表Iに示すように、前記検出距離
データ(CIIODAT)に対応して、前記左右両オフ
セット値(a)、(b)を直接設定するようにテーブル
化してある。
l)の検出距離データ(CHODAT)から目標ステア
リング角度アドレスのオフセット値(a) 、 (b>
を決定するに、下記表Iに示すように、前記検出距離
データ(CIIODAT)に対応して、前記左右両オフ
セット値(a)、(b)を直接設定するようにテーブル
化してある。
表■
尚、本実施例においては、前記検出距離データ(CII
ODAT) (7)値を、後述する区分距離(DIVL
)ニ基づいて、1m、2m、3m、4mとして、夫々設
定してある(第4図参照)。
ODAT) (7)値を、後述する区分距離(DIVL
)ニ基づいて、1m、2m、3m、4mとして、夫々設
定してある(第4図参照)。
但し、検出距離データ(CIIODAT)が1m以内で
ある場合は、衝突防止のために非常停止させるので、操
向制御自体が無意味であり、目標ステアリング角度の設
定は行わないようにしてある。
ある場合は、衝突防止のために非常停止させるので、操
向制御自体が無意味であり、目標ステアリング角度の設
定は行わないようにしてある。
又、前記左右両超音波センサ(SI)の検出距離データ
(CIIODAT)が4m以上ある場合は、操向制御を
行う必要がないので、データ処理の都合上、前記検出距
離データ(CIIODAT)の値を“O”にして目標ス
テアリング角度の設定を行わないようにしてある。勿論
、左右何れかの超音波センサ(Sl)の検出距離データ
(CHODAT)が4m以内である場合は、上記表■に
基づいて目標ステアリング角度のアドレスが設定される
こととなる。
(CIIODAT)が4m以上ある場合は、操向制御を
行う必要がないので、データ処理の都合上、前記検出距
離データ(CIIODAT)の値を“O”にして目標ス
テアリング角度の設定を行わないようにしてある。勿論
、左右何れかの超音波センサ(Sl)の検出距離データ
(CHODAT)が4m以内である場合は、上記表■に
基づいて目標ステアリング角度のアドレスが設定される
こととなる。
次に、前記CPU2の動作について説明する。
第5図(イ)に示すように、前記CPtJ2は、〔再生
〕の処理が開始されると前記CPUIに対して再生モー
ドの開始キーワードを転送すると共に、全走行行程数を
、前記直線行程の個数(KNUM)として人力する(ス
テップ#100.ステフブ#1O1)。
〕の処理が開始されると前記CPUIに対して再生モー
ドの開始キーワードを転送すると共に、全走行行程数を
、前記直線行程の個数(KNUM)として人力する(ス
テップ#100.ステフブ#1O1)。
そして、前記〔ティーチング〕にて記憶された基準方位
(BASDRn)、この基準方位(BASDRn)に対
して設定許容差以上ずれると操向操作するための不惑帯
(FKAN2)、及び、前記超音波センサ(S+)の感
知距離区分を予め設定した区分距離(DIVL)(1m
、 2 m、 3 m、 4 m)に夫々セット
した後、直線行程の走行予定距離を、前記基準距離(D
LENGn)から所定距離を減算した前エリア(KOT
EIF)、前記基準路d(DLENGn)に所定距離を
加算した後エリア(KOTEIB)、及び、回向を確実
に行うために走行速度を減速させるための減速開始地点
に対応する′$i速距離(KOTEI2)、の夫々を算
出して設定し、そして、実際の走行距離を計測する距離
カウンタの値(CNTPl)を、“0”にリセットして
各走行制御情報を初期化して、現走行行程が前記第1〜
第4行程の何れの行程であるかを示す行程フラグ(CF
LAG)を、第1行程(i)を示す“1”にセントする
(ステップ#102〜ステップ11104)。
(BASDRn)、この基準方位(BASDRn)に対
して設定許容差以上ずれると操向操作するための不惑帯
(FKAN2)、及び、前記超音波センサ(S+)の感
知距離区分を予め設定した区分距離(DIVL)(1m
、 2 m、 3 m、 4 m)に夫々セット
した後、直線行程の走行予定距離を、前記基準距離(D
LENGn)から所定距離を減算した前エリア(KOT
EIF)、前記基準路d(DLENGn)に所定距離を
加算した後エリア(KOTEIB)、及び、回向を確実
に行うために走行速度を減速させるための減速開始地点
に対応する′$i速距離(KOTEI2)、の夫々を算
出して設定し、そして、実際の走行距離を計測する距離
カウンタの値(CNTPl)を、“0”にリセットして
各走行制御情報を初期化して、現走行行程が前記第1〜
第4行程の何れの行程であるかを示す行程フラグ(CF
LAG)を、第1行程(i)を示す“1”にセントする
(ステップ#102〜ステップ11104)。
前記ステップ#104にて行程フラグ(CFLAG)が
セットされると、前記変速位置検出用のポテンショメー
タ(R3)の検出値に基づいて前記変速装置(11)の
変速位置を操作して設定走行速度となるようにして走行
を開始し、前記スフ7ブ#101にて入力された行程数
(KNUM)をチェックすることにより、全行程を走行
したか否かを判別する(ステップ#105)。
セットされると、前記変速位置検出用のポテンショメー
タ(R3)の検出値に基づいて前記変速装置(11)の
変速位置を操作して設定走行速度となるようにして走行
を開始し、前記スフ7ブ#101にて入力された行程数
(KNUM)をチェックすることにより、全行程を走行
したか否かを判別する(ステップ#105)。
但し、全行程の走行が終了していると〔再生〕モードを
終了して、前記動作モードを選択する処理に復帰して全
処理を終了することとなる。
終了して、前記動作モードを選択する処理に復帰して全
処理を終了することとなる。
次に、前記受信機(19)の受信情報に基づいて、前記
送信i (18)に設けた割り込みスイッチ(25)が
0N17作されたか否かをチェックすることにより、自
動走行中に遠隔毘縦モードに切り換えるためのラジコン
割り込みがあったか否かを判別すると共に、後述する直
線行程の終了を判別する〔直線終了〕の処理にてセット
された行程フラグ(CFLAG)の値が、前記第2行程
(ii )又は第4行程(iv)の回向行程の値(2又
は4)にセットされているか否かを判別する(ステップ
11106.ステップ#107)。
送信i (18)に設けた割り込みスイッチ(25)が
0N17作されたか否かをチェックすることにより、自
動走行中に遠隔毘縦モードに切り換えるためのラジコン
割り込みがあったか否かを判別すると共に、後述する直
線行程の終了を判別する〔直線終了〕の処理にてセット
された行程フラグ(CFLAG)の値が、前記第2行程
(ii )又は第4行程(iv)の回向行程の値(2又
は4)にセットされているか否かを判別する(ステップ
11106.ステップ#107)。
但し、前記ラジコン割り込みがあった場合は、後述する
〔ラジコン割り込み〕の処理に分岐し、前記行程フラグ
(CFLAG)の値が“2”又は“4″にセットされて
いる場合は、後述する〔回向〕の処理に分岐して、前記
ステフブ#106以降の処理を中断することとなる。
〔ラジコン割り込み〕の処理に分岐し、前記行程フラグ
(CFLAG)の値が“2”又は“4″にセットされて
いる場合は、後述する〔回向〕の処理に分岐して、前記
ステフブ#106以降の処理を中断することとなる。
一方、全行程が終了せず、〔ラジコン割り込み〕も無く
、且つ、前記行程フラグ(CFLAG)が回向行程にセ
ントされていない場合は、前記CPUIからの方位セン
サ(S2)及び超音波センサ(Sl)の各検出データの
転送を待って、そのデータを更新する(ステップ111
08.ステフプ#109)。
、且つ、前記行程フラグ(CFLAG)が回向行程にセ
ントされていない場合は、前記CPUIからの方位セン
サ(S2)及び超音波センサ(Sl)の各検出データの
転送を待って、そのデータを更新する(ステップ111
08.ステフプ#109)。
次に、前記方位フラグ(HFLAG)がセットされてい
るか否かに基づいて、方位ずれつまり基準方位(BAS
DRn)に対する機体の向きがずれているか否かを判別
する(ステップ#110)。
るか否かに基づいて、方位ずれつまり基準方位(BAS
DRn)に対する機体の向きがずれているか否かを判別
する(ステップ#110)。
方位ずれがある場合は、そのずれが方位ずれ無の状態か
ら新たにずれが生じたのか否かに基づいて、前回のデー
タ更新時に方位ずれ有りを検出した状態がmMしている
か否かを判別する(ステップ#111)。
ら新たにずれが生じたのか否かに基づいて、前回のデー
タ更新時に方位ずれ有りを検出した状態がmMしている
か否かを判別する(ステップ#111)。
そして、そのずれが旧のずれである場合は、前記現在方
位(No−〇IR)が判別方位(RASDIR)に対し
て設定不惑帯(FKAN2)内に収束させるために機体
(V)向きを修正する方位ずれ修正のステアリングを達
成しているか否かを判別する(ステップ#112)。
位(No−〇IR)が判別方位(RASDIR)に対し
て設定不惑帯(FKAN2)内に収束させるために機体
(V)向きを修正する方位ずれ修正のステアリングを達
成しているか否かを判別する(ステップ#112)。
又、方位ずれflに正ステアリングを達成している場合
は、そのずれの方向に応じて、前記ステアリング角度用
アドレスの方位ずれ有無を示すビット位置(上位8ビツ
トのビット“0”)すなわち前記方位フラグ(IIFL
AG)及びそのずれ方向を示すビット位置(下位8ビツ
トのビット7)すなわち前記方向フラグ(SFLAG)
の植床々を、直進状態に対応する“0”又は元の値に戻
して、前記目標ステアリング角度を、そのアドレスに対
応するステアリング角度に設定した後、その値に基づい
て、前記ステアリング用油圧シリンダ(9F) 、 (
9R)の電磁弁(IOF) 、 (IOR)を作動させ
る制御信号を出力する(ヌテフ加115)。
は、そのずれの方向に応じて、前記ステアリング角度用
アドレスの方位ずれ有無を示すビット位置(上位8ビツ
トのビット“0”)すなわち前記方位フラグ(IIFL
AG)及びそのずれ方向を示すビット位置(下位8ビツ
トのビット7)すなわち前記方向フラグ(SFLAG)
の植床々を、直進状態に対応する“0”又は元の値に戻
して、前記目標ステアリング角度を、そのアドレスに対
応するステアリング角度に設定した後、その値に基づい
て、前記ステアリング用油圧シリンダ(9F) 、 (
9R)の電磁弁(IOF) 、 (IOR)を作動させ
る制御信号を出力する(ヌテフ加115)。
その後は、前記近接センサ(S3)がONしたか否かを
チェックすることにより、機体(V)が直線行程の終了
地点つまり回向行程の開始地点に達したか否かを判別す
ると共に、前記3つの超音波センサ(S1)の何れか1
つでも走行前方側1m以内に障害物を感知したか否かを
チェックする。そして、前記近接センサ(S3)がON
している場合は、直線行程を終了して次の直線行程に向
けて回向するための直線終了処理に分岐し、前記超音波
センサ(Sl)が走行前方側1m以内に障害物を感知し
た場合は、非常停止させるとともに、その後の回避を前
記〔ラジコン割り込み〕により遠隔操縦にて行うために
後述する(ラジコン要求〕の処理に分岐する(ステツブ
11116.ステフプ#117)。
チェックすることにより、機体(V)が直線行程の終了
地点つまり回向行程の開始地点に達したか否かを判別す
ると共に、前記3つの超音波センサ(S1)の何れか1
つでも走行前方側1m以内に障害物を感知したか否かを
チェックする。そして、前記近接センサ(S3)がON
している場合は、直線行程を終了して次の直線行程に向
けて回向するための直線終了処理に分岐し、前記超音波
センサ(Sl)が走行前方側1m以内に障害物を感知し
た場合は、非常停止させるとともに、その後の回避を前
記〔ラジコン割り込み〕により遠隔操縦にて行うために
後述する(ラジコン要求〕の処理に分岐する(ステツブ
11116.ステフプ#117)。
次に、前記距離センサ(S4)の検出情報に基づいて走
行距離をカウントする距離カウンタの値(CNTPI)
と前記減速距離(に0TEI2)とを比較することによ
って減速地点に達したか否かを判別し、前記減速距離(
KOTEI2)に達している場合は、予め設定してある
走行速度となるように減速操作を行い、減速距離(KO
TEI2)に達していない場合はそのままで、前記ステ
ツブ#105からの処理に復帰する(ステフブ#118
.ステフブ#119)。
行距離をカウントする距離カウンタの値(CNTPI)
と前記減速距離(に0TEI2)とを比較することによ
って減速地点に達したか否かを判別し、前記減速距離(
KOTEI2)に達している場合は、予め設定してある
走行速度となるように減速操作を行い、減速距離(KO
TEI2)に達していない場合はそのままで、前記ステ
ツブ#105からの処理に復帰する(ステフブ#118
.ステフブ#119)。
前記ステツブ#114のステアリング角度アドレスの設
定、並びに、その設定値に基づいて、目標ステアリング
角度を読み出すための処理について詳述すれば、前記方
位フラグ(HFLAG)の値により方位ずれ無しの場合
は、下記表■に基づいて、方位ずれ有りの場合は、その
ずれ方向を示す方向フラグ(SFLAG)の値により下
記表■又は表■に基づいて、前記前後輪(3F) 、
(3R)夫々の目標ステアリング角度を設定するように
してある。
定、並びに、その設定値に基づいて、目標ステアリング
角度を読み出すための処理について詳述すれば、前記方
位フラグ(HFLAG)の値により方位ずれ無しの場合
は、下記表■に基づいて、方位ずれ有りの場合は、その
ずれ方向を示す方向フラグ(SFLAG)の値により下
記表■又は表■に基づいて、前記前後輪(3F) 、
(3R)夫々の目標ステアリング角度を設定するように
してある。
つまり、方位ずれ無しの場合は、左右に位置する走行用
ガイドとしての樹木(F)の中間に機体(V)が位置す
るように、表■に基づいて、平行ステアリング形式にて
部体(V)横幅方向の位置のみを修正することとなる。
ガイドとしての樹木(F)の中間に機体(V)が位置す
るように、表■に基づいて、平行ステアリング形式にて
部体(V)横幅方向の位置のみを修正することとなる。
一方、方位ずれ有りの場合は、前記方向フラグ(SFL
AG)の値に対応して下記表■又は表■を選択する。つ
まり、前記方向フラグ(SFLAG)が“O”となり左
方向にずれている場合(第7図(イ)参照)は、下記表
■を選択し、前記方向フラグ(SFLAG)が“l”と
なり右方向にずれている場合(第7図(n)参照)は、
下記表■を選択して、機体(V)横幅方向の位置が左右
に位置する走行用ガイドとしての樹木(F)の中間とな
り、且つ、機体(V)の向きである前記現在方位(NO
WDIR)が前記基準方位(RASDIR) ニ対して
設定不惑帯(FUKAN2)内に維持されるように、機
体(V)の向きと横幅方向の両方を同時に変えるステア
リング形式にて修正するようにしてある。
AG)の値に対応して下記表■又は表■を選択する。つ
まり、前記方向フラグ(SFLAG)が“O”となり左
方向にずれている場合(第7図(イ)参照)は、下記表
■を選択し、前記方向フラグ(SFLAG)が“l”と
なり右方向にずれている場合(第7図(n)参照)は、
下記表■を選択して、機体(V)横幅方向の位置が左右
に位置する走行用ガイドとしての樹木(F)の中間とな
り、且つ、機体(V)の向きである前記現在方位(NO
WDIR)が前記基準方位(RASDIR) ニ対して
設定不惑帯(FUKAN2)内に維持されるように、機
体(V)の向きと横幅方向の両方を同時に変えるステア
リング形式にて修正するようにしてある。
表■ 方位ずれ無しくHFLAG=0)但し、上記各表
において、Nはステアリング角度が零の操向中立状態で
あることを示し、上段は前輪(3F)の目標ステアリン
グ角度を、下段は後輪(3R)の目標ステアリング角度
を、夫々示す。
において、Nはステアリング角度が零の操向中立状態で
あることを示し、上段は前輪(3F)の目標ステアリン
グ角度を、下段は後輪(3R)の目標ステアリング角度
を、夫々示す。
又、上記各表における目標ステアリング角度は、障害物
つまり走行用ガイドとしての樹木(F)に対する距離が
短いほど大きくステアリング操作して速く機体(V)の
向きや位置を修正できるように、前記左右夫々の超音波
センサ(S+)による検出距離データ(CHODAT)
に対応させて設定してある。
つまり走行用ガイドとしての樹木(F)に対する距離が
短いほど大きくステアリング操作して速く機体(V)の
向きや位置を修正できるように、前記左右夫々の超音波
センサ(S+)による検出距離データ(CHODAT)
に対応させて設定してある。
又、上記表■及び表■において、機体(V)の向きと横
幅方向の位置の両方を同時に修正するに、前記超音波セ
ンサ(Sl)による検出距離が遠く、方向及び位置の修
正に余裕がある場合は、機体(V)の向きと横幅方向の
位置の夫々がゆっくりと修正されるようにするため、前
輪(3F)のみを操向操作する2輪ステアリング形式に
て操向し、超音波センサ(S1)による検出距離が近く
、方向及び位置の修正に余裕が無い場合は、機体(V)
の向きと横幅方向の位置の夫々が速く修正されるように
、前後輪(3F) 、 (3R)の両方を、夫々の操向
量に差を付ける状態で同一方向に向けて操向するオフセ
ント付き平行ステアリング形式にて操向するようにして
ある。
幅方向の位置の両方を同時に修正するに、前記超音波セ
ンサ(Sl)による検出距離が遠く、方向及び位置の修
正に余裕がある場合は、機体(V)の向きと横幅方向の
位置の夫々がゆっくりと修正されるようにするため、前
輪(3F)のみを操向操作する2輪ステアリング形式に
て操向し、超音波センサ(S1)による検出距離が近く
、方向及び位置の修正に余裕が無い場合は、機体(V)
の向きと横幅方向の位置の夫々が速く修正されるように
、前後輪(3F) 、 (3R)の両方を、夫々の操向
量に差を付ける状態で同一方向に向けて操向するオフセ
ント付き平行ステアリング形式にて操向するようにして
ある。
次に、前記ステツブ#116にて近接センサ(S3)が
ONするに伴って分岐する〔直線終了〕の処理について
説明する。
ONするに伴って分岐する〔直線終了〕の処理について
説明する。
すなわち、第8図に示すように、前記距離カウンタの値
(CNTPI)が前エリア(KOTEIF)及び後エリ
ア(KOTEIB)の間にあるか否かを判別することに
より、回向許可範囲内に機体(V)があるか否かを判別
し、回向許可範囲内に機体(V)がない場合は、後述す
る〔ラジコン要求〕の処理に分岐して、前記送信機(1
8)にて遠隔操縦にて回向させるようにする(ステツブ
#200)。
(CNTPI)が前エリア(KOTEIF)及び後エリ
ア(KOTEIB)の間にあるか否かを判別することに
より、回向許可範囲内に機体(V)があるか否かを判別
し、回向許可範囲内に機体(V)がない場合は、後述す
る〔ラジコン要求〕の処理に分岐して、前記送信機(1
8)にて遠隔操縦にて回向させるようにする(ステツブ
#200)。
前記距離カウンタの値(CNTPI)が回向許可範囲内
にある場合は、前記行程フラグ(CFLAG)の値に基
づいて行程フラグ(CFLAG)の値を第2行程(ii
)又は第4行程(1v)を示す値(2又は4)に夫々セ
ットして、回向行程の終了を判別するための反転方位(
BASDR2又はBASDRI)を設定すると共に、前
記行程数(にNUM)を減算して、前記ステフ加105
以降の掻向制御処理に復帰する(ス5yブ#201〜ス
テップ#206)。
にある場合は、前記行程フラグ(CFLAG)の値に基
づいて行程フラグ(CFLAG)の値を第2行程(ii
)又は第4行程(1v)を示す値(2又は4)に夫々セ
ットして、回向行程の終了を判別するための反転方位(
BASDR2又はBASDRI)を設定すると共に、前
記行程数(にNUM)を減算して、前記ステフ加105
以降の掻向制御処理に復帰する(ス5yブ#201〜ス
テップ#206)。
従って、上述した処理により前記行程フラグ(CFLA
G)の値は直線行程を示す“1”又は“3”から回向行
程を示す“′2”又は“4”に変わっていることから、
前記ステップIt107の回向判別処理では、自動的に
C回向〕の処理に分岐することとなる。
G)の値は直線行程を示す“1”又は“3”から回向行
程を示す“′2”又は“4”に変わっていることから、
前記ステップIt107の回向判別処理では、自動的に
C回向〕の処理に分岐することとなる。
次に、前記〔回向〕の処理について詳述する。
第9図に示すように、前記〔直線終了〕にてセントされ
た行程フラグ(CFLAG)の値に基づいて、前記〔外
周ティーチング〕にて記憶された第2行程(11)又は
第4行程(1v)の何れかの記憶ステアリング角度の情
報を読み出すように設定すると共に、各回向行程での終
了を判別するための反転方位(BASDRI又はBAS
DR2)、方位の不惑帯(FUKAN2)、及び、前記
超音波センサ(S1)の区分距離(DIVL)の夫々を
再設定する(ステップ11300〜ステツプ1304)
。
た行程フラグ(CFLAG)の値に基づいて、前記〔外
周ティーチング〕にて記憶された第2行程(11)又は
第4行程(1v)の何れかの記憶ステアリング角度の情
報を読み出すように設定すると共に、各回向行程での終
了を判別するための反転方位(BASDRI又はBAS
DR2)、方位の不惑帯(FUKAN2)、及び、前記
超音波センサ(S1)の区分距離(DIVL)の夫々を
再設定する(ステップ11300〜ステツプ1304)
。
そして、前記CPUIによる方位センサ(S2)および
超音波センサ(S+)夫々の検出データ更新を確認した
後、その更新された各データつまり現在方位(NOWD
IR)、超音波センサ(S1)による検出距離データ(
CHODAT)、及び、方位フラグ()IFLAG)を
受は取る(ステップ11305.ステップ+1306)
。
超音波センサ(S+)夫々の検出データ更新を確認した
後、その更新された各データつまり現在方位(NOWD
IR)、超音波センサ(S1)による検出距離データ(
CHODAT)、及び、方位フラグ()IFLAG)を
受は取る(ステップ11305.ステップ+1306)
。
その後、前記ステアリング位置検出用ポテンショメータ
(R+)、(Rz)の値をサンプリングしたか否かを確
認した後、目標ステアリング角度である前記ステアリン
グ操作のティーチングデータを更新する(ステフブ#3
07.ステフブ#308)。
(R+)、(Rz)の値をサンプリングしたか否かを確
認した後、目標ステアリング角度である前記ステアリン
グ操作のティーチングデータを更新する(ステフブ#3
07.ステフブ#308)。
次に、前記ティーチングデータを全て出力したか否かを
判別するとともに、前記方位フラグ(IIFLAG)が
セットされているか否かに基づいて、機体(V)向きが
次行程方向に反転したか否かを判別し、前記全ティーチ
ングデータが出力されたか、又は、方位フラグ(HFL
AG)がセントされている場合は、後述するステフブ#
313〜ステフブ#3工8の次の直線行程に対する各種
データのセントを行う〔初期化ルーチン〕に分岐し、全
ティーチングデータが出力されず、且つ、前記方位フラ
グ(IIFLAG)がセントされていない場合は、前記
直線行程におけるラジコン割り込みの有無、及び、超音
波センサ(S1)が1m以内に障害物を恩知したか否か
を判別して、前記ヌテフプ#305以降のティーチング
データの再生処理を繰り返すこととなる(ステフブ#3
09〜ステフブ#312)。
判別するとともに、前記方位フラグ(IIFLAG)が
セットされているか否かに基づいて、機体(V)向きが
次行程方向に反転したか否かを判別し、前記全ティーチ
ングデータが出力されたか、又は、方位フラグ(HFL
AG)がセントされている場合は、後述するステフブ#
313〜ステフブ#3工8の次の直線行程に対する各種
データのセントを行う〔初期化ルーチン〕に分岐し、全
ティーチングデータが出力されず、且つ、前記方位フラ
グ(IIFLAG)がセントされていない場合は、前記
直線行程におけるラジコン割り込みの有無、及び、超音
波センサ(S1)が1m以内に障害物を恩知したか否か
を判別して、前記ヌテフプ#305以降のティーチング
データの再生処理を繰り返すこととなる(ステフブ#3
09〜ステフブ#312)。
前記〔初期化ルーチン〕について説明すれば、前記〔再
生〕の処理ルーチンのステフブ#102〜ス5フブ#1
04と同様の処理にて、前記行程フラグ(CFLAG)
の値に基づいて、走行予定距離(DLENGI、 DL
ENG2)を基準に前エリア(KOTEIF)、後エリ
ア(KOTEIB)、及び、減速距離(KOTEI2)
の夫々を設定すると共に、前記距離カウンタの値(CN
TPI)を“O″のリセットし、次の直線行程の方向に
基づいて、前記行程フラグ(CFLAG)の値を“1”
又は“3”にセットする。そして、基準方位(BASD
Rn)、その基準方位(BASDRn)に対する不感帯
(FUKAN2)、及び、前記超音波センサ(S+)に
対する感知距離の区分距離(DIVL)の夫々を設定し
て、前述した〔再生〕ルーチンの全行程終了の判別処理
(ステップ#105)に復帰することとなる(ステフブ
#313〜ステフブ#318)。
生〕の処理ルーチンのステフブ#102〜ス5フブ#1
04と同様の処理にて、前記行程フラグ(CFLAG)
の値に基づいて、走行予定距離(DLENGI、 DL
ENG2)を基準に前エリア(KOTEIF)、後エリ
ア(KOTEIB)、及び、減速距離(KOTEI2)
の夫々を設定すると共に、前記距離カウンタの値(CN
TPI)を“O″のリセットし、次の直線行程の方向に
基づいて、前記行程フラグ(CFLAG)の値を“1”
又は“3”にセットする。そして、基準方位(BASD
Rn)、その基準方位(BASDRn)に対する不感帯
(FUKAN2)、及び、前記超音波センサ(S+)に
対する感知距離の区分距離(DIVL)の夫々を設定し
て、前述した〔再生〕ルーチンの全行程終了の判別処理
(ステップ#105)に復帰することとなる(ステフブ
#313〜ステフブ#318)。
次に、前記〔ラジコン割り込み〕の処理について詳述す
る。
る。
第10図に示すように、先ず、前記行程フラグ(CFL
AG)の値に基づいて、現在の走行行程が直線行程であ
るか回向行程であるかを判別する(ステップ#400)
。
AG)の値に基づいて、現在の走行行程が直線行程であ
るか回向行程であるかを判別する(ステップ#400)
。
そして、現在の走行行程が直線行程である場合は、前記
受信機(19)を介して入力される前記割り込みスイッ
チ(25)の状態に基づいて、この〔ラジコン割り込み
〕の処理が終了したか否かを判別し、処理が終了してい
る場合は、現走行行程の基準方位(BASDRn)に対
して予め設定してある不感帯(SFUKAN) (本実
施例では、約士約2度に設定してある)内にあるか否か
を判別する。
受信機(19)を介して入力される前記割り込みスイッ
チ(25)の状態に基づいて、この〔ラジコン割り込み
〕の処理が終了したか否かを判別し、処理が終了してい
る場合は、現走行行程の基準方位(BASDRn)に対
して予め設定してある不感帯(SFUKAN) (本実
施例では、約士約2度に設定してある)内にあるか否か
を判別する。
現在方位(NOWDIR)が、前記不惑帯(SFUKA
N)内にある場合は、自動走行を継続すべく、前記〔再
生〕の処理ルーチンの全行程終了の判別処理(ス?)f
lt105)に復帰し、前記不感帯(SFUKAN)外
である場合は、再度、前記送信機(18)による遠隔操
縦を継続すべく作業者に報知させる後述する〔ラジコン
要求〕の処理に分岐する(ステツブ11401〜ステフ
ブ11403)。
N)内にある場合は、自動走行を継続すべく、前記〔再
生〕の処理ルーチンの全行程終了の判別処理(ス?)f
lt105)に復帰し、前記不感帯(SFUKAN)外
である場合は、再度、前記送信機(18)による遠隔操
縦を継続すべく作業者に報知させる後述する〔ラジコン
要求〕の処理に分岐する(ステツブ11401〜ステフ
ブ11403)。
そして、前記ス??ブ#401にて割り込み処理が終了
していない場合は、前記近接センサ(S3)がONした
か否か、つまり、直線行程が終了したか否かを判別し、
前記近接センサ(S3)がONしていない場合は、前記
ステツブ#401の割り込み処理終了の判別処理を繰り
返し、近接センサ(S3)がONしている場合は、前記
〔再生〕ルーチン同様に、前記距離カウンタの値(CN
TPl)が回向許可距離(KOTEIF≦CNTPI≦
KOTEIB)に達しているか否かを判別する(ステフ
ブ#404.ステフブ#405)。
していない場合は、前記近接センサ(S3)がONした
か否か、つまり、直線行程が終了したか否かを判別し、
前記近接センサ(S3)がONしていない場合は、前記
ステツブ#401の割り込み処理終了の判別処理を繰り
返し、近接センサ(S3)がONしている場合は、前記
〔再生〕ルーチン同様に、前記距離カウンタの値(CN
TPl)が回向許可距離(KOTEIF≦CNTPI≦
KOTEIB)に達しているか否かを判別する(ステフ
ブ#404.ステフブ#405)。
前記距離カウンタの値(CNTPI)が回向許可距離に
達している場合は、前記行程フラグ(CFLAG)の値
に基づいて、次に起動すべき回向行程が前記第2行程(
ii)であるか第4行程(iv)であるかを判別して、
前記行程フラグ(CPLAG)を対応する値にセットす
ると共に、反転方位(BASDRI又はBASDR2)
を設定して、行程数(KNUM)を減算した後、前記ス
テフッ#400の現行程が直線行程であるか回向行程で
あるかの判別処理を繰り返す(ステップ#406〜ステ
フブ#411)。
達している場合は、前記行程フラグ(CFLAG)の値
に基づいて、次に起動すべき回向行程が前記第2行程(
ii)であるか第4行程(iv)であるかを判別して、
前記行程フラグ(CPLAG)を対応する値にセットす
ると共に、反転方位(BASDRI又はBASDR2)
を設定して、行程数(KNUM)を減算した後、前記ス
テフッ#400の現行程が直線行程であるか回向行程で
あるかの判別処理を繰り返す(ステップ#406〜ステ
フブ#411)。
一方、現走行行程が、回向行程である場合は、前記基準
方位(BASDRn)に対する不感帯を回向行程での不
感帯(KFUKAN)に設定すると共に、前記ステツブ
#401の処理と同様の処理にて、この〔ラジコン割り
込み〕の処理が終了するまで待機する(ステツブ141
2.ステフブ#413)。
方位(BASDRn)に対する不感帯を回向行程での不
感帯(KFUKAN)に設定すると共に、前記ステツブ
#401の処理と同様の処理にて、この〔ラジコン割り
込み〕の処理が終了するまで待機する(ステツブ141
2.ステフブ#413)。
そして、〔ラジコン割り込み〕の処理が終了するに伴っ
て、前記現在方位(NOWDIR)が判別方位(RAS
DIR)に対して前記不感帯(KFUKAN)内に一致
したか否かに基づいて機体(V)向きが次の行程方向に
変化したか否かを判別し、方位が反転すると、前記〔回
向〕ルーチンにおけるステフブ#312〜ヌTフ介31
7に示す直線行程での基準データを設定する〔初期化ル
ーチン〕の処理を行った後、前記ステツブ#400の現
行程が直線行程であるか回向行程であるかの判別処理に
復帰する。一方、〔ラジコン割り込み〕の処理が終了し
ていても、前記現在方位(NOWDIR)の方位が反転
していない場合は、回向行程の走行が終了するまで遠隔
操縦する前記ステップ#403の〔ラジコン要求〕の処
理に分岐することとなる(ステフブ#413〜ステフブ
#415)。
て、前記現在方位(NOWDIR)が判別方位(RAS
DIR)に対して前記不感帯(KFUKAN)内に一致
したか否かに基づいて機体(V)向きが次の行程方向に
変化したか否かを判別し、方位が反転すると、前記〔回
向〕ルーチンにおけるステフブ#312〜ヌTフ介31
7に示す直線行程での基準データを設定する〔初期化ル
ーチン〕の処理を行った後、前記ステツブ#400の現
行程が直線行程であるか回向行程であるかの判別処理に
復帰する。一方、〔ラジコン割り込み〕の処理が終了し
ていても、前記現在方位(NOWDIR)の方位が反転
していない場合は、回向行程の走行が終了するまで遠隔
操縦する前記ステップ#403の〔ラジコン要求〕の処
理に分岐することとなる(ステフブ#413〜ステフブ
#415)。
前記〔ラジコン要求〕の処理について説明すれば、第1
1図に示すように、前記機体(V)を非常停止させると
共に、機体(V)の上部に設けられた警告灯(26)(
第3図、第4図参照)を点灯させ、て、遠隔操縦にて機
体(V)の走行を縁線するように、作業者に報知すると
共に、前記〔ラジコン割り込み〕の処理同様に、割り込
みが発生するまで待機する。そして、割り込みが発生す
るに伴って、前記警告灯(26)を消煙して、前記〔ラ
ジコン割り込み〕のステツブ#400に分岐することと
なる。
1図に示すように、前記機体(V)を非常停止させると
共に、機体(V)の上部に設けられた警告灯(26)(
第3図、第4図参照)を点灯させ、て、遠隔操縦にて機
体(V)の走行を縁線するように、作業者に報知すると
共に、前記〔ラジコン割り込み〕の処理同様に、割り込
みが発生するまで待機する。そして、割り込みが発生す
るに伴って、前記警告灯(26)を消煙して、前記〔ラ
ジコン割り込み〕のステツブ#400に分岐することと
なる。
従って、自動走行中に、誤動作が発生したり障害物を感
知して、機体(V)が、直線行程や回向行程の途中で停
止しても、前記送信機(18)の割り込みスイ・7チ(
25)をONすれば、遠隔操縦にて走行を継続できると
共に、上述した所定の条件を満たせば、自動走行モード
に自動的に復帰させることができるのである。尚ぐ前記
〔ラジコン割り込み〕の処理は、正常に自動走行中であ
っても、前記送信機(18)の割り込みスイッチ(25
)をON操作すれば、自動的に起動されて、遠隔操縦す
ることができるのは、勿論である。
知して、機体(V)が、直線行程や回向行程の途中で停
止しても、前記送信機(18)の割り込みスイ・7チ(
25)をONすれば、遠隔操縦にて走行を継続できると
共に、上述した所定の条件を満たせば、自動走行モード
に自動的に復帰させることができるのである。尚ぐ前記
〔ラジコン割り込み〕の処理は、正常に自動走行中であ
っても、前記送信機(18)の割り込みスイッチ(25
)をON操作すれば、自動的に起動されて、遠隔操縦す
ることができるのは、勿論である。
上記実施例においては、作業車を薬剤散布作業車に構成
した場合を例示したが、本発明は、その他のコンバイン
や芝刈り作業車等の各種作業車にも適用できるものであ
って、操縦手段や制御手段並びに各種センサ等の各部の
具体構成、及び、使用する走行用ガイドの具体構成等は
、本発明を適用する作業車の形態や走行形態に応じて各
種変更することになるものであって、木実施例に限定さ
れるものではない。
した場合を例示したが、本発明は、その他のコンバイン
や芝刈り作業車等の各種作業車にも適用できるものであ
って、操縦手段や制御手段並びに各種センサ等の各部の
具体構成、及び、使用する走行用ガイドの具体構成等は
、本発明を適用する作業車の形態や走行形態に応じて各
種変更することになるものであって、木実施例に限定さ
れるものではない。
又、上記実施例では、直線行程を往復走行するべく18
0度回向するように構成した場合を例示したが、本発明
は、90度交差する直線行程を順次回り走行させるよう
な場合にも通用できるものであって、直線行程並びに回
向行程夫々での具体的な走行形態は、各種変更できる。
0度回向するように構成した場合を例示したが、本発明
は、90度交差する直線行程を順次回り走行させるよう
な場合にも通用できるものであって、直線行程並びに回
向行程夫々での具体的な走行形態は、各種変更できる。
図面は本発明に係る自動走行作業車の操向制御装置の実
施例を示し、第1図は制御システムの概略構成を示すブ
ロック図、第2図は走行経路の説明図、第3図は薬剤散
布作業車の全体側面図、第4図は超音波センサの障害物
感知エリア及び薬剤散布作業車の概略構成を示す平面図
、第5図(イ)は再生時のCPU2の動作を示すフロー
チャート、同図(o)はCPU1の動作を示すフローチ
ャート、第6図は目標ステアリング角度アドレスのデー
タ構成を示す図面、第7図(イ’) 、 (Il+)は
方位ずれの説明図、第8図は直線終了判別のフローチャ
ート、第9図は回向処理のフローチャート、第10図は
ラジコン割り込み処理のフローチャート、第11図はラ
ジコン要求のフローチャートである。 (3F) 、 (3R)・・・・・・前後輪、(V)・
・・・・・機体、(F)・・・・・・走行用ガイド、(
Sl)、(S2)・・・・・・センサ、(100)・・
・・・・操向制御手段。
施例を示し、第1図は制御システムの概略構成を示すブ
ロック図、第2図は走行経路の説明図、第3図は薬剤散
布作業車の全体側面図、第4図は超音波センサの障害物
感知エリア及び薬剤散布作業車の概略構成を示す平面図
、第5図(イ)は再生時のCPU2の動作を示すフロー
チャート、同図(o)はCPU1の動作を示すフローチ
ャート、第6図は目標ステアリング角度アドレスのデー
タ構成を示す図面、第7図(イ’) 、 (Il+)は
方位ずれの説明図、第8図は直線終了判別のフローチャ
ート、第9図は回向処理のフローチャート、第10図は
ラジコン割り込み処理のフローチャート、第11図はラ
ジコン要求のフローチャートである。 (3F) 、 (3R)・・・・・・前後輪、(V)・
・・・・・機体、(F)・・・・・・走行用ガイド、(
Sl)、(S2)・・・・・・センサ、(100)・・
・・・・操向制御手段。
Claims (1)
- 【特許請求の範囲】 [1]前後輪(3F)、(3R)の夫々を操向操作自在
に構成された機体(V)を走行用ガイド(F)に沿って
自動走行させるべく、前記走行用ガイド(F)の長さ方
向に基づいて設定した基準方位に対する機体(V)の向
きを検出するセンサ(S_2)及び前記走行用ガイド(
F)に対する機体(V)の横幅方向の位置を検出するセ
ンサ(S_1)による検出情報に基づいて、前記前後輪
(3F)、(3R)夫々を自動的に操向操作する操向制
御手段(100)を備えた自動走行作業車の操向制御装
置であって、前記操向制御手段(100)を、機体(V
)の向きが設定基準方位から外れ、且つ、前記走行用ガ
イド(F)に対する機体(V)の横幅方向の位置が設定
適正位置から外れている場合は、前記機体(V)の向き
及び横幅方向の位置を同時に修正するステアリング形式
にて操向するように構成してある自動走行作業車の操向
制御装置。 [2]前記ステアリング形式が、前記前後輪(3F)、
(3R)の操向量に差を付ける状態で同一方向に向けて
ステアリング操作するステアリング形式である特許請求
の範囲第[1]項に記載の自動走行作業車の操向制御装
置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP61108045A JPS62265906A (ja) | 1986-05-12 | 1986-05-12 | 自動走行作業車の操向制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP61108045A JPS62265906A (ja) | 1986-05-12 | 1986-05-12 | 自動走行作業車の操向制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPS62265906A true JPS62265906A (ja) | 1987-11-18 |
JPH0570402B2 JPH0570402B2 (ja) | 1993-10-05 |
Family
ID=14474536
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP61108045A Granted JPS62265906A (ja) | 1986-05-12 | 1986-05-12 | 自動走行作業車の操向制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS62265906A (ja) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH04114212A (ja) * | 1990-09-05 | 1992-04-15 | Shikoku Sogo Kenkyusho:Kk | 走行作業車の誘導制御装置 |
JP2021027806A (ja) * | 2019-08-09 | 2021-02-25 | 和同産業株式会社 | 自律制御型草刈機 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6024109A (ja) * | 1983-07-18 | 1985-02-06 | 株式会社クボタ | 自動走行作業車 |
-
1986
- 1986-05-12 JP JP61108045A patent/JPS62265906A/ja active Granted
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6024109A (ja) * | 1983-07-18 | 1985-02-06 | 株式会社クボタ | 自動走行作業車 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH04114212A (ja) * | 1990-09-05 | 1992-04-15 | Shikoku Sogo Kenkyusho:Kk | 走行作業車の誘導制御装置 |
JP2021027806A (ja) * | 2019-08-09 | 2021-02-25 | 和同産業株式会社 | 自律制御型草刈機 |
Also Published As
Publication number | Publication date |
---|---|
JPH0570402B2 (ja) | 1993-10-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US5079706A (en) | Control system for self-propelled working vehicle including vehicle course correction means | |
JPS633711A (ja) | 自動走行作業車の走行制御装置 | |
JPS62265906A (ja) | 自動走行作業車の操向制御装置 | |
JPS63157908A (ja) | 樹木間走行作業車の操向制御装置 | |
JPS63153605A (ja) | 自動走行作業車の操向制御装置 | |
JPS62259110A (ja) | 自動走行作業車の走行制御装置 | |
JPS637706A (ja) | 自動走行作業車の走行制御装置 | |
JPS62296805A (ja) | 自動走行作業車の走行制御装置 | |
JPS633710A (ja) | 自動走行作業車の走行制御装置 | |
JPH0570403B2 (ja) | ||
JPS62285114A (ja) | 自動走行作業車の走行制御装置 | |
JPS62294003A (ja) | 自動走行作業車の走行制御装置 | |
JPS63204A (ja) | 自動走行作業車の走行制御装置 | |
JPS62297909A (ja) | 自動走行作業車の走行制御装置 | |
JP3533575B2 (ja) | 作業車 | |
JPS62248011A (ja) | 作業車の走行制御装置 | |
JPS62269769A (ja) | 薬剤散布作業車の走行制御装置 | |
JPS63298114A (ja) | 作業車用の測距装置 | |
JPS6049406A (ja) | 自動走行作業車 | |
JPH01108909A (ja) | 自動走行式芝刈り作業車の操向制御装置 | |
JPS63158153A (ja) | 薬剤散布作業車の走行制御装置 | |
JP2571238B2 (ja) | 自動走行式芝刈り作業車の操向制御装置 | |
JPH01109413A (ja) | 自動走行作業車の操向制御装置 | |
TWM605304U (zh) | 農地循跡自走的載具 | |
JPH011010A (ja) | 自動走行作業車の走行制御装置 |