JP2023181796A - work vehicle - Google Patents

work vehicle Download PDF

Info

Publication number
JP2023181796A
JP2023181796A JP2022095140A JP2022095140A JP2023181796A JP 2023181796 A JP2023181796 A JP 2023181796A JP 2022095140 A JP2022095140 A JP 2022095140A JP 2022095140 A JP2022095140 A JP 2022095140A JP 2023181796 A JP2023181796 A JP 2023181796A
Authority
JP
Japan
Prior art keywords
turning
travel
automatic
aircraft
work
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
JP2022095140A
Other languages
Japanese (ja)
Inventor
真也 寺田
Shinya Terada
祐樹 久保田
Yuki Kubota
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 JP2022095140A priority Critical patent/JP2023181796A/en
Priority to CN202211533422.6A priority patent/CN117223447A/en
Publication of JP2023181796A publication Critical patent/JP2023181796A/en
Pending legal-status Critical Current

Links

Images

Landscapes

  • Guiding Agricultural Machines (AREA)

Abstract

To provide a work vehicle appropriately performing turning travel by detecting that inappropriate turning travel has been made.SOLUTION: A work vehicle includes an automatic work travel control part for controlling work travel by automatic travel along a straight path IPL based on a position PP of a machine body 1, and an automatic turning travel control part for controlling turning travel performed according to a predetermined prescribed procedure. When controlling the turning travel, the automatic turning travel control part calculates as a target turning circle RRC, a circle that passes through a turning start position PSR and comes into contact with the straight path IPL having traveled just before and a straight path IPL1 traveling next, calculates as a turning distance DR, a distance between a center point CRC of a target turning circle RRC and a position PP of the machine body 1 traveling, and when a difference between a radius RC of the target turning circle RRC and the turning distance DR is larger than a predetermined prescribed threshold, executes a prescribed escape control function.SELECTED DRAWING: Figure 8

Description

本発明は、旋回走行を挟んで複数の直進作業走行を行う作業車に関する。 TECHNICAL FIELD The present invention relates to a work vehicle that performs a plurality of straight work runs with turning runs in between.

特許文献1に開示されるように、田植機は、圃場内において、旋回走行を挟んで直線経路を往復して作業走行を行う。旋回走行は、旋回経路が生成されず、直線経路における作業の終了を判断し、あらかじめ定められた所定の旋回角度で自動旋回が行われる。 As disclosed in Patent Document 1, a rice transplanter performs work travel in a field by reciprocating along a straight path with turning travel in between. In turning travel, a turning path is not generated, and the end of work on a straight path is determined, and automatic turning is performed at a predetermined turning angle.

特開2007-244288号公報JP2007-244288A

しかしながら、このような田植機では、旋回経路に沿った旋回が行われず、所定の旋回手順で自動旋回走行が制御される。旋回手順として、所定の旋回角度で旋回するように制御される。そのため、圃場の状態等により機体が横滑りした場合等には、予定していた旋回が適切に行われず、不適切な位置を通り、不適切な位置で旋回が終了する場合がある。 However, in such a rice transplanter, turning is not performed along a turning route, but automatic turning travel is controlled according to a predetermined turning procedure. The turning procedure is controlled to turn at a predetermined turning angle. Therefore, if the aircraft skids due to field conditions or the like, the planned turn may not be carried out properly, and the aircraft may pass through an inappropriate position and end the turn at an inappropriate position.

本発明は、不適切な旋回走行が行われたことを検知し、適切に旋回走行が行われることを目的とする。 An object of the present invention is to detect that an inappropriate turning has been performed and to appropriately perform the turning.

上記目的を達成するために、本発明の一実施形態に係る作業車は、旋回走行と直進走行とを繰り返すことにより圃場に対する作業走行を行う作業車であって、機体と、前記機体の位置を算出する機体位置算出部と、前記直進走行を行うための直線経路を生成する経路生成部と、前記機体の位置に基づいて前記直線経路に沿った自動走行による前記作業走行を制御する自動作業走行制御部と、あらかじめ定められた所定の手順で行われる前記旋回走行を制御する自動旋回走行制御部とを備え、前記自動旋回走行制御部は、前記旋回走行を制御する際に、旋回開始位置を通り、直前に走行した前記直線経路と次に走行する前記直線経路とに接する円を目標旋回円として算出し、前記目標旋回円の中心点と走行中の前記機体の位置との距離を旋回距離として算出し、前記目標旋回円の半径と前記旋回距離との差があらかじめ定められた所定の閾値より大きい場合に、所定の脱走制御機能を実行する。 In order to achieve the above object, a work vehicle according to an embodiment of the present invention is a work vehicle that travels for work in a field by repeating turning travel and straight travel, and has a body and a position of the body. an aircraft position calculation unit that calculates the aircraft position; a route generation unit that generates a straight path for performing the straight forward travel; and an automatic work drive that controls the work travel by automatic travel along the straight route based on the position of the aircraft. and an automatic turning driving control unit that controls the turning driving performed in a predetermined procedure, and the automatic turning driving control unit controls the turning start position when controlling the turning driving. The circle tangent to the straight line route traveled immediately before and the straight line route traveled next is calculated as a target turning circle, and the distance between the center point of the target turning circle and the position of the aircraft during travel is calculated as the turning distance. If the difference between the radius of the target turning circle and the turning distance is greater than a predetermined threshold, a predetermined escape control function is executed.

自動旋回走行はあらかじめ定められた手順に従って行われ、この手順は、直線経路から次に走行する直線経路に適切に旋回走行が行われるように設定される。ここで、自動旋回走行中に機体がスリップする等して適切な旋回が行われず、所定の手順で自動旋回走行が行われても、次に走行する直線経路の適切な位置に到達できない場合がある。また、自動旋回走行は走行経路が生成されないため、自動旋回走行の制御を容易に行うことができる反面、自動旋回走行中に旋回走行の適否を確認することができない。 Automatic turning is performed according to a predetermined procedure, and this procedure is set so that turning is appropriately performed from one straight route to the next straight route. At this time, the aircraft may slip during automatic turning and the appropriate turning may not be performed, and even if automatic turning is performed according to the prescribed procedure, it may not be possible to reach the appropriate position on the next straight path. be. Furthermore, since a travel route is not generated during automatic turning, while the automatic turning can be easily controlled, it is not possible to confirm whether or not the turning is appropriate during automatic turning.

上記構成によると、自動旋回走行の際に、目標旋回円を仮想的に算出し、目標旋回円に機体が沿うように制御されないながらも、旋回距離と目標旋回円の半径とが比較される。旋回距離が目標旋回円の半径に対して閾値以上ずれたことをもって、スリップ等により機体が脱走し、適切な自動旋回走行が行われていない判断することができる。そして、適切な自動旋回走行が行われていないと判断されると、脱走制御機能が実行され、適切な自動旋回走行が行われるように対処することができる。その結果、不適切な旋回走行が行われていることが検知され、適切に自動旋回走行を行うことができる。 According to the above configuration, during automatic turning, the target turning circle is virtually calculated, and the turning distance is compared with the radius of the target turning circle, even though the aircraft is not controlled to follow the target turning circle. If the turning distance deviates from the radius of the target turning circle by more than a threshold value, it can be determined that the aircraft has escaped due to slipping or the like and is not performing an appropriate automatic turning. If it is determined that appropriate automatic turning is not being performed, an escape control function is executed, and measures can be taken to ensure that appropriate automatic turning is performed. As a result, it is detected that inappropriate turning is being performed, and automatic turning can be performed appropriately.

また、前記脱走制御機能は、前記機体を少なくとも一回以上減速させる制御であってもよい。 Further, the escape control function may be a control that decelerates the aircraft at least once or more.

このような構成により、適切な自動旋回走行が行われていないと判断された際に、機体が減速されている間に、適切に旋回走行が行われるための措置を行うことができる。 With this configuration, when it is determined that appropriate automatic turning is not being performed, measures can be taken to ensure appropriate turning while the aircraft is being decelerated.

