JPS63158152A - Running control apparatus of chemical agent sprinkling work vehicle - Google Patents

Running control apparatus of chemical agent sprinkling work vehicle

Info

Publication number
JPS63158152A
JPS63158152A JP30597886A JP30597886A JPS63158152A JP S63158152 A JPS63158152 A JP S63158152A JP 30597886 A JP30597886 A JP 30597886A JP 30597886 A JP30597886 A JP 30597886A JP S63158152 A JPS63158152 A JP S63158152A
Authority
JP
Japan
Prior art keywords
stroke
aircraft
state
spraying
distance
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
Application number
JP30597886A
Other languages
Japanese (ja)
Inventor
Tetsuo Yamaguchi
哲雄 山口
Shingo Yoshimura
吉村 愼吾
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 JP30597886A priority Critical patent/JPS63158152A/en
Publication of JPS63158152A publication Critical patent/JPS63158152A/en
Pending legal-status Critical Current

Links

Landscapes

  • Guiding Agricultural Machines (AREA)
  • Catching Or Destruction (AREA)
  • Special Spraying Apparatus (AREA)

Abstract

PURPOSE:To eliminate the wastefulness of a chemical agent in a turnaround process, by making it possible to control the sprinkling state of a chemical agent sprinkling apparatus in the turnaround process on the basis of set data. CONSTITUTION:A control apparatus 17 controls the operation of various actuators on the basis of the detection data of sensors S1-S4 and potentiometers R1-R3, the receiving data of a receiver 21 and preliminarily stored and set running control data and allows a machine body to automatically run to a straight line process and a turnaround process. In the turnabout process, the running control data is taught and the values of three nozzle switches 16L, 16R, 16C are successively added at each time when the steering angles of steering angle detecting potentiometers R1, R2 are sampled to renew the respective values of three sprinkling counters sampling a scattering state. By this method, the chemical agent sprinkling state in the turnabout process is taught.

Description

【発明の詳細な説明】 〔産業上の利用分野〕 本発明は、薬剤の散布状態を切り換え自在な薬剤散布装
置を備えた機体が、直線行程と、直線行程の終端部から
次の直線行程の始端部へ前記機体を移動させる回向行程
の夫々において、薬剤を散布しながら自動走行するよう
に制御する走行制御手段を設けてある薬・剤敗布作業車
の走行制御装置に関する。
[Detailed Description of the Invention] [Industrial Application Field] The present invention provides an airframe equipped with a chemical spraying device capable of freely changing the chemical spraying state, which can be used in a straight line stroke and from the end of a straight line stroke to the next straight line stroke. The present invention relates to a travel control device for a medicine/reagent-degrading cloth work vehicle, which is provided with a travel control means for automatically controlling the vehicle to travel while spraying chemicals during each of the turning strokes in which the body is moved to the starting end.

〔従来の技術〕[Conventional technology]

上記この種の薬剤散布作業車の走行制御装置においては
、一般に、直線行程においては、機体の左右両側や上方
に向けて薬剤を散布しながら自動走行させることにより
、機体の両側に位置する樹木に対する散布作業を自動的
に行うこととなる。
In general, in the above-mentioned travel control device for this type of chemical spraying work vehicle, when traveling in a straight line, the vehicle automatically travels while spraying chemicals on both left and right sides of the vehicle and upward, thereby spraying chemicals on trees located on both sides of the vehicle. Spraying work will be performed automatically.

そして、従来では、回向行程においても、直腺行程と同
様に薬剤を散布しながら走行させるようにしてあった。
Conventionally, in the turning stroke, the medicine was also spread while traveling in the same way as in the straight stroke.

〔発明が解決しようとする問題点〕[Problem that the invention seeks to solve]

しかしながら、例えば回向行程の外側に道路が位置して
いるような場合、薬剤を散布しながら回向させると、回
向行程の外側に位置する薬剤の散布が不要な道路側に薬
剤が散布される状態となる等、回向行程において薬剤が
無駄になる震れがあった。
However, for example, if a road is located outside the turning path, if the agent is sprayed while turning, the agent will be sprayed on the side of the road, which is located outside the turning path and does not need to be sprayed. There were tremors that caused the drug to be wasted during the recirculation process, such as when the patient was in a state where the patient was in a state of trembling.

本発明は、上記実情に鑑みてなされたものであって、そ
の目的は、回向行程における薬剤の散布状態を設定でき
るようにして、回向行程において無駄な薬剤が散布され
ないようにすることにある。
The present invention has been made in view of the above-mentioned circumstances, and its purpose is to make it possible to set the spraying state of chemicals during the redirection process, thereby preventing unnecessary spraying of chemicals during the redirection process. be.

〔問題点を解決するための手段〕[Means for solving problems]

本発明による薬剤散布作業車の走行制御装置の特徴構成
は、前記回向行程における薬剤散布状態を設定する散布
状態設定手段を設け、前記散布状態設定手段による設定
情報に基づいて、前記回向行程における前記薬剤散布装
置の散布状態を制御する散布状態制御手段を設けてある
点にあり、その作用並びに効果は以下の通りである。
A characteristic configuration of the travel control device for a chemical spraying work vehicle according to the present invention is that a spraying state setting means is provided for setting a chemical spraying state in the turning stroke, and the spraying state setting means is configured to set a spraying state during the turning stroke based on setting information by the spraying state setting means. The present invention is further provided with a spraying state control means for controlling the spraying state of the chemical spraying device, and its functions and effects are as follows.

〔作 用〕[For production]

すなわち、散布状態設定手段にて、回向行程における薬
剤の散布状態を設定し、そして、実際に回向行程を走行
する際に、その設定された情報に基づいて薬剤の散布を
制御させるのである。
That is, the dispersion state setting means sets the dispersion state of the chemical during the turning stroke, and when the vehicle actually travels through the turning stroke, the dispersion of the chemical is controlled based on the set information. .

〔発明の効果〕〔Effect of the invention〕

従って、回向行程において、無駄な薬剤が散布されるこ
とを防止できるに至った。
Therefore, it has become possible to prevent unnecessary spraying of chemicals during the turning process.

〔実施例〕〔Example〕

以下、本発明の実施例を図面に基づいて説明する。 Embodiments of the present invention will be described below based on the drawings.

第3図及び第4図に示すように、自動走行、遠隔操縦(
ラジコン)、並びに、搭乗操縦(手動)の何れをも可能
な機体(V)の前方側に、エンジン(E)及び搭乗操縦
部(1)を設けると共に、機体(V)の後方側に、外装
カバー(2a)を備えた薬剤タンク(2)を搭載してあ
る。そして、機体(V)下部に設けたポンプ(4)によ
って前記薬剤タンク(2)から供給される薬剤を多数の
ノズル(5)から噴出させ、ブロア(6)による送風に
よって飛散させる薬剤散布装置(7)を、前記薬剤タン
ク(2)の後方側に付設して、主に果樹園等にて樹木(
F) 、 (F)間を走行しながら薬剤散布を行うため
の作業車を構成してある。
As shown in Figures 3 and 4, automatic driving, remote control (
The engine (E) and the boarding control section (1) are installed on the front side of the fuselage (V), which can be operated both radio-controlled (radio-controlled) and boarding control (manual), and the exterior is installed on the rear side of the fuselage (V). It is equipped with a drug tank (2) with a cover (2a). A chemical dispersion device (a chemical spraying device) in which a pump (4) provided at the lower part of the fuselage (V) jets the chemical supplied from the chemical tank (2) from a number of nozzles (5) and is dispersed by air blown by a blower (6). 7) is attached to the rear side of the chemical tank (2), and is used mainly for planting trees (in orchards, etc.).
A work vehicle is configured to spray chemicals while traveling between F) and (F).

但し、前記ノズル(5)は、前記機体(V)に対して左
右及び上方の3方に分割した各範囲において各別に散布
状態を切り換えられるように、左右及び上方の各ノズル
(5L) 、 (5R) 、 (5C)に3分割してあ
る。
However, the nozzle (5) is arranged so that the spraying state can be switched separately in each range divided into three directions, left, right, and upper with respect to the aircraft (V). It is divided into three parts: 5R) and (5C).

そして、第2図に示すように、機体(V)に対して左右
両横側に位置する状態で列状に並ぶ樹木(F) 、 (
F)の間をその長平方向に向かう直線行程の端部に位置
する樹木(F)の外側にて隣接する次の直線行程の方向
に回向させながら、樹木(F) 、 (F)の間を往復
走行して、薬剤散布を行うようにしてある。
As shown in Fig. 2, trees (F) are arranged in rows on both the left and right sides of the aircraft (V).
Between trees (F) and (F), while turning the tree (F) located at the end of the straight line between trees (F) in the longitudinal direction toward the direction of the next adjacent straight line. It is designed to travel back and forth to spray chemicals.

