JP7398328B2 - work vehicle - Google Patents

work vehicle Download PDF

Info

Publication number
JP7398328B2
JP7398328B2 JP2020077088A JP2020077088A JP7398328B2 JP 7398328 B2 JP7398328 B2 JP 7398328B2 JP 2020077088 A JP2020077088 A JP 2020077088A JP 2020077088 A JP2020077088 A JP 2020077088A JP 7398328 B2 JP7398328 B2 JP 7398328B2
Authority
JP
Japan
Prior art keywords
line
orthogonal
automatic steering
virtual
predetermined direction
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.)
Active
Application number
JP2020077088A
Other languages
Japanese (ja)
Other versions
JP2021170988A (en
Inventor
洋三 都田
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.)
Mitsubishi Mahindra Agricultural Machinery Co Ltd
Original Assignee
Mitsubishi Mahindra Agricultural Machinery Co Ltd
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 Mitsubishi Mahindra Agricultural Machinery Co Ltd filed Critical Mitsubishi Mahindra Agricultural Machinery Co Ltd
Priority to JP2020077088A priority Critical patent/JP7398328B2/en
Publication of JP2021170988A publication Critical patent/JP2021170988A/en
Application granted granted Critical
Publication of JP7398328B2 publication Critical patent/JP7398328B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Description

本発明は、乗用田植機などの作業車両に関する。 The present invention relates to a working vehicle such as a riding rice transplanter.

等間隔に並列する複数の仮想ラインに沿って走行するように走行機体を自動的に操舵する自動操舵制御手段を備える作業車両が知られている(例えば、特許文献1参照)。このような作業車両では、運転者の操作負担を軽減できるだけでなく、作業精度が向上するという利点がある。 2. Description of the Related Art A work vehicle is known that includes an automatic steering control means that automatically steers a traveling body so as to travel along a plurality of parallel virtual lines arranged at equal intervals (see, for example, Patent Document 1). Such a work vehicle has the advantage of not only reducing the operational burden on the driver but also improving work accuracy.

特開2017-123804号公報Japanese Patent Application Publication No. 2017-123804

しかしながら、特許文献1の作業車両では、並列する1方向の仮想ラインにおいて自動操舵を行うに過ぎないため、2方向の作業走行が必要な場合には、手動操舵による走行比率が増加してしまい、自動操舵の利点を十分に活かせない虞がある。 However, since the work vehicle of Patent Document 1 only performs automatic steering on parallel virtual lines in one direction, when work travel in two directions is required, the travel ratio by manual steering increases. There is a risk that the benefits of automatic steering may not be fully utilized.

本発明は、上記の如き実情に鑑みこれらの課題を解決することを目的として創作されたものであって、請求項1の発明は、走行機体と、前記走行機体の学習走行に基づいて所定方向の基準ラインを演算する基準ライン演算手段と、前記基準ラインと平行で、かつ等間隔に並列する複数の所定方向仮想ラインを演算する所定方向仮想ライン演算手段と、前記走行機体の位置を検出する機体位置検出手段と、前記走行機体の現在位置から近い前記所定方向仮想ラインを目標ラインとし、該目標ラインに沿って走行するように前記走行機体を自動的に操舵する自動操舵制御手段と、を備える作業車両であって、所定の人為的切換え操作に応じて、前記所定方向と直交する方向に沿う直交方向仮想ラインを演算し、前記自動操舵制御手段の目標ラインを前記直交方向仮想ラインに切換える目標ライン切換え手段をさらに備えることを特徴とする。
請求項2の発明は、走行機体と、前記走行機体の学習走行に基づいて所定方向の基準ラインを演算する基準ライン演算手段と、前記基準ラインと平行で、かつ等間隔に並列する複数の所定方向仮想ラインを演算する所定方向仮想ライン演算手段と、前記走行機体の位置を検出する機体位置検出手段と、前記走行機体の現在位置から近い前記所定方向仮想ラインを目標ラインとし、該目標ラインに沿って走行するように前記走行機体を自動的に操舵する自動操舵制御手段と、を備える作業車両であって、前記走行機体が前記所定方向と直交する方向へ方向転換したことを判断する方向転換判断手段と、前記方向転換の判断に応じて、前記所定方向と直交する方向の直交方向仮想ラインを演算し、前記自動操舵制御手段の目標ラインを前記直交方向仮想ラインに切換える目標ライン切換え手段と、をさらに備えることを特徴とする。
請求項3の発明は、請求項2に記載の作業車両であって、前記走行機体の作業再開を判断する作業再開判断手段をさらに備え、前記目標ライン切換え手段は、前記方向転換及び前記作業再開の判断に応じて、前記所定方向と直交する方向の直交方向仮想ラインを演算し、前記自動操舵制御手段の目標ラインを前記直交方向仮想ラインに切換えることを特徴とする。
請求項4の発明は、請求項1~3のいずれか1項に記載の作業車両であって、前記目標ライン切換え手段は、前記自動操舵制御の目標ラインを切換えるとき、前記所定方向仮想ラインと前記直交方向仮想ラインを交互に切換えることを特徴とする。
The present invention has been created with the aim of solving these problems in view of the above-mentioned actual circumstances, and the invention of claim 1 is directed to a traveling aircraft and a predetermined direction based on learning travel of the traveling aircraft. a reference line calculation means for calculating a reference line, a predetermined direction virtual line calculation means for calculating a plurality of virtual lines in a predetermined direction that are parallel to the reference line and parallel at equal intervals, and detecting the position of the traveling aircraft. an aircraft position detection means; and an automatic steering control means that sets the virtual line in the predetermined direction near the current position of the traveling aircraft as a target line and automatically steers the traveling aircraft to travel along the target line. The work vehicle is provided with a work vehicle, which calculates a virtual line in an orthogonal direction along a direction orthogonal to the predetermined direction in response to a predetermined artificial switching operation, and switches a target line of the automatic steering control means to the virtual line in the orthogonal direction. The present invention is characterized in that it further includes target line switching means.
The invention according to claim 2 provides a traveling aircraft; a reference line calculating means for calculating a reference line in a predetermined direction based on learning travel of the traveling aircraft; and a plurality of predetermined lines parallel to the reference line and arranged at equal intervals. a predetermined direction virtual line calculation means for calculating a direction virtual line; an aircraft position detection means for detecting the position of the traveling aircraft; and a predetermined direction virtual line close to the current position of the traveling aircraft as a target line; automatic steering control means for automatically steering the traveling aircraft so as to travel along the same direction, and a direction change for determining that the traveling aircraft has changed direction in a direction perpendicular to the predetermined direction. determination means; and target line switching means for calculating an orthogonal virtual line in a direction perpendicular to the predetermined direction and switching the target line of the automatic steering control means to the orthogonal virtual line in accordance with the direction change determination. , further comprising:
The invention according to claim 3 is the work vehicle according to claim 2, further comprising a work resumption determining means for determining whether to restart work of the traveling body, and wherein the target line switching means determines whether the direction change and the work resumption are necessary. According to the determination, an orthogonal virtual line in a direction orthogonal to the predetermined direction is calculated, and the target line of the automatic steering control means is switched to the orthogonal virtual line.
The invention according to claim 4 is the work vehicle according to any one of claims 1 to 3, wherein the target line switching means is configured to switch between the virtual line in the predetermined direction and the virtual line in the predetermined direction when switching the target line of the automatic steering control. The present invention is characterized in that the virtual lines in the orthogonal directions are alternately switched.