また、前記脱走制御機能は、前記機体の作業部を停止させる制御であってもよい。 Moreover, the escape control function may be a control that stops a working part of the aircraft body.

このような構成により、適切な自動旋回走行が行われていないと判断された際に、適切に旋回走行が行われるための措置を容易に行うことができる。 With such a configuration, when it is determined that appropriate automatic turning is not being performed, it is possible to easily take measures to ensure appropriate turning.

また、前記脱走制御機能は、前記機体を停車させる制御であってもよい。 Moreover, the escape control function may be a control for stopping the aircraft.

このような構成により、適切な自動旋回走行が行われていないと判断されると機体が一旦停車され、その後、適切に旋回走行が行われるように容易に対処することができる。 With such a configuration, if it is determined that appropriate automatic turning is not being performed, the aircraft is temporarily stopped, and then it is possible to easily take measures such that appropriate turning is performed.

また、大きく膨らんで旋回が行われると、機体が畦に接触する場合がある。適切な自動旋回走行が行われていないと判断されると機体を停車させることにより、機体が畦に接触することを適切に抑制することができる。 Additionally, if the aircraft makes a turn with a large bulge, the aircraft may come into contact with the ridge. By stopping the aircraft when it is determined that appropriate automatic turning is not being performed, it is possible to appropriately prevent the aircraft from coming into contact with the ridge.

また、前記目標旋回円の半径と前記旋回距離との差は絶対値として算出され、前記自動旋回走行制御部は、前記目標旋回円の半径と前記旋回距離との差の絶対値が前記閾値より大きい場合であっても、前記旋回距離が前記目標旋回円の半径より小さい場合は前記脱走制御機能を無効としてもよい。 Further, the difference between the radius of the target turning circle and the turning distance is calculated as an absolute value, and the automatic turning travel control section calculates that the absolute value of the difference between the radius of the target turning circle and the turning distance is less than the threshold value. Even if the turning distance is larger than the radius of the target turning circle, the escape control function may be disabled if the turning distance is smaller than the radius of the target turning circle.

旋回距離が目標旋回円の半径より小さくなる状況は、大きな旋回角度(小さな旋回半径)で旋回しすぎ、手順に沿った旋回で想定される旋回軌跡に対して機体が内側にずれている状況である。このような状況では、次に走行する直線経路の適切な位置に向かっていないとしても、畦に接触する可能性は小さい状況である。また、旋回の最終段階または直線経路での走行の初期段階に適切な操舵制御を行うことにより、直線経路に沿った走行を行うことができる可能性がある。 A situation where the turning distance becomes smaller than the radius of the target turning circle is a situation where the aircraft is turning too much at a large turning angle (small turning radius) and the aircraft deviates inward from the expected turning trajectory when turning according to the procedure. be. In such a situation, even if the vehicle is not heading to an appropriate position on the next straight route, there is a small possibility that the vehicle will come into contact with a ridge. Furthermore, by performing appropriate steering control at the final stage of turning or at the initial stage of traveling on a straight route, there is a possibility that the vehicle can travel along a straight route.

そのため、上記構成によると、適切な自動旋回走行が行われていないと判断されても、機体が内側にずれている場合には脱走制御機能を行わないことで、効率的に自動旋回走行およびその後の作業走行を継続することができる。 Therefore, according to the above configuration, even if it is determined that an appropriate automatic turning operation is not being performed, if the aircraft is shifted inward, the escape control function is not performed, thereby efficiently allowing automatic turning operation and subsequent can continue to work.

また、前記自動旋回走行制御部は、前記旋回走行を制御する際に、あらかじめ定められた所定の操舵角度で前記機体を旋回させると共に、前記機体の進行方向に平行な直線と次に走行する前記直線経路とのなす角度が所定の角度以下になると前記旋回走行を終了させてもよい。 In addition, when controlling the turning, the automatic turning travel control unit turns the aircraft at a predetermined steering angle, and the automatic turning travel control unit rotates the aircraft at a predetermined steering angle, and the automatic turning travel control unit rotates the aircraft at a predetermined steering angle, and the automatic turning travel control unit rotates the aircraft at a predetermined steering angle. The turning movement may be terminated when the angle with the straight path becomes less than or equal to a predetermined angle.

旋回走行において、機体の進行方向が次に走行する直線経路の走行方向と同じ方向に近づくと、旋回の終了位置に近づいたと判断することができ、機体の進行方向が直線経路の走行方向と略一致していれば、そこから直線経路に沿った自動作業走行を開始することができる。 During turning, when the direction of movement of the aircraft approaches the same direction as the direction of travel of the next straight path, it can be determined that the end position of the turn has been approached, and the direction of movement of the aircraft is approximately the same as the direction of travel of the straight path. If they match, automatic work travel along a straight path can be started from there.

上記構成によると、容易に自動旋回走行を行いながら、その後、スムーズに直線経路に沿った自動作業走行に移行することができる。 According to the above configuration, it is possible to easily perform automatic turning travel and then smoothly shift to automatic work travel along a straight path.

田植機の全体構成を例示する左側面図である。It is a left side view illustrating the whole structure of a rice transplanter. 田植機の全体構成を例示する平面図である。FIG. 1 is a plan view illustrating the overall configuration of a rice transplanter. 運転パネルの要部構成を例示する図である。FIG. 3 is a diagram illustrating the configuration of main parts of an operation panel. 作業走行を説明する図である。It is a figure explaining work traveling. 直線経路の生成例を説明する図である。FIG. 3 is a diagram illustrating an example of generating a straight route. 旋回走行の手順の例を説明する図である。It is a figure explaining the example of the procedure of turning travel. 自動走行を制御する機能構成を例示する図である。FIG. 2 is a diagram illustrating a functional configuration for controlling automatic driving. 自動旋回走行における制御の例を説明する図である。It is a figure explaining the example of control in automatic turning travel. 自動旋回走行のフローの例を説明する図である。It is a figure explaining the example of the flow of automatic turning travel.

以下、作業車の一例として、圃場を作業走行する田植機について説明する。 Hereinafter, a rice transplanter that travels in a field will be described as an example of a working vehicle.

ここで、理解を容易にするために、本実施形態では、特に断りがない限り、「前」(図1,図2に示す矢印Fの方向)は機体前後方向(走行方向)における前方を意味し、「後」(図1,図2に示す矢印Bの方向)は機体前後方向(走行方向)における後方を意味するものとする。また、左右方向または横方向は、機体前後方向に直交する機体横断方向(機体幅方向)を意味し、「左」(図2に示す矢印Lの方向)および「右」(図2に示す矢印Rの方向)は、それぞれ、機体の左方向および右方向を意味するものとする。 Here, for ease of understanding, in this embodiment, unless otherwise specified, "front" (direction of arrow F shown in FIGS. 1 and 2) means the front in the longitudinal direction (traveling direction) of the aircraft. However, "rear" (the direction of arrow B shown in FIGS. 1 and 2) means the rear in the longitudinal direction (traveling direction) of the aircraft. In addition, the left-right direction or lateral direction means the transverse direction of the fuselage (aircraft width direction) orthogonal to the longitudinal direction of the fuselage, and "left" (direction of arrow L shown in Figure 2) and "right" (arrow shown in Figure 2) R direction) shall mean the left direction and the right direction of the aircraft, respectively.

〔全体構造〕
図1,図2に示すように、田植機は、乗用型で四輪駆動形式の機体1を備える。機体1は、機体1の後部に昇降揺動可能に連結された平行四連リンク形式のリンク機構13、リンク機構13を揺動駆動する油圧式の昇降リンク13a、リンク機構13の後端部領域にローリング可能に連結される苗植付装置3を備える。苗植付装置3は作業装置の一例であり、他の作業装置として、施肥装置や薬剤散布装置等が搭載されてもよい。
[Overall structure]
As shown in FIGS. 1 and 2, the rice transplanter includes a body 1 of a riding type and a four-wheel drive type. The fuselage 1 includes a link mechanism 13 in the form of parallel quadruple links connected to the rear of the fuselage 1 so as to be able to swing up and down, a hydraulic lift link 13a that swings the link mechanism 13, and a rear end area of the link mechanism 13. The seedling planting device 3 is rollably connected to the seedling planting device 3. The seedling planting device 3 is an example of a working device, and a fertilizing device, a chemical spraying device, etc. may be installed as other working devices.

