JPH01171402A - Automatic steering device of transplanter - Google Patents
Automatic steering device of transplanterInfo
- Publication number
- JPH01171402A JPH01171402A JP62330689A JP33068987A JPH01171402A JP H01171402 A JPH01171402 A JP H01171402A JP 62330689 A JP62330689 A JP 62330689A JP 33068987 A JP33068987 A JP 33068987A JP H01171402 A JPH01171402 A JP H01171402A
- Authority
- JP
- Japan
- Prior art keywords
- traveling
- steering
- detector
- teaching
- automatic
- 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
- 238000012790 confirmation Methods 0.000 abstract 1
- 241000209094 Oryza Species 0.000 description 18
- 235000007164 Oryza sativa Nutrition 0.000 description 18
- 235000009566 rice Nutrition 0.000 description 18
- 238000001514 detection method Methods 0.000 description 13
- 230000003287 optical effect Effects 0.000 description 6
- 108091008695 photoreceptors Proteins 0.000 description 6
- 241000196324 Embryophyta Species 0.000 description 5
- 238000004804 winding Methods 0.000 description 5
- 230000000694 effects Effects 0.000 description 4
- 235000014676 Phragmites communis Nutrition 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000005284 excitation Effects 0.000 description 3
- 210000000078 claw Anatomy 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 230000000630 rising effect Effects 0.000 description 2
- 230000001580 bacterial effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 210000000988 bone and bone Anatomy 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 239000000696 magnetic material Substances 0.000 description 1
- 238000000034 method Methods 0.000 description 1
- 230000007935 neutral effect Effects 0.000 description 1
- 230000004043 responsiveness Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Landscapes
- Guiding Agricultural Machines (AREA)
- Transplanting Machines (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
【発明の詳細な説明】
〔産業上の利用分野〕
本発明は植付は済の苗株の列条を倣いガイドとして、移
植機を自動的に操向せしめる移植機の自動操向装置に関
する。DETAILED DESCRIPTION OF THE INVENTION [Field of Industrial Application] The present invention relates to an automatic steering device for a transplanter that automatically steers the transplanter by following the rows of seedlings that have already been planted as a guide.
移植機である田植機は走行機体と該機体の後部に連結さ
れた植付部とからなり、走行機体を走行させつつ、植付
部に搭載した苗株を、該植付部に装備された植付爪の動
作により、所定の間隔にて圃場に植付けるものである。A rice transplanting machine, which is a transplanting machine, consists of a traveling machine body and a planting section connected to the rear of the machine body. The plants are planted in the field at predetermined intervals by the movement of the planting claws.
ところで、苗株相互間の植付は間隔が過度に狭いと、苗
株の育成不良を招来する虞があり、逆に植付は間隔が過
度に広いと、単位面積当たりの収M量が少なくなるため
、苗株の植付けは、適正な植付は間隔にて行われること
が望ましい。田植機においては、前記植付爪が走行機体
の走行速度と同期して動作するようになっており、走行
機体の進行方向の植付は間隔は、走行速度の如何に拘ら
ず、自動的に前記適正値に保たれるが、走行機体の進行
方向と直交する方向の植付は間隔(以下条間隔という)
を前記適正値に保つためには、既に植付けられた苗株の
列条に沿って走行機体を操向させつつ植付けを行わせる
必要がある。しかしながら、田植機による植付は作業の
際には、植付部に搭載された苗株の残量、植付部の動作
状態、及びエンジンの運転状態等の種々の監視事項があ
り、これら各事項の監視と同時に前記操向を確実に行う
ことは、作業者に多大の労力負担を強いるという難点が
あった。By the way, if the spacing between seedlings is too narrow, there is a risk of poor growth of the seedlings, and conversely, if the spacing between seedlings is too wide, the yield per unit area will be low. Therefore, it is desirable to plant seedlings at appropriate intervals. In the rice transplanter, the planting claws operate in synchronization with the traveling speed of the traveling machine, and the planting interval in the traveling direction of the traveling machine is automatically adjusted regardless of the traveling speed. The above-mentioned appropriate value is maintained, but the planting distance in the direction perpendicular to the traveling direction of the traveling aircraft (hereinafter referred to as row spacing)
In order to maintain the above-mentioned appropriate value, it is necessary to plant the seedlings while steering the traveling machine along the rows of seedlings that have already been planted. However, when planting with a rice transplanter, there are various monitoring items such as the remaining amount of seedlings loaded in the planting section, the operating state of the planting section, and the operating state of the engine. There is a problem in that reliably performing the above-mentioned steering at the same time as monitoring matters requires a great deal of labor and effort on the operator.
そこで、作業者の労力負担を軽減し、しかも条間隔を前
記適正値に保った状態で植付は作業が行えるように、走
行機体を前記菌株の列条に沿って自動的に操向せしめる
自動操向装置を装備した田植機がある。Therefore, in order to reduce the labor burden on the worker and to carry out the planting work while maintaining the row spacing at the appropriate value, an automatic machine that automatically steers the traveling machine along the rows of the bacterial strains has been developed. There are rice transplanters equipped with a steering device.
この自動操向装置の一例として、特開昭53−1271
13号に開示されているものがある。これは、現状の植
付は条に隣接する既植苗の列条に赤外線を照射し、走行
機体の側部に左右方向に並設した複数個の受光体により
前記既植苗からの反射光を受光する苗列検出器を設け、
該苗列検出器の受光体にて反射光を受光する場合に、こ
れらの受光体の内、前記列条の直上に位置する受光体に
より前記反射光の受光がなされることを利用し、所定の
受光体により常に受光がなされるように自動操向を行う
ことにより、既植苗の列条に対する走行機体の相対位置
を適正位置に保つものであり、前記所定の受光体よりも
左側(又は右側)に位置する受光体により受光がなされ
た場合には、走行機体の相対位置が右(又は左)にずれ
ていると判断して、このずれを解消すべく、左方向(又
は右方向)に所定量の操舵を行う構成となっている。As an example of this automatic steering device, Japanese Patent Laid-Open No. 53-1271
There is one disclosed in No. 13. In the current planting method, infrared light is irradiated onto the rows of already planted seedlings adjacent to the rows, and the reflected light from the already planted seedlings is received by multiple photoreceptors arranged side by side in the left and right direction on the side of the traveling machine. A seedling row detector is installed to
When the reflected light is received by the photoreceptor of the seedling row detector, the reflected light is received by the photoreceptor located directly above the row among these photoreceptors, so that a predetermined The device maintains the relative position of the traveling machine relative to the row of already planted seedlings at an appropriate position by automatically steering the vehicle so that light is always received by the photoreceptor, and is positioned on the left side (or right side) of the predetermined photoreceptor. ), it is determined that the relative position of the traveling aircraft has shifted to the right (or left), and in order to eliminate this shift, it moves to the left (or right). It is configured to perform a predetermined amount of steering.
田植機の自動操向装置としては、この他にも種々提案さ
れているが、いずれも、既植苗の検出手段が異なるもの
の、自動操向の手段は、これと路間−の構成となってい
る。Various other automatic steering devices for rice transplanters have been proposed, but all of them have different means for detecting planted seedlings, but the automatic steering means has a structure that is similar to this. There is.
このような従来の田植機の自動操向装置においては、既
植苗が何らかの理由により欠株となり存在しない場合、
又は障害物等が田植機の前方にあり、圃場内の既植苗が
中断されているような場合は、前記苗列検出器で既植苗
を検出できないので、前記苗列検出器のみによる自動操
向では正常な倣い操向制御が行なわれなくなり、その結
果大幅に既植苗の列条からはずれてしまったり、又は自
動操向が中断されてしまうという問題があった。In such a conventional automatic steering device of a rice transplanter, if a seedling that has already been planted becomes missing for some reason and does not exist,
Alternatively, if there is an obstacle in front of the rice transplanter and the already planted seedlings in the field are interrupted, the seedling row detector cannot detect the already planted seedlings, so automatic steering is performed using only the seedling row detector. In this case, normal copying steering control is no longer performed, and as a result, there is a problem in that the seedlings deviate significantly from the rows of already planted seedlings, or the automatic steering is interrupted.
この問題点を解決するものとして、特公昭62−328
06号公報に開示された発明がある。この発明に係る無
人走行作業車は、作業地の外周を手動走行により作業し
つつ、本機に設けた方位検出機と走行距離検出器とのデ
ータを記憶することにより、作業地の往復行程の各行程
毎の走行コース距離及び方位を算出及び記憶する教示を
行い、この教示による自動操向と前記倣いによる自動操
向とを併用して次行程以降の作業をする。即ち前記教示
による走行コース距離と実走行距離との一致により自動
回向し、通常の行程の操向は前記倣いによる自動操向に
て行なわれ、前記境界が検出不能のとき、教示に基づく
自動操向が行なわれる。As a solution to this problem, the
There is an invention disclosed in Publication No. 06. The unmanned working vehicle according to the present invention manually travels around the outer periphery of the work site and stores data from the direction detector and travel distance detector installed in the machine, thereby controlling the round trip to the work site. The robot is taught to calculate and store the driving course distance and direction for each stroke, and the automatic steering based on this teaching and the automatic steering based on the copying are used together for the work from the next stroke onwards. In other words, automatic turning is performed when the travel course distance based on the teachings matches the actual travel distance, and steering during the normal stroke is performed by automatic steering based on the tracing, and when the boundary cannot be detected, automatic steering based on the teachings is performed. Steering is performed.
しかしながら前記発明においては、教示作業を対地作業
と同時に行っているので、これを移植機に応用した場合
、回向を行うときに既植苗を機体にて踏み倒し損傷を与
える虞がある。また対地作業は機体に対して進行方向に
直交する方向に外力が働き機体に横ずれを発生させるこ
とがあり、そのため教示中に対地作業を行うと正確な教
示が行なわれない虞があった。However, in the invention, since the teaching work is performed simultaneously with the ground work, if this is applied to a transplanting machine, there is a risk that the machine body may trample and damage the already planted seedlings when turning. In addition, during ground work, an external force is applied to the aircraft in a direction perpendicular to the direction of travel, which may cause the aircraft to shift laterally, so if ground work is performed during teaching, there is a risk that accurate teaching may not be performed.
本発明は斯かる事情に鑑みなされたものであり、既植苗
の列条に倣い圃場内の移植作業を行う移植機の自動操向
を既植苗に損傷を与えることなく行え、また教示作業に
横ずれ等が発生せず正確な教示に基づき自動操向される
移植機の自動操向装置を提供することを目的とする。The present invention has been developed in view of the above circumstances, and it is possible to automatically steer a transplanter that performs transplanting work in a field by following the rows of already planted seedlings without damaging the already planted seedlings, and also to prevent lateral slippage during teaching work. An object of the present invention is to provide an automatic steering device for a transplant machine that automatically steers based on accurate teaching without causing problems such as the following.
本発明に係る移植機の自動操向装置は、植付部を走行機
体に取付けてあり、圃場内をティーチングプレイバック
制御により自動操向しつつ移植作業をする移植機の自動
操向装置において、方位検出器と、走行距離を検出する
走行距離検出器と、植付部が非作業位置にあることを検
出する非作業検出器と、前記方位検出器により検出され
た前記移植機の進行方向の方位と、前記走行距離検出器
による前記進行方向への走行距離とから前記圃場内にお
ける走行位置を特定し、前記非作業検出器が前記非作業
位置を検出したとき、前記走行位置を記憶する手段とを
具備することを特徴とする。An automatic steering device for a transplanting machine according to the present invention is an automatic steering device for a transplanting machine in which a planting part is attached to a traveling machine body, and the transplanting machine performs transplanting work while automatically steering the inside of the field by teaching playback control. an azimuth detector, a traversal distance detector that detects a travel distance, a non-work detector that detects that the planting section is in a non-work position, and a direction of travel of the transplanter detected by the azimuth detector. Means for specifying a running position in the field from a direction and a running distance in the traveling direction by the running distance detector, and storing the running position when the non-working detector detects the non-working position. It is characterized by comprising the following.
本発明においては、植付部を非作業位置に位置せしめ、
移植作業をせずに手動操向により適宜に機体を走行させ
、この際の走行位置を逐次特定し、この特定結果を走行
位置に関する情報として記憶しているので、自動操向時
に既植苗に損傷を与ず、また教示中に横ずれが発生しな
い。In the present invention, the planting part is located in a non-working position,
Without transplanting, the machine is manually steered to run as appropriate, and the running position at this time is identified sequentially, and this identification result is stored as information regarding the running position, so there is no chance of damage to the already planted seedlings during automatic steering. Also, no lateral deviation occurs during teaching.
以下、本発明をその実施例を示す図面に従って詳述する
。Hereinafter, the present invention will be described in detail with reference to the drawings showing embodiments thereof.
第1図は本発明に係る作業用車両の自動操向装置(以下
本発明装置という)を装備した乗用田植機の左側面図、
第2図はその平面図である。FIG. 1 is a left side view of a riding rice transplanter equipped with an automatic steering device for a work vehicle according to the present invention (hereinafter referred to as the device of the present invention);
FIG. 2 is a plan view thereof.
図において1は、前輪14及び後輪15に支持された走
行機体、6は走行機体1の後部に備えられた3点リンク
機構62に取付けられた植付部であり、3点リンク機構
62の昇降により植付部6全体が走行機体1に対して昇
降される。In the figure, 1 is a traveling body supported by front wheels 14 and rear wheels 15, and 6 is a planting part attached to a three-point link mechanism 62 provided at the rear of the traveling body 1. The entire planting section 6 is raised and lowered with respect to the traveling body 1 by raising and lowering.
走行機体1は、その前端寄りに搭載した動力部3(エン
ジン、変速装置等を含む)にて発生した動力が後輪15
に伝達されて自走し、ハンドル2の回転操舵により前輪
14が操向操作されて走行機体1の進行方向の制御(操
向制御m)が行われる。なお、動力部3にて発生した動
力は、植付部6に装備されている後述する苗植装置67
等にも伝達されている。In the traveling body 1, the power generated by the power unit 3 (including the engine, transmission, etc.) mounted near the front end is transmitted to the rear wheels 15.
The front wheels 14 are steered by the rotational steering of the handle 2, and the traveling direction of the traveling body 1 is controlled (steering control m). Note that the power generated in the power unit 3 is transmitted to a seedling planting device 67, which will be described later, and which is installed in the planting unit 6.
etc. has also been communicated.
前輪14の操向操作は、上述の如くハンドル2により手
動にて可能なことは勿論、後述する如くソレノイドSr
、SRを電気的に制御して油圧シリンダ27(第4図参
照)に圧油を給排することにより操作することも可能で
ある。The steering operation of the front wheels 14 can of course be done manually using the handle 2 as described above, or by using the solenoid Sr as described later.
, SR may be electrically controlled to supply and discharge pressure oil to the hydraulic cylinder 27 (see FIG. 4).
植付部6は、走行機体1の後部における3点リンク機構
62に取付けられている苗植装置67、この苗植装置6
7の上側に取付けられた苗載台60及び苗植装置67の
下側に、上下方向への揺動自在に取付けられた3組のフ
ロート61.61.61から構成されている。The planting section 6 includes a seedling planting device 67 attached to a three-point link mechanism 62 at the rear of the traveling body 1, and a seedling planting device 6.
It is composed of three sets of floats 61, 61, and 61 that are attached to the lower side of the seedling platform 60 and the seedling planting device 67 that are attached to the upper side of the seedling table 7 and the seedling planting device 67 so as to be swingable in the vertical direction.
苗載台60は、左右方向に6分割された苗載部69゜6
9・・・が設けられており、また各苗載部69.69・
・・に苗株が載置された場合に苗株が自動的に植付部6
の後端の苗植装置67に送られるように、側面視で、植
付msの後下端側から上前方にかけて円弧状に形成され
ている。そして、各苗載部69上の苗株は順次苗載部6
9上をその後下方に向けて滑動しつつ、その最下端に位
置する苗株が前述の苗植装置67により圃場に植付けら
れる。The seedling mounting table 60 has a seedling mounting section 69°6 divided into six parts in the left and right direction.
9... is provided, and each seedling tray 69.69.
When a seedling is placed in ..., the seedling is automatically placed in the planting section 6.
In a side view, it is formed in an arc shape from the rear lower end side to the upper front side of the planting ms so as to be sent to the seedling planting device 67 at the rear end. Then, the seedlings on each seedling tray 69 are sequentially placed on the seedling tray 69.
9 is then slid downward, and the seedlings located at the lowest end are planted in the field by the aforementioned seedling planting device 67.
さて、走行機体1の前頭下部には、進行方向左右両側(
第2図では左側のみを示しである)に、夫々苗列検出器
101 、1Orが棒状をなした取付アーム11を介し
て取付けられている。苗列検出器101゜10rはとも
にその検知域を走行機体1の前端部よりやや前方として
、しかも左右の検知環間を、走行機体1の後部に取付け
た植付部6の苗植装置67の苗の植付幅に応じて、変更
できるようになしである。Now, at the lower part of the front of the traveling aircraft 1, there are
In FIG. 2, only the left side is shown), seedling row detectors 101 and 1Or are respectively attached via rod-shaped attachment arms 11. The seedling row detectors 101 and 10r both have their detection areas slightly forward of the front end of the traveling body 1, and the distance between the left and right detection rings is that of the seedling planting device 67 of the planting section 6 attached to the rear of the traveling body 1. None can be changed depending on the planting width of the seedlings.
前記苗列検出器101 、1Orはアウタケースと発光
素子及び受光素子を内蔵した夫々2つの光センサ101
a、 10 l b、 10ra、 10rbとを含
んでなり、発光素子から発せられた光を被検物に投射し
、該被検物からの反射光を受光素子にて捉え、その受光
量に応じた電圧信号を出力するものであり、左側の苗列
検出器10fの2つの光センサ101 a、 10 l
b。The seedling row detector 101 and 1Or each have an outer case and two optical sensors 101 each having a built-in light emitting element and a light receiving element.
a, 10lb, 10ra, and 10rb, the light emitted from the light emitting element is projected onto the test object, the reflected light from the test object is captured by the light receiving element, and the The two optical sensors 101a and 10l of the left seedling row detector 10f output a voltage signal.
b.
は光センサ10ffiaを走行機体1側とし、夫々の光
照射域を所定幅重ねられるように適宜離隔し、アウタケ
ース内に取付けられている。そして走行機体1は前記所
定幅内で常に前行程で植付けられた苗株の列条の最外側
を前記所定幅領域で検出するように操向制御される。右
側の苗列検出器10rも同様となっている。The optical sensor 10ffia is placed on the side of the traveling aircraft 1, and is installed in the outer case at appropriate intervals so that the respective light irradiation areas are overlapped by a predetermined width. The steering of the traveling body 1 is controlled so that the outermost side of the row of seedlings planted in the previous step is always detected within the predetermined width region. The same applies to the seedling row detector 10r on the right side.
また前記3点リンク機構62には植付部6が非作業位置
にあることを検出する非作業検出器18(第4図参照)
が取付けられている。In addition, the three-point link mechanism 62 has a non-working detector 18 (see FIG. 4) that detects that the planting section 6 is in a non-working position.
is installed.
さらに走行機体1の後部に設けられた運転席4の右側及
び植付部6の苗載台60の上端部中央には田植機の進行
方向を検出するための方位検出器8゜8がその分解能の
2だけ方向をずらせて固着されている。第3図は方位検
出器8の構成を示すブロック図であり、この方位検出器
8としては、トロイダルコア80を外側から囲う態様に
て互いに直交する一対の検出巻線81.82を巻装して
なる地磁気センサを用い、トロイダルコア80を、発振
器により発振される所定の周波数にて交流励磁すると共
に、検出巻線81.82に基準電圧を印加した場合に、
前記検出巻線81.82に誘起される電圧は、地磁気の
方向が夫々に直交する場合に最大となることを利用し、
センサ技術第5巻4号(1985年4月号)に掲載され
ているような回路を構成したものである。検出巻線81
.82の出力電圧の周波数成分は、トロイダルコア80
の励磁電流の周波数の2倍であるから、夫々の出力電圧
は、前記発振器により発振される2倍周波数を基準とし
て同期検波され、各別の積分回路及びアンプを経て出力
として取出されるようにしである。このように取出され
た検出巻線81.82の出力電圧は、後述する操向制御
部30に与えられており、操向制御部30は、これらの
両出力の比の逆正接により、地磁気の方位を絶対的な基
準として、方位検出器8の設置方向の方位、換言すれば
田植機の進行方向を算出する。Furthermore, on the right side of the driver's seat 4 provided at the rear of the traveling body 1 and at the center of the upper end of the seedling stand 60 of the planting section 6, there is a direction detector 8°8 for detecting the direction of movement of the rice transplanter. They are fixed with the direction shifted by 2. FIG. 3 is a block diagram showing the configuration of the azimuth detector 8. The azimuth detector 8 includes a pair of mutually orthogonal detection windings 81 and 82 wound around the toroidal core 80 from the outside. When using a geomagnetic sensor made of
Utilizing the fact that the voltage induced in the detection windings 81 and 82 is maximum when the geomagnetic directions are perpendicular to each other,
This circuit is configured as described in Sensor Technology Vol. 5, No. 4 (April 1985 issue). Detection winding 81
.. The frequency component of the output voltage of 82 is the frequency component of the toroidal core 80.
Since the frequency of the excitation current is twice the frequency of the excitation current, each output voltage is synchronously detected using the double frequency oscillated by the oscillator as a reference, and is taken out as an output through separate integration circuits and amplifiers. It is. The output voltages of the detection windings 81 and 82 taken out in this way are given to the steering control section 30, which will be described later, and the steering control section 30 calculates the earth's magnetic field by the arctangent of the ratio of both outputs. Using the orientation as an absolute reference, the orientation of the installation direction of the orientation detector 8, in other words, the traveling direction of the rice transplanter is calculated.
第4図は、前輪14.14の舵取機構の平面図と共に示
す本発明装置の制御系のブロック図である。FIG. 4 is a block diagram of the control system of the device of the present invention, shown together with a plan view of the steering mechanism for the front wheels 14.14.
図において20は、その長手方向を左右方向として走行
機体1の下ブラケットに固着されたフロントアクスルで
あり、該フロントアクスル20の左右両端部には、左右
の前輪14.14を夫々軸支するナックルアーム22.
22が、各別のキングピン21.21回りに水平面内で
の回動自在に枢支しである。ナックルアーム22.22
は、夫々の前端部を、フロントアクスル20の上部に立
設した枢軸23回りに水平面内で回動する回動板24の
前部に各別のリンク部材25.25を介して連結されて
おり、操向用の油圧シリンダ27はそのピストンロッド
の先端部を、前記回動板24の中途部に左方に突設され
たアーム26の先端部に係止させて取付けられている。In the figure, reference numeral 20 denotes a front axle that is fixed to the lower bracket of the traveling body 1 with its longitudinal direction being the left-right direction. At both left and right ends of the front axle 20, there are knuckles that pivotally support the left and right front wheels 14 and 14, respectively. Arm 22.
22 is a pivot support for rotation in a horizontal plane about each separate king pin 21, 21. Knuckle arm 22.22
The front end portions of the two are connected via separate link members 25 and 25 to the front portion of a rotating plate 24 that rotates in a horizontal plane around a pivot shaft 23 that stands on the top of the front axle 20. The steering hydraulic cylinder 27 is attached so that the tip of its piston rod is locked to the tip of an arm 26 that projects leftward from the middle of the rotary plate 24.
従って、前記油圧シリンダ27が進出動作(又は退入動
作)した場合、これに応じて回動板24が第3図におけ
る時計回り(又は反時計回り)に回動し、この回動がリ
ンク部材25.25を介して左右のナックルアーム22
.22に伝達され、前輪14.14は、夫々のナックル
アーム22.22と共に右(又は左)に舵取される。Therefore, when the hydraulic cylinder 27 moves forward (or retreats), the rotating plate 24 rotates clockwise (or counterclockwise) in FIG. 25. Left and right knuckle arms 22 through 25
.. 22, the front wheels 14.14 are steered to the right (or left) with their respective knuckle arms 22.22.
また前記キングピン21の位置には、ポテンシオメータ
を用いた操向角検出器17が設けてあり、該操向角検出
器17は、キングピン21の回動量、即ち前輪14.1
4の操向角に応じて直進に対して右に操向されていると
きには正の電圧を、左に操向されているときは負の電圧
を出力する。Further, a steering angle detector 17 using a potentiometer is provided at the position of the king pin 21, and the steering angle detector 17 detects the rotation amount of the king pin 21, that is, the front wheel 14.1.
According to the steering angle of No. 4, a positive voltage is output when the vehicle is being steered to the right when traveling straight, and a negative voltage is output when the vehicle is being steered to the left.
さらに左右の前記ナックルアーム22.22の位置には
、リードスイッチを用いた走行距離検出器16!。Further, at the positions of the left and right knuckle arms 22, 22, mileage detectors 16 using reed switches! .
16rが設けてあり、前輪14.14に取付けた磁性体
を感知することにより、前輪14.14の回転数を検出
し、検出された左右の回転数を平均し、その平均回転数
から走行距離を算出する。16r is installed, and by sensing the magnetic material attached to the front wheel 14.14, the rotation speed of the front wheel 14.14 is detected, the detected left and right rotation speeds are averaged, and the mileage is calculated from the average rotation speed. Calculate.
油圧シリンダ27へは、油圧ポンプ29が発生する圧油
が、4ポ一ト3位置切換式の電磁方向切換弁Vを介して
供給されており、電磁方向切換弁■のソレノイドSlが
励磁されている場合、油圧ポンプ27からの圧油は、油
圧シリンダ27の退入側油室に送給され、前述の如き舵
取機構の動作によって前輪14.14は左に操向され、
逆に電磁方向切換弁VのソレノイドSrが励磁されてい
る場合、前輪14゜14は右に操向される。更に、ソレ
ノイドS!及びソレノイドSrが共に消磁されており、
電磁方向切換弁■がその中立位置にある場合、前輪14
.14は現状の舵取角度に保たれる。Pressure oil generated by a hydraulic pump 29 is supplied to the hydraulic cylinder 27 via a 4-point/3-position electromagnetic directional switching valve V, and the solenoid Sl of the electromagnetic directional switching valve ■ is energized. If so, the pressure oil from the hydraulic pump 27 is fed to the oil chamber on the retracting side of the hydraulic cylinder 27, and the front wheels 14, 14 are steered to the left by the operation of the steering mechanism as described above.
Conversely, when the solenoid Sr of the electromagnetic directional control valve V is energized, the front wheels 14°14 are steered to the right. Furthermore, solenoid S! and solenoid Sr are both demagnetized,
When the solenoid directional control valve ■ is in its neutral position, the front wheel 14
.. 14 is maintained at the current steering angle.
一方、30は前記方位検出器8.前記苗列検出器101
、1Or及び走行距離検出器161 、16rの検出結
果に基づいて後述の如く動作し、電磁方向切換弁■のソ
レノイドS!又はソレノイドSrの励磁を行うことによ
り走行機体1を操向せしめる操向制御部である。On the other hand, 30 is the direction detector 8. The seedling row detector 101
, 1Or and the travel distance detectors 161 and 16r as described below, and the solenoid S! of the electromagnetic directional control valve ■ is activated. Alternatively, it is a steering control section that steers the traveling aircraft 1 by energizing the solenoid Sr.
該操向制御部30は、エンジンを始動せしめるだめのキ
ースイッチ31を介して電源に接続されており、エンジ
ンが駆動状態にある場合にのみ動作可能となっている。The steering control section 30 is connected to a power source via a key switch 31 for starting the engine, and is operable only when the engine is in a driving state.
操向制御部30の入カポ−)a+ には、運転席4に着
座した運転者が操向制御部30にその動作開始を指令す
る場合にオン操作する自動スイッチ32が接続されてお
り、該スイッチ32のオンに応じて入力ポートatがハ
イレベルに転じるようになっている。An automatic switch 32 that is turned on when the driver seated in the driver's seat 4 instructs the steering control section 30 to start its operation is connected to the input port a+ of the steering control section 30. When the switch 32 is turned on, the input port at changes to a high level.
また操向制御部30の入カポ−1”ax及び入カポ−ト
a 3には、運転席4に着座した運転者により操作可能
な位置に配された走行状態選択レバ9の基端部に、該レ
バ9の係止位置に応じてオンするように配設されたマイ
クロスイッチを用いてなる教示走行スイッチ33及び自
動操向スイッチ34が夫々接続されており、前記自動ス
イッチ32及び教示走行スイッチ33が共にオンされて
いる場合に入カポ−)aXがハイレベルに転じ、また自
動スイッチ32及び自動操向スイッチ34がオンされて
いる場合に入力ポートa3がハイレベルに転じるように
なっている。前記走行状態選択レバ9は、前記教示走行
スイッチ33がオンされる係止位置、前記自動操向スイ
ッチ34がオンされる係止位置、及び両スイッチが共に
オフ状態となる係止位置の3通りの係止位置を有してお
り、運転席4に着座した運転者は、該レバ9を回動操作
し、その係止位置を変更せしめることにより、操向制御
部30の後述する2通りの動作内容の選択が可能である
。In addition, the input ports 1"ax and 3 of the steering control unit 30 are connected to the base end of the driving state selection lever 9, which is arranged at a position that can be operated by the driver seated in the driver's seat 4. , a teaching running switch 33 and an automatic steering switch 34 are connected to each other, each using a microswitch arranged to be turned on according to the locking position of the lever 9. 33 are both turned on, input port aX turns to high level, and when automatic switch 32 and automatic steering switch 34 are turned on, input port a3 turns to high level. The driving state selection lever 9 has three locking positions: a locking position where the teaching driving switch 33 is turned on, a locking position where the automatic steering switch 34 is turned on, and a locking position where both switches are turned off. The driver seated in the driver's seat 4 rotates the lever 9 to change the locking position, thereby controlling the steering control unit 30 in two ways as described below. It is possible to select the operation contents.
操向制御部30の入カポ−) a4+as+a&+a’
lには、苗列検出器10f、 10rの夫々の光センサ
10fa。Input capo of steering control unit 30) a4+as+a&+a'
1 includes optical sensors 10fa for seedling row detectors 10f and 10r.
104!b、 10ra、 10rbの出力が夫々与え
られている。104! b, 10ra, and 10rb outputs are given, respectively.
また入力ポートallには前記操向角検出器17が与え
られ、この出力と前記苗列検出器101 、1Orの検
出結果により算出された操向角目標値により走行機体1
は苗列に倣って操向制御される。Further, the steering angle detector 17 is provided to the input port all, and the steering angle target value calculated from this output and the detection results of the seedling row detector 101 and 1Or is used to control the traveling aircraft.
The steering is controlled to follow the row of seedlings.
入カポ−)aqには非作業検出器18の出力が与えられ
ており、該出力により教示の可否を決定している。The output of the non-work detector 18 is given to the input capo (aq), and whether teaching is possible or not is determined based on the output.
入カポ−)at。tallには方位検出器8,8の夫々
2つの検出巻線81.81.82.82からの出力電圧
の平均出力電圧が与えられており、操向制御部30は予
め記憶させである演算式に基づいて、これらの出力電圧
間の比の逆正接から田植機の進行方向を算出する。At. Tall is given the average output voltage of the output voltages from the two detection windings 81.81.82.82 of the direction detectors 8, 8, respectively, and the steering control unit 30 uses an arithmetic expression stored in advance. Based on this, the traveling direction of the rice transplanter is calculated from the arctangent of the ratio between these output voltages.
さらに入カポ−) all!には前記走行距離検出器1
51 、16rからのパルス信号が入力され前記操向制
御部30にて一定時間内の左右夫々の回転数を検出し、
その平均回転数Paを求め、それにより走行距離が算出
される。In addition, all! The mileage detector 1 is
Pulse signals from 51 and 16r are input, and the steering control unit 30 detects the left and right rotational speeds within a certain period of time,
The average rotation speed Pa is determined, and the travel distance is calculated based on the average rotation speed Pa.
また入力ポート”13+a14には回向スイッチ35及
び回向終了スイッチ36の出力が与えられている。Further, the outputs of the redirection switch 35 and the redirection end switch 36 are provided to the input port "13+a14."
そして操向制御部30の出力ポートb、及び同b2は、
図示しない各別の励磁回路を介して、前記電磁方向切換
弁■のソレノイドSr及びソレノイドSlに夫々接続さ
れており、出力ポートb1 (又は出力ポートb2)の
ハイレベル出力に応じてソレノイドSr (又はソレノ
イドSl)が励磁され、油圧シリンダ27が進出(又は
退入)動作するようになしてあり、舵取機構の前述の動
作により前輪14゜14が右方向(又は左方向)に舵取
りされる。The output ports b and b2 of the steering control unit 30 are
It is connected to the solenoid Sr and solenoid Sl of the electromagnetic directional control valve (2) through separate excitation circuits (not shown), respectively, and the solenoid Sr (or The solenoid SL) is energized, the hydraulic cylinder 27 is moved forward (or retracted), and the front wheels 14.degree. 14 are steered rightward (or leftward) by the aforementioned operation of the steering mechanism.
さて以上の如く構成された本発明装置の動作について説
明する。第5図は田植機の走行経路を説明する圃場の模
式的平面図であり、1点鎖線は手動操向による教示走行
、破線は教示に基づく自動操向、2点鎖線は倣いによる
自動操向を夫々示している。教示走行は植付部6が上昇
側に設けられた非作業位置にあることを非作業検出器1
8により検出し、それを確認した後、運転者がハンドル
2を手動操作することにより、第5図左下の基点より圃
場の一端側から外周に沿って基点から植付は場d、第5
図横方向に離隔した第1行程開始位置に、走行機体1を
走行せしめ、この教示走行時の走行機体1の進行方向及
び走行距離を各回向毎に一定間隔にて記憶する。この記
憶に基づき後述する演算がなされ、走行経路が設定され
る。Now, the operation of the apparatus of the present invention constructed as above will be explained. Figure 5 is a schematic plan view of a field explaining the travel route of the rice transplanter, where the dashed line indicates taught travel by manual steering, the dashed line shows automatic steering based on teaching, and the dashed two dotted line shows automatic steering by tracing. are shown respectively. During the teaching run, the non-working detector 1 detects that the planting section 6 is in the non-working position provided on the rising side.
8, and after confirming it, the driver manually operates the handle 2 to plant from the base point at the bottom left of Fig. 5 along the outer periphery from one end of the field.
The traveling body 1 is caused to travel to a first stroke start position spaced apart in the lateral direction of the figure, and the traveling direction and travel distance of the traveling body 1 during this teaching traveling are stored at regular intervals for each turn. Based on this memory, calculations to be described later are performed and a travel route is set.
次に第1行程の田植え作業が前記教示に基づき設定され
た走行経路に沿って第5図圃場上辺の回向地点まで行な
われ、回向後、第1行程で植付けられた苗株の列条の最
外側に倣って自動操向が圃場の他端側まで行なわれる。Next, the first stage of rice planting work is carried out along the travel route set based on the above teachings to the turning point at the top of the field in Figure 5.After turning, the rows of seedlings planted in the first stage are Automatic steering follows the outermost field to the other end of the field.
倣いによる自動操向が終了すると、圃場の外周を教示さ
れた走行経路に沿って基点まで田植え作業を行いながら
、自動操向が行なわれる。When the automatic steering by copying is completed, the automatic steering is performed while planting rice along the taught traveling route around the outer circumference of the field to the base point.
第6図は操向制御の開始時のフローチャートであるが、
運転者はこの自動操向を行なわせる場合、まず自動スイ
ッチ32をオン操作して操向制御部30に動作開始を指
令し、次に前記走行状態選択レバ9を回動操作して、こ
れを前記教示走行を選択する係止位置に係止せしめ、前
記教示走行スイッチ33をオンさせた状態で前記教示走
行を行う。この教示走行終了後、運転者は走行状態選択
レバ9を回動操作し、これを自動操向スイッチ34をオ
ンさせる係止位置に係止せしめることにより、前記操向
制御部30の動作による自動操向を開始させる。FIG. 6 is a flowchart at the start of steering control,
When the driver performs this automatic steering, the driver first turns on the automatic switch 32 to instruct the steering control section 30 to start operation, and then rotates the driving state selection lever 9 to turn it on. The vehicle is locked at the locking position for selecting the taught travel, and the taught travel is performed with the taught travel switch 33 turned on. After the teaching driving is completed, the driver rotates the driving state selection lever 9 and locks it in the locking position where the automatic steering switch 34 is turned on. Start steering.
操向制御部30は、キースイッチ31がオンされ電源に
接続された場合、第6図のフローチャートに示すように
、まずその大男ボートa+ のレベルにより前記自動ス
イッチ32のオンオフ状態を調べる。When the key switch 31 is turned on and connected to the power supply, the steering control section 30 first checks the on/off state of the automatic switch 32 based on the level of the big boat a+, as shown in the flow chart of FIG.
そして自動スイッチ32がオフされており、入カポ)a
+がローレベルである場合、操向制御部30は、そのメ
モリ、レジスタ及び全てのフラグ等をリセットし、自動
スイッチ32がオンされるまで終了し、また自動スイッ
チ32がオンされており、入力ポートa+がハイレベル
である場合、次に入カポ−)at及び入力ポートa3の
レベルにより前記教示走行スイッチ33及び自動操向ス
イッチ34のオンオフ状態を調べ、教示走行スイッチ3
3がオンされており、入力ポートazがハイレベルであ
るときには、後述の教示走行サブルーチンに従って、ま
た自動操向スイッチ34がオンされており、入力ポート
aiがハイレベルであるときには、後述の自動操向サブ
ルーチンに従って夫々動作し、更に教示走行スイッチ3
3及び自動操向スイッチ34が共にオフ状態にある場合
に番よ、これらのいずれかガオンされるまで待機する。Then, the automatic switch 32 is turned off, and the input capo)a
+ is at a low level, the steering control unit 30 resets its memory, registers, all flags, etc. until the automatic switch 32 is turned on, and the automatic switch 32 is turned on and the input When the port a+ is at a high level, the on/off states of the teaching travel switch 33 and the automatic steering switch 34 are checked based on the level of the input port (a)at and the input port a3, and the teaching travel switch 3 is checked.
3 is turned on and the input port az is at a high level, the automatic steering switch 34 is turned on and the input port ai is at a high level, the automatic steering is performed according to the taught driving subroutine described later. The teaching run switch 3 operates according to the direction subroutine.
3 and the automatic steering switch 34 are both in the OFF state, the system waits until either of them is turned on.
前述した如く、自動操向スイッチ34と教示走行スイッ
チ33とは、−本の走行状態選択レバ9の異なる係止位
置において夫々オンされるように配設されているから、
これらが共にオンされることはなく、運転者は、前記自
動スイッチ32のオンオフ操作及び走行状態選択レバ9
の回動操作により、操向制御部30に、待機状態、教示
走行サブルーチン及び自動操向サブルーチンに夫々従う
動作を指令することができる。As mentioned above, the automatic steering switch 34 and the taught running switch 33 are arranged so as to be turned on at different locking positions of the - running state selection lever 9, respectively.
Both of these are not turned on, and the driver is required to turn on/off the automatic switch 32 and drive state selection lever 9.
By the rotational operation of , it is possible to instruct the steering control section 30 to operate in accordance with the standby state, the taught driving subroutine, and the automatic steering subroutine, respectively.
前述の教示走行は、第5図に左下の基点位置から走行を
開始し、圃場の外周に沿って走行機体1を走行させ、前
記第1行程開始位置に戻って終了する。この走行の形態
は、第5図に示すような平面視で四辺形をなすものに限
らず、直進走行と角部での回向を組合せて、圃場外周を
囲む多角形状をなしておればよく、更に、直進走行時に
おいても厳密に直進状態を保つ必要はない。The above-mentioned teaching run starts from the lower left base position in FIG. 5, causes the traveling body 1 to run along the outer periphery of the field, and ends when it returns to the first stroke start position. The form of this running is not limited to a quadrilateral shape in plan view as shown in Fig. 5, but may be a polygonal shape that surrounds the outer periphery of the field by combining straight running and turning around corners. Furthermore, even when traveling straight, it is not necessary to maintain a strictly straight traveling state.
第7図は、このような教示走行中の操向制御部30の動
作内容を示す教示走行サブルーチンのフローチャートで
ある。前述の条件が満足され、教示走行サブルーチンに
移行した場合、操向制御部30はサンプル数を計数する
カウンタiをカウントアツプし、走行距離検出器161
、16rにより開始位置よりの走行距離を検出し、所
定路i!1ILa毎に方位検出器8,8の夫々2つの検
出コイル81.82の出力電圧の平均電圧から、前述し
た如く、機体1の進行方向Diを算出する。さらに操向
角検出器17からの操向角Siも算出する。これらのデ
ータを回向する。第8及び第9図は方位を検出する方位
検出サブルーチンと操向角を検出する操向角検出サブル
ーチンを示し、前記教示すブルーチンにて方位及び操向
角を検出するときの検出方法を示している。進行方向及
び操向角は細かな変動があるので、所定回数Naの平均
を求めて方位及び操向角データとしている。FIG. 7 is a flowchart of a teaching driving subroutine showing the operation contents of the steering control section 30 during such teaching driving. When the above-mentioned conditions are satisfied and the transition is made to the teaching driving subroutine, the steering control unit 30 counts up the counter i that counts the number of samples, and the running distance detector 161
, 16r detects the traveling distance from the starting position, and the predetermined route i! As described above, the traveling direction Di of the aircraft 1 is calculated from the average voltage of the output voltages of the two detection coils 81 and 82 of the direction detectors 8 and 8 for every 1 ILa. Furthermore, the steering angle Si from the steering angle detector 17 is also calculated. Transfer these data. 8 and 9 show a direction detection subroutine for detecting a direction and a steering angle detection subroutine for detecting a steering angle, and show a detection method when detecting a direction and a steering angle in the blue routine taught above. There is. Since there are small fluctuations in the traveling direction and the steering angle, the average of a predetermined number of times Na is calculated and used as the azimuth and steering angle data.
運転者は回向位置まで走行機体1を手動操向すると回向
スイッチ35をオンする。回向スイッチ35がオンされ
ると、操向角Siと進行方向Diとの関係を求め、それ
を各回向毎に記憶し、自動回向時等、進行方向が変化す
るときの操向角データとして使用する。When the driver manually steers the traveling aircraft 1 to the turning position, he turns on the turning switch 35. When the turning switch 35 is turned on, the relationship between the steering angle Si and the traveling direction Di is determined and stored for each turning, and the steering angle data is used when the traveling direction changes, such as during automatic turning. Use as.
第10図は回向サブルーチンの制御内容を示したフロー
チャートであり、最初に回向数Nを記憶された回向数N
1に1を加えて算出する。なお第1回向時はN、は零な
のでNは1となる。次に回向までの平均方向り、の算出
及び回向前距離LINの検出が行なわれる。そして前回
の回向後距離Lz、4−1を回向前距離LINから除し
、走行距離り、を得る。FIG. 10 is a flowchart showing the control contents of the turning subroutine, in which the turning number N is first stored.
Calculate by adding 1 to 1. Note that during the first turn, N is zero, so N becomes one. Next, the average direction up to turning is calculated and the distance before turning LIN is detected. Then, the previous distance after turning Lz, 4-1 is divided from the distance before turning LIN to obtain the running distance.
次に回向数Nが2以上かを判定し、回向数Nが1のとき
はすぐに運転者は回向を始め、2以上のときは今回の平
均方向DHと前回の平均方向DH−1とにより前回回向
N−1の中心角θ8−3を求め、この中心角θN−1と
前回回向距離PH−1とにより前回回向N−1の曲率半
径RN−1を求める。この曲率半径RN−1と中心角θ
N−1とにより前回回向の変曲点(多角形の頂点)座標
(X N−113F N−υを地磁気の北をy軸止方向
とし、東を%軸圧方向とするxy座標系として求め、そ
の後回向を始める。Next, it is determined whether the number of turns N is 2 or more. If the number of turns N is 1, the driver starts turning immediately, and if it is 2 or more, the current average direction DH and the previous average direction DH - 1, the central angle θ8-3 of the previous turning N-1 is determined, and the radius of curvature RN-1 of the previous turning N-1 is determined from this central angle θN-1 and the previous turning distance PH-1. This radius of curvature RN-1 and central angle θ
By N-1, the inflection point (vertex of the polygon) coordinates of the previous rotation (X seek, and then begin turning.
回向が終了すると運転者は回向終了スイッチ36をオン
し、操向制御部30に回向終了を教示する。回向終了後
、操向制御部30は回向後距離L2Nを検出し、該回向
後距離L!、から回向前距離LINを除し回向距離PM
を得る。そして回向数NをN、に置きかえ記憶し、また
平均方向DH1回向距離PM、回向前距離LIN、回向
後距離し2N%変曲点(x、。When the turning is completed, the driver turns on the turning end switch 36 to instruct the steering control section 30 to end the turning. After the turning is completed, the steering control unit 30 detects the turning distance L2N, and detects the turning distance L! , by dividing the pre-turning distance LIN to obtain the turning distance PM.
get. Then, the number of turns N is replaced with N, and stored, and the average direction DH1 turning distance PM, the distance before turning LIN, the distance after turning, and the 2N% inflection point (x,).
yN)を夫々記憶する。この動作を第1行程開始位置に
到着し教示走行が終了するまで繰返す。yN) respectively. This operation is repeated until the first stroke start position is reached and the teaching run is completed.
教示走行の終了は、運転者による前記走行状態選択レバ
9の回動操作により、教示走行スイッチ33がオフされ
た時点において教示走行が終了することになる。The teaching driving ends when the teaching driving switch 33 is turned off by the driver's rotation operation of the driving state selection lever 9.
さてこのようにして教示走行を行った後、運転者は、植
付部6を圃場面に下降させ、該植付部6に動力を伝達し
、田植え作業の準備を行う。次に前記走行状態選択レバ
9を回動操作し、自動走行スイッチ34をオンせしめて
操向制御部30に自動操向動作を指令する。After performing the teaching run in this manner, the driver lowers the planting section 6 to the field, transmits power to the planting section 6, and prepares for rice planting work. Next, the driving state selection lever 9 is rotated to turn on the automatic driving switch 34 to instruct the steering control section 30 to perform an automatic steering operation.
第11図は自動操向サブルーチンの動作内容を示し、第
12図は走行経路設定サブルーチンのを示すフローチャ
ートである。自動操向スイッチ34のオンに応して、操
向制御部30は第6図に示すフローチャートに従って動
作を指定する。FIG. 11 shows the operation contents of the automatic steering subroutine, and FIG. 12 is a flowchart showing the driving route setting subroutine. In response to turning on the automatic steering switch 34, the steering control section 30 specifies the operation according to the flowchart shown in FIG.
まず、走行経路設定サブルーチンにて、前記教示走行サ
ブルーチンにて算出された各回向位置の変曲点の座標(
XN、)FN)を前記走行開始位置を原点とし、第1回
向方向り、をy軸の正方向として座標を回転させる。こ
れにより第1変曲点の座標は(0,y+’)となる。ま
た第N変曲点の座標は(X ’Ml )” H)とな
る。次にX方向の最大値を求め、その最大値X ’Mi
lKを植付幅dで除し、その商mを求める。商mが最大
行程数となり、その商mの数だけy軸に平行に各行程の
走行経路をその初期値(x+1.yo)を走行開始位置
(Xo。First, in the driving route setting subroutine, the coordinates (
The coordinates are rotated with XN, )FN) set at the travel start position as the origin, and the first rotation direction set as the positive direction of the y-axis. As a result, the coordinates of the first inflection point become (0, y+'). Also, the coordinates of the Nth inflection point are (X'Ml)''H). Next, find the maximum value in the X direction, and calculate the maximum value X'Mi
Divide lK by planting width d to find the quotient m. The quotient m is the maximum number of strokes, and the travel route of each stroke is moved parallel to the y-axis by the number of quotient m from its initial value (x+1.yo) to the travel start position (Xo).
yo)より植付は幅dの1.5倍X軸正方向に移動し、
X軸止方向に植付は幅dだけ離隔させ夫々設定し、その
走行経路の外周との夫々の交点(X、。yo), the planting will move in the positive direction of the X-axis by 1.5 times the width d,
The plantings are set apart by a width d in the X-axis stopping direction, and each intersection with the outer circumference of the traveling route (X,.
Y、、Y、)を求める(第5図参照)。そして交点のy
座標より各行程の距離j27を求め、さらに該距離7!
7から回向必要距離αを減じて回向距離l Inを求め
る。これにより求められた走行経路と教示走行時外周走
路とにより走行経路が設定される。Y,,Y,) (see Figure 5). and the intersection y
The distance j27 of each stroke is determined from the coordinates, and the distance 7!
The required turning distance α is subtracted from 7 to find the turning distance l In. A travel route is set based on the travel route thus determined and the outer circumferential travel route during taught travel.
走行経路が設定されると行程mの計数が行なわれ、第1
行程のとき即ちm=1のときは前記走行経路の第1行程
のデータに基づく自動操向により田植え作業か行なわれ
、回向距離Nl+になると自動的に回向する。第2行程
以降は苗列検出器11!。Once the travel route is set, the distance m is counted, and the first
During a stroke, that is, when m=1, the rice planting work is performed by automatic steering based on the data of the first stroke of the travel route, and when the turning distance Nl+ is reached, the rice-planting operation is automatically turned. After the second step, the seedling row detector 11! .
10rによる第1行程で植付けられた苗株の列条の最外
側に倣う自動操向にりよ田植え作業が行なわれる。The rice planting work is carried out automatically following the outermost rows of seedlings planted in the first step of 10R.
この倣いによる自動操向は、苗列検出器101 、10
r内に設けられた夫々2個の光センサ10fa、10j
!b。This automatic steering by tracing is performed by the seedling row detectors 101 and 10.
Two optical sensors 10fa and 10j provided in r
! b.
10ra、 10rbの圃面での照射域を各1個の照射
域の半分だけ重ねておき、倣いカイトなるべき苗株の列
条の最外側が常に重ねられた照射域にて検出されるよう
に操向するものであり、苗株の列条が走行機体1の左側
にある場合に、前記苗株の列条の最外側が光センサ10
j!a(又は10 l b)側で検出されたときは、操
向制御部30の出力ボートbl (又はbz)が出力
され走行機体1は右進(又は左進)することになる。The irradiation areas of 10ra and 10rb on the field are overlapped by half of each irradiation area, so that the outermost side of the row of seedlings that will become copy kites is always detected in the overlapped irradiation area. When the row of seedlings is on the left side of the traveling body 1, the outermost row of the seedlings is the optical sensor 10.
j! When detected on the a (or 10 l b) side, the output boat bl (or bz) of the steering control unit 30 is output, and the traveling aircraft 1 moves to the right (or to the left).
またこのとき前記苗株の列条の最外側が欠株等の理由に
より検出不能となり、前記自動操向ができなくなると、
現在の方位及び操向角が夫々の検出器より入力され、そ
の検出方位りと教示された第M工程の方向DMとが比較
され、それが略一致し操向角Stが零に近くなるように
自動操向される。Also, at this time, if the outermost part of the row of seedlings becomes undetectable due to reasons such as missing plants, and the automatic steering becomes impossible,
The current azimuth and steering angle are input from each detector, and the detected azimuth is compared with the taught direction DM of the M-th step, so that they substantially match and the steering angle St becomes close to zero. is automatically steered.
この教示走路に基づく自動操向は前記苗株の列条の最外
側が検出可能となるまで続けられる。The automatic steering based on this teaching route is continued until the outermost part of the row of seedlings can be detected.
なお本実施例においては、方向検出器8.8を走行機体
1に対して振れ角が小さく、動きの少ない植付部6と制
御に対する応答性の早い機体1とに固着し、これを方位
の最小骨分解能の%だけ方向をずらして設置し、その出
力電圧の平均を求め、方位テークとしているが、記憶の
ときは動きの少ない植付部6に設けた方位検出器8を使
用し、自動操向制御の検出に使用するときは、応答性の
良い走行機体1に設けた方向検出器8を使用してもよい
。In this embodiment, the direction detector 8.8 is fixed to the planting part 6, which has a small deflection angle with respect to the traveling body 1 and has little movement, and to the body 1, which has a quick response to control, and is used to determine the direction. The direction is shifted by % of the minimum bone resolution, and the average output voltage is calculated to take the direction. However, when memorizing, the direction is taken using the direction detector 8 installed in the planting area 6, which has little movement. When used for detecting steering control, the direction detector 8 provided in the traveling aircraft 1 with good responsiveness may be used.
また本実施例においては、距離検出器161 、16r
として前輪2,2ナツクルアームに設けたリードスイッ
チを使用したが、本発明はこれに限るものではなく、近
接スイッチその他の非接触スイッチでもよ(、また光セ
ンサ、マイクロ波センサ等の波動検出型センサを用い、
そのドツプラ効果により速度を求めそれにより距離を求
めてもよい。Further, in this embodiment, the distance detectors 161 and 16r
Although a reed switch installed on the front wheels 2 and 2 knuckle arms was used as a reed switch, the present invention is not limited to this, and a proximity switch or other non-contact switch may also be used. using
The speed may be determined by the Doppler effect and the distance may be determined from the speed.
以上詳述した如く本発明装置においては、教示走行を植
付部の上昇状態を検出して行っているので、教示作業中
に横ずれ等の発生がなく、また回向時に既植苗を損傷を
与えることもない。As detailed above, in the device of the present invention, teaching travel is performed by detecting the rising state of the planting part, so there is no occurrence of lateral slipping during teaching work, and there is no risk of damaging already planted seedlings when turning. Not at all.
また既植苗に倣って行なわれる自動操向中に、該既植苗
を検出不能となっても、教示記憶に基づき設定された走
行経路に沿って自動操向されるので、自動操向が中断さ
れることなく行える等価れた効果を奏する。Furthermore, even if the planted seedlings cannot be detected during automatic steering that follows the pattern of the already planted seedlings, the automatic steering will continue along the travel route set based on the teaching memory, so the automatic steering will not be interrupted. It produces the same effect without having to do it.
図面は本発明の一実施例を示すものであり、第1図は本
発明装置を装備した乗用田植機の左側面図、第2図はそ
の平面図、第3図は方位検出器の構成を示すブロック図
、第4図は本発明装置の構成を示すブロック図、第5図
は走行経路を説明する圃場の模式的平面図、第6〜12
図は本発明装置の動作内容を示すフローチャートである
。
■・・・走行機体 6・・・植付部 8,8・・・方位
検出器 9・・・走行状態検出レバー 101 、10
r・・・苗列検出器 161. 、16r・・・走行距
離検出器 17・・・操向角検出器 18・・・非作業
検出器
30・・・操向制御部
第6図
第 11 図
簗12図The drawings show one embodiment of the present invention; Fig. 1 is a left side view of a riding rice transplanter equipped with the device of the present invention, Fig. 2 is a plan view thereof, and Fig. 3 shows the configuration of the direction detector. FIG. 4 is a block diagram showing the configuration of the device of the present invention, FIG. 5 is a schematic plan view of a field explaining the traveling route, and Nos.
The figure is a flowchart showing the operation details of the apparatus of the present invention. ■... Traveling body 6... Planting section 8, 8... Direction detector 9... Traveling state detection lever 101, 10
r... Seedling row detector 161. , 16r... Travel distance detector 17... Steering angle detector 18... Non-working detector 30... Steering control section Fig. 6 Fig. 11 Fig. 12
Claims (1)
チングプレイバック制御により自動操向しつつ移植作業
をする移植機の自動操向装置において、 方位検出器と、 走行距離を検出する走行距離検出器と、 植付部が非作業位置にあることを検出する 非作業検出器と、 前記方位検出器により検出された前記移植 機の進行方向の方位と、前記走行距離検出器による前記
進行方向への走行距離とから前記圃場内における走行位
置を特定し、前記非作業検出器が前記非作業位置を検出
したとき、前記走行位置を記憶する手段と を具備することを特徴とする移植機の自動 操向装置。[Claims] 1. An automatic steering device for a transplanter in which a planting part is attached to a traveling machine body and performs transplanting work while automatically steering within a field by teaching playback control, comprising: an azimuth detector; a travel distance detector that detects travel distance; a non-work detector that detects that the planting section is in a non-work position; an azimuth in the traveling direction of the transplanter detected by the orientation detector; and means for specifying a running position in the field from a distance traveled in the traveling direction by a distance detector, and storing the running position when the non-working detector detects the non-working position. An automatic steering device for a transplant machine featuring:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP62330689A JP2616788B2 (en) | 1987-12-25 | 1987-12-25 | Automatic steering device for transplanter |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP62330689A JP2616788B2 (en) | 1987-12-25 | 1987-12-25 | Automatic steering device for transplanter |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH01171402A true JPH01171402A (en) | 1989-07-06 |
JP2616788B2 JP2616788B2 (en) | 1997-06-04 |
Family
ID=18235472
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP62330689A Expired - Fee Related JP2616788B2 (en) | 1987-12-25 | 1987-12-25 | Automatic steering device for transplanter |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2616788B2 (en) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005199770A (en) * | 2004-01-13 | 2005-07-28 | Iseki & Co Ltd | Turning control device for agricultural working vehicle |
JP2009286398A (en) * | 2009-09-09 | 2009-12-10 | Iseki & Co Ltd | Farm working vehicle |
JP2020099242A (en) * | 2018-12-21 | 2020-07-02 | 株式会社クボタ | Seeding type implement and automatic travel control system thereof |
JP2020178631A (en) * | 2019-04-25 | 2020-11-05 | 株式会社クボタ | Turning control system and work machine |
-
1987
- 1987-12-25 JP JP62330689A patent/JP2616788B2/en not_active Expired - Fee Related
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005199770A (en) * | 2004-01-13 | 2005-07-28 | Iseki & Co Ltd | Turning control device for agricultural working vehicle |
JP2009286398A (en) * | 2009-09-09 | 2009-12-10 | Iseki & Co Ltd | Farm working vehicle |
JP2020099242A (en) * | 2018-12-21 | 2020-07-02 | 株式会社クボタ | Seeding type implement and automatic travel control system thereof |
JP2020178631A (en) * | 2019-04-25 | 2020-11-05 | 株式会社クボタ | Turning control system and work machine |
Also Published As
Publication number | Publication date |
---|---|
JP2616788B2 (en) | 1997-06-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6394280B2 (en) | Work vehicle | |
JP7068528B2 (en) | Area registration system | |
KR20190066528A (en) | Travel working machine | |
JP2019103467A (en) | Field work machine | |
JPH01171402A (en) | Automatic steering device of transplanter | |
JP6891103B2 (en) | Planting work machine | |
JPH0851808A (en) | Agricultural working machine | |
WO2022059734A1 (en) | Traveling line creation system for agricultural machine | |
JP7137270B2 (en) | Autonomous driving system | |
JPH08317712A (en) | Travel control system in working vehicle | |
WO2020145040A1 (en) | Field work system | |
JP2632332B2 (en) | Automatic steering system for work vehicles | |
JPS5911410A (en) | Unmanned traveling truck | |
JP2599943B2 (en) | Automatic steering system for work vehicles | |
JPH06250737A (en) | Automatic running structure of working vehicle | |
JP2020000125A (en) | Work vehicle | |
JP2599944B2 (en) | Automatic steering system for work vehicles | |
JP7034860B2 (en) | Area registration system | |
JP2651579B2 (en) | Automatic steering device for agricultural work vehicles | |
JP2854482B2 (en) | Automatic steering structure of work vehicle | |
JP2525950Y2 (en) | Work vehicle | |
JPH0711527Y2 (en) | Automatic steering device for work vehicles | |
JP2505356Y2 (en) | Steering control device for work vehicle | |
JPS63296614A (en) | Controlling apparatus for steering of transplantation machine | |
JPH07236320A (en) | Working machine for paddy field |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
LAPS | Cancellation because of no payment of annual fees |