請求項1の発明によれば、所定の人為的切換え操作に応じて、自動操舵制御手段の目標ラインを直交方向仮想ラインに切換える目標ライン切換え手段を備えるので、所定方向だけでなく、その直交方向の作業走行でも自動操舵を適用することができる。また、所定の人為的切換え操作に応じて、所定方向と直交する方向に沿う直交方向仮想ラインを演算するので、圃場の外形データが取得できない場合でも、自動操舵の適用範囲を広げることができる。
請求項2の発明によれば、走行機体の方向転換に応じて、自動操舵制御手段の目標ラインを直交方向仮想ラインに切換える目標ライン切換え手段を備えるので、所定方向だけでなく、その直交方向の作業走行でも自動操舵を適用することができる。また、方向転換の判断に応じて、自動操舵制御手段の目標ラインを直交方向仮想ラインに切換えるので、人為的な切換え操作を不要とし、作業者の操作負担をさらに低減させることができる。また、方向転換の判断に応じて、所定方向と直交する方向に沿う直交方向仮想ラインを演算するので、圃場の外形データが取得できない場合でも、自動操舵の適用範囲を広げることができる。
請求項3の発明によれば、方向転換及び作業再開の判断に応じて、所定方向と直交する方向の直交方向仮想ラインを演算し、自動操舵制御手段の目標ラインを直交方向仮想ラインに切換えるので、目標ラインの誤った切換えを抑制し、自動操舵の信頼性を高めることができる。
請求項4の発明によれば、自動操舵制御の目標ラインを切換えるとき、所定方向走行仮想ラインと直交方向仮想ラインを交互に切換えるので、圃場の4辺を周回状に走行する枕地走行などにおける利便性を向上させることができる。
According to the invention of claim 1, since the target line switching means is provided for switching the target line of the automatic steering control means to the orthogonal direction virtual line in response to a predetermined artificial switching operation, Automatic steering can also be applied during work driving. In addition, since a virtual line in an orthogonal direction along a direction orthogonal to the predetermined direction is calculated in response to a predetermined artificial switching operation, the range of application of automatic steering can be expanded even when the external shape data of the field cannot be obtained.
According to the invention of claim 2, since the target line switching means is provided for switching the target line of the automatic steering control means to the orthogonal direction virtual line in response to the direction change of the traveling aircraft, Automatic steering can also be applied during work driving. Further, since the target line of the automatic steering control means is switched to the orthogonal direction virtual line in accordance with the judgment of direction change, a manual switching operation is not required, and the operational burden on the operator can be further reduced. In addition, since a virtual line in an orthogonal direction along a direction orthogonal to a predetermined direction is calculated in accordance with the determination of a direction change, the range of application of automatic steering can be expanded even when external shape data of the field cannot be obtained.
According to the invention of claim 3, a virtual line in the orthogonal direction in a direction perpendicular to the predetermined direction is calculated and the target line of the automatic steering control means is switched to the virtual line in the orthogonal direction in accordance with the judgment to change direction and restart work. , it is possible to suppress erroneous switching of the target line and improve the reliability of automatic steering.
According to the invention of claim 4, when switching the target line of the automatic steering control, the predetermined direction traveling virtual line and the orthogonal direction virtual line are alternately switched, so that when traveling on a headland, etc., traveling in a circular manner around the four sides of a field, etc. Convenience can be improved.

本発明の実施形態に係る乗用田植機の側面図である。FIG. 1 is a side view of a riding rice transplanter according to an embodiment of the present invention. 乗用田植機の平面図である。It is a top view of a riding rice transplanter. 自動操舵ユニットを示す図であり、(A)は自動操舵ユニットの斜視図、(B)は自動操舵ユニットの操作パネルを示す正面図である。FIG. 2 is a diagram showing an automatic steering unit, in which (A) is a perspective view of the automatic steering unit, and (B) is a front view showing an operation panel of the automatic steering unit. 乗用田植機の制御構成を示すブロック図である。FIG. 2 is a block diagram showing the control configuration of the riding rice transplanter. 入場から作業開始までの走行経路を示す説明図である。FIG. 2 is an explanatory diagram showing a travel route from entry to the start of work. 作業開始から退場までの走行経路を示す説明図であり、植付位置合わせを省いた説明図である。It is an explanatory diagram showing a running route from the start of work to exit, and is an explanatory diagram omitting planting position alignment. 作業開始から退場までの走行経路を示す説明図であり、植付位置合わせを含む説明図である。It is an explanatory diagram showing a driving route from the start of work to exit, and is an explanatory diagram including planting position alignment. ティーチング走行制御の処理手順を示すフローチャートである。It is a flowchart which shows the processing procedure of teaching travel control. 自動操舵制御の処理手順を示すフローチャートである。3 is a flowchart showing a processing procedure of automatic steering control. 直交線作成/方向切換え制御(第1モード)の処理手順を示すフローチャートである。It is a flowchart which shows the processing procedure of orthogonal line creation/direction switching control (1st mode). 直交線作成/方向切換え制御(第2モード)の処理手順を示すフローチャートである。It is a flowchart which shows the processing procedure of orthogonal line creation/direction switching control (2nd mode). 直交線作成/方向切換え制御(第3モード)の処理手順を示すフローチャートである。It is a flowchart which shows the processing procedure of orthogonal line creation/direction switching control (3rd mode).

(作業車両)
以下、本発明の実施の形態について、図面に基づいて説明する。図1及び図2において、1は乗用田植機P(作業車両)の走行機体であって、該走行機体1の後部には、昇降リンク機構2を介して植付作業機3が昇降可能に連結されている。
(work vehicle)
Embodiments of the present invention will be described below based on the drawings. In FIGS. 1 and 2, 1 is a traveling body of a riding rice transplanter P (work vehicle), and a planting work machine 3 is connected to the rear of the traveling body 1 via an elevating link mechanism 2 so as to be able to be raised and lowered. has been done.

植付作業機3は、マット苗が載置される苗載台4と、苗載台4の下端部から苗を掻き取って圃場に植え付ける植付機構5とを備える。本実施形態の植付作業機3は、同時に8条分の苗を植え付け可能な8条植え仕様であり、8つの植付機構5が車幅方向に所定間隔を存して並設されている。 The planting machine 3 includes a seedling platform 4 on which the mat seedlings are placed, and a planting mechanism 5 that scrapes the seedlings from the lower end of the seedling platform 4 and plants them in the field. The planting machine 3 of this embodiment has an 8-row planting specification that can simultaneously plant 8 rows of seedlings, and eight planting mechanisms 5 are arranged in parallel at predetermined intervals in the vehicle width direction. .

走行機体1は、エンジン(図示せず)が搭載されるエンジン搭載部6と、エンジン動力を変速し、走行動力及び作業動力として出力するミッションケース7と、ミッションケース7が出力する走行動力で駆動され、かつ、ステアリングハンドル8の操作に応じて操舵される前輪9と、ミッションケース7が出力する走行動力で駆動される後輪10と、作業者が乗車する操縦部11とを備える。なお、走行機体1は、次行程に目標走行ラインを引く左右一対のマーカ装置12を備えるが、本実施形態では使用しないため、詳細な説明は省略する。 The traveling aircraft 1 includes an engine mounting section 6 in which an engine (not shown) is mounted, a transmission case 7 that changes the speed of engine power and outputs it as traveling power and working power, and is driven by the traveling power outputted by the mission case 7. and a front wheel 9 that is steered according to the operation of a steering handle 8, a rear wheel 10 that is driven by the driving power output from a transmission case 7, and a control section 11 on which an operator rides. Note that the traveling body 1 includes a pair of left and right marker devices 12 for drawing a target traveling line in the next stroke, but since they are not used in this embodiment, a detailed explanation will be omitted.