機体1は、走行のための機構として車輪12、エンジン2、および主変速装置である油圧式の無段変速装置9を備える。無段変速装置9は、例えばHST(Hydro-Static Transmission)であり、モータ斜板およびポンプ斜板の角度を調節することにより、エンジン2から出力される駆動力を変速する。車輪12は、操舵可能な左右の前輪12Aと、操舵不能な左右の後輪12Bとを有する。エンジン2および無段変速装置9は、機体1の前部に搭載される。エンジン2から出力された動力は、無段変速装置9等を介して前輪12A、後輪12B、作業装置等に供給される。 The aircraft body 1 includes wheels 12 as a mechanism for traveling, an engine 2, and a hydraulic continuously variable transmission 9 as a main transmission. The continuously variable transmission 9 is, for example, an HST (Hydro-Static Transmission), and changes the speed of the driving force output from the engine 2 by adjusting the angles of a motor swash plate and a pump swash plate. The wheels 12 include steerable left and right front wheels 12A and non-steerable left and right rear wheels 12B. The engine 2 and the continuously variable transmission 9 are mounted on the front part of the aircraft body 1. The power output from the engine 2 is supplied to the front wheels 12A, rear wheels 12B, working equipment, etc. via the continuously variable transmission 9 and the like.

苗植付装置3は、一例として8条植え形式に構成される。苗植付装置3は、苗載せ台21、8条分の植付機構22、5つのフロート15等を備える。なお、この苗植付装置3は、各条クラッチ(植付クラッチ23)の制御により、2条植え、4条植え、6条植え等の形式に変更可能である。 The seedling planting device 3 is configured, for example, in an 8-row planting format. The seedling planting device 3 includes a seedling mounting table 21, a planting mechanism 22 for eight rows, five floats 15, and the like. Note that this seedling planting device 3 can be changed to a format such as 2-row planting, 4-row planting, 6-row planting, etc. by controlling each row clutch (planting clutch 23).

苗載せ台21は、8条分のマット状苗を載置する台座である。苗載せ台21は、マット状苗の左右幅に対応する一定ストロークで左右方向に往復移動し、苗載せ台21が左右のストローク端に達する毎に、苗載せ台21上の各マット状苗を苗載せ台21の下端に向けて所定ピッチで縦送りする。 The seedling mounting stand 21 is a pedestal on which eight rows of mat-like seedlings are placed. The seedling platform 21 reciprocates in the left and right direction with a constant stroke corresponding to the left and right width of the mat-shaped seedlings, and each time the seedling platform 21 reaches the left and right stroke ends, each mat-shaped seedling on the seedling platform 21 is moved back and forth. The seedlings are vertically fed toward the lower end of the seedling platform 21 at a predetermined pitch.

8個の植付機構22は、ロータリ式で、植え付け条間に対応する一定間隔で左右方向に配置される。そして、各植付機構22は、植付クラッチ23が伝動状態に移行されることによりエンジン2から駆動力が伝達され、苗載せ台21に載置された各マット状苗の下端から一株分の苗を切り取って、整地後の泥土部に植え付ける。これにより、苗植付装置3は、苗載せ台21に載置されたマット状苗から苗を取り出して水田の泥土部に植え付けることができる。 The eight planting mechanisms 22 are of a rotary type and are arranged in the left-right direction at regular intervals corresponding to the planting rows. Then, each planting mechanism 22 receives driving force from the engine 2 by shifting the planting clutch 23 to a transmission state, and the planting mechanism 22 receives one plant from the lower end of each mat-shaped seedling placed on the seedling platform 21. Cut out the seedlings and plant them in the muddy soil area after leveling the land. Thereby, the seedling planting device 3 can take out the seedlings from the mat-shaped seedlings placed on the seedling platform 21 and plant them in the muddy soil part of the paddy field.

フロート15は苗植付作業の際に圃場を整地する。各フロート15は、2条分の植付機構22と対応付けて設けられる。 The float 15 levels the field during seedling planting work. Each float 15 is provided in association with a planting mechanism 22 for two rows.

機体1は、その後部側領域に運転部14を備える。運転部14は、前輪操舵用のステアリングホイール10、無段変速装置9の変速操作を行うことで車速を調節する主変速レバー7、苗植付装置3の昇降操作と植付クラッチ23の入切(伝動状態と非伝動状態との間の切り替え)を操作する作業操作レバー11、および、オペレータ(運転者・作業者)用の運転座席16等を備える。ステアリングホイール10、主変速レバー7、および作業操作レバー11は運転座席16の前方の運転パネル6に設けられる。さらに、運転部14の前方に、予備苗を収容する予備苗収納装置17Aが予備苗支持フレーム17に支持される。 The fuselage 1 includes a driving section 14 in its rear region. The driving unit 14 includes a steering wheel 10 for steering the front wheels, a main shift lever 7 that adjusts the vehicle speed by changing the speed of the continuously variable transmission 9, a lifting operation of the seedling planting device 3, and an on/off operation of the planting clutch 23. It includes a work operation lever 11 for operating (switching between a transmission state and a non-transmission state), a driver's seat 16 for an operator (driver/worker), and the like. The steering wheel 10, the main shift lever 7, and the work operation lever 11 are provided on the driving panel 6 in front of the driver's seat 16. Further, in front of the driving unit 14, a spare seedling storage device 17A for storing spare seedlings is supported by the spare seedling support frame 17.

また、予備苗支持フレーム17には、測位ユニット8が設けられる。測位ユニット8は、機体1の位置PP(図5参照)および方位を算出するための測位データを出力する。測位ユニット8には、全地球航法衛星システム(GNSS)の衛星からの電波を受信する衛星測位モジュール8Aと、機体1の三軸の傾きや加速度を検出する慣性計測モジュール8Bが含まれている。 Further, the preliminary seedling support frame 17 is provided with a positioning unit 8. The positioning unit 8 outputs positioning data for calculating the position PP (see FIG. 5) and direction of the aircraft 1. The positioning unit 8 includes a satellite positioning module 8A that receives radio waves from a Global Navigation Satellite System (GNSS) satellite, and an inertial measurement module 8B that detects the tilt and acceleration of the aircraft 1 in three axes.

また、図3に示すように、運転パネル6には、開始位置操作具18、終了位置操作具19が設けられる。開始位置操作具18および終了位置操作具19は、運転パネル6のステアリングホイール10より下側に左右に分かれて配置される。開始位置操作具18は、後述するティーチング走行における始点PA(図5参照)を決定する際に操作される。終了位置操作具19は、ティーチング走行における終点PB(図5参照)を決定する際に操作される。開始位置操作具18および終了位置操作具19は、入力操作が可能な操作具であればよく、例えば、押しボタンである。また、開始位置操作具18および終了位置操作具19の配置構成は図3に示す構成に限らず、走行中に運転者が操作できる位置に配置されればよい。 Further, as shown in FIG. 3, the operation panel 6 is provided with a start position operating tool 18 and an end position operating tool 19. The start position operating tool 18 and the end position operating tool 19 are arranged below the steering wheel 10 of the driving panel 6 and are divided into right and left parts. The starting position operating tool 18 is operated when determining a starting point PA (see FIG. 5) in a teaching run, which will be described later. The end position operating tool 19 is operated when determining the end point PB (see FIG. 5) in the teaching run. The start position operating tool 18 and the end position operating tool 19 may be any operating tool that allows input operations, such as push buttons. Further, the arrangement of the start position operating tool 18 and the end position operating tool 19 is not limited to the arrangement shown in FIG. 3, but may be arranged at positions where the driver can operate them while the vehicle is running.

