JPS61115408A - Turn controller of automatic running working machine - Google Patents
Turn controller of automatic running working machineInfo
- Publication number
- JPS61115408A JPS61115408A JP59237734A JP23773484A JPS61115408A JP S61115408 A JPS61115408 A JP S61115408A JP 59237734 A JP59237734 A JP 59237734A JP 23773484 A JP23773484 A JP 23773484A JP S61115408 A JPS61115408 A JP S61115408A
- Authority
- JP
- Japan
- Prior art keywords
- distance
- work
- vehicle
- detection means
- area
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000001514 detection method Methods 0.000 claims description 31
- 230000003287 optical effect Effects 0.000 description 6
- 238000000034 method Methods 0.000 description 5
- 244000025254 Cannabis sativa Species 0.000 description 4
- 230000005540 biological transmission Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
Landscapes
- Guiding Agricultural Machines (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。(57) [Summary] This bulletin contains application data before electronic filing, so abstract data is not recorded.
Description
【発明の詳細な説明】
〔産業上の利用分野〕
本発明は、作業車に走行箇所が未処理作業地であるか否
かを検出する作業地状況検出手段、および走行距離を検
出する距離検出手段を夫々備えさせ、前記両検出手段に
よる検出情報に基づいて、前記作業地状況検出手段が処
理済作業地検出状態で、かつ、検出走行距離が、車体進
行方向側端部の外方側に作業範囲設定用処理済作業地が
形成された作業地の一行程長さに基づいて設定された基
準距離以上になると、作業地の車体進行方向側端部の長
手方向に沿う姿勢で、作業地の前行程で処理された箇所
側に位置させるように、ステアリング操作しながら後進
させる方向転換制御手段を備えた自動走行作業車のター
ン制御装置に関する。[Detailed Description of the Invention] [Industrial Application Field] The present invention provides a working area condition detecting means for detecting whether a working area where a working vehicle is traveling is an untreated working area, and a distance detecting means for detecting the traveling distance. means are respectively provided, and based on the detection information by both the detection means, the work area situation detection means is in the processed work area detection state and the detected travel distance is on the outer side of the end on the side in the direction of travel of the vehicle body. When the treated work area for setting the work area exceeds the reference distance set based on the length of one stroke of the work area, the work area is moved in a posture along the longitudinal direction of the end of the work area in the direction of vehicle movement. The present invention relates to a turn control device for an automatic traveling work vehicle, which is equipped with a direction change control means that causes the vehicle to move backward while operating the steering wheel so that the vehicle is positioned on the side of the location treated in the previous stroke.
上記この種のターン制御装置を、例えば自動走行作業車
の一例である芝刈作業車に適用した場合について説明す
ると、予め外周ティーチング作業等によって作業範囲の
外側を処理済作業地とすると共にその大きさに基づいて
、−行程の基準距離を設定された所定範囲の作業地を、
各行程端で90度方向転換して次行程へ移動させ、外周
より内周方向へ順次作業幅を減じながら走行させる制御
を行うこととなる。 そして、前記行程端に達したこと
を検出するに、作業地状況検出手段が処理済作業地検出
状態にあり、かつ、検出走行距離が前記基準距離以上と
なることによってターン制御が起動されるようにしてい
た。To explain the case where this type of turn control device described above is applied to a lawn mowing work vehicle, which is an example of an automatic driving work vehicle, the outside of the work area is set as a treated work area by circumference teaching work etc. in advance, and the size of the work area is Based on - a predetermined range of work area with a reference distance for the trip,
Control is performed such that the direction is changed 90 degrees at the end of each stroke and the robot is moved to the next stroke, and the working width is gradually reduced from the outer circumference toward the inner circumference. When detecting that the stroke end has been reached, the turn control is activated when the work area condition detection means is in the processed work area detection state and the detected travel distance is equal to or greater than the reference distance. I was doing it.
尚、上記−行程の基準距離は、その走行形式から、−行
程走行する毎に作業幅分を減じられ、順次更新されるこ
ととなる。Note that the reference distance for the above-mentioned -stroke is subtracted by the working width every time the -stroke is traveled due to the traveling style, and is updated sequentially.
しかしながら、前記基準距離の設定の誤差や、作業地状
況検出手段の誤検出に起因して、ターン制御を開始する
位置が行程端に対応する所望位置よりも車体進行方向上
手側に片寄ってしまうことがあった。 ちなみに、作業
地状況検出手段が誤検出を生じる原因としては、作業地
の行程端近くに処理済作業地に近似する部分が存在する
場合等が挙げられ、又、基準距離の設定誤差が生じる原
因としては、例えば、上記の如く一行程毎に作業幅を滅
じる場合において、その減じる作業幅と実際の作業幅と
が異なる点等を挙げることができる。However, due to an error in the setting of the reference distance or an erroneous detection by the work area situation detection means, the position at which turn control is started may be shifted to the upper side in the vehicle traveling direction than the desired position corresponding to the end of the stroke. was there. Incidentally, causes of false detection by the work area condition detection means include the presence of a portion that approximates the processed work area near the end of the work area, and also causes of errors in setting the reference distance. For example, when the working width is reduced for each stroke as described above, the reduced working width is different from the actual working width.
そして、このように、車体進行方向上手側でターン制御
を行うと、方向転換した後の車***置が次行程に対して
未処理済作業地側へ大きくずれた状態となり、その時点
から処理済作業地側へ操向制御したとしても作業地状況
検出手段が処理済作業地検出状態になるまで車体を平行
移動させながら作業を行うため、車体の移動中に未処理
部を発生する不都合があった。In this way, if the turn control is performed on the upper side in the direction of vehicle movement, the position of the vehicle after changing direction will be greatly shifted toward the unprocessed work area compared to the next stroke, and from that point on, the processed work Even if the steering is controlled to the ground side, the work is carried out while the vehicle body is moved in parallel until the work area condition detection means reaches the processed work area detection state, which has the inconvenience of generating unprocessed parts while the vehicle body is moving. .
本発明は、上記実情に漏みてなされたものであって、そ
の目的は、次行程への方向転換後において、車体の位置
が未処理作業地側に大きくずれた地点から次行程の作業
を開始することがないように抑制する点にある。The present invention has been made in view of the above-mentioned circumstances, and its purpose is to start the next process from a point where the position of the vehicle body deviates significantly toward the untreated work area after changing direction to the next process. The point is to suppress it so that it does not happen.
本発明の特徴構成は、前記方向転換後の走行において、
前記作業地状況検出手段の処理済作業地検出状態が所定
距離続(と、後進を行いながら前行程での走行方向上手
側に幅寄せ走行させるとともに、前記基準距離にこの後
進幅寄せ距離分を加算して前記基準距離を修正する基準
距離修正手段を設けてある点にあり、その作用及び効果
は次の通りである。A characteristic configuration of the present invention is that in running after the direction change,
When the processed work area detection state of the work area situation detection means continues for a predetermined distance (and while reversing, the vehicle is moved closer to the upper side in the traveling direction in the previous stroke, and the reference distance is increased by this backward approach distance). The present invention is provided with a reference distance correction means for correcting the reference distance by addition, and its functions and effects are as follows.
すなわち、車体の方向転換後の走行において、未処理作
業地上を所定距離走行すると、前行程での走行方向に沿
う方向に後進して幅寄せして未処理部の再処理を行った
後に次行程の作業を開始するとともに、基準距離を、上
記後進幅寄せを行った距離分、修正しておくのである。In other words, when the vehicle body travels a predetermined distance on untreated work ground after changing its direction, it reverses in the direction along the traveling direction of the previous stroke, width-aligns it, reprocesses the untreated area, and then starts the next stroke. At the same time as starting the work, the reference distance is corrected by the distance of the above-mentioned reverse movement.
したがって、ターン制御が一行程でターンを開始する所
望位置よりも車体進行方向上手側位置で行われても、所
望位置で方向転換した場合と差のない位置に車***置を
修正して次行程の走行を再開させることができるので、
従来のように次行程の所望位置が未処理作業地へ太き(
ずれた状態で作業を行うために生じる未処理部発生を防
止し、作業跡の蛇行のない状態で作業を行うことができ
るとともに、基準距離が短めに設定されていたことによ
る次行程以降の未処理作業地側に寄った状態での方向転
換開始が防止されるのである。Therefore, even if the turn control is performed in one stroke at a position above the desired position in the direction of vehicle travel, the vehicle body position is corrected to a position that is the same as when the direction is changed at the desired position, and the next stroke is performed. You can resume driving, so
As in the past, the desired position of the next process is thick (
This prevents the occurrence of unprocessed parts caused by working in a misaligned state, allows work to be carried out without meandering traces, and eliminates unfinished parts from the next process onwards due to the short reference distance. This prevents the vehicle from starting to change direction when it is close to the processing site.
以下、本発明の実施例を図面に基づいて説明する。 Embodiments of the present invention will be described below based on the drawings.
第4図および第5図に示すように、前・後輪(2) 、
(3)のいずれをもステアリング操作可能に構成され
た車体(1)の中間部にディスク型刈刃を内装した芝刈
装置(4)を上下動自在に懸架するとともに、作業地(
^)の境界である未処理作業地としての未刈地(B)と
処理済作業地としての既刈地(C)の境界(L)を検出
するための倣いセンサ(5) 、 (5)を、車体(1
)前方左右に夫々配置されるように、その其端部を前記
芝刈装置(4)に固定されたフレーム(9)の先端部に
設け、この倣いセンサ(5) 、 (5)による前記境
界(L)結果に基づいて、操向制御されて所定範囲の作
業地(A)を、前記未刈地(B)と既刈地(C)の境界
(L)に沿って自動走行可能な自動走行作業車としての
芝刈作業車を構成しである。As shown in Figures 4 and 5, front and rear wheels (2),
(3) A lawn mowing device (4) equipped with a disc-shaped cutting blade is suspended in the middle of the vehicle body (1), which is configured to be able to steer any of the above, and is movable up and down.
^) for detecting the boundary (L) between uncut land (B) as untreated work land and mown land (C) as treated work land (5), (5) , car body (1
) The edges thereof are provided at the tip of the frame (9) fixed to the lawn mowing device (4) so as to be placed on the front left and right sides respectively, and the boundary ( L) Based on the results, automatic driving that can automatically travel through a predetermined range of the work area (A) along the boundary (L) between the unmoved area (B) and the mowed area (C) under steering control. This is a lawn mowing vehicle used as a working vehicle.
また、前記車体(1)には、走行距離CI!’)を連続
的に検出するために、走行距離検出手段を構成する単位
走行距離当たり所定個数のパルス信号を発生する距離セ
ンサ(6)としての従動輪(6A)と、車体(1)の走
行方向(方位)を検出するために、地磁気の強度変化を
感知することによって方位を検出する地磁気センサを方
位センサ(7)として設けてある。The vehicle body (1) also has a mileage CI! '), a driven wheel (6A) is used as a distance sensor (6) that generates a predetermined number of pulse signals per unit traveling distance and constitutes a traveling distance detecting means, and In order to detect the direction (orientation), a geomagnetic sensor (7) that detects the direction by sensing changes in the intensity of the earth's magnetic field is provided.
尚、前記前輪(2) 、 (2)および後輪(3)、(
3)はそのいずれをもステアリング操作可能に構成しで
あることから、前・後輪(2)、、 (3)を同一方向
にステアリング操作することによって車体(1)の向き
を変えることなく平行移動する平行ステアリング形式と
、前・後輪(2) 、 (3)を相対的に逆方向にステ
アリング操作することによって非常に小さい旋回半径で
旋回する旋回ステアリング形式との、異なるステアリン
グ形式によって、操向制御可能に構成しである。In addition, the front wheels (2), (2) and the rear wheels (3), (
3) is configured so that both of them can be steered, so by steering the front and rear wheels (2), (3) in the same direction, the vehicle body (1) will be parallel without changing its direction. Steering is achieved by different steering types: a parallel steering type that moves, and a turning steering type that turns with a very small turning radius by steering the front and rear wheels (2) and (3) in relatively opposite directions. It is configured so that it can be controlled in both directions.
前記倣いセンサ(5)を構成するに、発光素子(Pl)
と受光素子(P2)とを一対としてスリ、トを介して対
抗する位置に配置した、いわゆるフォトインクラブタ式
の二つの光センサ(Sl)、(SZ)を、車体(1)に
対して左右方向に並ぶように前記フレーム(9)先端部
に固定しである。 そしり
て、前記発光素子(Pl)と受光素子(P2)との間を
通過する芝の有無を感知することによって、前記光セン
サ(Sl)、(SZ)が未刈地(B)、既刈地(C)の
いづれの上に有るかを判別し、その検出結果の組み合わ
せ、つまり、境界側でかつ車体(1)の外側にある光セ
ンサ(Sl)が既刈地(C)を検出するとともに車(本
(1)の内側にある光センサ(SZ)が未刈地(B)を
検出している状態を境界(L)に沿っている状態として
境界(L)と車体(1)との位置関係を判別するととも
に、走行箇所が、未刈地(B)であるか既刈地(C)で
あるかを検出するための作業地状況検出手段に兼用構成
してあり、左右側倣いセンサ(5) 、 (5)が既刈
地(C)を検出した状態を一行程が終了したものとして
、次行程に移動させるための方向転換制御を起動するよ
うにしである。 ところで、前記光センサ(S 、 )
。The scanning sensor (5) includes a light emitting element (Pl).
Two so-called photo ink club type optical sensors (Sl) and (SZ), which are arranged as a pair with a photo ink sensor and a light receiving element (P2) at opposite positions via a slot, are attached to the vehicle body (1). They are fixed to the tip of the frame (9) so as to be lined up in the left and right direction. Then, by sensing the presence or absence of grass passing between the light emitting element (Pl) and the light receiving element (P2), the optical sensors (Sl) and (SZ) The combination of the detection results, that is, the optical sensor (Sl) located on the boundary side and outside the vehicle body (1), detects the mowed ground (C). The state in which the optical sensor (SZ) inside the vehicle (book (1)) detects the uncut land (B) is defined as the state in which the vehicle is along the boundary (L) and the boundary (L) and the vehicle body (1). In addition to determining the positional relationship between the The state in which the sensors (5) and (5) detect the mown field (C) is considered to be the end of one stroke, and the direction change control for moving to the next stroke is activated. Sensor (S, )
.
(SZ)から得られる未刈地(B)・既刈地(C)の判
別信号は芝が断続的に通過するために、非連続なパルス
状の信号となる。 従って、連続した判別信号となるよ
うに、積分処理を行った後に後記制御装置(10)に人
力ずべく構成しである。The discrimination signal for unmowed land (B) and mowed land (C) obtained from (SZ) becomes a discontinuous pulse-like signal because the grass passes intermittently. Therefore, in order to obtain a continuous discrimination signal, the control device (10) described later should be configured manually after performing the integration process.
前記光センサ(St)、(SZ)からの信号を積分処理
するに、第1図に示すように、前記距離センサ(6)の
出力パルス数をカウントして予め設定されたカウント値
毎にキャリー信号(P4)を出力するプログラマブルカ
ウンタ(11)と、このカウンタ(11)のキャリー信
号(P4)によってリセットされるフリップフロップ(
12)を設け、前記受光素子(Sz)の出力信号(P3
)によって前記カウンタ(11)をリセットするととも
にフリップフロップ(12)をセットすべく構成してあ
り、このカウンタ(11)とフリップフロップ(12)
によってデジタルフィルタ(13)に構成して、前記未
刈地(B)と既刈地(C)夫々の状態に対応する連続し
た境界(L)の判別信号(Po)を得るようにしである
。To integrate the signals from the optical sensors (St) and (SZ), as shown in FIG. 1, the number of output pulses from the distance sensor (6) is counted and carried every preset count value. A programmable counter (11) that outputs a signal (P4) and a flip-flop (11) that is reset by the carry signal (P4) of this counter (11).
12) is provided, and the output signal (P3) of the light receiving element (Sz) is provided.
) is configured to reset the counter (11) and set the flip-flop (12), and the counter (11) and the flip-flop (12)
A digital filter (13) is configured to obtain continuous boundary (L) discrimination signals (Po) corresponding to the respective states of the unmowed field (B) and the mown field (C).
以下、このデジタルフィルタ(13)の動作を節単に説
明する。The operation of this digital filter (13) will be briefly explained below.
前記カウンタ(11)は、そのカウント値に拘らず前記
受光素子(P2)の出力パルス信号(P3)によって繰
り返しリセットされるとともに、フリップフロップ(1
2)はセントされる。 そして、芝が無くなってこのパ
ルス信号(P3)が”L”レベルになり、かつ、単位走
行距離走行して、前記カウンタ(11)がこの単位走行
距離に対応するカウント値まで前記距離センサ(6)の
出力信号(P3)をカウントした場合にのみ、前記カウ
ンタ(11)はキャリー信号(R4)を出力してフリッ
プフロップ(12)をリセットする。 従って、このフ
リップフロップ(12)の出力には芝感知状態すなわち
未刈地(B)検出に対応する”H’レベルまたは2無状
態すなわち既刈地(C)検出に対応する”L”レベルを
連続的に繰り返す作業地状況検出信号(Po)が得られ
るのである。The counter (11) is repeatedly reset by the output pulse signal (P3) of the light receiving element (P2) regardless of its count value, and the flip-flop (11) is reset repeatedly by the output pulse signal (P3) of the light receiving element (P2).
2) is cent. Then, when the grass disappears, this pulse signal (P3) becomes "L" level, and the distance sensor (6) reaches the count value corresponding to the unit distance traveled by the distance sensor (11). ), the counter (11) outputs a carry signal (R4) to reset the flip-flop (12). Therefore, the output of this flip-flop (12) has an "H" level corresponding to the grass sensing state, that is, the detection of an unmown area (B), or an "L" level, corresponding to the no state, that is, the detection of a mowed area (C). A continuously repeated work site situation detection signal (Po) is obtained.
なお、前記倣いセンサ(5) 、 (5)としては、前
記光センサ(Sl)、(S2)を用いるものに限らず、
接触式・非接触式を問わず、どのような形式のセンサか
ら構成してもよい。 そして、その検出信号から作業地
状況検出信号(Po)を得るための信号処理は、夫々セ
ンサの形式に対応して適宜行えばよい。Note that the copying sensors (5) and (5) are not limited to those using the optical sensors (Sl) and (S2),
It may be constructed from any type of sensor, regardless of whether it is a contact type or a non-contact type. The signal processing for obtaining the work place situation detection signal (Po) from the detection signal may be performed as appropriate depending on the type of sensor.
以下、前記構成になる倣いセンサ(5) 、 (5)、
距離センサ(6)、および方位センサ(7)による各検
出パラメータに基づいて、芝刈作業車の走行を制御する
制御システムについて説明する。Hereinafter, the copying sensor (5) having the above configuration, (5),
A control system that controls the running of the lawn mowing vehicle based on the parameters detected by the distance sensor (6) and the direction sensor (7) will be described.
第1図に示すように、制御システムは、主要部をマイク
ロコンビ二一夕によって構成された制御装置(10)に
、前記各センサ(5) 、 (6) 、 (7)からの
信号を入力してあり、これら各センサ(5)1(6)
、 (7)による検出パラメータを演算処理することに
よって、車体(1)の走行方向や走行速度を自動的に制
御すべく、前・後輪(2) 、 (3)夫々のステアリ
ング操作を行う油圧シリンダ(14)。As shown in FIG. 1, the control system inputs signals from each of the sensors (5), (6), and (7) to a control device (10) whose main part is composed of a microcomputer. Each of these sensors (5) 1 (6)
, (7) to automatically control the running direction and speed of the vehicle body (1), the hydraulic pressure for steering each of the front and rear wheels (2) and (3) is calculated. Cylinder (14).
(15)を作動させる電磁バルブ(16) 、 (17
)および油圧式無段変速装置(18)の変速位置を操作
するモータ(19)等の各アクチュエータを駆動する制
御信号を生成すべく構成しである。Electromagnetic valves (16) and (17) that operate (15)
) and a motor (19) that operates the shift position of the hydraulic continuously variable transmission (18).
尚、第1図中、(R+)、(Ri)は前・後輪(2)
、 (3)の実際のステアリング量を検出して制御装置
(10)にフィードバックするためのポテンショメータ
であり、(R3)は同様にして変速装置(18)の変速
位置を検出して制御装置(10)にフィードハ
jツクするためのポテンショメータである。In Figure 1, (R+) and (Ri) are the front and rear wheels (2).
, (3) is a potentiometer for detecting the actual steering amount and feeding it back to the control device (10), and (R3) is a potentiometer for similarly detecting the shift position of the transmission (18) and feeding it back to the control device (10). ) to feed
This is a potentiometer for turning.
そして、予め外周ティーチング等によって、その大きさ
く各辺の長さ)を設定され、外周の外側を作業範囲設定
用既刈地(C)とした所定範囲の作業地(A)内部の未
刈地CB)を、前記作業地(A)の大きさと芝刈装置(
4)の作業幅(ロ)とに基づいて算出した行程数とその
基準方位(甲。)とに基づいて、各行程間を走行するた
めの操向制御と一つの行程を終了後次行程へ90度方向
転換して移動するための方向転換制御とを繰り返しなが
ら所定範囲の作業地(^)を外周より内周方向へ作業幅
を減じながら対地作業としての芝刈作業を行うのである
。 、・□
そして、前記操向制御中は、未刈地(B)と既刈地(C
)との境界側にある倣いセンサ(5)による前記境界(
L)に対する車体(1)のずれ方向検出結果に恭づいて
前記前・後輪(2) 、 (3)を同一方向にステアリ
ング操作する平行ステアリングによって境界(シ)に対
する車体(1)の位置修正を行う倣い制御と、前記基準
方位(VO)と方位センサ(7)による検出方位(甲)
との比較結果に基づいて、前記前・後輪(2) 、 (
3)を逆方向にステアリング操作する旋回ステアリング
によって車体(1)の向き修正を行う方位制御とを併用
して、各行程での直進性を維持しながら境界(L)に沿
って自動走行するように制御するのである。Then, the unmown area inside the predetermined area of the work area (A) with the outside of the outer periphery set as the already-moved area (C) for setting the work area, whose size and length of each side are set in advance by outer circumference teaching etc. CB), the size of the work area (A) and the lawn mowing equipment (
Based on the number of strokes calculated based on the working width (B) in 4) and its reference direction (A.), steering control is performed to travel between each stroke, and after completing one stroke, proceed to the next stroke. While repeating the direction change control to change the direction by 90 degrees and move, the lawn mowing work as ground work is performed in a predetermined range of work area (^) while reducing the work width from the outer circumference to the inner circumference. ,・□ During the steering control, the unmoved area (B) and the mowed area (C
) is detected by the scanning sensor (5) on the boundary side with the boundary (
The position of the vehicle body (1) with respect to the boundary (C) is corrected by parallel steering in which the front and rear wheels (2) and (3) are steered in the same direction based on the detected deviation direction of the vehicle body (1) with respect to the boundary (L). The following control is performed, and the reference orientation (VO) and the orientation detected by the orientation sensor (7) (A)
Based on the comparison results with the front and rear wheels (2), (
3) is used in conjunction with direction control that corrects the orientation of the vehicle body (1) by turning steering in the opposite direction, so that the vehicle automatically travels along the boundary (L) while maintaining straightness in each stroke. control.
一方、前記方向転換制御は、前記両倣いセンサ(5)
、 (5)が既刈地(C)を検出し、距離センナ(6)
による検出距離(7りが各行程の距離に基づいて設定さ
れた基準距離(/n)に達したことを検出した場合に、
車体(1)が行程端部に至ったものと判断して、起動さ
れるように制御するのである。 尚、前記検出距離(6
)が基準距離(in)に対して所定距離以上となると前
記両倣いセンサ(5) 、 (5)が既刈地(C)を検
出しない場合であっても、強制的に方向転換が開始され
るようにしである。On the other hand, the direction change control is performed by the both scanning sensors (5).
, (5) detects the mowed field (C), and the distance sensor (6)
When it is detected that the detection distance (7) has reached the reference distance (/n) set based on the distance of each stroke,
It determines that the vehicle body (1) has reached the end of its stroke and controls it to start. In addition, the detection distance (6
) becomes a predetermined distance or more with respect to the reference distance (in), a direction change is forcibly started even if the two scanning sensors (5), (5) do not detect the mown area (C). It is like that.
そして、車体(1)の方向転換が所望位置よりも車体進
行方向上手側位置で行われた場合は、すなわち、第2図
及び第3図(() 、 (+1) 、 (+1)に示す
ように、方向転換後、所定距離(al)走行する間、倣
いセンサ(5)の未刈地(B)検出状態が続くと、一旦
停止した後に車体(1ン を所定距離(p2)後退させ
なから既刈地(C)側に軸寄せを行った後にその後退幅
寄せ距離(13)と前行程の基準距離(e n)とを加
算した距離を次周の基準距離にして、すなわち、予め設
定されていた基準距離(2n)を演算修正して、次行程
の走行を再開させて以下次行程の走行行程が終了するま
で倣いセンサ(5)及び方位センサ(7)により車体(
1)の操向制御を行うことになる。If the direction change of the vehicle body (1) is performed at a position on the upper side of the vehicle body traveling direction than the desired position, that is, as shown in FIGS. 2 and 3 ((), (+1), (+1)) If the scanning sensor (5) continues to detect uncut land (B) while driving for a predetermined distance (al) after changing direction, the vehicle body (1) must not be moved backward for a predetermined distance (p2) after it has stopped. After shifting the shaft to the mowed field (C) side, the distance obtained by adding the rearward shifting distance (13) and the reference distance (e n) of the previous stroke is set as the reference distance for the next round, that is, the distance is set in advance. The set reference distance (2n) is calculated and corrected, the next stroke is restarted, and the following sensor (5) and direction sensor (7) are used to control the vehicle body (
1) Steering control will be performed.
尚、後退幅寄せ距離(11)は、次行程へ進入後に走行
した所定距離(1)と、この所定距離(e)と後進した
所定距離(i2)との角度(θ)に基づいて演算するこ
とにより算出されることになる。Note that the backward moving distance (11) is calculated based on the predetermined distance traveled after entering the next stroke (1), and the angle (θ) between this predetermined distance (e) and the predetermined distance traveled in reverse (i2). It will be calculated by
すなわち、11!3=lsin θとなる。That is, 11!3=lsin θ.
図面は本発明に係る自動走行作業車のターン制御装置の
実施例を示し、第1図は制御システムのブロック図、第
2図は制御装置の動作を示すフローチャート、第3図は
方向転換の説明図、第4図は芝刈作業車の全体平面図、
そして、第5図は倣いセンサの要部正面図である。
(1)・・・・・・作業車、(5)・・・・・・作業地
状況検出手段、(6)・・・・・・距騨検出手段、(A
)・・・・・・作業地、(B)・・・・・・未処理作業
地、(C)・・・・・・処理済作業地、(N)・・・・
・・検出走行距離、(ln)・・・・・・基準距離、(
!l)・・・・・・所定距離、(i3)・・・・・・後
進幅寄せ距離。
ゴThe drawings show an embodiment of the turn control device for an automatic traveling work vehicle according to the present invention, FIG. 1 is a block diagram of the control system, FIG. 2 is a flowchart showing the operation of the control device, and FIG. 3 is an explanation of direction change. Figure 4 is an overall plan view of the lawn mowing vehicle.
FIG. 5 is a front view of the main parts of the scanning sensor. (1)...Working vehicle, (5)...Working area condition detection means, (6)...Distance detection means, (A
)...... Working area, (B)...... Untreated working area, (C)...... Treated working area, (N)...
...Detected travel distance, (ln)...Reference distance, (
! l)...Predetermined distance, (i3)...Reverse moving distance. Go
Claims (1)
否かを検出する作業地状況検出手段(5)、および走行
距離を検出する距離検出手段(6)を夫々備えさせ、前
記両検出手段(5),(6)による検出情報に基づいて
、前記作業地状況検出手段(5)が処理済作業地(C)
検出状態で、かつ、検出走行距離(l)が、車体進行方
向側端部の外方側に作業範囲設定用処理済作業地(C)
が形成された作業地(A)の一行程長さに基づいて設定
された基準距離(l_n)以上になると、作業地(A)
の車体進行方向側端部の長手方向に沿う姿勢で、作業地
(A)の前行程で処理された箇所側に位置させるように
、ステアリング操作しながら後進させる方向転換制御手
段を備えた自動走行作業車のターン制御装置であって、
前記方向転換後の走行において、前記作業地状況検出手
段の処理済作業地(C)検出状態が所定距離(l_1)
続くと、後進を行いながら前行程での走行方向上手側に
幅寄せ走行させるとともに、前記基準距離(l_n)に
この後進幅寄せ距離(l_3)分を加算して前記基準距
離(l_n)を修正する基準距離修正手段を設けてある
自動走行作業車のターン制御装置。The work vehicle (1) is provided with a work site condition detection means (5) for detecting whether the traveling location is an untreated work site (B) and a distance detection means (6) for detecting the travel distance, Based on the detection information by both the detection means (5) and (6), the work site condition detection means (5) detects the processed work site (C).
In the detection state, and when the detected mileage (l) is on the outer side of the end on the side in the direction of vehicle movement, there is a processed work area (C) for setting the work range.
When the distance is equal to or greater than the reference distance (l_n) set based on the length of one stroke of the working area (A), the working area (A)
Automated driving equipped with a direction change control means that moves backward while operating the steering so that the vehicle is positioned along the longitudinal direction of the end of the vehicle body in the direction of travel, and is located on the side of the work area (A) that has been treated in the previous step. A turn control device for a work vehicle,
During driving after the direction change, the detected state of the processed work area (C) of the work area situation detection means is a predetermined distance (l_1).
Subsequently, while moving backward, the vehicle is caused to move closer to the upper side in the traveling direction in the previous stroke, and the reference distance (l_n) is corrected by adding this backward moving distance (l_3) to the reference distance (l_n). A turn control device for an automatic driving work vehicle, which is equipped with a reference distance correction means for adjusting the reference distance.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP59237734A JPS61115408A (en) | 1984-11-12 | 1984-11-12 | Turn controller of automatic running working machine |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP59237734A JPS61115408A (en) | 1984-11-12 | 1984-11-12 | Turn controller of automatic running working machine |
Publications (1)
Publication Number | Publication Date |
---|---|
JPS61115408A true JPS61115408A (en) | 1986-06-03 |
Family
ID=17019682
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP59237734A Pending JPS61115408A (en) | 1984-11-12 | 1984-11-12 | Turn controller of automatic running working machine |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS61115408A (en) |
-
1984
- 1984-11-12 JP JP59237734A patent/JPS61115408A/en active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US4603753A (en) | Automatic running work vehicle | |
GB2124798A (en) | Automatic running work vehicle | |
JPS61115408A (en) | Turn controller of automatic running working machine | |
JPH0241282B2 (en) | ||
JPS61115404A (en) | Turn controller of automatic running working machine | |
JPS61115405A (en) | Steering controller of automatic running working vehicle | |
JPH0214005B2 (en) | ||
JPS63240707A (en) | Running control apparatus of automatic running working vehicle | |
JPS60120903A (en) | Self-propelling working machine | |
JPH04259014A (en) | Automatic steering type working vehicle | |
JPS61108302A (en) | Automatic propelling working vehicle | |
JPH0365122B2 (en) | ||
JPS5972523A (en) | Unmanned traveling truck | |
JPS6121008A (en) | Automatic propelling working vehicle | |
JPS61108303A (en) | Automatic propelling working vehicle | |
JPS61111605A (en) | Automatic propelling working vehicle | |
JPH01231809A (en) | Photographing type travel control device for automatic travel working car | |
JPH0410086B2 (en) | ||
JPS60114104A (en) | Self-propelling working machine | |
JPS611306A (en) | Automatic propelling working vehicle | |
JPS6078504A (en) | Self-propelling working vehicle | |
JPH024B2 (en) | ||
JPS61124304A (en) | Self-propelling working vehicle | |
JPS60184309A (en) | Automatic running work machine | |
JPS6196906A (en) | Automatic propelling working machine |