操縦部11は、作業者が座る運転席13と、運転席13の前方に配置される前述のステアリングハンドル8と、走行動力及び作業動力を変速操作する主変速レバー14と、主変速レバー14の変速レンジを切り換える副変速レバー(図示せず)と、植付作業機3の昇降操作具及び植付クラッチ操作具を兼ねる作業機昇降レバー(図示せず)とを備える。 The control section 11 includes a driver's seat 13 on which a worker sits, the aforementioned steering handle 8 disposed in front of the driver's seat 13, a main shift lever 14 for shifting the traveling power and working power, and a main shift lever 14. It is provided with a sub-shift lever (not shown) for switching the speed range, and a work machine lift lever (not shown) that also serves as a lift operation tool for the planting work machine 3 and a planting clutch operation tool.

図3の(A)に示すように、ステアリングハンドル8には、自動操舵ユニット15が連結されている。自動操舵ユニット15は、ステアリングハンドル8の手動操作に代えて、ステアリングハンドル8をモータ動力で回転操作するステアリングモータ16(図4参照)と、後述する自動操舵制御関連の操作具及びモニタランプが配置される操作パネル17とを備える。なお、ステアリングモータ16の駆動中でもステアリングハンドル8の手動操作は許容される。 As shown in FIG. 3A, an automatic steering unit 15 is connected to the steering handle 8. The automatic steering unit 15 includes a steering motor 16 (see FIG. 4) that rotates the steering wheel 8 using motor power instead of manual operation of the steering wheel 8, and automatic steering control-related operating tools and monitor lamps, which will be described later. and an operation panel 17. Note that manual operation of the steering handle 8 is allowed even while the steering motor 16 is being driven.

図3の(B)に示すように、操作パネル17には、電源スイッチ18と、自動操舵制御が自動操舵を行わない自動操舵オフ状態から自動操舵を行う自動操舵オン状態への切換操作や自動操舵オン状態から自動操舵オフ状態への切換操作が可能な自動操舵スイッチ19と、後述する始点A点を登録する始点A点登録スイッチ20と、後述する終点B点を登録する終点B点登録スイッチ21と、後述する直交線作成/方向切換えを行う直交線作成/方向切換えスイッチ22と、ランプ表示による報知を行う報知表示部23と、を備える。報知表示部23には、速度超過を報知する速度超過報知ランプ23aと、速度アップ可能状態を報知する速度アップOK報知ランプ23bと、目標ライン上を走行していることを報知する目標ライン上報知ランプ23cと、が含まれる。なお、各スイッチ19~24には、その切換状態を表示するランプ19a~22aが並設されている。 As shown in FIG. 3B, the operation panel 17 includes a power switch 18 and a switch operation for switching the automatic steering control from an automatic steering off state in which automatic steering is not performed to an automatic steering on state in which automatic steering is performed. An automatic steering switch 19 that can switch from a steering on state to an automatic steering off state, a starting point A point registration switch 20 that registers a starting point A, which will be described later, and an ending point B registration switch, which registers an ending point B, which will be described later. 21, an orthogonal line creation/direction switch 22 that performs orthogonal line creation/direction switching, which will be described later, and a notification display section 23 that provides notification by lamp display. The notification display section 23 includes an overspeed notification lamp 23a that notifies you of overspeeding, a speed up OK notification lamp 23b that notifies you that speeding up is possible, and an on-target line notification that notifies you that you are traveling on the target line. A lamp 23c is included. Note that lamps 19a to 22a are arranged in parallel to each of the switches 19 to 24 to display their switching states.

また、図1及び図2に示すように、操縦部11には、正面視冂字状の測位用フレーム25が立設されている。測位用フレーム25は、上方に延在する左右一対の縦フレーム部25aと、左右の縦フレーム部25aの上端部同士を連結する横フレーム部25bとを有する。横フレーム部25bには、後述する測位システム26の構成要素である2つのGNSSアンテナ27、28などが取付けられ、左右いずれか一方の縦フレーム25aには、ナビゲーション表示などを行うタブレット29が取付けられている。 Further, as shown in FIGS. 1 and 2, a positioning frame 25 having a square shape when viewed from the front is erected on the control unit 11. The positioning frame 25 includes a pair of left and right vertical frame parts 25a that extend upward, and a horizontal frame part 25b that connects the upper ends of the left and right vertical frame parts 25a. Two GNSS antennas 27 and 28, which are components of a positioning system 26 to be described later, are attached to the horizontal frame portion 25b, and a tablet 29 for displaying navigation, etc. is attached to either the left or right vertical frame 25a. ing.

(測位システム及び制御部)
図4に示すように、走行機体1は、自動操舵制御(自動操舵制御手段)を行うための制御構成として、測位システム26(機体位置検出手段)及び制御部30を備える。測位システム26としては、例えば、数cmの誤差で高精度な測位が可能なRTK-GNSS測位システムが採用される。RTK-GNSS測位システムは、固定設置された基地局と、移動する移動局とのそれぞれで、GPSなどのGNSS測位を行い、基地局から移動局に送信される補正信号でリアルタイムに測位データを補正することで、誤差数cmの高精度な測位を実現するものである。また、移動局に所定の間隔をあけて2つのGNSSアンテナを設置すれば、移動局の絶対位置だけでなく、2つの測位結果に基づいて、移動局の進行方向(方位)も高精度に検出することが可能になる。
(Positioning system and control unit)
As shown in FIG. 4, the traveling aircraft 1 includes a positioning system 26 (aircraft position detection means) and a control unit 30 as a control configuration for performing automatic steering control (automatic steering control means). As the positioning system 26, for example, an RTK-GNSS positioning system that can perform highly accurate positioning with an error of several centimeters is adopted. The RTK-GNSS positioning system performs GNSS positioning such as GPS at a fixed base station and a moving mobile station, and corrects the positioning data in real time using a correction signal sent from the base station to the mobile station. By doing so, highly accurate positioning with an error of several centimeters is achieved. In addition, by installing two GNSS antennas at a predetermined interval on a mobile station, not only the absolute position of the mobile station but also the direction of movement (azimuth) of the mobile station can be detected with high precision based on the two positioning results. It becomes possible to do so.

具体的に説明すると、本実施形態の測位システム26は、図4に示すように、RTK-GNSS測位を実行する制御ユニットであるGNSSユニット31と、測位用フレーム25の横フレーム部25bに車幅方向に所定の間隔をあけて取付けられる基準用GNSSアンテナ27及び方位用GNSSアンテナ28と、固定設置されるRTK基地局32から補正信号を受信する補正信号受信装置33とを備える。GNSSユニット31は、RTK-GNSS測位による測位データ(絶対位置データ及び進行方向データ)を、CANなどの有線通信手段を介して制御部30に送信するとともに、Bluetooth(登録商標)などの無線通信手段を介してタブレット29に送信する。 Specifically, as shown in FIG. 4, the positioning system 26 of this embodiment includes a GNSS unit 31, which is a control unit that executes RTK-GNSS positioning, and a horizontal frame portion 25b of the positioning frame 25, which has a vehicle width. It includes a reference GNSS antenna 27 and a direction GNSS antenna 28 that are installed at a predetermined interval in the direction, and a correction signal receiving device 33 that receives a correction signal from a fixedly installed RTK base station 32. The GNSS unit 31 transmits positioning data (absolute position data and traveling direction data) obtained by RTK-GNSS positioning to the control unit 30 via a wired communication means such as CAN, and also transmits positioning data (absolute position data and traveling direction data) through a wireless communication means such as Bluetooth (registered trademark). The data is sent to the tablet 29 via the .