〔作業走行〕
田植機が圃場を田植作業する作業走行について、図1,図2を参照しながら、図4を用いて説明する。
[Work driving]
The working movement of a rice transplanter in rice planting work in a field will be explained using FIG. 4 while referring to FIGS. 1 and 2.

本実施形態における田植機は、手動走行および自動走行を選択的に行うことができる。手動走行は、運転者が手動で、ステアリングホイール10、主変速レバー7、作業操作レバー11等の作業走行操作具を操作して作業走行を行うものである。自動走行は、田植機が自動制御で走行および作業を行うものであり、旋回走行を挟んで、後述の直線経路IPLに沿った直進作業走行を行う。この際の旋回走行は、走行経路が生成されず、あらかじめ定められた所定の手順で自動制御される。 The rice transplanter in this embodiment can selectively run manually or automatically. In manual travel, the driver manually operates work travel operating tools such as the steering wheel 10, the main shift lever 7, and the work operation lever 11 to perform work travel. In automatic travel, the rice transplanter travels and performs work under automatic control, and performs straight work travel along a straight route IPL, which will be described later, with turning travel in between. At this time, the turning movement is automatically controlled according to a predetermined procedure without generating a driving route.

田植機が植え付け作業を行う際には、圃場が外周領域OAと内部領域IAに区分けされ、それぞれに応じた作業走行が行われる。 When the rice transplanter performs planting work, the field is divided into an outer peripheral area OA and an inner area IA, and work travel is performed according to each area.

内部領域IAでは、圃場の一つの辺に略平行な複数の直線経路IPL(内部往復経路)が生成される。直線経路IPLは、内部領域IAの全体をくまなく走行する走行経路であり、それぞれの直線経路IPLは旋回走行を挟んで走行される。直線経路IPLは、旋回走行が行われる度に、次に走行する直線経路IPLが順次生成される。 In the internal region IA, a plurality of linear paths IPL (internal reciprocating paths) substantially parallel to one side of the field are generated. The straight route IPL is a travel route that travels all over the interior area IA, and each straight route IPL travels with turning travel in between. Each time the vehicle makes a turn, the next straight route IPL is generated in sequence.

内部領域IAでの作業走行が行われた後、外周領域OAでの作業走行が行われる。外周領域OAでの作業走行は、自動走行または手動走行により行われる。外周領域OAで自動作業走行が行われる場合、圃場の外周に沿って外周領域OA内を周回する、内側周回経路IRLと外側周回経路ORLの2つの走行経路が生成される。内側周回経路IRLと外側周回経路ORLとを作業走行することにより、外周領域OAの全体の作業走行が行われる。なお、外周領域OA内を周回する走行経路は、内側周回経路IRLと外側周回経路ORLとの2つに限らず、1以上の走行経路であればよい。 After work travel is performed in the inner area IA, work travel is performed in the outer peripheral area OA. Work travel in the outer peripheral area OA is performed by automatic travel or manual travel. When automatic work travel is performed in the outer peripheral area OA, two driving routes are generated, an inner circular route IRL and an outer circular route ORL, which travel around the outer peripheral area OA along the outer periphery of the field. By traveling along the inner circumferential route IRL and the outer circumferential route ORL, the entire outer circumferential area OA is operated. Note that the running route that goes around the outer circumferential area OA is not limited to two, the inner loop route IRL and the outer loop route ORL, but may be one or more running routes.

〔直線経路の自動作業走行〕
次に、図1~図4を参照しながら、図5を用いて直線経路における自動作業走行について説明する。
[Automatic work travel along a straight path]
Next, while referring to FIGS. 1 to 4, automatic work travel on a straight path will be explained using FIG. 5.

まず、内部領域IAの一端から他端に向けて手動走行を行うティーチング走行が行われる。ティーチング走行において、運転者は、作業走行を開始する位置で開始位置操作具18を操作し、ティーチング走行の始点PAを登録する。そして、運転者は、手動操作で直線状の作業走行(手動走行)を行い、作業走行の終了位置に到達すると終了位置操作具19を操作し、ティーチング走行の終点PBを登録する。なお、終点PBは、作業走行の終了位置から、苗植付装置3の上昇される間に直進走行された位置であってもよい。 First, teaching travel is performed in which manual travel is performed from one end of the internal area IA to the other end. In the teaching travel, the driver operates the start position operating tool 18 at the position where the work travel is to be started, and registers the starting point PA of the teaching travel. Then, the driver manually performs linear work travel (manual travel), and when reaching the end position of the work travel, operates the end position operating tool 19 to register the end point PB of the teaching travel. Note that the end point PB may be a position traveled straight from the end position of the working travel while the seedling planting device 3 is being raised.

この始点PAと終点PBとを結ぶ直線が基本直線RLであり、基本直線RL、および、基本直線RLに平行な方向である基準方位RDの少なくともいずれかが登録される。 The straight line connecting the starting point PA and the ending point PB is the basic straight line RL, and at least one of the basic straight line RL and the reference direction RD, which is a direction parallel to the basic straight line RL, is registered.

次に、往復作業走行を行うために、運転者は所定の操作を行い、後述の自動旋回走行によって、機体1を180°旋回させる。 Next, in order to perform a reciprocating work run, the driver performs a predetermined operation to turn the aircraft 1 180 degrees by automatic turning to be described later.

自動旋回走行の終了位置PE(図6参照)が直進走行の開始位置PSSとなり、開始位置PSSを通り、基本直線RLに平行な(基準方位RDの方向の)直線が次に走行する直線経路IPLとして生成される。なお、直線経路IPLは、直進走行の開始位置PSSと走行方位(基準方位RDと平行となる方向)とにより定義されてもよいが、開始位置PSSとその後走行すべき機体1の位置PPの集合として定義されてもよく、直進走行の開始位置PSSと直進走行の終了位置とを結ぶ線分として定義されてもよい。 The end position PE (see Figure 6) of automatic turning travel becomes the start position PSS of straight-ahead travel, and a straight line passing through the start position PSS and parallel to the basic straight line RL (in the direction of the reference direction RD) is the straight line route IPL to be traveled next. is generated as . Note that the straight route IPL may be defined by the starting position PSS of straight traveling and the traveling direction (direction parallel to the reference direction RD), but it is also a set of the starting position PSS and the position PP of the aircraft 1 to be traveled thereafter. , or may be defined as a line segment connecting the straight-ahead travel start position PSS and the straight-ahead travel end position.

そして、運転者は直線経路IPLに沿った自動作業走行を開始させる。その後、直線経路IPLに沿った自動作業走行と自動旋回走行とが繰り返され、自動旋回走行が終了する度に、次の直線経路IPLが生成されて、内部領域IA全体にわたる往復走行が行われる。 Then, the driver starts automatic work travel along the straight route IPL. Thereafter, automatic work travel and automatic turning travel along the straight route IPL are repeated, and each time the automatic turning travel is completed, the next straight route IPL is generated and reciprocating travel over the entire interior area IA is performed.

〔自動旋回走行〕
次に、図1,図5を参照しながら、図6を用いて自動旋回走行について説明する。
[Automatic turning travel]
Next, automatic turning traveling will be explained using FIG. 6 while referring to FIGS. 1 and 5.

自動旋回走行は、所定の人為操作が行われることにより開始される。自動旋回走行は外周領域OAで行われるが、特に、畦RWから所定の距離だけ圃場の内側の領域で行われる。自動旋回走行は走行経路に沿って行われるのではなく、車輪12等の走行装置が所定の手順で制御されることにより、あらかじめ定められた所定の手順で行われる。 Automatic turning travel is started by performing a predetermined manual operation. The automatic turning travel is performed in the outer peripheral area OA, but particularly in the area inside the field by a predetermined distance from the ridge RW. Automatic turning travel is not performed along a travel route, but is performed according to a predetermined procedure determined by controlling the traveling devices such as the wheels 12 according to a predetermined procedure.