前記機体(V)に装備のセンサ類について説明すれば、
第3図及び第4図に示すように、前記機体(V)の前部
のバンパ(8)の前面側に、非接触式の障害物センサ兼
用の操向制御用の超音波センサ(Sl)の3個を、各障
害物感知範囲が互いに隣接する状態で、左右及び中央の
夫々に設けてある。
To explain the sensors installed on the aircraft (V),
As shown in FIGS. 3 and 4, an ultrasonic sensor (Sl) for steering control that also serves as a non-contact obstacle sensor is installed on the front side of the bumper (8) at the front of the aircraft (V). Three of them are provided on the left, right and center, respectively, with their respective obstacle sensing ranges adjacent to each other.

但し、左右2個の超音波センサ(S+)、(S+)は、
それらの障害物感知情報を、前記機体(V)に対して左
右両側に位置する樹木(F) 、 (F)に対する車体
横幅方向の距離情報として利用できるように、障害物ま
での距離を感知できるようにすると共に、その障害物感
知範囲を車体幅よりも外側に拡がるように設定してある
。尚、中央の超音波センサ(S、)は、設定距離(本実
施例では約1mに設定してある)以内の障害物存否のみ
を感知するようにしてある。
However, the two left and right ultrasonic sensors (S+), (S+) are
The distance to the obstacle can be sensed so that the obstacle detection information can be used as distance information in the vehicle width direction to the trees (F) and (F) located on both the left and right sides of the aircraft (V). At the same time, the obstacle sensing range is set to extend outside the width of the vehicle body. The central ultrasonic sensor (S,) is designed to detect only the presence or absence of an obstacle within a set distance (in this embodiment, it is set to about 1 m).

又、前記薬剤タンク(2)の上部には、地磁気を感知す
ることによって絶対方位を検出する方位センサ(S2)
を設けてあり、後述の如く、前記樹木(F) 、 (F
)の間を直線的に走行する直線行程の方向に基づいて予
め設定された基準方位に対する機体(V)の向きを検出
できるようにしてある。
Further, on the upper part of the drug tank (2), there is a direction sensor (S2) that detects the absolute direction by sensing the earth's magnetism.
As described below, the trees (F) and (F
) The orientation of the aircraft (V) with respect to a preset reference direction can be detected based on the direction of the straight line traveling between the two.

又、前記直線行程の終端部に位置する樹木同士の間に、
前記直線行程の終端部を表示する鉄等の磁性材にて形成
したマーカ(a+)を埋設すると共に、前記マーカ(m
)を検出する磁気感知式の近接センサ(S3)を、前記
機体(V)の前端部下方に設けてある。
Also, between the trees located at the end of the straight line,
A marker (a+) formed of a magnetic material such as iron is embedded to indicate the end of the linear stroke, and the marker (m
) is provided below the front end of the body (V).

前記機体(V)の走行系について説明すれば、第1図に
示すように、左右一対の前輪(3F)及び左右一対の後
輪(3R)を設けると共に、それら一対の前後輪(3F
) 、 (3R)を各別に操作するステアリング用油圧
シリンダ(9F) 、 (9R)、及び、それに対する
電磁操作式の制御弁(10“F) 、 (IOR)を設
けてある。
To explain the traveling system of the aircraft (V), as shown in FIG.
), (3R) for steering hydraulic cylinders (9F), (9R), and electromagnetically operated control valves (10"F), (IOR) for the steering hydraulic cylinders (9F), (9R).

又、前後進切り換え自在で且つ前進変速並びに後進変速
自在な油圧式無段変速装置(11)を、前記エンジン(
E)に連動連結すると共に、前記変速装置(11)の出
力にて、前記前後輪(3F) 、 (31?)を同時に
駆動するように構成してある。そして、搭乗操縦用の変
速ペダル(12)及び遠隔操縦時並びに自動走行時にお
ける変速アクチュエータとしての変速モータ(13)を
、その何れによっても変速操作可能に、前記変速装置(
11)の変速アーム(14)に連動連結してある。
In addition, a hydraulic continuously variable transmission (11) capable of freely switching forward and backward speeds and freely changing forward and reverse speeds is connected to the engine (
E), and the front and rear wheels (3F) and (31?) are simultaneously driven by the output of the transmission (11). The transmission device (
It is interlocked and connected to the speed change arm (14) of 11).

又、搭乗操縦用のステアリングハンドル()I)を、前
記搭乗操縦部(1)に設けてある。尚、第1図中、(S
4)は、前記変速装置(11)の出力回転数を検出する
ことにより走行距離を検出する距離センサ、(15)は
、自動走行時において、前記超音波センサ(Sl)が障
害物を感知して自動停止した時等に、その回避を遠隔操
縦にて行うように、操作者に報知するための警告灯であ
る。又、(16L) 、 (16R) 、 (16C)
は、前記左右及び上方の3方向の夫々における各ノズル
(5L) 、 (5R) 、 (5C)の作動を各別に
手動操作するためのノズルスイッチである。
Further, a steering handle ( ) I) for boarding control is provided in the boarding control section (1). In addition, in Figure 1, (S
4) is a distance sensor that detects the traveling distance by detecting the output rotation speed of the transmission (11), and (15) is a distance sensor that detects an obstacle when the ultrasonic sensor (Sl) detects an obstacle during automatic driving. This is a warning light to notify the operator to use remote control to avoid the situation when the vehicle automatically stops. Also, (16L), (16R), (16C)
are nozzle switches for manually operating the respective nozzles (5L), (5R), and (5C) in each of the three directions, left, right, and upward.

前記一対の前後輪(3F) 、 (3R)を向き変更さ
せて操向するに、前後輪(3F) 、 (3R)を同一
方向に操向操作して機体(V)を平行移動させる平行ス
テアリング形式、前後輪(3F) 、 (3R)を逆方
向に操向操作して機体(V)を急旋回させる4輪ステア
リング形式、通常の自動車同様に前輪(3F)のみを操
向操作する2輪ステアリング形式を選択使用できるよう
に構成してある。
Parallel steering involves steering the pair of front and rear wheels (3F) and (3R) in the same direction to move the aircraft (V) in parallel. Type, 4-wheel steering type that turns the aircraft (V) sharply by steering the front and rear wheels (3F) and (3R) in opposite directions, 2-wheel steering type that steers only the front wheels (3F) like a normal car It is configured so that the steering type can be selected and used.

そして、遠隔操縦時には、前記平行ステアリング形式と
4輪ステアリング形式とを選択できるように、且つ、搭
乗操縦時には、上記3種類のステアリング形式の何れか
を選択使用できるように構成してある。
The configuration is such that the parallel steering type and the four-wheel steering type can be selected during remote control, and one of the three types of steering types can be selected during boarding operation.

但し、自動走行時には、前記各ステアリング形式の切り
換えは自動的に行われると共に、前後輪(3F) 、 
(3R)の操向両に差を付けた状態で同一方向にステア
リング操作するステアリング形式にも切り換えることが
できるようにしてある。
However, during automatic driving, the above-mentioned steering types are automatically switched, and the front and rear wheels (3F),
It is also possible to switch to a steering type (3R) in which both steering wheels are operated in the same direction with a difference.

又、搭乗操縦時の目標ステアリング角度を検出する目標
ステアリング角度検出用ポテンショメータ(Ro)を、
前記ステアリングハンドル(H)にて回動操作されるよ
うに設けると共に、前記前後輪(3F) 、 (3R)
夫々のステアリング角度を検出するステアリング角度検
出用ポテンショメータ(R1)、(R2)を設けてある
。又、前記変速装置(11)の変速位置を検出する変速
位置検出用ポテンショメータ(R3)を、前記変速アー
ム(14)の回動操作に連動するように設けてある。そ
して、前記各ポテンショメータ(Ro)〜(R3)によ
る検出信号を自動走行制御手段(100)、遠隔操縦手
段、並びに、搭乗操縦手段の夫々を構成する制御装置(
17)に入力してある。又、上記各操縦手段の何れによ
って機体(V)の走行を制御するかを選択する操縦モー
ド選択用スイッチ(18)、及び、搭乗操縦時における
ステアリング形式選択用スイッチ(19)を設けてある
。但し、後述の如く、前記自動走行制御手段が作動する
自動操縦モードにおいては、前記操縦モード選択用スイ
ッチ(18)を操作することなく、前記遠隔操縦手段を
、自動走行制御手段に優先して作動させる状態に切り換
えられるように構成してある。
In addition, a target steering angle detection potentiometer (Ro) that detects the target steering angle during boarding maneuvers,
The front and rear wheels (3F) and (3R) are provided to be rotated by the steering handle (H), and the front and rear wheels (3F), (3R)
Steering angle detection potentiometers (R1) and (R2) are provided to detect the respective steering angles. Further, a shift position detection potentiometer (R3) for detecting the shift position of the transmission device (11) is provided so as to be interlocked with the rotational operation of the shift arm (14). Then, the detection signals from each of the potentiometers (Ro) to (R3) are transmitted to a control device (100) constituting each of the automatic travel control means (100), the remote control means, and the boarding control means.
17). Further, there are provided a control mode selection switch (18) for selecting which of the above-mentioned control means should be used to control the traveling of the aircraft (V), and a steering type selection switch (19) during boarding operation. However, as will be described later, in the autopilot mode in which the automatic travel control means operates, the remote control means is operated with priority over the automatic travel control means without operating the operation mode selection switch (18). It is configured so that it can be switched to a state in which it is activated.