制御部30は、自動操舵制御を実行する制御ユニットであり、制御部30の入力側には、前述した自動操舵スイッチ19、始点A点登録スイッチ20、終点B点登録スイッチ21及び直交線作成/方向切換えスイッチ22に加え、主変速レバー14の操作位置を検出する主変速レバーセンサ35と、副変速レバーの操作位置を検出する副変速レバーセンサ36と、前輪9の操舵角を検出する操舵角センサ37と、走行機体1の車速を検出する車速センサ38と、車軸の回転(走行距離)を検出する回転センサ39と、植付クラッチの入り/切りを検出する植付クラッチセンサ40と、が接続される一方、制御部30の出力側には、前述したステアリングモータ16及び報知表示部23に加え、報知音を出力する報知ブザー41が接続されている。 The control unit 30 is a control unit that executes automatic steering control, and on the input side of the control unit 30, the above-mentioned automatic steering switch 19, start point A point registration switch 20, end point B point registration switch 21, and orthogonal line creation / In addition to the direction changeover switch 22, there is a main shift lever sensor 35 that detects the operating position of the main shift lever 14, an auxiliary shift lever sensor 36 that detects the operating position of the auxiliary shift lever, and a steering angle that detects the steering angle of the front wheels 9. A sensor 37, a vehicle speed sensor 38 that detects the vehicle speed of the traveling body 1, a rotation sensor 39 that detects rotation of the axle (traveling distance), and a planting clutch sensor 40 that detects engagement/disengagement of the planting clutch. On the other hand, on the output side of the control section 30, in addition to the aforementioned steering motor 16 and notification display section 23, a notification buzzer 41 that outputs notification sound is connected.

(自動操舵制御)
自動操舵制御は、予め演算された所定方向の仮想ライン(LY1、LY2、…LYn)に沿って走行するように走行機体1を自動的に操舵する自動制御機能である。図5に示すように、仮想ライン(LY1、LY2、…LYn)は、最初の植付作業行程である基準ライン(LY0)の始点位置で始点A点登録スイッチ20を操作して始点A点の測位データを登録するとともに、基準ライン(LY0)の終点位置で終点B点登録スイッチ21を操作して終点B点の測位データを登録すると、後述するティーチング走行制御によって自動的に演算される。具体的には、基準ライン(LY0)と平行で、かつ等間隔(作業幅間隔)に並列する複数の仮想ライン(LY1、LY2、…LYn)が演算される。
(Automatic steering control)
The automatic steering control is an automatic control function that automatically steers the traveling aircraft 1 so as to travel along virtual lines (LY1, LY2, . . . LYn) in a predetermined direction calculated in advance. As shown in FIG. 5, the virtual lines (LY1, LY2,...LYn) are created by operating the starting point A registration switch 20 at the starting point position of the reference line (LY0), which is the first planting process. When the positioning data is registered and the end point B registration switch 21 is operated at the end point position of the reference line (LY0) to register the positioning data of the end point B, it is automatically calculated by the teaching travel control described later. Specifically, a plurality of virtual lines (LY1, LY2, . . . LYn) parallel to the reference line (LY0) and arranged at equal intervals (working width intervals) are calculated.

自動操舵制御では、演算した仮想ライン(LY1、LY2、…LYn)のうち最も走行機体1に近い仮想ラインを目標ラインとし、該目標ラインの座標データと、測位システム26による走行機体1の測位データに基づいて、目標ラインに対する走行機体1の横ズレ量D及びズレ方向θを演算するとともに、横ズレ量D及びズレ方向θに基づいて修正操舵角θsを演算し、該修正操舵角θsをステアリングモータ16に出力することにより、走行機体1を目標ラインに沿って走行させる。 In automatic steering control, the virtual line closest to the traveling aircraft 1 among the calculated virtual lines (LY1, LY2, ... LYn) is set as the target line, and the coordinate data of the target line and the positioning data of the traveling aircraft 1 by the positioning system 26 are used. Based on this, calculate the lateral deviation amount D and deviation direction θ of the traveling aircraft 1 with respect to the target line, calculate the corrected steering angle θs based on the lateral deviation amount D and the deviation direction θ, and use the corrected steering angle θs as the steering wheel. By outputting the power to the motor 16, the traveling body 1 is caused to travel along the target line.

走行機体1が目標の終点位置に到達したら、作業者によるステアリングハンドル8の手動操作に基づいて、走行機体1を次の目標ラインの始点位置に向けて枕地旋回させる。走行機体1が次の目標ラインの始点位置に到達すると、手動又は自動で自動操舵制御が再開され、走行機体1は、次の目標ラインに沿って走行する。 When the traveling body 1 reaches the target end point position, the traveling body 1 is turned into a headland toward the starting point position of the next target line based on the operator's manual operation of the steering handle 8. When the traveling aircraft 1 reaches the starting point position of the next target line, automatic steering control is restarted manually or automatically, and the traveling aircraft 1 travels along the next target line.

図6及び図7に示すように、通常の田植作業では、所定方向(Y方向)の仮想ライン(LY1、LY2、…LYn)に沿った植付けを行った後、その周囲に残った未植え領域である枕地の植付けを行う。枕地の植付作業は、所定方向(Y方向)の仮想ライン(LY1、LY2、…LYn)と直交する方向(X方向)の枕地植付走行と、所定方向(Y方向)の仮想ライン(LY1、LY2、…LYn)と平行する方向(Y方向)の枕地植付走行が交互に発生する。従来の自動操舵制御は、所定方向(Y方向)の仮想ライン(LY1、LY2、…LYn)と平行する方向(Y方向)の枕地植付走行においては適用可能であるが、所定方向(Y方向)の仮想ライン(LY1、LY2、…LYn)と直交する方向(X方向)の枕地植付走行においては適用が困難であった。 As shown in FIGS. 6 and 7, in normal rice planting work, after planting along virtual lines (LY1, LY2,...LYn) in a predetermined direction (Y direction), the unplanted area remaining around them Planting will be carried out on the headland. Headland planting work consists of headland planting travel in a direction (X direction) orthogonal to the virtual line (LY1, LY2,...LYn) in a predetermined direction (Y direction), and virtual line planting in a predetermined direction (Y direction). Headland planting runs in the direction (Y direction) parallel to (LY1, LY2, ... LYn) occur alternately. Conventional automatic steering control can be applied to headland planting travel in a direction (Y direction) parallel to the virtual line (LY1, LY2, ... LYn) in a predetermined direction (Y direction), but It was difficult to apply this method to headland planting travel in a direction (X direction) perpendicular to the virtual line (LY1, LY2, ...LYn) of the direction (direction).

(直交線作成/方向切換え制御:第1モード)
本実施形態の自動操舵制御は、所定の人為的切換え操作である直交線作成/方向切換えスイッチ22の操作に応じて、所定方向(Y方向)の仮想ライン(LY1、LY2、…LYn)と直交する方向(X方向)に沿い、かつ現在の機体位置を含む直交方向の仮想ライン(LX)を演算し、自動操舵制御の目標ラインを直交方向の仮想ライン(LX)に切換える直交線作成/方向切換え制御機能(目標ライン切換え手段)を備える。
(Orthogonal line creation/direction switching control: 1st mode)
The automatic steering control of this embodiment is configured to orthogonal to virtual lines (LY1, LY2,...LYn) in a predetermined direction (Y direction) in accordance with the operation of the orthogonal line creation/direction changeover switch 22, which is a predetermined artificial switching operation. Orthogonal line creation/direction that calculates an orthogonal virtual line (LX) along the direction (X direction) and including the current aircraft position, and switches the automatic steering control target line to the orthogonal virtual line (LX) Equipped with a switching control function (target line switching means).