例えば、自動旋回走行は、直線経路IPLでの作業走行が終了し、開始位置PSRで所定の人為操作が行われると、まず、前輪12Aがあらかじめ定められた所定の操舵角度、例えば、最大操舵角度に操作されて旋回走行が行われる。この走行での走行軌跡は図6に示すC1となる。 For example, in automatic turning driving, when work driving on the straight path IPL is completed and a predetermined manual operation is performed at the start position PSR, the front wheels 12A are first set at a predetermined steering angle, for example, the maximum steering angle. Turning is performed by operating the vehicle. The traveling trajectory in this traveling becomes C1 shown in FIG.

次に、旋回角度αが所定の旋回角度αC1になると、操舵角度が低減される。例えば、旋回角度αC1として旋回角度αが90°になると、操舵角度が0°にされる。つまり、旋回角度αが90°になると、機体1は直線経路IPLに対して直行する向き、言い換えると畦際境界線RBLに平行な向きに走行する。ここで、旋回角度αは、走行中の機体1の位置PPと中点CCとを結ぶ直線と、畦際境界線RBLとのなす角度である。中点CCは、直前に作業走行が行われた直線経路IPLの旋回の開始位置PSRと次に走行する直線経路IPLにおける作業走行の開始位置PSS(旋回の終了位置PE)との中点である。また、畦際境界線RBLは、開始位置PSRと終了位置PEとを結ぶ直線であり、開始位置PSRを通り直線経路IPLまたは基本直線RLと直行する直線である。なお、この走行での走行軌跡は図6に示すC2となる。 Next, when the turning angle α reaches a predetermined turning angle αC1, the steering angle is reduced. For example, when the turning angle α becomes 90° as the turning angle αC1, the steering angle is set to 0°. That is, when the turning angle α becomes 90°, the aircraft 1 travels in a direction perpendicular to the straight path IPL, in other words, in a direction parallel to the ridge boundary line RBL. Here, the turning angle α is the angle formed by the straight line connecting the position PP of the moving aircraft 1 and the midpoint CC and the ridge boundary line RBL. The midpoint CC is the midpoint between the turning start position PSR of the straight route IPL on which the work run was performed immediately before and the start position PSS of the work run (the end position PE of the turn) on the straight route IPL to be traveled next. . Furthermore, the ridge boundary line RBL is a straight line connecting the start position PSR and the end position PE, and is a straight line that passes through the start position PSR and is perpendicular to the straight line route IPL or the basic straight line RL. Note that the traveling trajectory in this traveling becomes C2 shown in FIG. 6.

そして、旋回角度αが所定の旋回角度αC2(残りの旋回角度がαC3=180°-αC2)になると、あらかじめ定められた所定の操舵角度に操作されて、旋回の終了位置PE(直線経路IPL)に向けて旋回走行が行われる。この際、旋回の終了位置PEに向けて自動操舵が行われてもよい。この走行での走行軌跡は図6に示すC3となる。 Then, when the turning angle α reaches a predetermined turning angle αC2 (the remaining turning angle is αC3 = 180° - αC2), the steering angle is operated to a predetermined predetermined angle, and the turning end position PE (straight path IPL) is reached. A turning run is carried out towards. At this time, automatic steering may be performed toward the end position PE of the turn. The traveling trajectory in this traveling becomes C3 shown in FIG.

〔自動走行の制御〕
次に、自動直進走行(自動作業走行)および自動旋回走行を行う自動走行を制御する機能構成について、図1,図5を参照しながら、図7を用いて説明する。
[Automatic driving control]
Next, a functional configuration for controlling automatic travel that performs automatic straight-ahead travel (automatic work travel) and automatic turning travel will be described using FIG. 7 with reference to FIGS. 1 and 5.

自動走行は、制御ユニット30により制御される。制御ユニット30には、測位ユニット8、走行切替操作具25、開始位置操作具18、終了位置操作具19、車輪12が、データ通信が可能な状態で接続される。 Automatic driving is controlled by a control unit 30. The positioning unit 8, travel switching operating tool 25, starting position operating tool 18, ending position operating tool 19, and wheels 12 are connected to the control unit 30 in a state where data communication is possible.

制御ユニット30は、測位ユニット8から測位データを受信する。また、制御ユニット30は、走行切替操作具25、開始位置操作具18、および終了位置操作具19が操作された情報を受け取る。なお、走行切替操作具25は、自動走行および手動走行に切り替える人為操作を受け付ける。また、制御ユニット30は、車輪12を制御して機体1の走行および操舵を制御する。 Control unit 30 receives positioning data from positioning unit 8 . Further, the control unit 30 receives information on whether the travel switching operation tool 25, the start position operation tool 18, and the end position operation tool 19 have been operated. Note that the travel switching operation tool 25 accepts a manual operation for switching between automatic travel and manual travel. Further, the control unit 30 controls the wheels 12 to control traveling and steering of the aircraft body 1 .

制御ユニット30は、機体位置算出部32、経路生成部33、自動作業走行制御部35、および自動旋回走行制御部36を備える。 The control unit 30 includes a body position calculation section 32 , a route generation section 33 , an automatic work travel control section 35 , and an automatic turning travel control section 36 .

機体位置算出部32は、測位ユニット8から受信した測位データに基づいて、圃場における機体1の位置PPを断続的または連続的に算出する。 The aircraft position calculation unit 32 intermittently or continuously calculates the position PP of the aircraft 1 in the field based on the positioning data received from the positioning unit 8.

経路生成部33は、上述のティーチング走行において、基本直線RLおよび基準方位RDの少なくともいずれかを算出する。そして、経路生成部33は、算出された基本直線RLまたは基準方位RDを用いて、旋回走行が行われる度に、次に走行する直線経路IPLを生成する。 The route generation unit 33 calculates at least one of the basic straight line RL and the reference direction RD in the above-described teaching travel. Then, the route generating unit 33 generates a straight line route IPL to be traveled next each time the vehicle turns, using the calculated basic straight line RL or reference direction RD.

なお、田植機は、所定の報知を行う報知部26を備えてもよい。この場合は、報知部26は制御ユニット30と接続され、制御ユニット30の制御により、所定の報知を行う。そして、経路生成部33は、ティーチング走行において始点PAおよび終点PBが登録された際に、報知部26に所定の報知を行わせる。例えば、報知部26はスピーカーであり、経路生成部33は、始点PAおよび終点PBが登録されると、スピーカーに所定の報知音を発生させる。 Note that the rice transplanter may include a notification section 26 that makes a predetermined notification. In this case, the notification section 26 is connected to the control unit 30, and performs predetermined notification under the control of the control unit 30. Then, the route generating section 33 causes the notifying section 26 to make a predetermined notification when the starting point PA and the ending point PB are registered in the teaching run. For example, the notification unit 26 is a speaker, and the route generation unit 33 causes the speaker to generate a predetermined notification sound when the starting point PA and the ending point PB are registered.

また、報知音と共に、または報知音に代わり、経路生成部33は、報知部26であるLEDに、始点PAおよび終点PBが登録されたことを知らせる発光を行わせてもよい。さらに、開始位置操作具18および終了位置操作具19が押しボタンであり、報知部26としてそれぞれの押しボタンの表面にLEDが設けられてもよい。そして、経路生成部33は、始点PAが登録されると開始位置操作具18のLEDを点灯させ、終点PBが登録されると終了位置操作具19のLEDを点灯させてもよい。 Further, along with or instead of the notification sound, the route generation unit 33 may cause the LED, which is the notification unit 26, to emit light to notify that the start point PA and the end point PB have been registered. Furthermore, the start position operating tool 18 and the end position operating tool 19 may be push buttons, and an LED may be provided on the surface of each push button as the notification section 26. Then, the route generation unit 33 may turn on the LED of the start position operating tool 18 when the starting point PA is registered, and may turn on the LED of the end position operating tool 19 when the end point PB is registered.

自動作業走行制御部35は、苗植付装置3等の作業装置を制御しながら、機体1の位置PPに基づいて直線経路IPLに沿った自動作業走行を制御する。 The automatic work travel control unit 35 controls automatic work travel along the straight path IPL based on the position PP of the machine body 1 while controlling work devices such as the seedling planting device 3 .