次に、各操縦手段の構成について詳述する。Next, the configuration of each control means will be explained in detail.

搭乗操縦手段の構成について説明すれば、前記ステアリ
ング形式選択用スイッチ(19)の情報及び前記目標ス
テアリング角度検出用ポテンショメータ(Ro)の検出
情報に基づいて、前記ステアリング用油圧シリンダ(9
F) 、 (9R)の制御弁(IOF) 、 (IOR
)の作動を制御して、前記前後輪(3F) 、 (3R
)を指示されたステアリング形式で且つ前記ステアリン
グハンドル(H)による目標ステアリング角度に操作す
ることとなる。但し、前記変速装置(11)の操作つま
り車速の調整は、前記変速ペダル(12)にて前記変速
アーム(14)を直接操作して行うこととなる。又、安
全のために、前記変速ペダル(12)の操作を止めると
、変速位置が自動的に中立状態つまり変速ニュートラル
位置(N)に復帰するように付勢して設けてある。
To explain the configuration of the boarding control means, based on the information of the steering type selection switch (19) and the detection information of the target steering angle detection potentiometer (Ro), the steering hydraulic cylinder (9
F), (9R) control valve (IOF), (IOR
), the front and rear wheels (3F), (3R
) in the instructed steering style and at the target steering angle using the steering handle (H). However, the operation of the transmission (11), that is, the adjustment of the vehicle speed, is performed by directly operating the transmission arm (14) using the transmission pedal (12). Further, for safety, the shift pedal (12) is biased so that when the operation of the shift pedal (12) is stopped, the shift position automatically returns to the neutral state, that is, the shift neutral position (N).

遠隔操縦手段の構成について説明すれば、遠隔操縦用の
送信機り20)から与えられる指示情報を受信する受信
機(21)を設けると共に、その受信情報に基づいて、
前記ステアリング用油圧シリンダ(9F) 、 (9R
)の制御弁(IOF) 、 (101’l)の作動、並
びに、薬剤の散布方向を左右及び上方に3分割された前
記ノズル(5L) 、 (5R) 、 (5C)の各制
御弁(22L) 、 (22R) 、 (22C)、前
記ブロア(6)の回転停止を操作する電磁操作式のクラ
ッチ(23)等の作動を制御することにより、機体(V
)の走行並びに前記薬剤散布装置(7)の散布作動を、
遠隔操作できるように構成してある。
To explain the configuration of the remote control means, it is provided with a receiver (21) that receives instruction information given from a remote control transmitter 20), and based on the received information,
The steering hydraulic cylinder (9F), (9R
), and the control valves (22L) of the nozzles (5L), (5R), (5C) whose chemical spray direction is divided into left, right, and upward three parts. ), (22R), (22C), the airframe (V
) and the spraying operation of the chemical spraying device (7),
It is configured for remote control.

前記送信機(20)の構成について説明すれば、第1図
に示すように、前後動によって目標変速位置を指示する
変速レバー(24)、及び、前後動によってステアリン
グ形式を指示し、且つ、左右動によって前記前後輪(3
F) 、 (3R)の目標ステアリング角度を指示する
ステアリングレバー(25)を設けると共に、前記ブロ
ア(6)の回転停止を指示するブロアスイッチ(26)
、前記ノズル(5)からの薬剤噴出の作動停止を指示す
るノズルスイッチ(27)、前記機体(V)を非常停止
させる指示を行う非常停止用スイッチ(28)、及び、
前記機体(V)が自動走行している時に、この送信機(
20)側にて前記機体(V)の走行並びに散布作動を遠
隔操作できる状態に切り換える割り込みスイッチ(29
)の夫々を設けてある。
To explain the configuration of the transmitter (20), as shown in FIG. The front and rear wheels (3
F) A steering lever (25) for instructing the target steering angle of (3R) is provided, and a blower switch (26) for instructing the rotation of the blower (6) to stop.
, a nozzle switch (27) that instructs to stop the operation of ejecting medicine from the nozzle (5), an emergency stop switch (28) that instructs to make an emergency stop of the aircraft (V), and
When the aircraft (V) is automatically traveling, this transmitter (
20) side, an interrupt switch (29
) are provided.

つまり、前記機体(V)が自動走行制御手段にて自動走
行している時に、例えば、前記超音波センサ(Sl)が
走行前方側の障害物を感知したり誤動作して、機体(V
)が自動停止したような場合に、作業者が機体(V)の
停止位置まで行くことなく、前記割り込みスイッチ(2
9)を操作すれば、その後は、前記送信機(20)によ
る遠隔操縦にて、その障害物を回避させることができる
ようにしてある。又、前記割り込みスイッチ(29)を
切れば、自動走行モードに自動的に復帰して、機体(V
)を引き続き自動走行させることができるようにしてあ
る。
That is, when the aircraft (V) is automatically traveling using the automatic travel control means, for example, the ultrasonic sensor (Sl) detects an obstacle in front of the vehicle or malfunctions, and the aircraft (V)
) automatically stops, the operator must press the interrupt switch (2) without going to the stop position of the machine (V).
9), the obstacle can then be avoided by remote control using the transmitter (20). In addition, if the interrupt switch (29) is turned off, the aircraft automatically returns to the automatic driving mode and the aircraft (V
) can continue to run automatically.

尚、安全のために、前記変速レバー(24)は、その操
作を止めると自動的に中立状態つまり変速ニュートラル
位置(N)に復帰するように付勢して設けてある。
For safety, the gear shift lever (24) is biased so that it automatically returns to the neutral state, that is, the gear shift neutral position (N) when its operation is stopped.

次に、自動走行制御手段(100)の構成について、前
記制御装置(17)の動作を説明しながら詳述する。
Next, the configuration of the automatic travel control means (100) will be explained in detail while explaining the operation of the control device (17).

前記制御装置(17)は、前記各センサ(S I) 。The control device (17) includes each of the sensors (SI).

(Sz) 、(Sol) 、C3a)や前記各ポテンシ
ョメータ(R1)〜(R1)の検出情報、並びに、前記
受信機(21)の受信情報や予め記憶設定された走行制
御情報等に基づいて、各種アクチュエータの作動を制御
することにより、前記機体(V)が樹木(F) 、 (
F)の間の直線行程を自動的に走行し、且つ、直線行程
の終端部に達するに伴って、自動的に次の直線行程に向
かって回向するように機体(V)の走行を制御すること
となる。
(Sz), (Sol), C3a) and the detection information of each of the potentiometers (R1) to (R1), as well as the reception information of the receiver (21), travel control information stored in advance, etc. By controlling the operations of various actuators, the aircraft (V) can fly trees (F), (
Control the traveling of the aircraft (V) so that it automatically travels the straight line between F) and automatically turns toward the next straight line as it reaches the end of the straight line. I will do it.

先ず、自動走行時における車体走行の概略を説明すれば
、第2図に示すように、直線行程の開始地点(ST)と
、この開始地点(ST)に対向する他端側に位置する樹
木(P)の間とを結ぶ直線状の第1行程(i)、前記他
端側に位置する樹木(F)の外方側を回向して前記第1
行程(i)に対して180度逆方向に向かう直線状の第
3行程(iii )へと車体を移動させる第2行程(i
i )、及び、前記第3行程(iii )の終了後に、
前記第1行程(i)と同一方向に向かう直線行程に方向
転換させるために、前記第2行程(ii )と同様にし
て回向させる第4行程(iv)の4つの作業行程夫々を
、前記搭乗操紺手段又は遠隔操継手段にて操縦しながら
、各行程における前記方位センサ(S2)。、距離セン
サ(S4)、及び、ステアリング角度検出用ポテンショ
メータ(R1)、 (R2)によるステアリング角度検
出情報に基づいて、前記4つの各行程(i)〜(iv 
)夫々を、機体(V)に対して左右両側に位置する樹木
(F) 、 (F)を走行用ガイドとしてティーチング
する。
First, to explain the outline of the vehicle body movement during automatic driving, as shown in Fig. 2, there is a starting point (ST) of the straight line travel, and a tree ( P), a straight line (i) connecting between
A second stroke (i) in which the vehicle body is moved to a linear third stroke (iii) facing 180 degrees in the opposite direction to the stroke (i).
i) and after the completion of the third step (iii),
In order to change the direction to a linear stroke in the same direction as the first stroke (i), each of the four working strokes of the fourth stroke (iv), which is turned in the same manner as the second stroke (ii), is performed as described above. The azimuth sensor (S2) in each stroke while being operated by the boarding control means or the remote control means. , distance sensor (S4), and steering angle detection potentiometers (R1) and (R2), each of the four steps (i) to (iv)
), respectively, using the trees (F) and (F) located on both the left and right sides of the aircraft (V) as traveling guides.