このような制御機能によれば、所定の人為的切換え操作に応じて、自動操舵制御の目標ラインを直交方向(X方向)の仮想ライン(LX)に切換えることができるので、所定方向(Y方向)の作業走行だけでなく、その直交方向(X方向)の作業走行でも自動操舵を適用することができる。また、所定の人為的切換え操作に応じて、所定方向(Y方向)と直交する方向(X方向)に沿う仮想ライン(LX)を演算するので、圃場の外形データが取得できない場合でも、自動操舵制御の適用範囲を広げることができる。 According to such a control function, the target line of automatic steering control can be switched to the virtual line (LX) in the orthogonal direction (X direction) in accordance with a predetermined artificial switching operation. ), automatic steering can be applied not only to work travel in the direction (X direction) but also to work travel in the orthogonal direction (X direction). In addition, since a virtual line (LX) along a direction (X direction) orthogonal to a predetermined direction (Y direction) is calculated in response to a predetermined artificial switching operation, automatic steering can be performed even when field outline data cannot be obtained. The scope of control can be expanded.

また、直交線作成/方向切換え制御機能は、自動操舵制御の目標ラインを切換えるとき、所定方向の仮想ライン(LY1、LY2、…LYn)と直交方向の仮想ライン(LX)を交互に切換えることが好ましい。このようにすると、圃場の4辺を周回状に走行する枕地走行などにおける利便性を向上させることができる。 In addition, the orthogonal line creation/direction switching control function can alternately switch the virtual line in a predetermined direction (LY1, LY2,...LYn) and the virtual line in the orthogonal direction (LX) when switching the target line for automatic steering control. preferable. In this way, it is possible to improve convenience when traveling on a headland where the vehicle travels in a circular manner around the four sides of the field.

(直交線作成/方向切換え制御:第2モード)
また、直交線作成/方向切換え制御は、走行機体1が所定方向(Y方向)と直交する方向(X方向)へ方向転換したことを判断し(方向転換判断手段)、この方向転換の判断に応じて、所定方向(Y方向)と直交する方向(X方向)の仮想ライン(LX)を演算し、自動操舵制御の目標ラインを直交方向の仮想ライン(LX)に切換えるようにしてもよい。
(Orthogonal line creation/direction switching control: 2nd mode)
In addition, the orthogonal line creation/direction switching control determines that the traveling aircraft 1 has changed direction in a direction (X direction) orthogonal to a predetermined direction (Y direction) (direction change determination means), and Accordingly, a virtual line (LX) in a direction (X direction) orthogonal to the predetermined direction (Y direction) may be calculated, and the target line for automatic steering control may be switched to the virtual line (LX) in the orthogonal direction.

このような制御機能によれば、走行機体1の方向転換の判断に応じて、自動操舵制御の目標ラインを直交方向の仮想ライン(LX)に切換えるので、人為的な切換え操作を不要とし、作業者の操作負担をさらに低減させることができる。 According to such a control function, the target line of the automatic steering control is switched to the virtual line (LX) in the orthogonal direction in accordance with the judgment of the direction change of the traveling aircraft 1, thereby eliminating the need for a manual switching operation and reducing the work time. The operational burden on the operator can be further reduced.

また、直交線作成/方向切換え制御は、走行機体1の方向転換だけでなく、作業再開(植付クラッチ入り)の判断に応じて(作業再開判断手段)、所定方向(Y方向)と直交する方向(X方向)の仮想ライン(LX)を演算し、自動操舵制御の目標ラインを直交方向の仮想ライン(LX)に切換えるようにしてもよい。このようにすると、目標ラインの誤った切換えを抑制し、自動操舵制御の信頼性を高めることができる。 In addition, the orthogonal line creation/direction switching control not only changes the direction of the traveling body 1, but also creates a line that is orthogonal to a predetermined direction (Y direction) according to the judgment of restarting work (planting clutch engagement) (work restart judgment means). A virtual line (LX) in the direction (X direction) may be calculated and the target line for automatic steering control may be switched to the virtual line (LX) in the orthogonal direction. In this way, it is possible to suppress erroneous switching of the target line and improve the reliability of automatic steering control.

(直交線作成/方向切換え制御:第3モード)
上述した第1モード及び第2モードの直交線作成/方向切換え制御は、圃場の外形データを事前に取得できない場合を想定しているが、第3モードの直交線作成/方向切換え制御は、圃場の外形データを事前に取得し、この外形データに基づいて、少なくとも2方向(Y方向及びX方向)の仮想ライン(LY1・・・、LX1・・・)を予め演算し、これを仮想ラインデータとして記憶することを想定している。なお、2方向は、必ずしも直交する方向である必要はない。また、仮想ラインデータは、3方向以上の仮想ラインを含んでもよい。
(Orthogonal line creation/direction switching control: 3rd mode)
The above-mentioned orthogonal line creation/direction switching control in the first and second modes assumes a case where the external shape data of the field cannot be obtained in advance, but the orthogonal line creation/direction switching control in the third mode Acquire the external shape data in advance, calculate virtual lines (LY1..., LX1...) in at least two directions (Y direction and X direction) in advance based on this external shape data, and convert this into virtual line data. It is assumed that it will be stored as . Note that the two directions do not necessarily have to be orthogonal. Further, the virtual line data may include virtual lines in three or more directions.

具体的に説明すると、第3モードの直交線作成/方向切換え制御は、所定の人為的切換え操作である直交線作成/方向切換えスイッチ22の操作に応じて、現在の機体方向と近い方向の仮想ライン(予め演算したY方向の仮想ライン、又はX方向の仮想ライン)を選択し、自動操舵制御の目標ラインを選択した仮想ラインに切換えるものである。このような制御機能であっても、1方向だけでなく、少なくとも2方向の作業走行で自動操舵制御を適用することができる。なお、第3モードの直交線作成/方向切換え制御では、所定の人為的切換え操作に代えて、第2モードのような走行機体1の方向転換や作業再開の判断に応じて仮想ラインの切換えを行うようにしてもよい。 To be more specific, the third mode of orthogonal line creation/direction switching control is based on the operation of the orthogonal line creation/direction changeover switch 22, which is a predetermined artificial switching operation, to create a virtual direction close to the current aircraft direction. A line (a pre-calculated virtual line in the Y direction or a virtual line in the X direction) is selected, and the target line for automatic steering control is switched to the selected virtual line. Even with such a control function, automatic steering control can be applied not only to one direction but also to at least two directions of work travel. In addition, in the third mode of orthogonal line creation/direction switching control, instead of the predetermined artificial switching operation, virtual line switching is performed according to the judgment of changing the direction of the traveling aircraft 1 or restarting work as in the second mode. You may also do so.

(制御部の処理手順)
つぎに、上記のような制御機能を実現するティーチング走行制御、自動操舵制御及び直交線作成/方向切換え制御(第1モード~第3モード)の処理手順について、図8~図12を参照して説明する。なお、直交線作成/方向切換え制御のモードは、所定の操作に基づいて任意に切換えられるものとする。また。フローチャートでは、ラインを線と表記する場合がある。
(Control unit processing procedure)
Next, the processing procedures of teaching travel control, automatic steering control, and orthogonal line creation/direction switching control (first mode to third mode) that realize the above control functions will be explained with reference to FIGS. 8 to 12. explain. Note that the orthogonal line creation/direction switching control mode can be arbitrarily switched based on a predetermined operation. Also. In flowcharts, lines are sometimes expressed as lines.