自動旋回走行制御部36は、所定の人為操作が行われると、あらかじめ定められた所定の手順で機体1を旋回させる。さらに、自動旋回走行制御部36は、自動旋回走行中に、後述の脱走制御機能を実行するための処理を行う。 The automatic turning travel control unit 36 causes the aircraft 1 to turn according to a predetermined procedure when a predetermined manual operation is performed. Further, the automatic turning travel control unit 36 performs processing for executing an escape control function, which will be described later, during automatic turning travel.

また、自動旋回モードに移行されると、自動旋回走行制御部36は、植付クラッチ23(図2参照)を停止させ、苗植付装置3を上昇させる制御を行ってもよい。 Furthermore, when the automatic turning mode is entered, the automatic turning travel control section 36 may perform control to stop the planting clutch 23 (see FIG. 2) and raise the seedling planting device 3.

〔自動旋回走行中の制御〕
次に、図7を参照しながら、図8,図9を用いて、自動旋回走行中に実行される制御について説明する。
[Control during automatic turning]
Next, with reference to FIG. 7 and FIGS. 8 and 9, control executed during automatic turning will be described.

自動旋回走行が開始されると(図9のステップ#1)、自動旋回走行制御部36は、目標旋回円RRCを算出する(図9のステップ#2)。目標旋回円RRCは、自動旋回走行の開始位置PSR(旋回開始位置)を通り、自動旋回走行の直前に作業走行を行った直線経路IPLと、次に走行する直線経路IPL1とに接する円である。ただし、自動旋回走行制御部36は、自動旋回走行において、機体1が目標旋回円RRCに沿って走行するように制御を行うわけではない。 When automatic turning driving is started (step #1 in FIG. 9), automatic turning driving control section 36 calculates a target turning circle RRC (step #2 in FIG. 9). The target turning circle RRC is a circle that passes through the starting position PSR (turning start position) of automatic turning driving and is in contact with the straight line route IPL on which work driving was performed immediately before automatic turning driving and the straight line route IPL1 to be traveled next. . However, the automatic turning travel control unit 36 does not control the aircraft 1 to travel along the target turning circle RRC during automatic turning travel.

次に、自動旋回走行制御部36は、目標旋回円RRCの中心点CRCを算出する(図9のステップ#3)。例えば、自動旋回走行制御部36は、開始位置PSRから直線経路IPL1に垂線をひき、この垂線と直線経路IPL1との交点と、開始位置PSRとの中点を中心点CRCとして算出する。 Next, the automatic turning travel control unit 36 calculates the center point CRC of the target turning circle RRC (step #3 in FIG. 9). For example, the automatic turning travel control unit 36 draws a perpendicular line from the starting position PSR to the straight line route IPL1, and calculates the midpoint between the intersection of this perpendicular line and the straight line route IPL1 and the starting position PSR as the center point CRC.

次に、自動旋回走行制御部36は、目標旋回円RRCの半径RCを算出する(図9のステップ#4)。例えば、自動旋回走行制御部36は、上述の垂線と直線経路IPL1との交点から開始位置PSRまでの距離を目標旋回円RRCの直径として算出し、直径から目標旋回円RRCの半径RCを算出する。 Next, the automatic turning travel control unit 36 calculates the radius RC of the target turning circle RRC (step #4 in FIG. 9). For example, the automatic turning travel control unit 36 calculates the distance from the intersection of the above-mentioned perpendicular line and the straight path IPL1 to the start position PSR as the diameter of the target turning circle RRC, and calculates the radius RC of the target turning circle RRC from the diameter. .

自動旋回走行制御部36は、自動旋回走行中に継続的に旋回距離DRを算出する(図9のステップ#5)。旋回距離DRは、自動旋回走行中の機体1の位置PPと目標旋回円RRCの中心点CRCとの距離である。 The automatic turning travel control unit 36 continuously calculates the turning distance DR during automatic turning travel (step #5 in FIG. 9). The turning distance DR is the distance between the position PP of the aircraft 1 during automatic turning and the center point CRC of the target turning circle RRC.

自動旋回走行の開始から終了までの間、自動旋回走行制御部36は、継続的に旋回距離DRと半径RCとの差を算出する。そして、自動旋回走行制御部36は、算出された旋回距離DRと半径RCとの差の絶対値が、あらかじめ定められた所定の閾値より大きいか否かを判定する(図9のステップ#6)。つまり、自動旋回走行制御部36は、旋回距離DRと半径RCとの差により、所定の手順で旋回走行を行った際に想定される旋回走行に対するずれ量を近似的に算出し、自動旋回走行が適切に行われているかいなかを判定する。旋回距離DRと半径RCとの差の絶対値が閾値以下の間は(図9のステップ#6 No)、自動旋回走行制御部36は自動旋回走行の制御を継続する。 From the start to the end of automatic turning travel, the automatic turning travel control unit 36 continuously calculates the difference between the turning distance DR and the radius RC. Then, the automatic turning travel control unit 36 determines whether the absolute value of the difference between the calculated turning distance DR and radius RC is larger than a predetermined threshold (step #6 in FIG. 9). . In other words, the automatic turning travel control unit 36 approximately calculates the amount of deviation with respect to the cornering travel that is assumed when the turning travel is performed in a predetermined procedure based on the difference between the turning distance DR and the radius RC, and Determine whether or not this is being done appropriately. As long as the absolute value of the difference between the turning distance DR and the radius RC is less than or equal to the threshold value (No in step #6 in FIG. 9), the automatic turning driving control section 36 continues to control the automatic turning driving.

旋回距離DRと半径RCとの差の絶対値が閾値より大きくなると(図9のステップ#6 Yes)、自動旋回走行制御部36は、適切に自動旋回走行が行われないと判断して、機体1を停車させる脱走制御機能を実行する(図9のステップ#7)。 When the absolute value of the difference between the turning distance DR and the radius RC becomes larger than the threshold value (Step #6 Yes in FIG. 9), the automatic turning driving control unit 36 determines that the automatic turning driving is not performed appropriately, and the aircraft The escape control function for stopping the vehicle 1 is executed (step #7 in FIG. 9).

これにより、目標旋回円RRCを、自動旋回走行の走行軌跡であると仮想的に見立てて、目標旋回円RRCと機体1とのずれ量から、自動旋回走行が適切に行われているか否かを容易に判断することができる。そして、自動旋回走行が適切に行われていないと判断された際に、機体1を停車させることにより、その後、手動走行により旋回走行を行ったり、自動旋回走行における操舵角度を調整したりして、適切な旋回走行を継続することができる。 As a result, the target turning circle RRC is virtually regarded as the trajectory of automatic turning, and it is determined from the amount of deviation between the target turning circle RRC and the aircraft 1 whether or not automatic turning is being performed appropriately. can be easily determined. Then, when it is determined that the automatic turning operation is not being performed properly, the aircraft 1 is stopped, and then the aircraft 1 is turned manually or the steering angle during automatic turning operation is adjusted. , it is possible to continue to make appropriate turns.

なお、報知部26を備える場合、自動旋回走行制御部36は、脱走制御機能を実行する際に、報知部26に所定の報知を行わせてもよい。 In addition, when the notification unit 26 is provided, the automatic turning travel control unit 36 may cause the notification unit 26 to issue a predetermined notification when executing the escape control function.

〔別実施形態〕
(1)上記実施形態では、脱走制御機能として機体1が停車されたが、脱走制御機能はこのような制御に限らない。例えば、自動旋回走行制御部36は、脱走制御機能として、エンジン2、植付機構22(作業部に相当)および苗植付装置3の少なくともいずれかを停止させてもよい。これにより、旋回走行を再開させる際の対応を容易に行うことができる。
[Another embodiment]
(1) In the above embodiment, the aircraft 1 is stopped as an escape control function, but the escape control function is not limited to such control. For example, the automatic turning travel control section 36 may stop at least one of the engine 2, the planting mechanism 22 (corresponding to a working section), and the seedling planting device 3 as an escape control function. Thereby, it is possible to easily take measures when restarting turning travel.

また、自動旋回走行制御部36は、脱走制御機能として、機体1を少なくとも一回以上減速(車速を減速)させてもよい。これによっても、車速が低減されている間に旋回角度を変更させる等の必要な対応を行い、その後、適切な旋回走行を行うことができる。 Further, the automatic turning travel control unit 36 may decelerate the aircraft 1 (decelerate the vehicle speed) at least once as an escape control function. This also makes it possible to take necessary measures such as changing the turning angle while the vehicle speed is being reduced, and then perform appropriate turning.

また、減速は旋回状況を見ながら段階的に行ってもよく、例えば最初に1回目の減速を行った後にそれでもずれ量が大きい場合はさらに大きな減速幅で2回目の減速を行う等の複数回にわたる減速による旋回の調整を行ってもよい。 Also, deceleration may be performed in stages while checking the turning situation. For example, if the amount of deviation is still large after the first deceleration, the deceleration may be performed multiple times, such as performing a second deceleration with an even larger deceleration width. Turning may be adjusted by decelerating over a period of time.

(2)上記各実施形態において、旋回距離DRと半径RCとの差の絶対値が閾値より大きいとしても、旋回距離DRが半径RCより小さい場合は、自動旋回走行制御部36脱走制御機能を無効としてもよい。 (2) In each of the above embodiments, even if the absolute value of the difference between the turning distance DR and the radius RC is greater than the threshold value, if the turning distance DR is smaller than the radius RC, the escape control function of the automatic turning travel control unit 36 is disabled. You can also use it as

旋回距離DRが半径RCより小さい場合、機体1が畦RWに向かって膨らむ方向に旋回走行がずれているのではなく、機体1が中心点CRCの側に向かって小さな旋回角度αで旋回している状況である。このような状況では、機体1が畦RWに接触する可能性は小さい。そのため、旋回距離DRが半径RCより小さい場合は、自動旋回走行制御部36脱走制御機能を無効としても、旋回走行に問題が生じる可能性が比較的小さい。このような制御を行うことにより、旋回走行の継続性が維持される。 If the turning distance DR is smaller than the radius RC, the turning movement of the aircraft 1 is not deviated in the direction of expanding toward the ridge RW, but the aircraft 1 is turning toward the center point CRC at a small turning angle α. This is the situation. In such a situation, the possibility that the aircraft 1 will come into contact with the ridge RW is small. Therefore, when the turning distance DR is smaller than the radius RC, even if the escape control function of the automatic turning control section 36 is disabled, there is a relatively small possibility that a problem will occur in the turning. By performing such control, continuity of turning travel is maintained.

(3)上記各実施形態において、自動旋回走行は、図6を用いて説明した上記手順に限らず、あらかじめ定められた任意の手順で行われればよい。例えば、自動旋回走行制御部36は、操舵角度を固定し、あらかじめ定められた1つの操舵角度で自動旋回走行を行わせてもよい。この場合も、自動旋回走行制御部36は、旋回走行の最終段階には、次に走行する直線経路IPLの自動作業走行の開始位置PSSと機体1の位置PPとに基づいて自動操舵してもよい。 (3) In each of the embodiments described above, automatic turning travel is not limited to the above-described procedure described using FIG. 6, but may be performed according to any predetermined procedure. For example, the automatic turning travel control unit 36 may fix the steering angle and cause the automatic turning travel to be performed at one predetermined steering angle. In this case as well, the automatic turning travel control unit 36 performs automatic steering at the final stage of the turning travel based on the automatic work travel start position PSS of the next straight route IPL and the position PP of the aircraft 1. good.

また、自動旋回走行が、次に走行する直線経路IPLの開始位置PSSまで行われる構成に限らず、自動旋回走行は、機体1の進行方向が次に走行する直線経路IPLの進行方向に所定の程度だけ近づいた際に終了されてもよい。例えば、自動旋回走行制御部36は、機体1の進行方向に平行な直線と、次に走行する直線経路IPLとのなす角度が所定の角度以下になると自動旋回走行を終了させてもよい。 In addition, the automatic turning operation is not limited to a configuration in which the automatic turning operation is performed up to the starting position PSS of the straight line route IPL to be traveled next, but the automatic turning operation is performed when the traveling direction of the aircraft 1 is a predetermined direction of travel of the straight route IPL to be traveled next. It may be terminated when the distance approaches by a certain amount. For example, the automatic turning travel control unit 36 may end the automatic turning travel when the angle between a straight line parallel to the traveling direction of the aircraft 1 and the next straight line route IPL becomes less than or equal to a predetermined angle.

なお、自動旋回走行の終了後は、自動作業走行制御部35が、次に走行する直線経路IPLに沿うように機体1の操舵制御を行う。 Note that after the automatic turning travel is completed, the automatic work travel control section 35 performs steering control of the aircraft 1 so as to follow the next straight route IPL.

(4)上記各実施形態において、自動走行による走行開始時や自動走行中に、進行方向の前方や機体1の周囲に障害物があると、走行や作業に問題が生じる場合がある。そのため、本実施形態の田植機は、機体1の周囲の障害物を検知する障害物検知装置28(図7参照)の一例として、ソナーセンサを備えてもよい。ソナーセンサは、所定の距離の範囲内にある物体を障害物として検知する。障害物の検知は、基本的には自動走行中に行われるが、手動走行中に障害物の検知が行われる構成とすることもできる。 (4) In each of the above embodiments, if there is an obstacle in front of the vehicle in the direction of travel or around the aircraft 1 at the start of automatic travel or during automatic travel, problems may occur in travel or work. Therefore, the rice transplanter of this embodiment may include a sonar sensor as an example of the obstacle detection device 28 (see FIG. 7) that detects obstacles around the machine body 1. The sonar sensor detects objects within a predetermined distance as obstacles. Obstacle detection is basically performed during automatic driving, but it may also be configured such that obstacle detection is performed during manual driving.

走行禁止制御部38は、ソナーセンサが障害物を検知すると、機体1を停車させる。これにより、機体1が障害物に接触することを抑制することができる。なお、このような制御は直線経路IPLに沿った自動作業走行中のみならず、自動旋回走行中にも行われてもよく、手動走行中にも行われてもよい。 The travel prohibition control unit 38 stops the aircraft 1 when the sonar sensor detects an obstacle. Thereby, it is possible to suppress the aircraft 1 from coming into contact with obstacles. Note that such control may be performed not only during automatic work travel along the straight route IPL, but also during automatic turning travel, and may also be performed during manual travel.

(5)上記各実施形態において、田植機は、エンジン2に限らず、任意の原動機で駆動されてもよい。 (5) In each of the above embodiments, the rice transplanter may be driven not only by the engine 2 but also by any other prime mover.

(6)上記各実施形態において、走行装置は車輪12に限らず、クローラ等の任意の走行装置であってもよい。 (6) In each of the above embodiments, the traveling device is not limited to the wheels 12, but may be any traveling device such as a crawler.

(7)上記各実施形態において、制御ユニット30は上記のような機能ブロックから構成されるものに限定されず、任意の機能ブロックから構成されてもよい。例えば、制御ユニット30の各機能ブロックはさらに細分化されても良く、逆に、各機能ブロックの一部または全部がまとめられてもよい。また、制御ユニット30の機能は、上記機能ブロックに限らず、任意の機能ブロックが実行する方法により実現されてもよい。また、制御ユニット30の機能の一部または全部は、ソフトウエアで構成されてもよい。ソフトウエアに係るプログラムは、任意の記憶装置に記憶され、制御ユニット30が備えるCPU等のプロセッサ、あるいは別に設けられたプロセッサにより実行される。 (7) In each of the embodiments described above, the control unit 30 is not limited to being composed of functional blocks as described above, but may be composed of arbitrary functional blocks. For example, each functional block of the control unit 30 may be further subdivided, or conversely, a part or all of each functional block may be combined. Further, the functions of the control unit 30 are not limited to the above-mentioned functional blocks, and may be realized by a method executed by any functional block. Moreover, some or all of the functions of the control unit 30 may be configured by software. The software program is stored in any storage device and executed by a processor such as a CPU included in the control unit 30 or a separately provided processor.

また、田植機は、情報端末5を備えてもよい。情報端末5は、各種の情報や警告を表示してオペレータに報知(出力)すると共に、各種の情報の入力を受け付けるタッチパネル(モニタ画面)を有する。また、情報端末5は、運転部14に、運転座席16に着座する運転者が視認および操作が可能な態様で、着脱可能な状態で設けられる。そして、制御ユニット30は機体1に搭載される構成であってもよいが、制御ユニット30の機能の一部または全部は、情報端末5に設けられてもよい。 Further, the rice transplanter may include an information terminal 5. The information terminal 5 has a touch panel (monitor screen) that displays various information and warnings and notifies (outputs) them to the operator, as well as accepts input of various information. Further, the information terminal 5 is removably installed in the driver's unit 14 in a manner that allows the driver seated on the driver's seat 16 to view and operate the information terminal 5 . The control unit 30 may be configured to be mounted on the aircraft body 1, but some or all of the functions of the control unit 30 may be provided in the information terminal 5.

本発明は、田植機をはじめ、旋回走行を挟んで圃場を作業走行する農作業車、さらには、旋回走行を挟んで作業地を作業走行する各種の作業車等に適用することができる。 The present invention can be applied to rice transplanters, agricultural vehicles that work in fields while making turns, and various types of work vehicles that work in fields while making turns.

1 機体
22 植付機構(作業部)
32 機体位置算出部
33 経路生成部
35 自動作業走行制御部
36 自動旋回走行制御部
CRC 中心点
DR 旋回距離
DRP 畦際距離
IPL 直線経路
IPL1 直線経路
PP 位置
PSR 開始位置(旋回開始位置)
RC 半径
RRC 目標旋回円
1 Aircraft 22 Planting mechanism (working part)
32 Aircraft position calculation unit 33 Route generation unit 35 Automatic work travel control unit 36 Automatic turning travel control unit CRC Center point DR Turning distance DRP Ridge distance IPL Straight path IPL1 Straight path PP Position PSR Start position (turning start position)
RC Radius RRC Target turning circle

Claims (6)

旋回走行と直進走行とを繰り返すことにより圃場に対する作業走行を行う作業車であって、
機体と、
前記機体の位置を算出する機体位置算出部と、
前記直進走行を行うための直線経路を生成する経路生成部と、
前記機体の位置に基づいて前記直線経路に沿った自動走行による前記作業走行を制御する自動作業走行制御部と、
あらかじめ定められた所定の手順で行われる前記旋回走行を制御する自動旋回走行制御部とを備え、
前記自動旋回走行制御部は、前記旋回走行を制御する際に、旋回開始位置を通り、直前に走行した前記直線経路と次に走行する前記直線経路とに接する円を目標旋回円として算出し、前記目標旋回円の中心点と走行中の前記機体の位置との距離を旋回距離として算出し、前記目標旋回円の半径と前記旋回距離との差があらかじめ定められた所定の閾値より大きい場合に、所定の脱走制御機能を実行する作業車。
A work vehicle that performs work driving in a field by repeating turning driving and straight driving,
The aircraft and
an aircraft position calculation unit that calculates the position of the aircraft;
a route generation unit that generates a straight route for the straight-ahead traveling;
an automatic work travel control unit that controls the work travel by automatic travel along the straight path based on the position of the aircraft;
an automatic turning driving control unit that controls the turning driving performed according to a predetermined procedure,
When controlling the turning, the automatic turning travel control unit calculates, as a target turning circle, a circle that passes through the turning start position and is in contact with the straight line route traveled immediately before and the straight line route traveled next; The distance between the center point of the target turning circle and the position of the traveling aircraft is calculated as a turning distance, and if the difference between the radius of the target turning circle and the turning distance is larger than a predetermined threshold value, , a work vehicle that performs predetermined escape control functions.
前記脱走制御機能は、前記機体を少なくとも一回以上減速させる制御である請求項1に記載の作業車。 The work vehicle according to claim 1, wherein the escape control function is a control that decelerates the aircraft at least once or more. 前記脱走制御機能は、前記機体の作業部を停止させる制御である請求項1または2に記載の作業車。 The work vehicle according to claim 1 or 2, wherein the escape control function is a control for stopping a working section of the machine body. 前記脱走制御機能は、前記機体を停車させる制御である請求項1または2に記載の作業車。 The work vehicle according to claim 1 or 2, wherein the escape control function is a control for stopping the aircraft. 前記目標旋回円の半径と前記旋回距離との差は絶対値として算出され、
前記自動旋回走行制御部は、前記目標旋回円の半径と前記旋回距離との差の絶対値が前記閾値より大きい場合であっても、前記旋回距離が前記目標旋回円の半径より小さい場合は前記脱走制御機能を無効とする請求項1または2に記載の作業車。
The difference between the radius of the target turning circle and the turning distance is calculated as an absolute value,
Even if the absolute value of the difference between the radius of the target turning circle and the turning distance is greater than the threshold value, the automatic turning travel control unit may be configured to The work vehicle according to claim 1 or 2, wherein the escape control function is disabled.
前記自動旋回走行制御部は、前記旋回走行を制御する際に、あらかじめ定められた所定の操舵角度で前記機体を旋回させると共に、前記機体の進行方向に平行な直線と次に走行する前記直線経路とのなす角度が所定の角度以下になると前記旋回走行を終了させる請求項1または2に記載の作業車。
When controlling the turning, the automatic turning travel control unit turns the aircraft at a predetermined steering angle, and the automatic turning travel control unit rotates the aircraft at a predetermined steering angle, and selects a straight line parallel to the traveling direction of the aircraft and the straight line route to be traveled next. The work vehicle according to claim 1 or 2, wherein the turning travel is terminated when the angle formed by the vehicle becomes equal to or less than a predetermined angle.
JP2022095140A 2022-06-13 2022-06-13 work vehicle Pending JP2023181796A (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2022095140A JP2023181796A (en) 2022-06-13 2022-06-13 work vehicle
CN202211533422.6A CN117223447A (en) 2022-06-13 2022-12-01 Working vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2022095140A JP2023181796A (en) 2022-06-13 2022-06-13 work vehicle

Publications (1)

Publication Number Publication Date
JP2023181796A true JP2023181796A (en) 2023-12-25

Family

ID=89097286

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2022095140A Pending JP2023181796A (en) 2022-06-13 2022-06-13 work vehicle

Country Status (2)

Country Link
JP (1) JP2023181796A (en)
CN (1) CN117223447A (en)

Also Published As

Publication number Publication date
CN117223447A (en) 2023-12-15

Similar Documents

Publication Publication Date Title
JP7277520B2 (en) work vehicle
JP6860387B2 (en) Work platform
JP7091189B2 (en) Automatic driving system for work vehicles
KR101146066B1 (en) Control apparatus of work vehicle
KR20220099533A (en) Automated driving systems for work vehicles
JP6871831B2 (en) Autonomous driving system for work vehicles
JP2021166528A (en) Work vehicle
JP2023181796A (en) work vehicle
JP2021108594A (en) Agricultural implement
JP2023181795A (en) work vehicle
WO2020174839A1 (en) Autonomous traveling system
JP7132812B2 (en) work vehicle
JP2023181797A (en) work vehicle
WO2020044805A1 (en) Work vehicle autonomous travel system
KR20200121224A (en) Work vehicle
JP7471261B2 (en) Work vehicles and automatic driving control systems
JP2021108599A (en) Farm work vehicle
JP2023180809A (en) Paddy field work machine
JP2023091609A (en) Farm field work machine
JP7344453B2 (en) work vehicle
JP2023091610A (en) Paddy work machine
JP7343405B2 (en) agricultural vehicle
JP7447881B2 (en) work vehicle
JP2019004792A (en) Travel management system of workplace
JP2022099006A (en) Work vehicle