但し、本実施例においては、第1行程(i)及び第3行
程(iii )の直線行程では、この直線行程の開始地
点から前記近接センサ(S2)が作動するまでの実際の
走行距離(DLENGn)n−+、z及び前記方位セン
サ(S2)の検出方位を平均して算出した基準方位(B
ASDRn) n−+、zのみを、直線行程における走
行制御情報として記憶し、前記第2行程(11)及び第
4行程(iv)の回向行程では、前記ステアリング角度
検出用ポテンショメータ(R1)。
However, in this embodiment, in the straight-line strokes of the first stroke (i) and the third stroke (iii), the actual travel distance (DLENGn) from the start point of this straight-line stroke until the proximity sensor (S2) is activated is ) n-+, z and the reference orientation (B) calculated by averaging the detected orientation of the orientation sensor (S2).
ASDRn) Only n-+, z is stored as traveling control information in the straight stroke, and in the turning stroke of the second stroke (11) and the fourth stroke (iv), the steering angle detection potentiometer (R1) is used.

(R2)による検出ステアリング角度を、設定距離間隔
(本実施例では約20cmに設定してある)毎にサンプ
リングすると共に、その値を、各回向行程(ii)、(
iv)の走行制御情報として記憶させるようにしてある
The steering angle detected by (R2) is sampled at every set distance interval (in this example, it is set to approximately 20 cm), and the value is calculated for each turning stroke (ii), (
The information is stored as the traveling control information (iv).

尚、上述した第1行程(i)〜第4行程(iv)の走行
制御情報を収集するための一連の処理を、以下において
〔ティーチング〕と呼称する。
The series of processes for collecting travel control information in the first step (i) to the fourth step (iv) described above will be referred to as "teaching" hereinafter.

そして、〔ティーチング〕を終了すると、前記機体(V
)を一旦前記作業行程の開始地点(ST)まで移動させ
た後、〔ティーチング〕にて記憶された第1行程(i)
〜第4行程(iv )の各行程での記憶情報に基づいて
機体(V)の走行を制御しながら、各行程での走行を設
定回数繰り返すことにより、各直線行程の端部にて自動
回回しながら、前記樹木(F) 、、 (F)の間を設
定距離内に接近しないように操向制御しながら往復走行
させて、所定範囲の果樹園内における薬剤散布作業を自
動的に行わせるようにしてある。つまり、前記〔ティー
チング〕にて記憶された走行制御情報、前記左右一対の
超音波センサ(Sl)、(Sl)及び前記方位センサ(
S2)の検出情報に基づいて前記機体(V)が前記樹木
CF) 、 (F)に対して設定距離内に接近しないよ
うに操向操作しながら自動走行させるようにしてあり、
この処理を以下において〔再生]と呼称する。
Then, when [teaching] is finished, the aircraft (V
) is once moved to the start point (ST) of the work process, and then the first process (i) memorized in [teaching]
~ While controlling the traveling of the aircraft (V) based on the stored information in each stroke of the fourth stroke (iv), by repeating the traveling in each stroke a set number of times, automatic rotation is performed at the end of each linear stroke. While rotating, the trees (F), , (F) are made to travel back and forth while controlling the steering so as not to approach within a set distance, thereby automatically performing chemical spraying work within a predetermined range of the orchard. It is set as. In other words, the traveling control information stored in the [teaching], the pair of left and right ultrasonic sensors (Sl), and the direction sensor (
Based on the detection information of S2), the aircraft (V) automatically travels while operating the steering so as not to approach the trees CF) and (F) within a set distance;
This process will be referred to as "reproduction" below.

次に、第6図に示すフローチャートに基づいて、前記〔
ティーチング〕について詳述する。
Next, based on the flowchart shown in FIG.
teaching] in detail.

前記作業行程の開始地点(ST)から走行開始するに伴
って、前記第1行程(i)において、走行開始時点から
前記近接センサ(S3)が前記マーカ(m)を検出して
ONするまでの間における前記距離センサ(S、)の検
出情報に基づいて、直線行程の走行距離(OLENG 
+ )を算出すると共に、前記方位センサ(S2)の検
出情報に基づいてこの直線行程の向きである平均方位(
RASDR、)を算出する。
As the travel starts from the start point (ST) of the work process, in the first process (i), from the start of travel until the proximity sensor (S3) detects the marker (m) and turns ON. Based on the detection information of the distance sensor (S,) between
+ ), and also calculates the average direction (
RASDR, ) is calculated.

そして、前記近接センサ(S3)がマーカ(m)を検出
するに伴って、前記走行路#(OLENG、)を第1行
程(i)における基準走行距離として記憶すると共に、
前記平均方位(RASDP I)を基準方位として記憶
させる(ス、テフブ#100〜ステフブ#102)。
Then, as the proximity sensor (S3) detects the marker (m), the traveling route #(OLENG,) is stored as a reference traveling distance in the first step (i), and
The average orientation (RASDP I) is stored as a reference orientation (Step #100 to Step #102).

前記走行距離(IILENG+)及び平均方位(RAS
DP I)を記憶させた後は、前記方位センサ(S2)
の検出情報に基づいて車体向きが前記第1行程(i)に
て記憶された平均方位(RASDRI)に対して設定許
容差内に反転するまで、回向行程の走行距離(Ll)を
前記距離センサ(S4)の検出情報に基づいてカウント
すると共に、前記ステアリング角度検出用ポテンショメ
ータ(R+)、(Rz)による検出ステアリング角度を
、設定距離(20cm)毎にサンプリングして、その値
を順次記憶させる処理を行うことによって、第2行程(
ii)の走行制御情報をティーチングする。又、前記ス
テアリング角度のサンプリングを行う毎に、前記機体(
V)側のノズルスイッチ(16L) 、 (161?)
 、 (16C)夫々の操作状態をサンプリングして、
回向行程における薬剤散布状態をティーチングすると共
に、回行カウンタ値(LOCNTI)を1つづつ加算す
る処理ヲ行う (ステフブ#103〜ステフブ1ll1
2)。
The distance traveled (IILENG+) and the average bearing (RAS)
After storing the DP I), the direction sensor (S2)
Based on the detected information, the traveling distance (Ll) of the turning stroke is changed to the above-mentioned distance until the vehicle direction is reversed to within the set tolerance with respect to the average direction (RASDRI) stored in the first stroke (i). In addition to counting based on the detection information of the sensor (S4), the steering angle detected by the steering angle detection potentiometers (R+) and (Rz) is sampled at every set distance (20 cm), and the values are sequentially stored. By performing the processing, the second step (
ii) Teach travel control information. Furthermore, each time the steering angle is sampled, the aircraft (
V) side nozzle switch (16L), (161?)
, (16C) Sampling each operation state,
In addition to teaching the chemical dispersion state in the turning process, the process of incrementing the turning counter value (LOCNTI) by one is performed (Step #103 to Step #111)
2).

前記薬剤散布状態のティーチングについて説明を加えれ
ば、前記3個のノズルスイッチ(16L) 、 (16
R) 、 (16C)がON操作されている場合にその
値を順次加算することにより散布状態をサンプリングす
る3個の散布カウンタ(NZLL) 。
To explain the teaching of the chemical spraying state, the three nozzle switches (16L), (16
R), three dispersion counters (NZLL) that sample the dispersion state by sequentially adding their values when (16C) is turned on.

(NZLR) 、 (NZLC)の夫々の値を更新する
ことにより、回向行程における薬剤散布状態をティーチ
ングする。
By updating the values of (NZLR) and (NZLC), the chemical dispersion state in the turning process is taught.

そして、前記方位センサ(S2)の検出方位が前記第1
行程(i)の平均方位(RASDR,)に対して設定許
容差内に反転して、第2行程(ii )のティーチング
が終了するに伴って、回向カウンタ値(LOCNTI)
に設定比率(RATE) (本実施例では50%に設定
してある)を乗算して得られる闇値(THR)を求め、
そして、前記ノズルスイッチ(16L) 。
Then, the direction detected by the direction sensor (S2) is the first direction.
When the average orientation (RASDR,) of the stroke (i) is reversed to within the set tolerance and the teaching of the second stroke (ii) is completed, the turning counter value (LOCNTI)
Multiply the set ratio (RATE) (set to 50% in this example) to find the darkness value (THR).
And the nozzle switch (16L).

(16R) 、 (16C)夫々の操作状態をサンプリ
ングした各散布カウンタ(NZLL) 、 (NZLR
) 、 (NZLC) (7)値が、前記闇値(THR
)以上であるか否かを判別することにより、回向行程に
おける散布状態つまり左右及び上方の何れの方向に薬剤
を散布するかを示す第2行程用の散布フラグ(NZFL
AGI)をセラトスる(ステフブ#113〜ステフプ#
116)。
(16R), (16C) Each scattering counter (NZLL), (NZLR) that samples the respective operation status
), (NZLC) (7) The value is the dark value (THR
) or more, the second stroke spraying flag (NZFL) is set, which indicates the spraying state in the turning stroke, i.e. in which direction to spray the chemical, left, right or upward.
AGI) Seratos (Step #113 ~ Step #
116).