制御部30は、基準ライン(LY0)の走行に際してティーチング走行制御を実行する。図8に示すように、ティーチング走行制御を実行する制御部30は、基準ライン(LY0)の始点位置における始点A点登録スイッチ20の操作に応じて始点A点の測位データを登録するとともに(S101)、基準ライン(LY0)の終点位置における終点B点登録スイッチ21の操作に応じて終点B点の測位データを登録する(S102)。つぎに、制御部30は、始点A点の測位データ及び終点B点の測位データに基づいて基準ライン(LY0)の座標を演算するとともに(S103)、基準ライン(LY0)と所定間隔を介して平行する所定方向(Y方向)の仮想ライン(LY1、LY2、…LYn)の座標を演算する(S104)。 The control unit 30 executes teaching travel control when traveling on the reference line (LY0). As shown in FIG. 8, the control unit 30 that executes teaching travel control registers the positioning data of the starting point A according to the operation of the starting point A point registration switch 20 at the starting point position of the reference line (LY0) (S101 ), the positioning data of the end point B is registered in response to the operation of the end point B registration switch 21 at the end point position of the reference line (LY0) (S102). Next, the control unit 30 calculates the coordinates of the reference line (LY0) based on the positioning data of the starting point A and the positioning data of the ending point B (S103), and also calculates the coordinates of the reference line (LY0) through a predetermined interval. The coordinates of virtual lines (LY1, LY2, . . . LYn) in a parallel predetermined direction (Y direction) are calculated (S104).

図9に示すように、自動操舵制御を実行する制御部30は、まず、現在位置から近い任意の仮想ライン(LY1、LY2、…LYn)を目標ラインとして設定した後(S201)、サブルーチンである直交線作成/方向切換え制御を実行する(S202)。制御部30は、サブルーチン実行後、自動操舵ON状態であるか否かを判断し(S203)、この判断結果がYESの場合は、走行機体1の目標ラインに対する横ずれ量Dが所定量Dt以下であるか否かを判断するとともに(S204)、走行機体1の目標ラインに対するずれ方向θが所定角θt以下であるか否かを判断する(S205)。 As shown in FIG. 9, the control unit 30 that executes automatic steering control first sets any virtual line (LY1, LY2,...LYn) close to the current position as a target line (S201), and then executes a subroutine. Orthogonal line creation/direction switching control is executed (S202). After executing the subroutine, the control unit 30 determines whether the automatic steering is in the ON state (S203), and if the determination result is YES, the lateral deviation amount D of the traveling aircraft 1 with respect to the target line is less than or equal to the predetermined amount Dt. It is determined whether or not there is one (S204), and it is also determined whether the deviation direction θ of the traveling aircraft 1 with respect to the target line is less than or equal to a predetermined angle θt (S205).

制御部30は、ステップS204及びS205の判断結果がいずれもYESの場合、走行機体1の走行速度を上げられる旨の報知を行う(S206)。一方、制御部30は、ステップS204及びS205の少なくとも一方の判断結果がNOの場合、横ズレ量D及びズレ方向θに基づいて修正操舵角θsを演算し(S207)、該修正操舵角θsをステアリングモータ16に出力するとともに(S208)、現行速度Vが所定値Vt以上であるか否かを判断し(S209)、この判断結果がYESの場合は、速度超過の警告報知を行う(S210)。 If the determination results in steps S204 and S205 are both YES, the control unit 30 notifies that the traveling speed of the traveling aircraft 1 can be increased (S206). On the other hand, if the determination result in at least one of steps S204 and S205 is NO, the control unit 30 calculates the corrected steering angle θs based on the lateral deviation amount D and the deviation direction θ (S207), and calculates the corrected steering angle θs. At the same time as outputting to the steering motor 16 (S208), it is determined whether the current speed V is equal to or higher than a predetermined value Vt (S209), and if the result of this determination is YES, a warning of excessive speed is issued (S210). .

図10に示すように、直交線作成/方向切換え制御(第1モード)を実行する制御部30は、現在の目標ライン設定(目標ラインとする仮想ラインの方向)がY方向であるか否かを判断しつつ(S301)、直交線作成/方向切換えスイッチ22の操作を判断する(S302、S303)。制御部30は、ステップS301の判断結果に拘わらず、ステップS302、S303の判断結果がNOである場合は、そのまま上位ルーチンに復帰するが、ステップS301及びステップS302の判断結果がいずれもYESの場合は、現在位置を基準としたX方向の仮想ライン(LX)を作成するとともに(S304)、目標ライン設定をX方向仮想ラインに切換える(S305)。また、制御部30は、ステップS301の判断結果がNOで、かつステップS302の判断結果がYESの場合は、目標ライン設定をY方向仮想ラインに切換える(S306)。 As shown in FIG. 10, the control unit 30 that executes orthogonal line creation/direction switching control (first mode) determines whether the current target line setting (direction of the virtual line to be the target line) is the Y direction. While determining this (S301), the operation of the orthogonal line creation/direction changeover switch 22 is determined (S302, S303). Regardless of the determination result in step S301, if the determination results in steps S302 and S303 are NO, the control unit 30 returns to the upper routine as is, but if the determination results in step S301 and step S302 are both YES, the control unit 30 creates a virtual line (LX) in the X direction based on the current position (S304), and switches the target line setting to the virtual line in the X direction (S305). Further, if the determination result in step S301 is NO and the determination result in step S302 is YES, the control unit 30 switches the target line setting to the Y-direction virtual line (S306).

図11に示すように、直交線作成/方向切換え制御(第2モード)を実行する制御部30は、まず、走行機体1の方向転換を判断する(S401~S404)。具体的に説明すると、制御部30は、所定距離又は所定時間略Y方向を走行し(S401:YES)、かつその後に所定距離又は所定時間略X方向を走行したと判断した場合(S402:YES)、走行機体1がY方向からX方向に方向転換したと判断し、一方、所定距離又は所定時間略X方向を走行し(S403:YES)、かつその後に所定距離又は所定時間略Y方向を走行したと判断した場合(S404:YES)、走行機体1がX方向からY方向に方向転換したと判断する。 As shown in FIG. 11, the control unit 30 that executes the orthogonal line creation/direction switching control (second mode) first determines the direction change of the traveling aircraft 1 (S401 to S404). Specifically, when the control unit 30 determines that the vehicle has traveled approximately in the Y direction for a predetermined distance or for a predetermined time (S401: YES), and has subsequently traveled approximately in the X direction for a predetermined distance or for a predetermined time (S402: YES) ), it is determined that the traveling body 1 has changed direction from the Y direction to the X direction, and on the other hand, travels approximately in the X direction for a predetermined distance or for a predetermined time (S403: YES), and then travels approximately in the Y direction for a predetermined distance or for a predetermined time. If it is determined that the vehicle has traveled (S404: YES), it is determined that the traveling aircraft 1 has changed direction from the X direction to the Y direction.

制御部30は、走行機体1がY方向からX方向に方向転換したと判断し、かつ植付クラッチの入りにより作業再開を判断した場合(S405:YES)、所定距離又は所定時間における略X方向の走行データ(座標)に基づいてX方向の仮想ライン(LX)を作成するとともに(S406)、目標ライン設定をX方向仮想ラインに切換える(S407)。 If the control unit 30 determines that the traveling body 1 has changed direction from the Y direction to the X direction, and determines to restart the work by engaging the planting clutch (S405: YES), the control unit 30 changes direction approximately in the X direction for a predetermined distance or a predetermined time. A virtual line (LX) in the X direction is created based on the traveling data (coordinates) of (S406), and the target line setting is switched to the virtual line in the X direction (S407).

また、制御部30は、走行機体1がX方向からY方向に方向転換したと判断し、かつ植付クラッチの入りにより作業再開を判断した場合(S408:YES)、目標ライン設定をY方向仮想ラインに切換える(S409)。 Further, if the control unit 30 determines that the traveling body 1 has changed direction from the X direction to the Y direction, and determines to restart the work by engaging the planting clutch (S408: YES), the control unit 30 sets the target line in the Y direction. Switch to line (S409).

図12に示すように、直交線作成/方向切換え制御(第3モード)を実行する制御部30は、現在の目標ライン設定がY方向であるか否かを判断しつつ(S501)、直交線作成/方向切換えスイッチ22の操作を判断する(S502、S503)。制御部30は、ステップS501の判断結果に拘わらず、ステップS502、S503の判断結果がNOである場合は、そのまま上位ルーチンに復帰するが、ステップS501及びステップS502の判断結果がいずれもYESの場合は、現在の機体方向がX方向に最も近いか否かを確認した後(S504:YES)、目標ライン設定をX方向仮想ラインに切換える(S505)。また、制御部30は、ステップS501の判断結果がNOで、かつステップS502の判断結果がYESの場合は、現在の機体方向がY方向に最も近いか否かを確認した後(S506:YES)、目標ライン設定をY方向仮想ラインに切換える(S507)。 As shown in FIG. 12, the control unit 30 that executes the orthogonal line creation/direction switching control (third mode) determines whether or not the current target line setting is in the Y direction (S501). The operation of the creation/direction changeover switch 22 is determined (S502, S503). Regardless of the determination result in step S501, if the determination results in steps S502 and S503 are NO, the control unit 30 returns to the upper routine as is, but if the determination results in step S501 and step S502 are both YES, the control unit 30 returns to the upper routine. After confirming whether the current aircraft direction is closest to the X direction (S504: YES), the target line setting is switched to the X direction virtual line (S505). Further, if the determination result in step S501 is NO and the determination result in step S502 is YES, the control unit 30 checks whether the current aircraft direction is closest to the Y direction (S506: YES). , the target line setting is switched to the Y-direction virtual line (S507).

叙述の如く構成された本実施形態によれば、走行機体1の学習走行に基づいて所定方向の基準ライン(LY0)を演算し、基準ライン(LY0)と平行で、かつ等間隔に並列する複数の所定方向仮想ライン(LY1、LY2、…LYn)を演算し、走行機体1の現在位置から近い所定方向仮想ライン(LY1、LY2、…LYn)を目標ラインとし、該目標ラインに沿って走行するように走行機体1を自動的に操舵する自動操舵制御を備える乗用田植機Pであって、第1モードの直交線作成/方向切換え制御は、所定の人為的切換え操作(直交線作成/方向切換えスイッチ22の操作)に応じて、所定方向と直交する方向に沿う直交方向仮想ライン(LX)を演算し、自動操舵制御の目標ラインを直交方向仮想ライン(LX)に切換えるので、所定方向だけでなく、その直交方向の作業走行でも自動操舵制御を適用することができる。また、所定の人為的切換え操作に応じて、所定方向と直交する方向に沿う直交方向仮想ライン(LX)を演算するので、圃場の外形データが取得できない場合でも、自動操舵制御の適用範囲を広げることができる。 According to the present embodiment configured as described above, a reference line (LY0) in a predetermined direction is calculated based on the learning run of the traveling aircraft 1, and a plurality of lines parallel to the reference line (LY0) and arranged at equal intervals are calculated. A virtual line (LY1, LY2,...LYn) in a predetermined direction is calculated, a virtual line (LY1, LY2,...LYn) in a predetermined direction near the current position of the traveling aircraft 1 is set as a target line, and the vehicle travels along the target line. The riding rice transplanter P is equipped with an automatic steering control that automatically steers the traveling body 1 as shown in FIG. In response to the operation of the switch 22), an orthogonal virtual line (LX) along a direction orthogonal to the predetermined direction is calculated, and the target line for automatic steering control is switched to the orthogonal virtual line (LX), so that the automatic steering control can be performed only in the predetermined direction. Therefore, automatic steering control can be applied even when traveling in the orthogonal direction. In addition, in response to a predetermined artificial switching operation, a virtual line (LX) in the orthogonal direction is calculated along a direction orthogonal to the predetermined direction, so even when field outline data cannot be obtained, the scope of application of automatic steering control is expanded. be able to.

また、第2モードの直交線作成/方向切換え制御は、走行機体1が所定方向と直交する方向へ方向転換したことを判断し、該判断に応じて、所定方向と直交する方向の直交方向仮想ライン(LX)を演算し、自動操舵制御の目標ラインを直交方向仮想ライン(LX)に切換えるので、所定方向だけでなく、その直交方向の作業走行でも自動操舵制御を適用することができる。また、方向転換の判断に応じて、自動操舵制御の目標ラインを直交方向仮想ライン(LX)に切換えるので、人為的な切換え操作を不要とし、作業者の操作負担をさらに低減させることができる。 In addition, the second mode of orthogonal line creation/direction switching control determines that the traveling aircraft 1 has changed direction in a direction orthogonal to a predetermined direction, and based on the determination, an orthogonal direction virtual in a direction orthogonal to the predetermined direction is determined. The line (LX) is calculated and the target line for automatic steering control is switched to the orthogonal direction virtual line (LX), so automatic steering control can be applied not only to a predetermined direction but also to work travel in the orthogonal direction. Furthermore, since the target line for automatic steering control is switched to the orthogonal direction virtual line (LX) in accordance with the judgment of direction change, a manual switching operation is not required, and the operational burden on the operator can be further reduced.

また、第2モードの直交線作成/方向切換え制御は、走行機体1の作業再開を判断し、方向転換及び作業再開の判断に応じて、所定方向と直交する方向の直交方向仮想ライン(LX)を演算し、自動操舵制御の目標ラインを直交方向仮想ライン(LX)に切換えるので、目標ラインの誤った切換えを抑制し、自動操舵制御の信頼性を高めることができる。 In addition, the second mode of orthogonal line creation/direction switching control determines whether to restart work on the traveling aircraft 1, and creates an orthogonal virtual line (LX) in a direction orthogonal to a predetermined direction depending on the direction change and the determination to restart work. Since the target line for automatic steering control is switched to the orthogonal direction virtual line (LX), erroneous switching of the target line can be suppressed and the reliability of automatic steering control can be improved.

また、直交線作成/方向切換え制御は、自動操舵制御の目標ラインを切換えるとき、所定方向仮想ライン(LY1、LY2、…LYn)と直交方向仮想ライン(LX)を交互に切換えるので、圃場の4辺を周回状に走行する枕地走行などにおける利便性を向上させることができる。 In addition, the orthogonal line creation/direction switching control alternately switches the predetermined direction virtual lines (LY1, LY2, ... LYn) and the orthogonal direction virtual line (LX) when switching the target line of the automatic steering control. It is possible to improve convenience when driving on a headland where the vehicle travels in a circumferential manner around the side.

P 乗用田植機
1 走行機体
3 植付作業機
8 ステアリングハンドル
15 自動操舵ユニット
22 直交線作成/方向切換えスイッチ
26 測位システム
30 制御部
40 植付クラッチセンサ
P Riding rice transplanter 1 Traveling machine 3 Planting work machine 8 Steering handle 15 Automatic steering unit 22 Orthogonal line creation/direction changeover switch 26 Positioning system 30 Control unit 40 Planting clutch sensor

Claims (4)