前記第2行程(ii )のティーチングが終了するに伴
って、前記ステフブ#100〜ステフブ#102で示す
処理と同様にして、前記近接センサ(S、)がマーカ(
m)を検出してONするまで、第3行程(iii )の
走行距離(DLENGz)及び平均方位(BASDRz
)つまり基準方位をティーチングする(ステフプ#11
7〜ステフプ#119)。
As the teaching of the second step (ii) is completed, the proximity sensor (S,) moves to the marker (
The travel distance (DLENGz) and average direction (BASDRz) of the third step (iii) are
) In other words, teach the reference direction (Step #11
7~Step #119).

第3行程(iii )のティーチングが終了するに伴っ
て、前記第2行程(ii )のティーチングと同様の処
理を行うことにより、第4行程(iv )の走行距離(
Lx)並びに第4行程(iv )における回向カウンタ
値(LOCNT2)及び薬剤散布状態を示す第4行程用
の散布フラグ(NZFLAG2)をティーチングする(
ステフブ#120〜ステフブ#133)。
As the teaching of the third step (iii) is completed, the same process as the teaching of the second step (ii) is performed, so that the traveling distance (iv) of the fourth step (iv) is
Lx) and the turning counter value (LOCNT2) in the fourth process (iv) and the dispersion flag (NZFLAG2) for the fourth process indicating the chemical dispersion state (
Step #120 to Step #133).

もって、前記第2行程(ii)及び第4行程(iv )
の夫々ニおイテ散布フラグ(NZFLAGI) 、 (
NZFLAG2)を設定する処理にて、散布状態設定手
段(101)を構成してある。
Therefore, the second step (ii) and the fourth step (iv)
NZFLAGI and (
The process of setting NZFLAG2) constitutes a dispersion state setting means (101).

第4行程(iv )のティーチングが終了するに伴って
、この〔ティーチング〕の処理を終了し、そして、後述
の〔再生〕の処理が開始されるまで待機することとなる
When the teaching of the fourth step (iv) is completed, this [teaching] process is ended, and the system waits until the later-described [playback] process is started.

次に、第7図に示すフローチャートに基づいて、前記〔
再生〕の処理について詳述する。
Next, based on the flowchart shown in FIG.
The following describes the processing of [Reproduction] in detail.

[再生]の処理が開始されるに伴って、先ず、全走行行
程数を、直線行程(第1行程及び第3行程)の個数(K
N[IM)として入力し、そして、前記〔ティーチング
〕の処理にて記憶された基準方位(BASDRn)、走
行距離(DLENGn)、及び、現在の行程が第1行程
(i)〜第4行程(iv )の何れの行程に相当するか
を示す行程フラグ(CFLAG)の夫々を、記憶された
情報に基づいて初期設定する(ステフブ#200.ステ
フブ#201)。
As the [Regeneration] process starts, first, the total number of travel strokes is calculated as the number of straight strokes (first stroke and third stroke) (K
N [IM), and the reference orientation (BASDRn), distance traveled (DLENGn), and current stroke stored in the [teaching] process are the first stroke (i) to the fourth stroke ( iv) Each of the process flags (CFLAG) indicating which process corresponds to the process is initialized based on the stored information (step #200, step #201).

尚、前記初期設定の処理において、第1行程(i)にお
ける処理について説明を加えれば、前記基準方位(BA
SDRn)及び走行距離(DLENGn)の夫々を、第
1行程(i)の基準方位(RASDR+)及び走行距離
(OLENG I )の夫々に設定すると共に、前記行
程フラグ(CFLAG)の値を第1行程(i)を示す″
“1nにセットすることになる。
In addition, in the initial setting process, the process in the first step (i) will be explained.
SDRn) and traveling distance (DLENGn) are respectively set to the reference direction (RASDR+) and traveling distance (OLENG I) of the first stroke (i), and the value of the stroke flag (CFLAG) is set to the first stroke (i). (i)”
“It will be set to 1n.

前記初期設定の処理が終了した後は、前記ブロア(6)
のクラッチ(23)をONすると共に、前記3分割した
ノズル(5L) 、 (5R) 、 (5C)の各制御
弁(22L) 、 (22R) 、 (22C)の全部
を作動させて機体(V)の左右及び上方の3方向全てに
向けて薬剤を散布しながら走行を開始し、そして、前記
設定され行程数(KNUM)に基づいて全行程の走行を
終了したか否かを判別する(ヌテフブ#202.ステフ
ブ#203)。
After the initial setting process is completed, the blower (6)
At the same time, the clutch (23) of the fuselage (V ) starts running while spraying chemicals in all three directions, left, right, and upward, and then determines whether or not the entire journey has been completed based on the set number of strokes (KNUM). #202. Step #203).

前記行程数(KNUM)が零になっている場合は、設定
された行程数を走行したものと判断して、例示はしない
が、前記薬剤散布装置(7)の作動を停止すると共に、
走行を停止して、作業を終了することとなる。
If the number of strokes (KNUM) is zero, it is determined that the set number of strokes has been traveled, and although not illustrated, the operation of the chemical spraying device (7) is stopped, and
The vehicle will stop running and the work will be completed.

前記行程数(KNUM)が零になっていない場合は、前
記受信機(21)の受信情報に基づいて、前記送信機(
20)の割り込みスイッチ(29)が操作されて遠隔操
縦手段を優先的に作動させるラジコン割り込みの要求が
あるか否かを判別する(ステフブ#204)。
If the number of strokes (KNUM) is not zero, based on the information received by the receiver (21), the transmitter (
20) is operated to determine whether there is a radio control interrupt request for preferentially operating the remote control means (step #204).

ラジコン割り込みの要求がある場合は、後述の如く、〔
ラジコン割り込み〕の処理に分岐することとなる。
If there is a radio control interrupt request, as described below,
The process branches to the radio control interrupt] processing.

ラジコン割り込みの要求が無い場合は、前記行程フラグ
(CFLAG)の値が回向行程を示す“2″又は4°゛
になっているか否かを判別することにより、機体(V)
を次の直線行程に移動させるための〔回向〕の処理に分
岐するか否かを判別する(ステツブ+1205)。
If there is no radio control interrupt request, the aircraft (V)
It is determined whether or not to branch to the [turn] process for moving the line to the next linear stroke (Step +1205).

前記行程フラグ(CFLAG)の値が回向行程を示す“
2゛′又は“4”になっている場合は、後述する〔回向
〕の処理に分岐することとなる。
The value of the process flag (CFLAG) indicates the turning process.
If the value is 2' or "4", the process branches to the [turn] process, which will be described later.

一方、前記行程フラグ(CFLAG)の値が回向行程を
示す“2”又は“4゛になっていない場合、つまり、直
線行程を示す“′1″”又は“3”である場合は、前記
操向制御用の左右一対の超音波センサ(St)、(Sυ
の検出距離情報及び前記方位センサ(s2)による検出
方位に基づいて、前記機体(V)の向きが前記基準方位
(BASDRn)に対して許容差内に維持され、且つ、
機体(V)に対して左右両側に位置する樹木(F) 、
 (F)の間を直進するように、前記前後輪(3F) 
、 (3R)を操向操作する操向制御を行う(ステツブ
1t206)。
On the other hand, if the value of the stroke flag (CFLAG) is not "2" or "4" indicating a turning stroke, that is, if it is "'1" or "3" indicating a straight stroke, A pair of left and right ultrasonic sensors (St), (Sυ
The orientation of the aircraft (V) is maintained within a tolerance with respect to the reference orientation (BASDRn) based on the detected distance information and the orientation detected by the orientation sensor (s2), and
Trees (F) located on both left and right sides of the aircraft (V),
(F) so as to go straight between the front and rear wheels (3F).
, (3R) is performed (step 1t206).

但し、前記超音波センサ(S、)が1m以内に障害物が
あることを検出した場合は、機体(V)を非常停止させ
ると共に、その後の回避を遠隔操縦手段にて行うように
操作者に報知すべく、後述の〔ラジコン要求〕の処理に
分岐する(ステップ+1207)。
However, if the ultrasonic sensor (S,) detects that there is an obstacle within 1 meter, the operator will be instructed to make an emergency stop of the aircraft (V) and use remote control means to avoid it. In order to make the notification, the process branches to the process of [radio control request], which will be described later (step +1207).

〔ラジコン要求〕が不要な場合は、前記近接センサ(S
3)が前記マーカ(m)を検出してONしたか否かを判
別することにより、直線行程が終了したか否かを判別す
る(ステツ1t208)。
If [radio control request] is not required, the proximity sensor (S
3) detects the marker (m) and determines whether it has been turned on, thereby determining whether the linear stroke has ended (step 1t208).

前記近接センサ(S、)がONしていない場合は、上述
したステツブ+1203からの行程数(KNUM)の判
別処理から以降の処理を繰り返すことにより、前記機体
(V)が樹木(F) 、 (F)の間を直進する状態を
維持させることになる。
If the proximity sensor (S,) is not turned on, the aircraft (V) is moved to the tree (F), ( This will keep the vehicle moving straight between F).

前記近接センサ(S3)がONしている場合は、前記ス
テップ#205の処理にて〔回向〕の処理に分岐させる
べく、現在の行程フラグ(CFLAG)の値を判別し、
1°′である場合は、前記行程フラグ(CFLAG)の
値を第1回向行程である第2行程(ii )を示す“2
”に設定すると共に、回向行程の終了を判別するための
反転方位つまり次の直線行程である第3行程(iii 
)の基準方位(BASDIh)に設定する。一方、前記
現在の行程フラグ(CFLAG)の値が“3”である場
合は、前記行程フラグ(CFLAG)の値を第2回向行
程である第4行程(iv)を示す“4”に設定すると共
に、前記反転方位を第1行程(i)の基準方位(13A
sDR,)に設定する(ステフブ#209〜ステフブH
1l)。
If the proximity sensor (S3) is ON, the value of the current stroke flag (CFLAG) is determined in order to branch to the [turn] process in the process of step #205,
1°', the value of the stroke flag (CFLAG) is set to "2" indicating the second stroke (ii) which is the first return stroke.
” and the third stroke (iii
) to the reference direction (BASDIh). On the other hand, if the value of the current process flag (CFLAG) is "3", the value of the process flag (CFLAG) is set to "4" indicating the fourth process (iv), which is the second direction process. At the same time, the reversal direction is set to the reference direction (13A) of the first step (i).
sDR, ) (step #209 to step H
1l).

そして、前記行程フラグ((:FLAG)及び反転方位
を設定した後は、前記行程数(KNtlM)を1行程分
減算して、前記ステツブ#208にて前記近接センサ(
S、)がONLない場合と同様に、全行程数を走行した
か否かを判別するステップ#203からの処理を繰り返
すことになる(ステツブ#212)。
After setting the stroke flag ((:FLAG) and the reversal direction, the stroke number (KNtlM) is subtracted by one stroke, and in step #208, the proximity sensor (
As in the case where S, ) is not ONL, the process from step #203 to determine whether the entire number of strokes has been traveled is repeated (step #212).

前記操向制御について説明を加えれば、所定時間間隔で
繰り返し更新される前記左右一対の超音波センサ(sr
)、(sr)の検出情報に基づいて、左右両側の樹木(
F) 、 (F)に対して機体(V)が設定距離内に接
近しているか否かを判別すると共に、前記方位センサ(
S2)の検出情報に基づいて、機体(V)の向きが基準
方位(BASDRn)に対してず乳でいるか否かを判別
し、方位ずれかない場合は、平行ステアリング形式にて
、機体(V)向きが変わらないようにしなか、ら、機体
(V)が接近している樹木(F)から離れる方向に平行
移動させることにより、機体(V)が左右両側の樹木(
F) 、 (F)の中間を走行するように、横幅方向に
おける機体(V)の位置を修正するようにしてある。
To explain the steering control, the pair of left and right ultrasonic sensors (sr
), (sr) based on the detection information of trees (
F), determines whether the aircraft (V) is approaching within a set distance to (F), and also uses the direction sensor (
Based on the detection information in S2), it is determined whether the orientation of the aircraft (V) is aligned with the reference orientation (BASDRn), and if there is no deviation from the orientation, the aircraft (V) is steered in parallel steering mode. While keeping the orientation unchanged, move the aircraft (V) in parallel in the direction away from the approaching trees (F), so that the aircraft (V) can move away from the trees (F) on both the left and right sides.
The position of the aircraft (V) in the width direction is adjusted so that the aircraft (V) travels midway between F) and (F).

一方、方位ずれがある場合は、そのずれ方向に対応して
、前記前後輪(3F) 、 (3R)夫々を逆方向に向
けて操向操作することにより、機体(V)゛が左右両側
の樹木(F) 、 (F)の中間に位置し、且つ、機体
(V)の向きが前記基準方位(BASDRn)に対して
設定不惑帯内に維持されるように、機体(V)の向きを
修正する。
On the other hand, if there is a misalignment, the front and rear wheels (3F) and (3R) are steered in opposite directions in accordance with the direction of misalignment, so that the aircraft (V) The aircraft (V) is oriented so that it is located between the trees (F) and (F), and the orientation of the aircraft (V) is maintained within the set unfavorable zone with respect to the reference orientation (BASDRn). Fix it.

但し、本実施例においては、前記前後輪(3F) 。However, in this embodiment, the front and rear wheels (3F).

(3R)を、設定されたステアリング角度まで向き変更
した後は、直ちに操向中立状態に復帰させるようにして
あり、その−回の操作にて機体(V)の向きや位置が修
正できなかった場合は、機体(V)の向き及び位置の修
正が完了するまで、制御ループが一巡して次回に検出さ
れた情報に基づいて再度操向操作することとなる。
After the (3R) direction was changed to the set steering angle, it was set to immediately return to the neutral steering state, and the direction and position of the aircraft (V) could not be corrected by the previous operation. In this case, the control loop completes one cycle until the orientation and position of the aircraft (V) are corrected, and the steering operation is performed again based on the next detected information.

次に、第8図に示すフローチャートに基づいて、前記〔
回向〕について詳述する。
Next, based on the flowchart shown in FIG.
Eko] will be explained in detail.

先ず、前記行程フラグ(CFLAG)の値に基づいて、
第1回向つまり第2行程(ii)であるか第2回向つま
り第4行程(iv)であるかを判別し、前記〔ティーチ
ング〕にて記憶されたステアリング角度、及び、走行距
離(1,l、Ll> と散布フラグ(NZFLAGl、
NZFLAG2) f7)各情報を、−判別さレタ行程
に対応する情報を用いて回向するように読み込む・(ス
テツブ11300〜ステフブ11302)。
First, based on the value of the process flag (CFLAG),
It is determined whether it is the first turn, that is, the second stroke (ii) or the second turn, that is, the fourth stroke (iv), and the steering angle and mileage (1 , l, Ll> and scatter flag (NZFLAGl,
NZFLAG2) f7) Each piece of information is read in a backward manner using the information corresponding to the determined letter process (steps 11300 to 11302).

次に、前記走行距離(Ll又はtz)に基づいて、後述
の如(、回向行程における散布の開始停止を判別すると
共に、前記散布フラグ(NZFLAGI又はNZFLA
G2)の設定状態に基づいて、前記ノズル(5L) 、
 (5R) 、 (5C)の何れを作動させるかを判別
して、対応する制御弁(22L) 、 (22R) 、
 (22C)を作動させると共に、前記距離センサ(S
4)の検出情報に基づいて、前記〔ティーチング〕にお
いてステアリング角度をサンプリングした設定距離走行
する毎に、記憶されたステアリング角度を順次読み出し
て現在のステアリング角度を更新する(ステフブ#30
3〜ステフブ11308)。
Next, based on the travel distance (Ll or tz), the start and stop of spraying in the turning process is determined (as described later), and the spraying flag (NZFLAGI or NZFLAGI) is determined.
Based on the setting state of G2), the nozzle (5L),
(5R), (5C) to be operated, and the corresponding control valve (22L), (22R),
(22C) and the distance sensor (S) is activated.
Based on the detection information in step 4), each time the steering angle is sampled in the above [teaching] and the set distance is traveled, the stored steering angle is sequentially read out and the current steering angle is updated (step #30).
3~Stephbu 11308).

但し、この回向行程の走行距離が短い場合は、前記散布
フラグ(NZFLAGI又はNZFLAG2)の設定状
態に基づいて行う散布状態の制御は行わないようにして
ある。
However, if the traveling distance of this turning stroke is short, the control of the spreading state based on the setting state of the spreading flag (NZFLAGI or NZFLAG2) is not performed.

すなわち、第5図に示すように、回向行程の走行が開始
されるに伴って、前記〔ティーチング〕の処理にて計測
した走行距離(Ll又はLz)が、前記機体(V)の長
さに基づいて設定した第1設定距MCI 、)(本実施
例では3mに設定してある)とこの第1設定距離(II
)に所定距離(1m)を加算した第2設定距離(12)
とを加算した距離(l++l12)未満である場合は、
ティーチングされた散布状態に拘らず、回向中における
薬剤散布を停止しないようにしてある。
That is, as shown in FIG. 5, as the turning stroke starts, the traveling distance (Ll or Lz) measured in the [teaching] process becomes equal to the length of the aircraft (V). The first set distance MCI, ) (set to 3 m in this example) and this first set distance (II
) plus the predetermined distance (1m) (2nd set distance (12))
If the distance is less than the sum of (l++l12),
Regardless of the taught spraying state, the chemical spraying is not stopped during turning.

一方、前記回向距離(1,+又はL2)が、前記第1設
定距離(11)と第2設定距離(12)とを加算した距
離(j!1+42g)以上ある場合は、前記回向行程の
開始と共に、前記距離センサ(S4)の検出情報に基づ
いてカウントされる走行距離(CNT)が、前記第1設
定距離(β、)以上になるに伴って、前記散布7−7グ
(NZFLAGI又はNZFLAG2)の設定状態に基
づいて、左右及び上方の何れか又は全部の方向に向けて
薬剤を散布するように、前記ノズル(5L) 、 (5
R) 、 (5C)の各制御弁(22L) 、 (22
R) 。
On the other hand, if the turning distance (1, + or L2) is greater than or equal to the sum of the first setting distance (11) and the second setting distance (12) (j!1+42g), the turning distance At the same time as the distance traveled (CNT) counted based on the detection information of the distance sensor (S4) exceeds the first set distance (β,), the spraying 7-7g (NZFLAGI) starts. or NZFLAG2), the nozzle (5L), (5
R), (5C) control valves (22L), (22
R).

(22C)の作動を、前記散布フラグ(NZFLAGI
又はNZFLAG2)の設定状態に基づいて制御する。
(22C) is activated by the scattering flag (NZFLAGI).
or NZFLAG2).

そして、前記走行距離(CNT)が、前記回向距離(L
=L、又はL2)から前記第2設定距離(12)を減算
した実際の回向行程の距離である第3設定距離(13)
に達するに伴って、前記制御弁(22L) 。
Then, the traveling distance (CNT) is equal to the turning distance (L
= L, or a third set distance (13) which is the distance of the actual turning stroke obtained by subtracting the second set distance (12) from L2).
The control valve (22L).

(22R) 、 (22C)の全部を作動させて、前記
第1行程(i)又は第3行程(iii )の直線行程の
開始時から左右及び上方の3方向に向けて薬剤を散布す
る状態に復帰するようにしてある(ステフブ#303〜
ステフブ#307)。
(22R) and (22C) are all activated to spray the chemical in three directions: left, right, and upward from the start of the linear stroke of the first step (i) or third step (iii). It is set to return (Stephbu #303~
Step #307).

もって、上述した処理にて、前記散布状態設定手段(1
01)による設定情報に基づいて、回向行程における前
記薬剤散布装置(7)の散布状態を制御する散布状態制
御手段(IO2)を構成してある。
Therefore, in the above-described process, the dispersion state setting means (1
A spraying state control means (IO2) is configured to control the spraying state of the chemical spraying device (7) in the redirection process based on the setting information according to No. 01).

次に、記憶された全データつまり前記ステアリング角度
の情報を全て読み出したか否を判別し、全データの出力
を終了した場合は、前記行程フラグCCFLAG)を、
現在の値に基づいて、次の直線行程を示す値(″“1′
“又は“3”)に更新すると共に、走行距離(DLEN
Gn)の値を、前記更新された行程フラグ(CFLAG
)に対応して、前記第1行程(i)の走行距離(OLE
NG+)又は第3行程(iii )の走行距離(OLE
NG2)に設定して、この〔回向〕の処理を終了して前
記〔再生〕のステフプ#203の行程数判別の処理に復
帰させる(ステフブ#308〜ステフブ$1312)。
Next, it is determined whether all the stored data, that is, all the information on the steering angle has been read out, and if all the data has been output, the stroke flag CCFLAG) is set to
Based on the current value, the value indicating the next linear stroke (""1'
“or “3”) and the mileage (DLEN).
Gn) is set to the updated stroke flag (CFLAG).
), the traveling distance of the first step (i) (OLE
NG+) or the mileage of the third step (iii) (OLE
NG2) to end this [return] process and return to the process of determining the number of strokes in step #203 of [reproduction] (step #308 to step $1312).

前記記憶された全データの出力が終了していない場合は
、前記方位センサ(S2)の検出情報に基づいて、機体
(V)の向きつまり方位が反転したか否かを判別し、方
位が反転している場合は、〔回向〕の処理を終了すべく
、前記ステフブ#310〜ステフブ1312の処理に分
岐させる(ステツブ11313)。
If the output of all the stored data has not been completed, it is determined whether the direction of the aircraft (V), that is, the direction has been reversed, based on the detection information of the direction sensor (S2), and the direction is reversed. If so, the process is branched to steps #310 to #1312 to end the [turn] process (step #11313).

方位が反転していない場合は、前記受信機(18)の受
信情報に基づいて、ラジコン割り込みがあるか否かを判
別し、ラジコン割り込みがある場合は、後述の〔ラジコ
ン割り込み〕の処理に分岐させる(ステツブ$1314
)。
If the direction has not been reversed, it is determined whether or not there is a radio control interrupt based on the information received by the receiver (18), and if there is a radio control interrupt, the process branches to the process of [radio control interrupt] described later. Let (Steve $1314
).

ラジコン割り込みがない場合は、前記超音波センサ(S
l)が障害物を検出したか否かを判別し、障害物を検出
した場合は、その回避を遠隔操縦にて行うように指示す
るために、〔ラジコン要求〕の処理に分岐させる。障害
物を検出していない場合は、前記Xラフ21303以降
の散布状態の制御を行う処理並びに設定距離毎に記憶さ
れたステアリング角度を読み出して現在のステアリング
角度を更新する処理に復帰して、〔回向〕の処理を継続
することとなる(ステップ11315)。
If there is no radio control interrupt, the ultrasonic sensor (S
l) determines whether or not an obstacle has been detected, and if an obstacle is detected, branches to processing of [radio control request] in order to instruct remote control to avoid the obstacle. [ The processing of [return] will be continued (step 11315).

前記〔ラジコン要求〕について説明すれば、第9図に示
すように、前記変速装置(11)を変速ニュートラル位
置(N)に復帰させて走行停止させると共に、前記警告
灯(15)を点灯させて、非常停止したことを報知する
と共に、前記受信機(21)の受信情報に基づいて、前
記送信機(20)の割り込みスイッチ(29)がONさ
れたか否かを判別する。そして、前記割り込みスイッチ
(29)がONされるに伴って、前記機体(V)の走行
を前記送信機(20)側にて行うように、後述の〔ラジ
コン割り込み〕の処理に分岐して、遠隔操縦モードに切
り換える。
To explain the above [radio control request], as shown in Fig. 9, the transmission device (11) is returned to the neutral position (N) to stop traveling, and the warning light (15) is turned on. , notifies that the emergency stop has occurred, and determines whether or not the interrupt switch (29) of the transmitter (20) has been turned on based on the information received by the receiver (21). Then, as the interrupt switch (29) is turned on, the process branches to a [radio control interrupt] process, which will be described later, so that the aircraft (V) runs on the transmitter (20) side. Switch to remote control mode.

前記〔ラジコン割り込み〕について説明すれば、第10
図に示すように、前記〔ラジコン要求〕の処理と同様に
前記受信機(21)の受信情報に基づいて、前記割り込
みスイッチ(29)がOFFされたか否かを判別するこ
とにより、〔ラジコン割り込み〕の処理が終了したか否
かを判別する。
To explain the above [radio control interrupt], the 10th
As shown in the figure, similar to the processing of the [radio control request], by determining whether or not the interrupt switch (29) is turned off based on the information received by the receiver (21), ] is completed.

そして、割り込みが終了するに伴って、前記方位センサ
(S2)の検出情報に基づいて、機体(V)の向きが、
前記直線行程の基準方位(RASDRn)に対して設定
不感帯(SFKAN)内にあるか否かを判別し、設定不
感帯(SFKAN)内にある場合は、自動走行を再開す
べく、前記〔再生〕における行程数(KNUM)を判別
する処理(ステ7ブ#202)に復帰する。但し、前記
機体(V)の向きが直線行程の基準方位(BASDRn
)に対して設定不感帯(SFKAN)内にない場合は、
引き続き機体(V)の走行を遠隔操縦することを要求す
べく、前記〔ラジコン要求)の処理に分岐させることと
なる。
Then, as the interruption ends, the orientation of the aircraft (V) is determined based on the detection information of the orientation sensor (S2).
It is determined whether or not it is within the set dead zone (SFKAN) with respect to the reference direction (RASDRn) of the straight line travel, and if it is within the set dead zone (SFKAN), the process in the [regeneration] is performed in order to restart automatic driving. The process returns to the process of determining the number of strokes (KNUM) (Step #202). However, the direction of the aircraft (V) is the standard direction for straight line travel (BASDRn).
), if it is not within the set dead band (SFKAN),
In order to subsequently request remote control of the flight of the aircraft (V), the processing branches to the above-mentioned [radio control request].

[別実施例] 上記実施例では、散布状態設定手段(101)を、機体
(V)を自動走行させるための走行制御情報をティーチ
ングする処理を利用して、散布状態をティーチングする
ようにした場合を例示したが、予め人為的に設定するよ
うにしてもよく、散布状態設定手段(101)の具体構
成は各種変更できる。
[Another Embodiment] In the above embodiment, the dispersion state setting means (101) is configured to teach the dispersion state by using a process of teaching travel control information for automatically traveling the aircraft (V). Although exemplified above, it may be set manually in advance, and the specific configuration of the dispersion state setting means (101) can be changed in various ways.

又、上記実施例では、散布状態を設定するに、散布方向
を機体(V)に対して左右及び上方の3方向に分割して
設定できるように構成し、そして3方向に分割した何れ
の方向に散布するかを設定するようにした場合を例示し
たが、例えば、散布方向を左右2分割する、あるいは、
単に散布の開始停止のみを設定するようにしたり、さら
には、噴出量を調節させるようにしてもよく、薬剤散布
状態を切り換えるための具体構成は各種変更できる。
In addition, in the above embodiment, when setting the dispersion state, the dispersion direction can be set by dividing it into three directions, left, right, and upward with respect to the aircraft (V), and which of the three directions can be set. The example above shows the case where you can set whether to spray, but for example, you can divide the scattering direction into left and right, or
It is also possible to simply set the start and stop of spraying, or even to adjust the amount of ejection, and the specific configuration for switching the chemical spraying state can be changed in various ways.

尚、特許請求の範囲の項に図面との対照を便利にするた
めに符号を記すが、該記入により本発明は添付図面の構
造に限定されるものではない。
Incidentally, although reference numerals are written in the claims section for convenient comparison with the drawings, the present invention is not limited to the structure shown in the accompanying drawings by the reference numerals.

【図面の簡単な説明】[Brief explanation of the drawing]

図面は本発明に係る薬剤散布作業車の走行制御装置の実
施例を示し、第1図は制御構成を示すブロック図、第2
図はティーチングの説明図、第3図は作業車の全体平面
図、第4図は同側面図、第5図は回向行程における散布
状態切り換え処理の説明図、第6図はティーチング処理
のフローチャート、第7図は再生処理のフローチャート
、第8図は回向処理のフローチャート、第9図はラジコ
ン要求処理のフローチャート、第10図はラジコン割り
込み処理のフローチャートである。 (V)・・・・・・機体、(7)・・・・・・薬剤散布
装置、(100)・・・・・・走行制御手段、(101
)・・・・・・散布状態設定手段、(102)・・・・
・・散布状態制御手段。
The drawings show an embodiment of the travel control device for a chemical spraying work vehicle according to the present invention, and FIG. 1 is a block diagram showing the control configuration, and FIG. 2 is a block diagram showing the control configuration.
The figure is an explanatory diagram of teaching, Fig. 3 is an overall plan view of the work vehicle, Fig. 4 is a side view of the same, Fig. 5 is an explanatory diagram of the scattering state switching process in the turning process, and Fig. 6 is a flowchart of the teaching process. , FIG. 7 is a flowchart of reproduction processing, FIG. 8 is a flowchart of redirection processing, FIG. 9 is a flowchart of radio control request processing, and FIG. 10 is a flowchart of radio control interrupt processing. (V)... Airframe, (7)... Chemical spraying device, (100)... Travel control means, (101
)...Spreading state setting means, (102)...
... Spreading state control means.

Claims (1)

【特許請求の範囲】 1、薬剤の散布状態を切り換え自在な薬剤散布装置(7
)を備えた機体(V)が、直線行程と、直線行程の終端
部から次の直線行程の始端部へ前記機体(V)を移動さ
せる回向行程の夫々において、薬剤を散布しながら自動
走行するように制御する走行制御手段(100)を設け
てある薬剤散布作業車の走行制御装置であって、前記回
向行程における薬剤散布状態を設定する散布状態設定手
段(101)を設け、前記散布状態設定手段(101)
による設定情報に基づいて、前記回向行程における前記
薬剤散布装置(7)の散布状態を制御する散布状態制御
手段(102)を設けてある薬剤散布作業車の走行制御
装置。 2、前記散布状態設定手段(101)は、前記機体(V
)に対して左右及び上の3方向における薬剤の散布方向
を設定すべく構成してある特許請求の範囲第1項に記載
の薬剤散布作業車の走行制御装置。
[Claims] 1. A chemical spraying device (7
) is automatically traveling while dispersing chemicals in each of the straight line stroke and the turning stroke in which the body (V) is moved from the end of the straight line stroke to the starting point of the next straight line stroke. A travel control device for a chemical spraying work vehicle, which is provided with a travel control means (100) for controlling the spraying state, and is provided with a spraying state setting means (101) for setting the chemical spraying state in the turning stroke. Status setting means (101)
A travel control device for a chemical spraying work vehicle, comprising a spraying state control means (102) for controlling the spraying state of the chemical spraying device (7) in the turning stroke based on setting information according to the above. 2. The dispersion state setting means (101)
2. A travel control device for a chemical spraying work vehicle according to claim 1, which is configured to set the chemical spraying directions in three directions: left, right, and above with respect to the vehicle.
JP30597886A 1986-12-22 1986-12-22 Running control apparatus of chemical agent sprinkling work vehicle Pending JPS63158152A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP30597886A JPS63158152A (en) 1986-12-22 1986-12-22 Running control apparatus of chemical agent sprinkling work vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP30597886A JPS63158152A (en) 1986-12-22 1986-12-22 Running control apparatus of chemical agent sprinkling work vehicle

Publications (1)

Publication Number Publication Date
JPS63158152A true JPS63158152A (en) 1988-07-01

Family

ID=17951589

Family Applications (1)

Application Number Title Priority Date Filing Date
JP30597886A Pending JPS63158152A (en) 1986-12-22 1986-12-22 Running control apparatus of chemical agent sprinkling work vehicle

Country Status (1)

Country Link
JP (1) JPS63158152A (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0220970U (en) * 1988-07-27 1990-02-13
JPH0269956U (en) * 1988-11-11 1990-05-28
JPH08196105A (en) * 1995-01-24 1996-08-06 Yanmar Agricult Equip Co Ltd Rotation angle detecting device for automatic chemical applicator
JP2006020507A (en) * 2004-07-06 2006-01-26 National Agriculture & Bio-Oriented Research Organization Fertilizing machine

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0220970U (en) * 1988-07-27 1990-02-13
JPH0269956U (en) * 1988-11-11 1990-05-28
JPH08196105A (en) * 1995-01-24 1996-08-06 Yanmar Agricult Equip Co Ltd Rotation angle detecting device for automatic chemical applicator
JP2006020507A (en) * 2004-07-06 2006-01-26 National Agriculture & Bio-Oriented Research Organization Fertilizing machine

Similar Documents

Publication Publication Date Title
CN108791482A (en) Automatic steering system
JPS63158152A (en) Running control apparatus of chemical agent sprinkling work vehicle
JPS63157908A (en) Steering control apparatus of running working vehicle between trees
JPS62289472A (en) Method and device for steering control of trailer drawn by tractor
JPS633711A (en) Running control apparatus of automatic running working vehicle
JPS63158153A (en) Running control apparatus of chemical agent sprinkling work vehicle
JPS62259110A (en) Drive controller for self-traveling farm machine
JPS637706A (en) Running control apparatus of automatic running working vehicle
JPH061407B2 (en) Travel control device for automated guided vehicles
JPS62285114A (en) Traveling controller for automatic traveling vehicle
JPH0570403B2 (en)
JPS62269769A (en) Device for controlling traveling of chemical sprinkling car
JPS62265906A (en) Steering controller of automatic running working machine
JPS63153608A (en) Steering controller for working vehicle
JPS63204A (en) Running control apparatus of automatic running working vehicle
JPS62296805A (en) Running control unit of automatic running working vehicle
JPS62248011A (en) Running control device for service car
JPS633710A (en) Running control apparatus of automatic running working vehicle
JPS62297909A (en) Drive controller for automatic traveling truck
JPS62294003A (en) Running control unit of automatic running working vehicle
JP3265404B2 (en) Mobile Farming Equipment Steering Controller
JPS63298114A (en) Range finder for working vehicle
JP3005153B2 (en) Travel control device for beam-guided work vehicle
JP3005151B2 (en) Traveling control device for beam-guided work vehicle
JPH01109413A (en) Steering control device for automatic travelling working vehicle