走行機体と、
前記走行機体の学習走行に基づいて所定方向の基準ラインを演算する基準ライン演算手段と、
前記基準ラインと平行で、かつ等間隔に並列する複数の所定方向仮想ラインを演算する所定方向仮想ライン演算手段と、
前記走行機体の位置を検出する機体位置検出手段と、
前記走行機体の現在位置から近い前記所定方向仮想ラインを目標ラインとし、該目標ラインに沿って走行するように前記走行機体を自動的に操舵する自動操舵制御手段と、を備える作業車両であって、
所定の人為的切換え操作に応じて、前記所定方向と直交する方向に沿う直交方向仮想ラインを演算し、前記自動操舵制御手段の目標ラインを前記直交方向仮想ラインに切換える目標ライン切換え手段をさらに備えることを特徴とする作業車両。
A traveling aircraft,
a reference line calculation means for calculating a reference line in a predetermined direction based on a learning run of the traveling aircraft;
a predetermined direction virtual line calculating means for calculating a plurality of predetermined direction virtual lines that are parallel to the reference line and parallel at equal intervals;
Aircraft position detection means for detecting the position of the traveling aircraft;
A work vehicle, comprising an automatic steering control means that sets the virtual line in the predetermined direction near the current position of the traveling machine as a target line, and automatically steers the traveling machine to travel along the target line. ,
The vehicle further includes target line switching means for calculating an orthogonal virtual line along a direction perpendicular to the predetermined direction and switching the target line of the automatic steering control means to the orthogonal virtual line in response to a predetermined artificial switching operation. A work vehicle characterized by:
走行機体と、
前記走行機体の学習走行に基づいて所定方向の基準ラインを演算する基準ライン演算手段と、
前記基準ラインと平行で、かつ等間隔に並列する複数の所定方向仮想ラインを演算する所定方向仮想ライン演算手段と、
前記走行機体の位置を検出する機体位置検出手段と、
前記走行機体の現在位置から近い前記所定方向仮想ラインを目標ラインとし、該目標ラインに沿って走行するように前記走行機体を自動的に操舵する自動操舵制御手段と、を備える作業車両であって、
前記走行機体が前記所定方向と直交する方向へ方向転換したことを判断する方向転換判断手段と、
前記方向転換の判断に応じて、前記所定方向と直交する方向の直交方向仮想ラインを演算し、前記自動操舵制御手段の目標ラインを前記直交方向仮想ラインに切換える目標ライン切換え手段と、をさらに備えることを特徴とする作業車両。
A traveling aircraft,
a reference line calculation means for calculating a reference line in a predetermined direction based on a learning run of the traveling aircraft;
a predetermined direction virtual line calculating means for calculating a plurality of predetermined direction virtual lines that are parallel to the reference line and parallel at equal intervals;
Aircraft position detection means for detecting the position of the traveling aircraft;
A work vehicle, comprising an automatic steering control means that sets the virtual line in the predetermined direction near the current position of the traveling machine as a target line, and automatically steers the traveling machine to travel along the target line. ,
direction change determination means for determining that the traveling aircraft has changed direction in a direction perpendicular to the predetermined direction;
The vehicle further includes target line switching means for calculating an orthogonal virtual line in a direction perpendicular to the predetermined direction and switching the target line of the automatic steering control means to the orthogonal virtual line in response to the determination of the direction change. A work vehicle characterized by:
前記走行機体の作業再開を判断する作業再開判断手段をさらに備え、
前記目標ライン切換え手段は、前記方向転換及び前記作業再開の判断に応じて、前記所定方向と直交する方向の直交方向仮想ラインを演算し、前記自動操舵制御手段の目標ラインを前記直交方向仮想ラインに切換えることを特徴とする請求項2に記載の作業車両。
further comprising a work restart determination means for determining whether to restart work on the traveling aircraft,
The target line switching means calculates a virtual line in an orthogonal direction in a direction perpendicular to the predetermined direction, and changes the target line of the automatic steering control means to the virtual line in the orthogonal direction, in accordance with the judgment of the direction change and the resumption of work. The work vehicle according to claim 2, characterized in that the work vehicle is switched to:
前記目標ライン切換え手段は、前記自動操舵制御の目標ラインを切換えるとき、前記所定方向仮想ラインと前記直交方向仮想ラインを交互に切換えることを特徴とする請求項1~3のいずれか1項に記載の作業車両。 4. The target line switching means, when switching the target line of the automatic steering control, alternately switches the predetermined direction virtual line and the orthogonal direction virtual line. work vehicle.
JP2020077088A 2020-04-24 2020-04-24 work vehicle Active JP7398328B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2020077088A JP7398328B2 (en) 2020-04-24 2020-04-24 work vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2020077088A JP7398328B2 (en) 2020-04-24 2020-04-24 work vehicle

Publications (2)

Publication Number Publication Date
JP2021170988A JP2021170988A (en) 2021-11-01
JP7398328B2 true JP7398328B2 (en) 2023-12-14

Family

ID=78278079

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020077088A Active JP7398328B2 (en) 2020-04-24 2020-04-24 work vehicle

Country Status (1)

Country Link
JP (1) JP7398328B2 (en)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20070255470A1 (en) 2006-04-21 2007-11-01 Norbert Diekhans Method for controlling an agricultural machine system
JP2015112068A (en) 2013-12-12 2015-06-22 株式会社クボタ Field work machine
JP2016023973A (en) 2014-07-17 2016-02-08 株式会社クボタ Agricultural work machine
JP2018147421A (en) 2017-03-09 2018-09-20 ヤンマー株式会社 Route production system
JP2019110880A (en) 2017-12-26 2019-07-11 株式会社クボタ Paddy field work vehicle
JP2020018236A (en) 2018-08-01 2020-02-06 株式会社クボタ Harvester

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20070255470A1 (en) 2006-04-21 2007-11-01 Norbert Diekhans Method for controlling an agricultural machine system
JP2015112068A (en) 2013-12-12 2015-06-22 株式会社クボタ Field work machine
JP2016023973A (en) 2014-07-17 2016-02-08 株式会社クボタ Agricultural work machine
JP2018147421A (en) 2017-03-09 2018-09-20 ヤンマー株式会社 Route production system
JP2019110880A (en) 2017-12-26 2019-07-11 株式会社クボタ Paddy field work vehicle
JP2020018236A (en) 2018-08-01 2020-02-06 株式会社クボタ Harvester

Also Published As

Publication number Publication date
JP2021170988A (en) 2021-11-01

Similar Documents

Publication Publication Date Title
KR102575115B1 (en) Work vehicle and travel region specification device
EP3176665B1 (en) Cooperation system for work vehicles
JP2008131880A (en) Agricultural working vehicle
JPH09178481A (en) Device for preparing running data of working vehicle, and guidance and control device
JP7068528B2 (en) Area registration system
JP7139492B2 (en) field work machine
JP2017167910A (en) Work vehicle and work path generation device
JP7398329B2 (en) work vehicle
KR20220010474A (en) autonomous driving system
JP7398328B2 (en) work vehicle
JP2020000066A (en) Traveling work machine
JP7236792B2 (en) riding rice transplanter
JP7236791B2 (en) riding rice transplanter
JP7137270B2 (en) Autonomous driving system
JP2021108577A (en) Work vehicle
JP2021040542A (en) Sulky rice transplanter
JP2021040543A (en) Sulky rice transplanter
JP2023139432A (en) work vehicle
JP7341873B2 (en) work equipment
WO2023112611A1 (en) Automatic steering system
JP2021108578A (en) Work vehicle and rice transplanter
JP7094833B2 (en) Travel route display device
JP2021108579A (en) Work vehicle
JP2021108576A (en) Work vehicle
JP2022030180A (en) Working vehicle

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20230228

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20231011

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20231122

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20231204

R151 Written notification of patent or utility model registration

Ref document number: 7398328

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151