JP2022063315A - Autonomous travel system - Google Patents

Autonomous travel system Download PDF

Info

Publication number
JP2022063315A
JP2022063315A JP2022021977A JP2022021977A JP2022063315A JP 2022063315 A JP2022063315 A JP 2022063315A JP 2022021977 A JP2022021977 A JP 2022021977A JP 2022021977 A JP2022021977 A JP 2022021977A JP 2022063315 A JP2022063315 A JP 2022063315A
Authority
JP
Japan
Prior art keywords
tractor
work
route
traveling
autonomous
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2022021977A
Other languages
Japanese (ja)
Other versions
JP7349518B2 (en
Inventor
敏史 平松
Toshifumi Hiramatsu
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.)
Yanmar Power Technology Co Ltd
Original Assignee
Yanmar Power Technology 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 Yanmar Power Technology Co Ltd filed Critical Yanmar Power Technology Co Ltd
Priority to JP2022021977A priority Critical patent/JP7349518B2/en
Publication of JP2022063315A publication Critical patent/JP2022063315A/en
Application granted granted Critical
Publication of JP7349518B2 publication Critical patent/JP7349518B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Guiding Agricultural Machines (AREA)

Abstract

PROBLEM TO BE SOLVED: To provide an autonomous travel system which allows a work vehicle to resume its work easily after it is halted.
SOLUTION: A positional information acquiring unit acquires positional information of a tractor 1. A control unit makes the tractor carry out its autonomous operation along a predetermined operation path P1 while the tractor is made autonomous travelling along the predetermined operation path P1. A deviation determination unit determines whether or not a position of the tractor 1 is deviated from the travel path P on the basis of the positional information acquired by the positional information acquiring unit. If the tractor 1 is positioned out of a range of a deviation determination width JW set with reference to the travel path P, the deviation determination unit determines that the tractor 1 is positionally deviated from the travel path P. A control unit stops the tractor 1 if the deviation determination unit determines that the tractor 1 is deviated from the travel path P.
SELECTED DRAWING: Figure 6
COPYRIGHT: (C)2022,JPO&INPIT

Description

本発明は、自律走行システムに関する。詳細には、予め定められた走行経路に沿って自律走行可能な作業車両の自律走行システムに関する。 The present invention relates to an autonomous traveling system. More specifically, the present invention relates to an autonomous traveling system of a work vehicle capable of autonomously traveling along a predetermined traveling route.

従来から、予め定められた走行経路に沿って自律走行可能な作業車両の自律走行システムが知られている。特許文献1は、この種の自律走行システムに備えられる作業車両及び作業車両の異常検出・対応方法を開示する。この特許文献1の自律走行システムにおいては、作業車両が設定区間外にはみ出したことを検出した場合、速やかに車両をいったん停止し、異常の発生を報知するとともに対応方法を表示して、管理者や運転者に一時的な手動による運転・操作を含めた対応を求める。管理者や運転者により異常への対応が行われた後は、正常状態への復帰のチェックや、管理者や運転者への確認が行われた上で、作業が再開される構成となっている。 Conventionally, an autonomous traveling system of a work vehicle capable of autonomously traveling along a predetermined traveling route has been known. Patent Document 1 discloses a work vehicle provided in this type of autonomous traveling system and a method for detecting and dealing with an abnormality in the work vehicle. In the autonomous traveling system of Patent Document 1, when it is detected that the work vehicle protrudes outside the set section, the vehicle is promptly stopped, the occurrence of an abnormality is notified, and the response method is displayed, and the administrator. And ask the driver to take measures including temporary manual operation and operation. After the administrator or driver responds to the abnormality, the work is resumed after checking the return to the normal state and confirming with the administrator and driver. There is.

特開2000-66725号公報Japanese Unexamined Patent Publication No. 2000-66725

しかし、上記特許文献1の構成は、作業車両が設定区間外にはみ出して停止した場合、管理者や運転者が手動による運転を行って作業車両を作業再開位置(作業を再開する位置)に移動させた上で、作業を再開させる必要があった。作業車両を作業区間内の特定の位置に正確に移動させるには、高度な運転技術を要し、容易には作業を再開することができない点で改善の余地があった。 However, in the configuration of Patent Document 1, when the work vehicle protrudes outside the set section and stops, the manager or the driver manually drives the work vehicle to the work restart position (position where the work is restarted). After that, it was necessary to restart the work. In order to accurately move the work vehicle to a specific position in the work section, advanced driving skills were required, and there was room for improvement in that work could not be resumed easily.

本発明は以上の事情に鑑みてされたものであり、その目的は、作業車両が停止した後、容易に作業を再開することが可能な自律走行システムを提供することにある。 The present invention has been made in view of the above circumstances, and an object of the present invention is to provide an autonomous traveling system capable of easily resuming work after a work vehicle has stopped.

一態様に係る自律走行システムは、位置情報取得部と、制御部と、逸脱判定部と、を備える。前記位置情報取得部は、作業車両の位置情報を取得する。前記制御部は、予め定められた走行経路に沿って前記作業車両を自律走行させながら予め定められた作業経路に沿って自律作業させる。前記逸脱判定部は、前記位置情報取得部で得られる位置情報に基づいて、前記作業車両が前記走行経路から逸脱しているか否かを判定する。前記逸脱判定部は、前記作業車両の位置が前記走行経路を基準とする逸脱判定幅の範囲外にあれば、前記作業車両が前記走行経路から逸脱していると判定する。前記制御部は、前記逸脱判定部にて前記作業車両が前記走行経路から逸脱していると判定された場合、前記作業車両を停止させる。 The autonomous traveling system according to one aspect includes a position information acquisition unit, a control unit, and a deviation determination unit. The position information acquisition unit acquires the position information of the work vehicle. The control unit autonomously causes the work vehicle to work autonomously along a predetermined work route while autonomously traveling the work vehicle along a predetermined travel route. The deviation determination unit determines whether or not the work vehicle deviates from the travel path based on the position information obtained by the position information acquisition unit. If the position of the work vehicle is outside the range of the deviation determination width based on the travel path, the deviation determination unit determines that the work vehicle deviates from the travel path. When the deviation determination unit determines that the work vehicle deviates from the travel path, the control unit stops the work vehicle.

本発明の一実施形態に係る自律走行システムに備えられるロボットトラクタの全体的な構成を示す側面図。The side view which shows the overall structure of the robot tractor provided in the autonomous traveling system which concerns on one Embodiment of this invention. ロボットトラクタの平面図。Top view of the robot tractor. 本発明の一実施形態に係る自律走行システムに備えられる無線通信端末を示す図。The figure which shows the wireless communication terminal provided in the autonomous traveling system which concerns on one Embodiment of this invention. ロボットトラクタ及び無線通信端末の制御系の主要な構成を示すブロック図。The block diagram which shows the main composition of the control system of a robot tractor and a wireless communication terminal. 無線通信端末のディスプレイにおける監視画面の表示例を示す図。The figure which shows the display example of the monitoring screen in the display of a wireless communication terminal. 作業経路に設定される逸脱判定幅及びマージン幅を説明する図。The figure explaining the deviation determination width and the margin width set in the work path. ロボットトラクタが走行経路から逸脱して停止した後に、自律走行・自律作業を再開するまでの処理の前半部を示すフローチャート。A flowchart showing the first half of the process from when the robot tractor deviates from the traveling path and stops, until the autonomous traveling / autonomous work is resumed. ロボットトラクタが走行経路から逸脱して停止した後に、自律走行・自律作業を再開するまでの処理の後半部を示すフローチャート。A flowchart showing the latter half of the process from when the robot tractor deviates from the traveling path and stops, until the autonomous traveling / autonomous work is resumed. ロボットトラクタが作業経路から逸脱して停止した様子を示す図。The figure which shows the state that the robot tractor deviated from the work path and stopped. ロボットトラクタが非作業経路から逸脱して非作業領域で停止した場合を示す図。The figure which shows the case where a robot tractor deviates from a non-working path and stops in a non-working area. ロボットトラクタが非作業経路から逸脱して作業領域で停止した場合を示す図。The figure which shows the case where a robot tractor deviates from a non-working path and stops in a working area. 再開位置を基準として設定される第1範囲及び第2範囲と、第2範囲内において再開位置より走行経路の進行方向前方で停止した状態のトラクタを説明する模式図。The schematic diagram explaining the 1st range and the 2nd range set with respect to the restart position, and the tractor in the state which stopped in the 2nd range in front of the traveling direction of the traveling path from the restart position. 第2範囲内において再開位置より走行経路の進行方向後方で停止した状態のトラクタを説明する模式図。The schematic diagram explaining the tractor in the state which stopped behind the traveling direction of a traveling path from the restarting position in the 2nd range. 位置合わせ用経路の作成の可否を判定するにあたって考慮される第1範囲及び第2範囲の変形例を説明する図。図中のハッチングは、第1範囲外かつ第2範囲内の領域を示している。The figure explaining the modification of the 1st range and the 2nd range considered in determining whether or not the alignment path can be made. The hatching in the figure indicates a region outside the first range and within the second range.

次に、図面を参照して本発明の実施の形態を説明する。以下では、図面の各図において同一の部材には同一の符号を付し、重複する説明を省略することがある。また、同一の符号に対応する部材等の名称が、簡略的に言い換えられたり、上位概念又は下位概念の名称で言い換えられたりすることがある。 Next, an embodiment of the present invention will be described with reference to the drawings. In the following, the same members may be designated by the same reference numerals in each of the drawings, and duplicate description may be omitted. In addition, the names of members and the like corresponding to the same reference numerals may be simply paraphrased, or may be paraphrased by the names of higher-level concepts or lower-level concepts.

本発明は、予め定められた圃場内で1台又は複数台の作業車両を走行させて、圃場内における農作業の全部又は一部を実行させるときに、作業車両を自律的に走行させる自律走行システムに関する。本実施形態では、作業車両としてトラクタを例に説明するが、作業車両としては、トラクタの他、田植機、コンバイン、土木・建設作業装置、除雪車等、乗用型作業機に加え、歩行型作業機も含まれる。本明細書において自律走行とは、トラクタが備える制御部(ECU)によりトラクタが備える走行に関する構成が制御されて予め定められた経路に沿ってトラクタが走行することを意味し、自律作業とは、トラクタが備える制御部によりトラクタが備える作業に関する構成が制御されて、予め定められた経路に沿ってトラクタが作業を行うことを意味する。これに対して、手動走行・手動作業とは、トラクタが備える各構成がユーザにより操作され、走行・作業が行われることを意味する。 The present invention is an autonomous traveling system in which one or a plurality of work vehicles are driven in a predetermined field to autonomously run the work vehicle when all or part of the farm work in the field is executed. Regarding. In the present embodiment, a tractor will be described as an example of a work vehicle, but the work vehicle includes a tractor, a rice transplanter, a combine harvester, a civil engineering / construction work device, a snowplow, and other passenger-type work machines, as well as walking-type work. Machines are also included. In the present specification, the autonomous traveling means that the configuration related to the traveling provided by the tractor is controlled by the control unit (ECU) provided in the tractor, and the tractor travels along a predetermined route. It means that the configuration related to the work included in the tractor is controlled by the control unit provided in the tractor, and the tractor performs the work along a predetermined route. On the other hand, the manual running / manual work means that each configuration of the tractor is operated by the user to perform the running / work.

以下の説明では、自律走行・自律作業されるトラクタを「無人(の)トラクタ」又は「ロボットトラクタ」と称することがあり、手動走行・手動作業されるトラクタを「有人(の)トラクタ」と称することがある。圃場内において農作業の一部が無人トラクタにより実行される場合、残りの農作業は有人トラクタにより実行される。単一の圃場における農作業を無人トラクタ及び有人トラクタで実行することを、農作業の協調作業、追従作業、随伴作業等と称することがある。本明細書において無人トラクタと有人トラクタの違いは、ユーザによる操作の有無であり、各構成は基本的に共通であるものとする。即ち、無人トラクタであってもユーザが搭乗(乗車)して操作することが可能であり(即ち、有人トラクタとして使用することができ)、あるいは有人トラクタであってもユーザが降車して自律走行・自律作業させることが可能である(即ち、無人トラクタとして使用することができる)。なお、農作業の協調作業としては、「単一の圃場における農作業を無人車両及び有人車両で実行すること」に加え、「隣接する圃場等の異なる圃場における農作業を同時期に無人車両及び有人車両が実行すること」が含まれていてもよい。 In the following description, a tractor that is autonomously driven or operated autonomously may be referred to as an "unmanned tractor" or a "robot tractor", and a tractor that is manually driven or manually operated is referred to as a "manned tractor". Sometimes. If part of the farm work is carried out by an unmanned tractor in the field, the rest of the farm work is carried out by a manned tractor. Performing farm work in a single field with unmanned tractors and manned tractors may be referred to as cooperative work, follow-up work, accompanying work, etc. of farm work. In the present specification, the difference between the unmanned tractor and the manned tractor is the presence or absence of operation by the user, and each configuration is basically common. That is, even if it is an unmanned tractor, the user can board (board) and operate it (that is, it can be used as a manned tractor), or even if it is a manned tractor, the user gets off and runs autonomously. -It is possible to work autonomously (that is, it can be used as an unmanned tractor). In addition, as cooperative work of farm work, in addition to "performing farm work in a single field with automatic guided vehicles and manned vehicles", "unmanned vehicles and manned vehicles perform farm work in different fields such as adjacent fields at the same time. "To do" may be included.

次に、図面を参照して本発明の実施の形態を説明する。図1は、本発明の一実施形態に係る自律走行システム99に備えられるロボットトラクタ1の全体的な構成を示す側面図である。図2は、ロボットトラクタ1の平面図である。図3は、本発明の一実施形態に係る自律走行システム99に備えられる無線通信端末46を示す図である。図4は、ロボットトラクタ1及び無線通信端末46の制御系の主要な構成を示すブロック図である。 Next, an embodiment of the present invention will be described with reference to the drawings. FIG. 1 is a side view showing an overall configuration of a robot tractor 1 provided in an autonomous traveling system 99 according to an embodiment of the present invention. FIG. 2 is a plan view of the robot tractor 1. FIG. 3 is a diagram showing a wireless communication terminal 46 provided in the autonomous traveling system 99 according to the embodiment of the present invention. FIG. 4 is a block diagram showing a main configuration of a control system of the robot tractor 1 and the wireless communication terminal 46.

図1に示すように、本発明の実施の一形態に係る自律走行システム99に備えられるロボットトラクタ(作業車両)1は、無線通信端末46との間で無線通信を行うことにより操作される作業車両である。ユーザが無線通信端末46を操作して、当該トラクタ1の制御部4との間で信号のやり取りを適宜行うことにより、トラクタ1を自律走行・自律作業させることができる。 As shown in FIG. 1, the robot tractor (working vehicle) 1 provided in the autonomous traveling system 99 according to the embodiment of the present invention is operated by performing wireless communication with the wireless communication terminal 46. It is a vehicle. By the user operating the wireless communication terminal 46 and appropriately exchanging signals with the control unit 4 of the tractor 1, the tractor 1 can be autonomously traveled and operated autonomously.

初めに、本発明の実施の一形態に係る自律走行システム99に備えられるロボットトラクタ(以下、単に「トラクタ」と称する場合がある。)1について、主として図1及び図2を参照して説明する。 First, the robot tractor (hereinafter, may be simply referred to as “tractor”) 1 provided in the autonomous traveling system 99 according to the embodiment of the present invention will be described mainly with reference to FIGS. 1 and 2. ..

トラクタ1は、圃場(走行領域)内を自律走行することが可能な走行機体(車体部)2を備える。走行機体2には、図1及び図2に示す作業機3が着脱可能に取り付けられている。この作業機3としては、例えば、耕耘機、プラウ、施肥機、草刈機、播種機等の種々の作業機があり、これらの中から必要に応じて所望の作業機3を選択して走行機体2に装着することができる。走行機体2は、装着された作業機3の高さ及び姿勢を変更可能に構成されている。 The tractor 1 includes a traveling machine body (body portion) 2 capable of autonomously traveling in a field (traveling area). The working machine 3 shown in FIGS. 1 and 2 is detachably attached to the traveling machine body 2. As the working machine 3, for example, there are various working machines such as a tiller, a plow, a fertilizer application machine, a grass mower, a sowing machine, etc., and a desired working machine 3 is selected from these as necessary and a traveling machine. Can be attached to 2. The traveling machine body 2 is configured so that the height and posture of the mounted working machine 3 can be changed.

トラクタ1の構成について、図1及び図2を参照してより詳細に説明する。トラクタ1の走行機体2は、図1に示すように、その前部が左右1対の前輪(車輪)7,7で支持され、その後部が左右1対の後輪8,8で支持されている。 The configuration of the tractor 1 will be described in more detail with reference to FIGS. 1 and 2. As shown in FIG. 1, the traveling body 2 of the tractor 1 is supported by a pair of left and right front wheels (wheels) 7 and 7 at the front portion thereof and by a pair of left and right rear wheels 8 and 8 at the rear portion. There is.

走行機体2の前部にはボンネット9が配置されている。このボンネット9内には、トラクタ1の駆動源であるエンジン10及び燃料タンク(図略)が収容されている。このエンジン10は、例えばディーゼルエンジンにより構成することができるが、これに限るものではなく、例えばガソリンエンジンにより構成してもよい。また、駆動源としては、エンジンに加えて、又はこれに代えて、電気モータを使用してもよい。 A bonnet 9 is arranged at the front portion of the traveling machine body 2. The engine 10 and the fuel tank (not shown), which are the drive sources of the tractor 1, are housed in the bonnet 9. The engine 10 can be configured by, for example, a diesel engine, but is not limited to this, and may be configured by, for example, a gasoline engine. Further, as the drive source, an electric motor may be used in addition to or instead of the engine.

ボンネット9の後方には、ユーザが搭乗するためのキャビン11が配置されている。このキャビン11の内部には、ユーザが操向操作するためのステアリングハンドル12と、ユーザが着座可能な座席13と、各種の操作を行うための様々な操作装置と、が主として設けられている。ただし、作業車両は、キャビン11付きのものに限るものではなく、キャビン11を備えないものであってもよい。 Behind the bonnet 9, a cabin 11 for a user to board is arranged. Inside the cabin 11, a steering handle 12 for the user to steer, a seat 13 for the user to sit on, and various operating devices for performing various operations are mainly provided. However, the work vehicle is not limited to the one with the cabin 11, and may be the one without the cabin 11.

上記の操作装置としては、図2に示すモニタ装置14、スロットルレバー15、主変速レバー27、複数の油圧操作レバー16、PTOスイッチ17、PTO変速レバー18、副変速レバー19、及び作業機昇降スイッチ28等を例として挙げることができる。これらの操作装置は、座席13の近傍、又はステアリングハンドル12の近傍に配置されている。 Examples of the operation device include the monitor device 14, the throttle lever 15, the main shift lever 27, a plurality of hydraulic operation levers 16, the PTO switch 17, the PTO shift lever 18, the auxiliary shift lever 19, and the work equipment elevating switch shown in FIG. 28 etc. can be mentioned as an example. These operating devices are arranged near the seat 13 or near the steering wheel 12.

モニタ装置14は、トラクタ1の様々な情報を表示可能に構成されている。スロットルレバー15は、エンジン10の出力回転数を設定するための操作具である。主変速レバー27は、トラクタ1の走行速度を無段階で変更するための操作具である。油圧操作レバー16は、図略の油圧外部取出バルブを切換操作するための操作具である。PTOスイッチ17は、トランスミッション22の後端から突出した図略のPTO軸(動力取出軸)への動力の伝達/遮断を切換操作するための操作具である。即ち、PTOスイッチ17がON状態であるときPTO軸に動力が伝達されてPTO軸が回転し、作業機3が駆動される一方、PTOスイッチ17がOFF状態であるときPTO軸への動力が遮断されてPTO軸が回転せず、作業機3が停止される。PTO変速レバー18は、作業機3に入力される動力の変更操作を行うものであり、具体的にはPTO軸の回転速度の変速操作を行うための操作具である。副変速レバー19は、トランスミッション22内の走行副変速ギア機構の変速比を切り換えるための操作具である。作業機昇降スイッチ28は、走行機体2に装着された作業機3の高さを所定範囲内で昇降操作するための操作具である。 The monitoring device 14 is configured to be able to display various information of the tractor 1. The throttle lever 15 is an operating tool for setting the output rotation speed of the engine 10. The main shift lever 27 is an operating tool for steplessly changing the traveling speed of the tractor 1. The hydraulic pressure operating lever 16 is an operating tool for switching and operating the hydraulic pressure external take-out valve (not shown). The PTO switch 17 is an operating tool for switching between transmission / disconnection of power to the PTO shaft (power take-off shaft) of the figure shown protruding from the rear end of the transmission 22. That is, when the PTO switch 17 is in the ON state, power is transmitted to the PTO shaft to rotate the PTO shaft, and the work equipment 3 is driven, while when the PTO switch 17 is in the OFF state, the power to the PTO shaft is cut off. Then, the PTO shaft does not rotate and the working machine 3 is stopped. The PTO shift lever 18 is for changing the power input to the working machine 3, and specifically, is an operating tool for changing the rotational speed of the PTO shaft. The auxiliary transmission lever 19 is an operating tool for switching the gear ratio of the traveling auxiliary transmission gear mechanism in the transmission 22. The work machine elevating switch 28 is an operating tool for raising and lowering the height of the work machine 3 mounted on the traveling machine body 2 within a predetermined range.

図1に示すように、走行機体2の下部には、トラクタ1のシャーシ20が設けられている。当該シャーシ20は、機体フレーム21、トランスミッション22、フロントアクスル23、及びリアアクスル24等から構成されている。 As shown in FIG. 1, the chassis 20 of the tractor 1 is provided in the lower part of the traveling machine body 2. The chassis 20 is composed of an airframe frame 21, a transmission 22, a front axle 23, a rear axle 24, and the like.

機体フレーム21は、トラクタ1の前部における支持部材であって、直接、又は防振部材等を介してエンジン10を支持している。トランスミッション22は、エンジン10からの動力を変化させてフロントアクスル23及びリアアクスル24に伝達する。フロントアクスル23は、トランスミッション22から入力された動力を前輪7に伝達するように構成されている。リアアクスル24は、トランスミッション22から入力された動力を後輪8に伝達するように構成されている。 The airframe frame 21 is a support member in the front portion of the tractor 1 and supports the engine 10 directly or via an anti-vibration member or the like. The transmission 22 changes the power from the engine 10 and transmits it to the front axle 23 and the rear axle 24. The front axle 23 is configured to transmit the power input from the transmission 22 to the front wheels 7. The rear axle 24 is configured to transmit the power input from the transmission 22 to the rear wheels 8.

図4に示すように、トラクタ1は、走行機体2の動作(前進、後進、停止及び旋回等)並びに作業機3の動作(昇降、駆動及び停止等)を制御するための制御部4を備える。制御部4は、図示しないCPU、ROM、RAM、I/O等を備えて構成されており、CPUは、各種プログラム等をROMから読み出して実行することができる。制御部4には、トラクタ1が備える各構成(例えば、エンジン10等)を制御するためのコントローラ、及び、他の無線通信機器と無線通信可能な無線通信部40等がそれぞれ電気的に接続されている。 As shown in FIG. 4, the tractor 1 includes a control unit 4 for controlling the operation of the traveling machine 2 (forward, reverse, stop, turn, etc.) and the operation of the work machine 3 (elevation, drive, stop, etc.). .. The control unit 4 includes a CPU, ROM, RAM, I / O, etc. (not shown), and the CPU can read various programs and the like from the ROM and execute them. A controller for controlling each configuration (for example, an engine 10 or the like) included in the tractor 1 and a wireless communication unit 40 or the like capable of wireless communication with other wireless communication devices are electrically connected to the control unit 4, respectively. ing.

上記のコントローラとして、トラクタ1は少なくとも、図略のエンジンコントローラ、車速コントローラ、操向コントローラ及び昇降コントローラを備える。それぞれのコントローラは、制御部4からの電気信号に応じて、トラクタ1の各構成を制御することができる。 As the above controller, the tractor 1 includes at least an engine controller, a vehicle speed controller, a steering controller, and an elevating controller (not shown). Each controller can control each configuration of the tractor 1 according to an electric signal from the control unit 4.

エンジンコントローラは、エンジン10の回転数等を制御するものである。具体的には、エンジン10には、当該エンジン10の回転数を変更させる図略のアクチュエータを備えたガバナ装置41が設けられている。エンジンコントローラは、ガバナ装置41を制御することで、エンジン10の回転数を制御することができる。また、エンジン10には、エンジン10の燃焼室内に噴射(供給)するための燃料の噴射時期・噴射量を調整する燃料噴射装置45が付設されている。エンジンコントローラは、燃料噴射装置45を制御することで、例えばエンジン10への燃料の供給を停止させ、エンジン10の駆動を停止させることができる。 The engine controller controls the rotation speed of the engine 10 and the like. Specifically, the engine 10 is provided with a governor device 41 provided with an actuator (not shown) for changing the rotation speed of the engine 10. The engine controller can control the rotation speed of the engine 10 by controlling the governor device 41. Further, the engine 10 is provided with a fuel injection device 45 for adjusting the injection timing and injection amount of fuel for injecting (supplying) into the combustion chamber of the engine 10. By controlling the fuel injection device 45, the engine controller can, for example, stop the supply of fuel to the engine 10 and stop the driving of the engine 10.

車速コントローラは、トラクタ1の車速を制御するものである。具体的には、トランスミッション22には、例えば可動斜板式の油圧式無段変速装置である変速装置42が設けられている。車速コントローラは、変速装置42の斜板の角度を図略のアクチュエータによって変更することで、トランスミッション22の変速比を変更し、所望の車速を実現することができる。 The vehicle speed controller controls the vehicle speed of the tractor 1. Specifically, the transmission 22 is provided with, for example, a transmission 42 which is a movable diagonal plate type hydraulic continuously variable transmission. The vehicle speed controller can change the gear ratio of the transmission 22 and realize a desired vehicle speed by changing the angle of the swash plate of the transmission 42 by the actuator shown in the figure.

操向コントローラは、ステアリングハンドル12の回動角度を制御するものである。具体的には、ステアリングハンドル12の回転軸(ステアリングシャフト)の中途部には、操向アクチュエータ43が設けられている。この構成で、予め定められた経路をトラクタ1が(無人トラクタとして)走行する場合、制御部4は、当該経路に沿ってトラクタ1が走行するようにステアリングハンドル12の適切な回動角度を計算し、得られた回動角度となるように操向コントローラに制御信号を出力する。操向コントローラは、制御部4から入力された制御信号に基づいて操向アクチュエータ43を駆動し、ステアリングハンドル12の回動角度を制御する。 The steering controller controls the rotation angle of the steering handle 12. Specifically, a steering actuator 43 is provided in the middle of the rotation shaft (steering shaft) of the steering handle 12. In this configuration, when the tractor 1 travels on a predetermined route (as an unmanned tractor), the control unit 4 calculates an appropriate rotation angle of the steering handle 12 so that the tractor 1 travels along the route. Then, a control signal is output to the steering controller so that the obtained rotation angle is obtained. The steering controller drives the steering actuator 43 based on the control signal input from the control unit 4, and controls the rotation angle of the steering handle 12.

昇降コントローラは、作業機3の昇降を制御するものである。具体的には、トラクタ1は、作業機3を走行機体2に連結している3点リンク機構の近傍に、油圧シリンダ等からなる昇降アクチュエータ44を備えている。この構成で、昇降コントローラは、制御部4から入力された制御信号に基づいて昇降アクチュエータ44を駆動して作業機3を適宜に昇降動作させることにより、所望の高さで作業機3により農作業を行うことができる。この制御により、作業機3を、退避高さ(農作業を行わない高さ)及び作業高さ(農作業を行う高さ)等の所望の高さで支持することができる。 The elevating controller controls the elevating and lowering of the working machine 3. Specifically, the tractor 1 is provided with an elevating actuator 44 made of a hydraulic cylinder or the like in the vicinity of a three-point link mechanism that connects the working machine 3 to the traveling machine body 2. In this configuration, the elevating controller drives the elevating actuator 44 based on the control signal input from the control unit 4 to appropriately raise and lower the working machine 3, so that the working machine 3 can perform agricultural work at a desired height. It can be carried out. By this control, the working machine 3 can be supported at a desired height such as a retracted height (height at which farm work is not performed) and a working height (height at which farm work is performed).

なお、上述した図略の複数のコントローラは、制御部4から入力される信号に基づいてエンジン10等の各部を制御していることから、制御部4が実質的に各部を制御していると把握することができる。 Since the plurality of controllers in the above-mentioned illustration control each part such as the engine 10 based on the signal input from the control unit 4, it is said that the control unit 4 substantially controls each part. Can be grasped.

上述のような制御部4を備えるトラクタ1は、ユーザがキャビン11内に搭乗して各種操作をすることにより、当該制御部4によりトラクタ1の各部(走行機体2、作業機3等)を制御して、圃場内を走行しながら農作業を行うことができるように構成されている。加えて、本実施形態のトラクタ1は、ユーザがトラクタ1に搭乗しなくても、無線通信端末46により出力される所定の制御信号に基づいて自律走行及び自律作業をさせることが可能となっている。 The tractor 1 provided with the control unit 4 as described above controls each part of the tractor 1 (traveling machine 2, working machine 3, etc.) by the control unit 4 when the user gets on the cabin 11 and performs various operations. Therefore, it is configured so that farm work can be performed while traveling in the field. In addition, the tractor 1 of the present embodiment can perform autonomous traveling and autonomous work based on a predetermined control signal output by the wireless communication terminal 46 without the user getting on the tractor 1. There is.

具体的には、図4等に示すように、トラクタ1は、自律走行・自律作業を可能とするための各種の構成を備えている。例えば、トラクタ1は、測位システムに基づいて自ら(走行機体2)の位置情報を取得するために必要な測位用アンテナ6等を備える。このような構成により、トラクタ1は、測位システムに基づいて自らの位置情報を取得して、圃場上を自律走行することが可能となっている。 Specifically, as shown in FIG. 4 and the like, the tractor 1 has various configurations for enabling autonomous traveling and autonomous work. For example, the tractor 1 includes a positioning antenna 6 and the like necessary for acquiring the position information of itself (traveling machine 2) based on the positioning system. With such a configuration, the tractor 1 can acquire its own position information based on the positioning system and autonomously travel on the field.

次に、自律走行を可能とするためにトラクタ1が備える構成について、より詳細に説明する。具体的には、本実施形態のトラクタ1は、図4等に示すように、操向アクチュエータ43、測位用アンテナ6、無線通信用アンテナ48、前方カメラ56、後方カメラ57、車速センサ、及び記憶部55等を備える。また、これらに加えて、トラクタ1には、走行機体2の姿勢(ロール角、ピッチ角、ヨー角)を特定することが可能な慣性計測ユニット(IMU)が備えられている。 Next, the configuration included in the tractor 1 to enable autonomous traveling will be described in more detail. Specifically, as shown in FIG. 4, the tractor 1 of the present embodiment includes a steering actuator 43, a positioning antenna 6, a wireless communication antenna 48, a front camera 56, a rear camera 57, a vehicle speed sensor, and a storage. A unit 55 or the like is provided. In addition to these, the tractor 1 is provided with an inertial measurement unit (IMU) capable of specifying the posture (roll angle, pitch angle, yaw angle) of the traveling machine body 2.

測位用アンテナ6は、例えば衛星測位システム(GNSS)等の測位システムを構成する測位衛星からの信号を受信するものである。図1に示すように、測位用アンテナ6は、トラクタ1のキャビン11のルーフ92の上面に取り付けられている。測位用アンテナ6で受信された測位信号は、図4に示す位置検出部としての位置情報取得部49に入力される。位置情報取得部49は、トラクタ1の走行機体2(厳密には、測位用アンテナ6)の位置情報を、例えば緯度・経度情報として算出し、取得する。当該位置情報取得部49で取得された位置情報は、制御部4に入力されて、自律走行に利用される。 The positioning antenna 6 receives a signal from a positioning satellite constituting a positioning system such as a satellite positioning system (GNSS). As shown in FIG. 1, the positioning antenna 6 is attached to the upper surface of the roof 92 of the cabin 11 of the tractor 1. The positioning signal received by the positioning antenna 6 is input to the position information acquisition unit 49 as the position detection unit shown in FIG. The position information acquisition unit 49 calculates and acquires the position information of the traveling machine 2 (strictly speaking, the positioning antenna 6) of the tractor 1 as latitude / longitude information, for example. The position information acquired by the position information acquisition unit 49 is input to the control unit 4 and used for autonomous traveling.

なお、本実施形態ではGNSS-RTK法を利用した高精度の衛星測位システムが用いられているが、これに限るものではなく、高精度の位置座標が得られる限りにおいて他の測位システムを用いてもよい。例えば、相対測位方式(DGPS)、又は静止衛星型衛星航法補強システム(SBAS)を使用することが考えられる。 In this embodiment, a high-precision satellite positioning system using the GNSS-RTK method is used, but the present invention is not limited to this, and other positioning systems can be used as long as high-precision position coordinates can be obtained. May be good. For example, it is conceivable to use a relative positioning method (DGPS) or a geostationary satellite type satellite navigation augmentation system (SBAS).

無線通信用アンテナ48は、ユーザが操作する無線通信端末46からの信号を受信したり、無線通信端末46への信号を送信したりするものである。図1に示すように、無線通信用アンテナ48は、トラクタ1のキャビン11が備えるルーフ92の上面に取り付けられている。無線通信用アンテナ48で受信した無線通信端末46からの信号は、図4に示す無線通信部40で信号処理された後、制御部4に入力される。また、制御部4等から無線通信端末46に送信する信号は、無線通信部40で信号処理された後、無線通信用アンテナ48から送信されて無線通信端末46で受信される。 The wireless communication antenna 48 receives a signal from the wireless communication terminal 46 operated by the user, and transmits a signal to the wireless communication terminal 46. As shown in FIG. 1, the wireless communication antenna 48 is attached to the upper surface of the roof 92 included in the cabin 11 of the tractor 1. The signal from the wireless communication terminal 46 received by the wireless communication antenna 48 is signal-processed by the wireless communication unit 40 shown in FIG. 4 and then input to the control unit 4. Further, the signal transmitted from the control unit 4 or the like to the wireless communication terminal 46 is signal-processed by the wireless communication unit 40, then transmitted from the wireless communication antenna 48 and received by the wireless communication terminal 46.

前方カメラ56はトラクタ1の前方を撮影するものである。後方カメラ57はトラクタ1の後方を撮影するものである。前方カメラ56及び後方カメラ57はトラクタ1のルーフ92に取り付けられている。前方カメラ56及び後方カメラ57で撮影された動画データは、無線通信部40により、無線通信用アンテナ48から無線通信端末46に送信される。動画データを受信した無線通信端末46は、その内容をディスプレイ37に表示する。 The front camera 56 captures the front of the tractor 1. The rear camera 57 captures the rear of the tractor 1. The front camera 56 and the rear camera 57 are attached to the roof 92 of the tractor 1. The moving image data captured by the front camera 56 and the rear camera 57 is transmitted from the wireless communication antenna 48 to the wireless communication terminal 46 by the wireless communication unit 40. The wireless communication terminal 46 that has received the moving image data displays the contents on the display 37.

上記の車速センサは、トラクタ1の車速を検出するものであり、例えば前輪7,7の間の車軸に設けられる。車速センサで得られた検出結果のデータは、無線通信部40で信号処理された後、無線通信用アンテナ48から送信されて無線通信端末46で受信されて、その内容がディスプレイ37に表示される。なお、トラクタ1には車速センサ以外にも、当該トラクタ1の状態を検出(監視)するための種々のセンサが設けられている。 The vehicle speed sensor is for detecting the vehicle speed of the tractor 1, and is provided, for example, on the axle between the front wheels 7 and 7. The detection result data obtained by the vehicle speed sensor is signal-processed by the wireless communication unit 40, then transmitted from the wireless communication antenna 48 and received by the wireless communication terminal 46, and the content thereof is displayed on the display 37. .. In addition to the vehicle speed sensor, the tractor 1 is provided with various sensors for detecting (monitoring) the state of the tractor 1.

記憶部55は、トラクタ1を自律走行させる走行経路や自律作業させる作業経路を記憶したり、自律走行中のトラクタ1(厳密には、測位用アンテナ6)の位置の推移(走行軌跡)を記憶したりするメモリである。その他にも、記憶部55は、トラクタ1を自律走行・自律作業させるために必要な様々な情報を記憶している。 The storage unit 55 stores a travel route for autonomously traveling the tractor 1 and a work route for autonomous work, and stores a transition (traveling locus) of the position of the tractor 1 (strictly speaking, the positioning antenna 6) during autonomous traveling. It is a memory to do. In addition, the storage unit 55 stores various information necessary for the tractor 1 to autonomously travel and work autonomously.

無線通信端末46は、図3に示すように、タッチパネル39を備えるタブレット型のパーソナルコンピュータとして構成される。ユーザは、無線通信端末46のディスプレイ37に表示された情報(例えば、前方カメラ56や、後方カメラ57や、車速センサ等からの情報)を参照して確認することができる。また、ユーザは、上記のタッチパネル39、又はディスプレイ37の近傍に配置されたハードウェアキー38等を操作して、トラクタ1の制御部4に、トラクタ1を制御するための制御信号(例えば、一時停止信号等)を送信することができる。なお、無線通信端末46はタブレット型のパーソナルコンピュータに限るものではなく、こえに代えて、例えばノート型のパーソナルコンピュータで構成することも可能である。あるいは、前述の協調作業を行うために有人のトラクタを無人のトラクタ1に付随して走行させる場合、有人側のトラクタに搭載されるモニタ装置14を無線通信端末とすることもできる。 As shown in FIG. 3, the wireless communication terminal 46 is configured as a tablet-type personal computer provided with a touch panel 39. The user can confirm by referring to the information displayed on the display 37 of the wireless communication terminal 46 (for example, the information from the front camera 56, the rear camera 57, the vehicle speed sensor, and the like). Further, the user operates the touch panel 39, the hardware key 38 arranged in the vicinity of the display 37, or the like, and causes the control unit 4 of the tractor 1 to control a control signal (for example, temporary) for controlling the tractor 1. (Stop signal, etc.) can be transmitted. The wireless communication terminal 46 is not limited to the tablet-type personal computer, and may be configured by, for example, a notebook-type personal computer instead of the tablet-type personal computer. Alternatively, when a manned tractor is run along with the unmanned tractor 1 in order to perform the above-mentioned cooperative work, the monitor device 14 mounted on the manned tractor can be used as a wireless communication terminal.

このように構成されたトラクタ1は、無線通信端末46を用いるユーザの指示に基づいて、圃場上の走行経路Pに沿って走行しつつ、作業経路P1に沿って作業機3による農作業を行うことができる。 Based on the instruction of the user using the wireless communication terminal 46, the tractor 1 configured in this way travels along the traveling path P on the field and performs farm work by the working machine 3 along the working path P1. Can be done.

具体的には、ユーザは、無線通信端末46を用いて各種設定を行うことにより、農作業を行う直線状又は折れ線状の作業経路P1と、当該作業経路P1の端同士を繋ぐ円弧状の旋回路(トラクタ1が旋回を行う非作業経路)P2と、を交互に繋いだ一連の経路としての走行経路(パス)Pを生成することができる。そして、このようにして生成した走行経路(作業経路P1及び非作業経路P2)Pの情報を、トラクタ1の制御部4に電気的に接続された記憶部55に入力(転送)して所定の操作をすることにより、当該制御部4によりトラクタ1を制御して、当該トラクタ1を走行経路Pに沿って自律走行させながら、作業経路P1に沿って作業機3により自律作業させることができる。 Specifically, the user makes various settings using the wireless communication terminal 46, so that the linear or polygonal work path P1 for performing agricultural work and the arc-shaped turning circuit connecting the ends of the work path P1 are connected to each other. It is possible to generate a traveling route (path) P as a series of routes in which (a non-working route in which the tractor 1 makes a turn) P2 and P2 are alternately connected. Then, the information of the traveling route (working route P1 and non-working route P2) P generated in this way is input (transferred) to the storage unit 55 electrically connected to the control unit 4 of the tractor 1 to be predetermined. By performing the operation, the tractor 1 can be controlled by the control unit 4, and the tractor 1 can be autonomously driven by the work machine 3 along the work path P1 while the tractor 1 is autonomously traveled along the travel path P.

以下では、図3から図5までを参照して、無線通信端末46の構成についてより詳細に説明する。図5は、無線通信端末46のディスプレイ37における監視画面100の表示例を示す図である。 Hereinafter, the configuration of the wireless communication terminal 46 will be described in more detail with reference to FIGS. 3 to 5. FIG. 5 is a diagram showing a display example of the monitoring screen 100 on the display 37 of the wireless communication terminal 46.

図3及び図4に示すように、本実施形態の無線通信端末46は、ディスプレイ37、ハードウェアキー38、及びタッチパネル39の他、制御系の主要な構成として、表示制御部31、記憶部32、圃場取得部33、作業領域取得部34、走行経路取得部35、自動位置合わせ開始指示部36、及び自律走行・自律作業再開指示部30等を備える。 As shown in FIGS. 3 and 4, the wireless communication terminal 46 of the present embodiment has a display 37, a hardware key 38, a touch panel 39, and as a main configuration of a control system, a display control unit 31 and a storage unit 32. A field acquisition unit 33, a work area acquisition unit 34, a travel route acquisition unit 35, an automatic alignment start instruction unit 36, an autonomous travel / autonomous work restart instruction unit 30, and the like are provided.

具体的には、無線通信端末46は上述のとおりコンピュータとして構成されており、CPU、ROM、RAM等を備える。また、前記ROMには、トラクタ1に自律走行・自律作業を行わせるための適宜のプログラムが記憶されている。このソフトウェアとハードウェアの協働により、無線通信端末46を、表示制御部31、記憶部32、圃場取得部33、作業領域取得部34、走行経路取得部35、自動位置合わせ開始指示部36、及び自律走行・自律作業再開指示部30等として動作させることができる。 Specifically, the wireless communication terminal 46 is configured as a computer as described above, and includes a CPU, a ROM, a RAM, and the like. Further, the ROM stores an appropriate program for causing the tractor 1 to perform autonomous traveling and autonomous work. By the cooperation of this software and hardware, the wireless communication terminal 46 is converted into a display control unit 31, a storage unit 32, a field acquisition unit 33, a work area acquisition unit 34, a travel route acquisition unit 35, an automatic alignment start instruction unit 36, and the like. It can also be operated as an autonomous traveling / autonomous work restart instruction unit 30 or the like.

表示制御部31は、ディスプレイ37に表示する表示用データを作成し、表示内容を適宜に制御する。例えば、表示制御部31は、トラクタ1を走行経路Pに沿って自律走行させながら作業経路P1に沿って自律作業させている間は、図5に示す監視画面100をディスプレイ37に表示させる。 The display control unit 31 creates display data to be displayed on the display 37, and appropriately controls the display contents. For example, the display control unit 31 displays the monitoring screen 100 shown in FIG. 5 on the display 37 while the tractor 1 is autonomously traveling along the traveling path P and autonomously working along the working path P1.

記憶部32は、ユーザが無線通信端末46のタッチパネル39を操作することにより入力したトラクタ1に関する情報や圃場に関する情報等を記憶するとともに、作成された走行経路P(作業経路P1及び非作業経路P2)の情報等を記憶するメモリである。 The storage unit 32 stores information about the tractor 1 and information about the field input by the user by operating the touch panel 39 of the wireless communication terminal 46, and also stores the created travel route P (work route P1 and non-work route P2). ) Is a memory for storing information and the like.

圃場取得部33は、トラクタ1が自律走行・自律作業を行う対象となる圃場(走行領域)の位置及び形状を記憶する。圃場の位置及び形状は、例えばユーザがトラクタ1に搭乗して圃場の外周に沿って1回り周回するように運転し、そのときの測位用アンテナ6の位置情報の推移を記録することで、取得することができる。圃場取得部33が取得した圃場の位置及び形状は、圃場情報として記憶部32に記憶される。 The field acquisition unit 33 stores the position and shape of the field (traveling area) on which the tractor 1 performs autonomous traveling / autonomous work. The position and shape of the field can be obtained by, for example, the user boarding the tractor 1 and driving the tractor 1 so as to make one round orbit along the outer circumference of the field and recording the transition of the position information of the positioning antenna 6 at that time. can do. The position and shape of the field acquired by the field acquisition unit 33 are stored in the storage unit 32 as field information.

作業領域取得部34は、トラクタ1が自律走行を行う対象の圃場内に配置される、農作業を行う作業領域の位置を設定するものである。具体的に説明すると、本実施形態の無線通信端末46においては、所定の操作をすることにより、枕地の幅と、非耕作地の幅と、を設定可能に構成されている。そして、枕地及び非耕作地からなる非作業領域が、上記の設定内容と、圃場取得部33で取得された圃場の位置及び形状と、に基づいて定められるとともに、圃場の領域から非作業領域を除いた領域が作業領域として定められる。 The work area acquisition unit 34 sets the position of the work area where the farm work is performed, which is arranged in the field where the tractor 1 autonomously travels. Specifically, the wireless communication terminal 46 of the present embodiment is configured so that the width of the headland and the width of the non-cultivated land can be set by performing a predetermined operation. Then, the non-working area consisting of the headland and the non-cultivated land is determined based on the above setting contents and the position and shape of the field acquired by the field acquisition unit 33, and the non-working area from the field area to the non-working area. The area excluding is defined as the work area.

走行経路取得部35は、圃場内においてトラクタ1が自律的に農作業を行う作業経路P1と、この作業経路P1の端同士を結ぶ非作業経路(旋回路)P2と、を交互に繋いだ走行経路Pを生成し、取得する。走行経路Pの生成に必要な情報をユーザがタッチパネル39等により入力すると、走行経路取得部35は、その情報に基づいて自動的に走行経路P(作業経路P1及び非作業経路P2)を作成する。この走行経路Pは、直線状又は折れ線状の作業経路P1が作業領域に含まれ、非作業経路(旋回路)P2が枕地等の非作業領域に含まれるように生成される。走行経路取得部35が生成した走行経路Pは、記憶部32に記憶される。 The travel route acquisition unit 35 alternately connects a work route P1 in which the tractor 1 autonomously performs farm work in the field and a non-work route (turning circuit) P2 connecting the ends of the work route P1. Generate and acquire P. When the user inputs information necessary for generating the travel route P using the touch panel 39 or the like, the travel route acquisition unit 35 automatically creates the travel route P (work route P1 and non-work route P2) based on the information. .. The traveling path P is generated so that the linear or polygonal working path P1 is included in the working area and the non-working path (turning circuit) P2 is included in the non-working area such as a headland. The travel path P generated by the travel route acquisition unit 35 is stored in the storage unit 32.

ユーザは、無線通信端末46を適宜操作して、走行経路取得部35で生成された走行経路Pの情報をトラクタ1の記憶部55に入力(転送)する。その後、ユーザはトラクタ1に搭乗して運転することで、トラクタ1を走行経路Pの開始位置(図9及び図10を参照)に配置する。続いて、ユーザがトラクタ1から降車して無線通信端末46を操作し、自律走行・自律作業の開始を指示する。これにより、トラクタ1が当該走行経路Pに沿って走行しながら作業経路P1に沿って農作業を行うように、制御部4がトラクタ1の走行及び農作業を制御する。 The user appropriately operates the wireless communication terminal 46 to input (transfer) the information of the travel path P generated by the travel route acquisition unit 35 to the storage unit 55 of the tractor 1. After that, the user rides on the tractor 1 and drives the tractor 1 at the start position of the traveling path P (see FIGS. 9 and 10). Subsequently, the user gets off the tractor 1 and operates the wireless communication terminal 46 to instruct the start of autonomous traveling / autonomous work. As a result, the control unit 4 controls the traveling and farming work of the tractor 1 so that the tractor 1 travels along the traveling route P and performs farming work along the working path P1.

自律走行・自律作業の開始に伴って、ディスプレイ37の表示画面は、図5に示す監視画面100に切り換わる。 With the start of autonomous traveling / autonomous work, the display screen of the display 37 is switched to the monitoring screen 100 shown in FIG.

監視画面100の左部には、前方カメラ56及び後方カメラ57から送信されてきたデータをそれぞれ動画データとして表示する前方カメラ表示部101及び後方カメラ表示部102が上下に配置される。監視画面100の右部には、トラクタ1の走行経路P及び現在位置等を図面等でグラフィカルに示す作業状態表示部103が配置される。前方カメラ表示部101の上方には、トラクタ1の現在の車速を表示する車速表示部106が設けられる。車速表示部106には、上述の車速センサから送信されてきたデータに基づいて取得された、トラクタ1の現在の車速が表示される。 On the left side of the monitoring screen 100, a front camera display unit 101 and a rear camera display unit 102 that display data transmitted from the front camera 56 and the rear camera 57 as moving image data are arranged vertically. On the right side of the monitoring screen 100, a work status display unit 103 that graphically shows the traveling path P of the tractor 1, the current position, and the like in a drawing or the like is arranged. Above the front camera display unit 101, a vehicle speed display unit 106 that displays the current vehicle speed of the tractor 1 is provided. The vehicle speed display unit 106 displays the current vehicle speed of the tractor 1 acquired based on the data transmitted from the vehicle speed sensor described above.

次に、本実施形態のトラクタ1で行われる自律走行・自律作業に関する制御について、図4及び図6等を参照しながら説明する。図6は、作業経路P1に設定される逸脱判定幅JW及びマージン幅MWを説明する説明図である。 Next, the control related to the autonomous traveling / autonomous work performed by the tractor 1 of the present embodiment will be described with reference to FIGS. 4 and 6 and the like. FIG. 6 is an explanatory diagram illustrating a deviation determination width JW and a margin width MW set in the work path P1.

本実施形態のトラクタ1は、自律走行・自律作業している間、自機が走行経路Pから逸脱したか否かを常に監視する構成となっている。そして、トラクタ1が例えばスリップや操向アクチュエータ43の不具合等の何らかの事情により走行経路Pから逸脱した場合、トラクタ1(走行機体2)の制御部4は、走行機体2の停止制御をして走行を自動的に停止させる。図6は、走行経路Pの一部である作業経路P1からトラクタ1が逸脱したために停止した様子を示している。 The tractor 1 of the present embodiment is configured to constantly monitor whether or not the own machine deviates from the traveling path P while autonomously traveling and performing autonomous work. When the tractor 1 deviates from the traveling path P due to some reason such as slippage or a malfunction of the steering actuator 43, the control unit 4 of the tractor 1 (traveling machine 2) controls the stop of the traveling machine 2 to travel. Is automatically stopped. FIG. 6 shows a state in which the tractor 1 has stopped because the tractor 1 has deviated from the work path P1 which is a part of the travel path P.

更に、本実施形態においては、トラクタ1が走行経路Pから逸脱したことに基づいて自動的に停止された場合、その後に自律走行・自律作業を再開するための再開位置(再開地点)が設定される構成となっている。なお、ここでの再開位置とは、走行経路Pの中途部から走行・作業を再開するためにトラクタ1を配置する位置を意味する。 Further, in the present embodiment, when the tractor 1 is automatically stopped based on the deviation from the travel path P, a restart position (restart point) for resuming autonomous driving / autonomous work is set thereafter. It has a structure of The restart position here means a position where the tractor 1 is arranged to restart the running / working from the middle part of the traveling path P.

本実施形態のトラクタ1は、上記の機能を実現するための特徴的な構成として、図4に示すように、逸脱判定部51と、再開位置設定部52と、位置合わせ用経路作成判定部53と、位置合わせ用経路作成部54と、を主として備えている。また、上記の機能に関連する構成として、無線通信端末46に自動位置合わせ開始指示部36及び自律走行・自律作業再開指示部30が設けられている。 As shown in FIG. 4, the tractor 1 of the present embodiment has a deviation determination unit 51, a restart position setting unit 52, and a positioning route creation determination unit 53 as a characteristic configuration for realizing the above functions. And a route creating unit 54 for alignment are mainly provided. Further, as a configuration related to the above function, the wireless communication terminal 46 is provided with an automatic alignment start instruction unit 36 and an autonomous traveling / autonomous work restart instruction unit 30.

以下では、上記の機能に関連する各構成について、図4等を参照して詳細に説明する。 Hereinafter, each configuration related to the above functions will be described in detail with reference to FIG. 4 and the like.

逸脱判定部51は、トラクタ1(走行機体2、厳密には測位用アンテナ6)の位置が走行経路Pから逸脱しているか否かを、位置情報取得部49から得られた位置情報、及び記憶部55から読み出したパスに基づいて判定する。図6には走行経路Pのうち直線状の作業経路P1からの逸脱を判定する場合が示されているが、本実施形態では、逸脱判定部51は、作業経路P1に対して予め定められた所定の逸脱判定幅(自律走行継続範囲)JWからトラクタ1の位置が外に出た場合に、トラクタ1が作業経路P1から逸脱したと判定する。作業経路P1に設定された逸脱判定幅JWの例が図6に示され、この逸脱判定幅JWは、作業経路P1を中心として例えば左に車幅(走行機体2の横幅)の1/2、右に車幅の1/2の幅とすることができる。トラクタ1には走行慣性が作用するので、トラクタ1が逸脱判定幅JWから外れた位置T2は、その後にトラクタ1が実際に停止した位置T3とは原則として一致しない。制御部4は、トラクタ1が逸脱判定幅JWから外れ、走行機体2が実際に停止したときの上記位置T3の位置座標を逸脱停止位置として記憶部55に記憶させる。 The deviation determination unit 51 determines whether or not the position of the tractor 1 (traveling machine 2, strictly speaking, the positioning antenna 6) deviates from the traveling path P, the position information obtained from the position information acquisition unit 49, and the storage. The determination is made based on the path read from the unit 55. FIG. 6 shows a case where the deviation from the linear work path P1 in the travel path P is determined, but in the present embodiment, the deviation determination unit 51 is predetermined with respect to the work path P1. When the position of the tractor 1 goes out of the predetermined deviation determination width (autonomous traveling continuation range) JW, it is determined that the tractor 1 has deviated from the work path P1. An example of the deviation determination width JW set in the work path P1 is shown in FIG. 6, and the deviation determination width JW is, for example, 1/2 of the vehicle width (horizontal width of the traveling machine 2) to the left of the work path P1. It can be half the width of the vehicle to the right. Since the traveling inertia acts on the tractor 1, the position T2 where the tractor 1 deviates from the deviation determination width JW does not coincide with the position T3 where the tractor 1 actually stops after that. The control unit 4 stores the position coordinates of the position T3 when the tractor 1 deviates from the deviation determination width JW and the traveling machine body 2 actually stops in the storage unit 55 as the deviation stop position.

なお、逸脱判定部51は、トラクタ1の位置が、上記の逸脱判定幅JWから外れているか否かを監視すると同時に、それよりも狭い幅となるように定められたマージン幅MWから外れているか否かについても監視する。マージン幅MWの例が図6に示され、このマージン幅MWは、例えばGNSSの誤差の範囲をカバーする幅となるように、作業経路P1を中心として左にMA、右にMAの幅とすることができる(ただし、MA<車幅の1/2)。トラクタ1の位置がマージン幅MWから外に出た場合でも、逸脱判定幅JWから外に出ていない限りは、逸脱判定部51は、トラクタ1が作業経路から逸脱したとは判定しない。これにより、GNSSの誤差の範囲は超えてしまうが経路逸脱として処理する必要がない程度の走行経路からのズレによっては、トラクタ1が逸脱に基づいて停止しないようにすることができる。ただし、マージン幅MWから外に出た時点でのトラクタ1の位置は、トラクタ1の走行軌跡にある程度のズレが生じた点として記憶部55に記憶される。以下の説明では、トラクタ1の位置がマージン幅MWの外にはみ出した地点の位置(図6の位置T1)をマージン超過位置と呼ぶことがある。 The deviation determination unit 51 monitors whether the position of the tractor 1 deviates from the deviation determination width JW, and at the same time, deviates from the margin width MW defined to be narrower than that. Also monitor whether or not. An example of the margin width MW is shown in FIG. 6, and the margin width MW is set to the width of MA on the left and the width of MA on the right with the work path P1 as the center so as to cover the error range of GNSS, for example. (However, MA <1/2 of the vehicle width). Even if the position of the tractor 1 goes out of the margin width MW, the deviation determination unit 51 does not determine that the tractor 1 has deviated from the work path unless it goes out of the deviation determination width JW. As a result, the tractor 1 can be prevented from stopping based on the deviation depending on the deviation from the traveling route to the extent that the error range of GNSS is exceeded but it is not necessary to treat it as a route deviation. However, the position of the tractor 1 at the time of going out of the margin width MW is stored in the storage unit 55 as a point where the traveling locus of the tractor 1 is deviated to some extent. In the following description, the position where the position of the tractor 1 protrudes outside the margin width MW (position T1 in FIG. 6) may be referred to as a margin excess position.

なお、非作業経路P2からの逸脱の判定については、詳細は説明しないが、例えば、作業経路P1からの逸脱の判定と同様に、トラクタ1の位置が所定の逸脱判定幅を外れるか否かで判定するように構成することができる。 The determination of deviation from the non-working path P2 will not be described in detail, but for example, as in the determination of deviation from the working path P1, whether or not the position of the tractor 1 deviates from the predetermined deviation determination range. It can be configured to determine.

再開位置設定部52は、トラクタ1が走行経路Pから逸脱した場合に、トラクタ1がその後に自律走行・自律作業を再開する位置となる再開位置R1を算出し、設定する。 When the tractor 1 deviates from the travel path P, the restart position setting unit 52 calculates and sets a restart position R1 at which the tractor 1 subsequently resumes autonomous travel / autonomous work.

位置合わせ用経路作成判定部53は、走行経路Pに対して走行機体2が逸脱したことに基づいてトラクタ1が停止した後、必要に応じて、トラクタ1を現在位置から再開位置R1まで走行させるための位置合わせ用経路の作成を位置合わせ用経路作成部54に指示する。具体的には、図12に示すように再開位置R1を基準とした2つの範囲(第1範囲、及び、前記第1範囲より大きい第2範囲)を考えたときに、位置合わせ用経路作成判定部53は、トラクタ1の現在位置が第1範囲内であるときには、位置合わせ用経路の作成を位置合わせ用経路作成部54に指示しない。一方、位置合わせ用経路作成判定部53は、トラクタ1の現在位置が第1範囲外かつ第2範囲内にあるときには、位置合わせ用経路の作成を位置合わせ用経路作成部54に指示する。 The alignment route creation determination unit 53 causes the tractor 1 to travel from the current position to the restart position R1 as necessary after the tractor 1 has stopped due to the deviation of the traveling aircraft 2 from the traveling route P. The alignment route creation unit 54 is instructed to create the alignment route for the purpose. Specifically, as shown in FIG. 12, when two ranges (the first range and the second range larger than the first range) with respect to the restart position R1 are considered, the alignment route creation determination is made. When the current position of the tractor 1 is within the first range, the unit 53 does not instruct the alignment route creation unit 54 to create the alignment route. On the other hand, when the current position of the tractor 1 is outside the first range and within the second range, the alignment route creation determination unit 53 instructs the alignment route creation unit 54 to create the alignment route.

第1範囲及び第2範囲の例が図12に示されている。図12においては誇張して描かれているが、本実施形態においては、再開位置R1を中心とした小さい円(例えば、半径r=2cmの円)で囲まれた領域が第1範囲であり、再開位置R1を中心とした大きい円(例えば、半径r=車幅/2の円)で囲まれた領域が第2範囲である。 Examples of the first range and the second range are shown in FIG. Although drawn in an exaggerated manner in FIG. 12, in the present embodiment, the region surrounded by a small circle (for example, a circle having a radius r = 2 cm) centered on the restart position R1 is the first range. The second range is a region surrounded by a large circle (for example, a circle having a radius r = a vehicle width / 2) centered on the restart position R1.

自動位置合わせ開始指示部36は、トラクタ1の位置を再開位置R1に合わせる位置合わせを自動で行いたい場合に、ユーザがその旨の信号を制御部4に送信するための操作部である。自動位置合わせ開始指示部36は、例えばディスプレイ37に表示される仮想的なボタンとして構成することができる。 The automatic alignment start instruction unit 36 is an operation unit for the user to transmit a signal to that effect to the control unit 4 when he / she wants to automatically perform positioning for aligning the position of the tractor 1 with the restart position R1. The automatic alignment start instruction unit 36 can be configured as, for example, a virtual button displayed on the display 37.

自律走行・自律作業再開指示部30は、走行経路Pに対して走行機体2が逸脱したことに基づいてトラクタ1が停止した後に、トラクタ1の自律走行・自律作業を開始させたい場合に、ユーザが操作する操作部である。自律走行・自律作業再開指示部30は、例えばディスプレイ37に表示される仮想的なボタンとして構成することができる。本実施形態の自律走行・自律作業再開指示部30は、トラクタ1を再開位置又はその近傍(前記第1範囲内)で一定時間停止させたときに操作可能となり、それ以外の場合には操作不能とされる。 When the user wants to start the autonomous traveling / autonomous work of the tractor 1 after the tractor 1 has stopped due to the deviation of the traveling machine 2 from the traveling path P, the autonomous traveling / autonomous work restart instruction unit 30 wants to start the autonomous traveling / autonomous work of the tractor 1. Is an operation unit operated by. The autonomous traveling / autonomous work restart instruction unit 30 can be configured as, for example, a virtual button displayed on the display 37. The autonomous traveling / autonomous work restart instruction unit 30 of the present embodiment can be operated when the tractor 1 is stopped at the restart position or its vicinity (within the first range) for a certain period of time, and cannot be operated in other cases. It is said that.

次に、トラクタ1の自律走行中に何らかの事情により走行機体2が走行経路Pから逸脱した場合に、逸脱判定部51、再開位置設定部52、位置合わせ用経路作成判定部53、及び位置合わせ用経路作成部54等によって行われる処理について、主として図7及び図8を参照して説明する。図7及び図8は、トラクタ1が走行経路から逸脱して停止した後に、自律走行・自律作業を再開するまでの処理を説明する図である。 Next, when the traveling machine 2 deviates from the traveling path P for some reason during the autonomous traveling of the tractor 1, the deviation determination unit 51, the restart position setting unit 52, the alignment route creation determination unit 53, and the alignment determination unit 53. The processing performed by the route creating unit 54 and the like will be described mainly with reference to FIGS. 7 and 8. 7 and 8 are diagrams for explaining the process from when the tractor 1 deviates from the traveling path and stops, until the autonomous traveling / autonomous work is resumed.

トラクタ1の自律走行時において、逸脱判定部51は、位置情報取得部49により得られた測位用アンテナ6の位置を所定の時間間隔で反復して取得し、測位用アンテナ6の位置が上記の逸脱判定幅JWからはみ出していないかを監視する。トラクタ1が走行経路Pから逸脱した(即ち、測位用アンテナ6の位置が逸脱判定幅JWから外れた)と逸脱判定部51により判定された場合、トラクタ1の制御部4は、走行機体2を停止させるための停止制御を直ちに行う。 During autonomous traveling of the tractor 1, the deviation determination unit 51 repeatedly acquires the position of the positioning antenna 6 obtained by the position information acquisition unit 49 at predetermined time intervals, and the position of the positioning antenna 6 is described above. Monitor whether the deviation judgment width is out of the JW. When the deviation determination unit 51 determines that the tractor 1 deviates from the travel path P (that is, the position of the positioning antenna 6 deviates from the deviation determination width JW), the control unit 4 of the tractor 1 determines that the traveling aircraft 2 is deviated. Immediately perform stop control to stop.

トラクタ1が走行経路Pのうち作業経路P1を走行している場合において、当該トラクタ1が逸脱判定幅JWから外れたときは、その前の段階で、マージン幅MWからも外れているはずである。トラクタ1(厳密に言えば、測位用アンテナ6)の位置がマージン幅MWから外れたと逸脱判定部51が判定した時点で、トラクタ1の制御部4は、当該時点での測位用アンテナ6の位置を示す情報を取得し、上記のマージン超過位置として記憶部55に記憶しておく。 When the tractor 1 is traveling on the work route P1 of the travel route P and the tractor 1 deviates from the deviation determination width JW, it should also deviate from the margin width MW at the stage before that. .. When the deviation determination unit 51 determines that the position of the tractor 1 (strictly speaking, the positioning antenna 6) deviates from the margin width MW, the control unit 4 of the tractor 1 determines the position of the positioning antenna 6 at that time. The information indicating the above-mentioned margin is acquired and stored in the storage unit 55 as the above-mentioned margin excess position.

トラクタ1が走行経路Pからの逸脱に基づいて停止制御されて、走行機体2が実際に停止したことが車速センサの検出結果により確認されると、図7の処理が開始される。再開位置設定部52は、初めに、走行経路Pから逸脱する直前にトラクタ1が走行していた経路が、直線状又は折れ線状の作業経路(農作業が行われる経路)P1であったか否かを判断する(ステップS101)。即ち、トラクタ1が走行経路Pから逸脱する場合としては、図9のように作業経路(農作業が行われる経路)P1から逸脱する場合と、図10のように非作業経路(旋回路)P2から逸脱する場合とがあり、再開位置設定部52は、上記の場合のうちの何れであったかを判断する。 When the tractor 1 is stopped and controlled based on the deviation from the traveling path P and it is confirmed by the detection result of the vehicle speed sensor that the traveling aircraft 2 has actually stopped, the process of FIG. 7 is started. The restart position setting unit 52 first determines whether or not the route on which the tractor 1 was traveling immediately before deviating from the travel route P was a linear or polygonal work route (route on which agricultural work is performed) P1. (Step S101). That is, when the tractor 1 deviates from the traveling path P, it deviates from the working route (route where agricultural work is performed) P1 as shown in FIG. 9 and from the non-working route (turning circuit) P2 as shown in FIG. There is a case of deviation, and the restart position setting unit 52 determines which of the above cases was the case.

ステップS101の判断で、走行経路Pから逸脱した直前にトラクタ1が走行していた経路が作業経路P1であると判断された場合(ステップS101、Yes)、再開位置設定部52は、再開位置を算出するために必要な情報として、上記のマージン超過位置(図6の例では、位置T1)の位置情報を記憶部55から取得する(ステップS102)。 When it is determined in step S101 that the route on which the tractor 1 was traveling immediately before deviating from the travel route P is the work route P1 (steps S101, Yes), the restart position setting unit 52 sets the restart position. As the information necessary for the calculation, the position information of the above margin excess position (position T1 in the example of FIG. 6) is acquired from the storage unit 55 (step S102).

続いて、再開位置設定部52は、走行経路Pから逸脱する直前にトラクタ1が走行していた作業経路P1を複数の作業経路P1,P1,・・・の中から特定し、当該特定した作業経路P1に対して、ステップS102で取得したマージン超過位置T1から仮想的な垂線を引く(ステップS103)。なお、図6は、図11のマージン超過位置T1近傍を拡大したものであり、この図6において上記の垂線が説明されている。そして、再開位置設定部52は、ステップS103で引いた垂線の足の位置(上記の垂線と、作業経路P1と、の交点の位置)を、自律作業を再開する再開位置R1として設定し、記憶する(ステップS104)。 Subsequently, the restart position setting unit 52 identifies the work path P1 on which the tractor 1 was traveling immediately before deviating from the travel path P from among the plurality of work paths P1, P1, ..., And the specified work. A virtual perpendicular line is drawn from the margin excess position T1 acquired in step S102 with respect to the path P1 (step S103). Note that FIG. 6 is an enlargement of the vicinity of the margin excess position T1 in FIG. 11, and the vertical line is described in FIG. Then, the restart position setting unit 52 sets the position of the foot of the vertical line drawn in step S103 (the position of the intersection of the above vertical line and the work path P1) as the restart position R1 for restarting the autonomous work, and stores it. (Step S104).

ステップS101の判断で、走行経路Pから逸脱する直前にトラクタ1が走行していた経路が非作業経路(農作業を行わずに走行機体2の方向変換を行う経路)P2であった場合、続いて再開位置設定部52は、トラクタ1が停止した位置が作業領域内に入っているか否かを判定する(ステップS105)。 If, at the determination of step S101, the route on which the tractor 1 was traveling immediately before deviating from the traveling route P is a non-working route (a route for changing the direction of the traveling aircraft 2 without performing agricultural work) P2, the following is continued. The restart position setting unit 52 determines whether or not the position where the tractor 1 has stopped is within the work area (step S105).

図10の例に示すようにトラクタ1の停止位置が非作業領域であった場合(ステップS105、No)、再開位置設定部52は、その非作業経路P2上の適宜の位置を再開位置として設定する(ステップS106)。この再開位置の設定方法としては、例えば、図10のように非作業経路P2に直線部分がある場合に、その直線部分において停止位置から最も近い点を再開位置R1とすることが考えられる。ただし、上記の方法に限定されず、再開位置は他の方法で定められても良い。 As shown in the example of FIG. 10, when the stop position of the tractor 1 is a non-working area (step S105, No), the restart position setting unit 52 sets an appropriate position on the non-work path P2 as the restart position. (Step S106). As a method of setting the restart position, for example, when there is a straight line portion in the non-working path P2 as shown in FIG. 10, the point closest to the stop position in the straight line portion may be set as the restart position R1. However, the present invention is not limited to the above method, and the restart position may be determined by another method.

一方、トラクタ1の停止位置が作業領域であった場合(ステップS105、Yes)、図11の例に示すように、トラクタ1の停止制御が行われてから実際にトラクタ1が停止するまでの間に、トラクタ1が非作業領域と作業領域の境界を跨いで、作業領域に入り込んだことを意味する。その場合、圃場に対してムラなく(未耕地領域を残すことなく)農作業を施すために、再開位置設定部52は、逸脱した非作業経路P2の下流端(言い換えれば、当該非作業経路P2に下流側で接続する作業経路P1の上流端)を、再開位置R1として設定する。この再開位置R1は、走行経路Pにおいて、作業領域と非作業領域の境界に位置する。 On the other hand, when the stop position of the tractor 1 is the work area (step S105, Yes), as shown in the example of FIG. 11, between the time when the stop control of the tractor 1 is performed and the time when the tractor 1 actually stops. In addition, it means that the tractor 1 has entered the working area across the boundary between the non-working area and the working area. In that case, in order to carry out the farm work evenly (without leaving the uncultivated land area) on the field, the restart position setting unit 52 is set to the downstream end of the deviated non-working path P2 (in other words, the non-working path P2). The upstream end of the work path P1 connected on the downstream side) is set as the restart position R1. This restart position R1 is located at the boundary between the working area and the non-working area in the traveling path P.

経路の逸脱によりトラクタ1が停止した後、ユーザは、経路逸脱の原因を調べるために、トラクタ1の状態を点検する。このとき、点検をし易くするために、例えば圃場の適宜の場所にトラクタ1を移動させても良い。 After the tractor 1 is stopped due to the deviation of the route, the user checks the state of the tractor 1 in order to investigate the cause of the deviation of the route. At this time, the tractor 1 may be moved to an appropriate place in the field, for example, in order to facilitate inspection.

その後、ユーザが自律走行・自律作業の再開を望む場合、トラクタ1に搭乗して手動で運転し、再開位置R1又はその近傍まで移動させ、停止させる。このとき、再開位置R1(好ましくは、更に、図8のステップS112における第2範囲)とともにトラクタ1の現在位置を無線通信端末46のディスプレイ37にリアルタイムで表示すると、ユーザがトラクタ1を再開位置R1までどのように移動させるべきかを理解し易くなる点で好ましい。 After that, when the user wishes to resume autonomous driving / autonomous work, he / she gets on the tractor 1 and manually drives the tractor 1, moves the tractor to the restart position R1 or its vicinity, and stops the tractor 1. At this time, when the current position of the tractor 1 is displayed in real time on the display 37 of the wireless communication terminal 46 together with the restart position R1 (preferably, the second range in step S112 of FIG. 8), the user sets the tractor 1 to the restart position R1. It is preferable because it makes it easier to understand how to move to.

何れの地点に再開位置R1が設定された場合でも、位置合わせ用経路作成判定部53は、ユーザが自律走行・自律作業再開指示部30を操作して自律走行を再開する旨の指示を行うまで待機する(図8のステップS108)。 Regardless of which point the restart position R1 is set, the alignment route creation determination unit 53 operates the autonomous travel / autonomous work restart instruction unit 30 until the user gives an instruction to restart the autonomous travel. Stand by (step S108 in FIG. 8).

ユーザがトラクタ1から降車し、無線通信端末46の自律走行・自律作業再開指示部30を操作して自律走行を再開する旨の指示を行った場合は(ステップS108、Yes)、位置合わせ用経路作成判定部53はトラクタ1の現在位置を取得する(ステップS109)。 When the user gets off from the tractor 1 and gives an instruction to restart the autonomous running by operating the autonomous running / autonomous work restart instruction unit 30 of the wireless communication terminal 46 (step S108, Yes), the alignment route. The creation determination unit 53 acquires the current position of the tractor 1 (step S109).

続いて、位置合わせ用経路作成判定部53は、トラクタ1の現在位置が、再開位置R1を基準とした第1範囲に入っているかを判定する(ステップS110)。なお、本実施形態の第1範囲は、再開位置R1を中心とした半径2cm程度の範囲に設定されている。トラクタ1の現在位置が第1範囲に入っている場合(ステップS110、Yes)、トラクタ1の現在位置が再開位置R1に十分に近いので、再開位置R1へのトラクタ1の位置合わせを改めて行う必要性が乏しい。従って、この場合は、位置合わせ用経路作成判定部53は、位置合わせ用経路の作成を位置合わせ用経路作成部54に指示しない。 Subsequently, the alignment route creation determination unit 53 determines whether the current position of the tractor 1 is within the first range with respect to the restart position R1 (step S110). The first range of the present embodiment is set to a range having a radius of about 2 cm centered on the restart position R1. When the current position of the tractor 1 is within the first range (step S110, Yes), the current position of the tractor 1 is sufficiently close to the restart position R1, so it is necessary to realign the tractor 1 with the restart position R1. Poor sex. Therefore, in this case, the alignment route creation determination unit 53 does not instruct the alignment route creation unit 54 to create the alignment route.

そして、制御部4は走行機体2及び作業機3等を制御して、現在位置から自律走行・自律作業を再開し(ステップS111)、一連の処理を終了する。 Then, the control unit 4 controls the traveling machine body 2, the working machine 3, and the like, restarts the autonomous traveling / autonomous work from the current position (step S111), and ends a series of processes.

ステップS110での判断の結果、トラクタ1の現在位置が第1範囲に入っていない場合(ステップS110、No)、位置合わせ用経路作成判定部53は、トラクタ1の現在位置が再開位置R1を基準とした第2範囲に入っているかを判定する(ステップS112)。なお、本実施形態の第2範囲は、再開位置R1を中心とした半径が車幅の1/2程度範囲に設定されている。ステップS112での判断の結果、トラクタ1の現在位置が第2範囲に入っていない場合(ステップS112、No)、トラクタ1が走行経路Pから逸脱して停止した状態を維持して、ステップS108に戻る。 As a result of the determination in step S110, when the current position of the tractor 1 is not within the first range (step S110, No), the alignment route creation determination unit 53 uses the restart position R1 as the reference for the current position of the tractor 1. It is determined whether or not it is within the second range (step S112). In the second range of the present embodiment, the radius centered on the restart position R1 is set to a range of about ½ of the vehicle width. As a result of the determination in step S112, when the current position of the tractor 1 is not within the second range (step S112, No), the tractor 1 deviates from the traveling path P and is maintained in a stopped state, and the step S108 is performed. return.

トラクタ1の現在位置が第1範囲外かつ第2範囲内である場合(ステップS112、Yes)、トラクタ1の現在位置が再開位置R1からやや離れているので、自動で再開位置R1に位置合わせを行うことが望ましいと考えられる。そこで、位置合わせ用経路作成判定部53は、位置合わせ用経路作成部54に位置合わせ用経路を作成させるための指示を行う。これを受けて、位置合わせ用経路作成部54は、トラクタ1の現在位置(始点)から再開位置R1(終点)までを繋ぐ一連の位置合わせ用経路を作成する(ステップS113)。 When the current position of the tractor 1 is outside the first range and within the second range (step S112, Yes), the current position of the tractor 1 is slightly distant from the restart position R1, so the position is automatically adjusted to the restart position R1. It is considered desirable to do so. Therefore, the alignment route creation determination unit 53 gives an instruction to cause the alignment route creation unit 54 to create the alignment route. In response to this, the alignment route creation unit 54 creates a series of alignment routes connecting the current position (start point) of the tractor 1 to the restart position R1 (end point) (step S113).

この際、例えば図12に示すように、トラクタ1の現在位置が再開位置R1に対して進行方向前方(走行経路Pにおける進行方向前方)に位置している場合、位置合わせ用経路作成部54は、トラクタ1を後進させる経路を含む位置合わせ用経路を作成する。図12の例では、作成された位置合わせ用経路が太線の破線で描かれている。位置合わせ用経路作成部54が作成する位置合わせ用経路は、その終点にトラクタ1が至ったときに走行機体2の向きが進行方向前方を向くように算出される。 At this time, for example, as shown in FIG. 12, when the current position of the tractor 1 is located forward in the traveling direction (forward in the traveling direction in the traveling route P) with respect to the restart position R1, the alignment route creating unit 54 , Create an alignment route including a route for moving the tractor 1 backward. In the example of FIG. 12, the created alignment path is drawn by a thick broken line. The alignment route created by the alignment route creation unit 54 is calculated so that the direction of the traveling machine body 2 faces forward in the traveling direction when the tractor 1 reaches the end point thereof.

一方、例えば図13に示すように、トラクタ1の現在位置が再開位置R1に対して進行方向後方(走行経路Pにおける進行方向後方)に位置している場合、位置合わせ用経路作成部54は、トラクタ1を前進させて再開位置R1に到達させるような位置合わせ用経路を作成する。位置合わせ用経路作成部54で作成された位置合わせ用経路は、記憶部55に記憶される。 On the other hand, for example, as shown in FIG. 13, when the current position of the tractor 1 is located behind the traveling direction (rearward in the traveling direction in the traveling route P) with respect to the restart position R1, the alignment route creating unit 54 may perform the alignment route creation unit 54. An alignment route is created so that the tractor 1 is advanced to reach the restart position R1. The alignment route created by the alignment route creation unit 54 is stored in the storage unit 55.

ステップS113において位置合わせ用経路が作成されたら、その後、制御部4は、ステップS113で作成した位置合わせ用経路に沿ってトラクタ1を自律的に走行させて、再開位置R1においてトラクタ1が停止するように制御する(ステップS114)。この際、本実施形態では、例えば図13の例で示すように、トラクタ1を前進させながら再開位置R1に到達させる位置合わせ用経路が生成されている場合、制御部4は、トラクタ1を位置合わせ経路に沿って自律的に走行させながら、作業機3で農作業を行わせる。一方、図12の例で示すように、トラクタ1を後進させながら再開位置R1に到達させる位置合わせ用経路の場合には、作業機3を停止させた状態でトラクタ1の位置合わせが行われる。 After the alignment route is created in step S113, the control unit 4 autonomously causes the tractor 1 to travel along the alignment route created in step S113, and the tractor 1 stops at the restart position R1. (Step S114). At this time, in the present embodiment, for example, as shown in the example of FIG. 13, when the alignment path for reaching the restart position R1 while advancing the tractor 1 is generated, the control unit 4 positions the tractor 1. The work machine 3 is used to carry out farm work while autonomously traveling along the matching route. On the other hand, as shown in the example of FIG. 12, in the case of the alignment route in which the tractor 1 is moved backward to reach the restart position R1, the alignment of the tractor 1 is performed with the working machine 3 stopped.

上記の処理によりトラクタ1が走行経路P上の中途部(再開位置)に復帰し、その後ユーザが無線通信端末46を用いて適宜の処理をすることにより、自律走行・自律作業を再開させることができる。 By the above processing, the tractor 1 returns to the middle part (restart position) on the traveling path P, and then the user performs appropriate processing using the wireless communication terminal 46 to restart the autonomous traveling / autonomous work. can.

このように、本実施形態においては、ユーザがロボットトラクタ1に搭乗して当該トラクタ1を運転操作して再開位置R1にピンポイントで移動させなくても、逸脱停止後のトラクタ1の位置が第1範囲内に入っていればその位置から自律走行・自律作業を再開することができる。更には、逸脱停止後のトラクタ1の位置が第1範囲外かつ第2範囲内であれば、位置合わせ用経路(図12及び図13の太い点線を参照)を生成して、この経路に沿ってトラクタ1を自動で運転して再開位置R1に位置合わせをすることができる。このように、従来のようにトラクタの位置を手動操作で再開位置に正確に合わせる必要がなくなるので、高度な運転技術が必要でなくなり、容易に位置合わせを行うことができる。 As described above, in the present embodiment, the position of the tractor 1 after the deviation stop is the first, even if the user does not board the robot tractor 1 and operate the tractor 1 to pinpoint the restart position R1. If it is within one range, autonomous driving / autonomous work can be resumed from that position. Further, if the position of the tractor 1 after the deviation stop is outside the first range and within the second range, an alignment path (see the thick dotted line in FIGS. 12 and 13) is generated and along this path. The tractor 1 can be automatically operated to align with the restart position R1. As described above, since it is not necessary to accurately adjust the position of the tractor to the restart position by manual operation as in the conventional case, advanced driving technique is not required and the alignment can be easily performed.

また、本実施形態においては、再開位置R1に対して進行方向前方にトラクタ1が位置している場合、手動操作では難しい後進走行を自動(自律走行)で行うことにより、トラクタ1を再開位置R1に正確に到達させることができる。よって、切返し操作等を多用することなく、トラクタ1を再開位置R1に配置することができるので、圃場を過剰に傷めてしまうおそれが軽減される。 Further, in the present embodiment, when the tractor 1 is located in front of the restart position R1 in the traveling direction, the tractor 1 is moved to the restart position R1 by automatically performing reverse running (autonomous running), which is difficult by manual operation. Can be reached exactly. Therefore, since the tractor 1 can be arranged at the restart position R1 without using a lot of turning operations and the like, the possibility of excessively damaging the field is reduced.

また、本実施形態においては、トラクタ1が非作業経路P2から逸脱してから実際に停止するまでの間にトラクタ1が非作業領域と作業領域の境界を跨いで作業領域に入り込んだ場合に、非作業領域と作業領域の境界に設定された再開位置R1まで自動で移動させて、その位置から自律作業を再開することができる。よって、未作業領域が生じることなく農作業を行うことができる。 Further, in the present embodiment, when the tractor 1 crosses the boundary between the non-working area and the working area and enters the working area between the time when the tractor 1 deviates from the non-working path P2 and the time when the tractor 1 actually stops. It is possible to automatically move to the restart position R1 set at the boundary between the non-work area and the work area, and restart the autonomous work from that position. Therefore, farm work can be performed without creating an unworked area.

また、本実施形態においては、トラクタ1が走行経路Pから逸脱したことに基づいて停止された場合に限り、再開位置R1を設定する。即ち、トラクタ1が走行経路Pから逸脱していないが、例えばユーザが無線通信端末46に対して適宜の停止操作を行ったために一時停止や緊急停止がされたような場合には、再開位置は設定されない。よって、再開位置の設定(算出)に伴う計算負荷を減らすことができる。 Further, in the present embodiment, the restart position R1 is set only when the tractor 1 is stopped based on the deviation from the traveling path P. That is, if the tractor 1 does not deviate from the travel path P, but is temporarily stopped or urgently stopped because, for example, the user has performed an appropriate stop operation on the wireless communication terminal 46, the restart position is set. Not set. Therefore, the calculation load associated with the setting (calculation) of the restart position can be reduced.

以上に説明したように、本実施形態の自律走行システム99は、位置情報取得部49と、制御部4と、再開位置設定部52と、を備える。位置情報取得部49は、トラクタ(作業車両)1の位置情報を取得する。制御部4は、予め定められた走行経路Pに沿ってトラクタ1を自律走行させながら予め定められた作業経路P1に沿って自律作業させるとともに、走行経路Pに対するトラクタ1の逸脱に基づいてトラクタ1を停止させる。再開位置設定部52は、前記停止後、トラクタ1による自律作業の再開位置R1を設定する。制御部4は、前記停止後、トラクタ1の現在位置が再開位置R1を基準とした第1範囲内である場合、トラクタ1の自律作業をトラクタ1の現在位置から再開させることが可能である。また、制御部4は、トラクタ1の現在位置が第1範囲外であり、かつ、再開位置R1を基準とした第2範囲内である場合、トラクタ1を現在位置から再開位置R1まで自律走行させた後に、自律作業を再開させることが可能である。 As described above, the autonomous traveling system 99 of the present embodiment includes a position information acquisition unit 49, a control unit 4, and a restart position setting unit 52. The position information acquisition unit 49 acquires the position information of the tractor (working vehicle) 1. The control unit 4 autonomously causes the tractor 1 to travel along the predetermined travel path P, autonomously works along the predetermined work path P1, and the tractor 1 is based on the deviation of the tractor 1 with respect to the predetermined travel path P. To stop. After the stop, the restart position setting unit 52 sets the restart position R1 of the autonomous work by the tractor 1. After the stop, the control unit 4 can restart the autonomous work of the tractor 1 from the current position of the tractor 1 when the current position of the tractor 1 is within the first range with respect to the restart position R1. Further, when the current position of the tractor 1 is outside the first range and within the second range with respect to the restart position R1, the control unit 4 autonomously causes the tractor 1 to travel from the current position to the restart position R1. After that, it is possible to resume autonomous work.

これにより、ユーザがトラクタ1を運転して再開位置R1にピンポイントで移動させなくても、自律作業を再開することができ、停止後、自律作業の再開が容易に行える。 As a result, the autonomous work can be restarted without the user driving the tractor 1 and pinpointing the movement to the restart position R1, and the autonomous work can be easily restarted after the stop.

また、本実施形態の自律走行システム99においては、制御部4は、前記停止後のトラクタ1の現在位置が、再開位置R1から第1範囲外かつ第2範囲内であって、再開位置R1に対して走行経路Pの進行方向前方である場合、図12に示すように、トラクタ1を再開位置R1まで後進させた後、作業経路P1に沿ってトラクタ1に自律作業させることが可能である。 Further, in the autonomous traveling system 99 of the present embodiment, the control unit 4 determines that the current position of the tractor 1 after the stop is outside the first range and within the second range from the restart position R1 and is at the restart position R1. On the other hand, when the traveling path P is ahead in the traveling direction, as shown in FIG. 12, after the tractor 1 is moved backward to the restart position R1, the tractor 1 can autonomously work along the working path P1.

これにより、トラクタ1が再開位置R1に対して進行方向前方にある場合に、トラクタ1の車体の向きによっては、後進して再開位置R1に到達させることができる。 As a result, when the tractor 1 is in front of the restart position R1 in the traveling direction, the tractor 1 can be moved backward to reach the restart position R1 depending on the direction of the vehicle body of the tractor 1.

また、本実施形態の自律走行システム99は、以下の構成とされる。即ち、制御部4が、トラクタ1により作業が行われない非作業経路P2における走行経路Pに対するトラクタ1の逸脱に基づいてトラクタ1の停止制御をした結果、トラクタ1が当該トラクタ1により作業が行われる作業領域において停止した場合、再開位置設定部52は、図11に示すように、走行経路P上であって、作業領域と非作業領域との境界に再開位置R1を設定することが可能である。制御部4は、再開位置設定部52により前記境界に再開位置R1が設定された場合、走行機体2を前記境界上の再開位置R1まで自律走行させた後、作業経路P1に沿ってトラクタ1に自律作業させることが可能である。 Further, the autonomous traveling system 99 of the present embodiment has the following configuration. That is, as a result of the control unit 4 controlling the stop of the tractor 1 based on the deviation of the tractor 1 with respect to the traveling path P in the non-working path P2 in which the work is not performed by the tractor 1, the tractor 1 performs the work by the tractor 1. When stopped in the work area, the restart position setting unit 52 can set the restart position R1 on the traveling path P at the boundary between the work area and the non-work area, as shown in FIG. be. When the restart position R1 is set at the boundary by the restart position setting unit 52, the control unit 4 autonomously causes the traveling machine body 2 to travel to the restart position R1 on the boundary, and then makes the tractor 1 along the work path P1. It is possible to work autonomously.

これにより、トラクタ1の逸脱に基づいてトラクタ1の停止制御が行われてから実際にトラクタ1が停止するまでの間に、トラクタ1が非作業領域と作業領域との境界を跨いで作業領域に入り込んだ場合、再開位置R1が両領域の境界に設定されるので、適切に作業が行われる。 As a result, between the time when the stop control of the tractor 1 is performed based on the deviation of the tractor 1 and the time when the tractor 1 actually stops, the tractor 1 straddles the boundary between the non-work area and the work area and becomes a work area. In the case of entering, the restart position R1 is set at the boundary between both regions, so that the work is appropriately performed.

また、本実施形態の自律走行システム99においては、再開位置設定部52は、トラクタ1が走行経路P上に位置するときに停止信号に基づいて制御部4により停止された場合、再開位置R1を設定しない。 Further, in the autonomous traveling system 99 of the present embodiment, the restart position setting unit 52 sets the restart position R1 when the tractor 1 is stopped by the control unit 4 based on the stop signal when the tractor 1 is located on the travel path P. Not set.

これにより、その場で自律走行・自律作業を再開すれば良い場合には再開位置R1が設定されないので、処理を効率化することができる。 As a result, the restart position R1 is not set when the autonomous traveling / autonomous work can be restarted on the spot, so that the processing can be made more efficient.

以上に本発明の好適な実施の形態を説明したが、上記の構成は例えば以下のように変更することができる。 Although the preferred embodiment of the present invention has been described above, the above configuration can be changed as follows, for example.

上記の実施形態では、トラクタ1の現在位置が再開位置R1に対して進行方向の後方の位置にあり、当該位置から再開位置R1に自動で位置合わせが行われる場合には、トラクタ1を当該位置合わせ用経路に沿って自律走行させながら作業機3で農作業を行わせるものとした。しかしながら、必ずしもこれに限るものではなく、トラクタ1を現在位置から再開位置R1まで位置合わせ用経路に沿って走行させる際に、農作業を行わせずに走行させる(空走させる)ものとしてもよい。 In the above embodiment, when the current position of the tractor 1 is located behind the restart position R1 in the traveling direction and the position is automatically aligned with the restart position R1, the tractor 1 is placed at the position. Agricultural work was to be performed by the work machine 3 while autonomously traveling along the matching route. However, the present invention is not limited to this, and when the tractor 1 is traveled along the alignment route from the current position to the restart position R1, the tractor 1 may be traveled (idle) without performing agricultural work.

あるいは、トラクタ1の現在位置が再開位置R1に対して進行方向に対してどの方角の位置にあるかに関わらず、トラクタ1を現在位置から再開位置R1まで位置合わせ用経路に沿って走行させる際に、農作業を行わせながら走行させることとてもよい。その場合、例えば、作業機3が接地したことを条件にして、位置合わせ用経路作成判定部53による判定処理を開始することとしてもよい。 Alternatively, when the tractor 1 is driven along the alignment route from the current position to the restart position R1 regardless of which direction the current position of the tractor 1 is in the traveling direction with respect to the restart position R1. In addition, it is very good to run while doing farm work. In that case, for example, the determination process by the alignment route creation determination unit 53 may be started on the condition that the work machine 3 is grounded.

あるいは、上記に代えて、トラクタ1が所定時間以上停止したことを条件にして、位置合わせ用経路作成判定部53による判定処理を開始することとしてもよい。 Alternatively, instead of the above, the determination process by the alignment route creation determination unit 53 may be started on the condition that the tractor 1 is stopped for a predetermined time or longer.

上記の実施形態では、トラクタ1が非作業経路で逸脱した後に作業経路に入り込んで停止した場合に、トラクタ1が走行経路Pから逸脱する直前に走行していた非作業経路P2の下流端から始まる作業経路P1の上流端の位置を、再開位置R1として設定するものとした。しかしながら、再開位置R1は、作業経路P1上であって、作業領域と非作業領域との境界に設定されるものであればよく、例えばこれに代えて、未作業の(まだ農作業が施されていない)他の作業経路P1の上流端又は下流端に再開位置R1を設定するものとしてもよい。その場合、最終的に全ての作業経路P1,P1,・・・に対して農作業が施されるように、自律作業再開後の走行経路Pを再生成する(未作業の作業経路P1に対して作業を施す順序を適宜入れ換える)ものとしてもよい。 In the above embodiment, when the tractor 1 deviates from the non-working path and then enters the working path and stops, the tractor 1 starts from the downstream end of the non-working path P2 which was traveling immediately before the tractor 1 deviates from the traveling path P. The position of the upstream end of the work path P1 is set as the restart position R1. However, the restart position R1 may be set as long as it is on the work path P1 and is set at the boundary between the work area and the non-work area. (No) The restart position R1 may be set at the upstream end or the downstream end of another work path P1. In that case, the travel path P after resuming the autonomous work is regenerated so that the farm work is finally performed on all the work paths P1, P1, ... (For the unworked work path P1). The order in which the work is performed may be changed as appropriate).

上記の実施形態では、第1範囲及び第2範囲は、何れも、再開位置R1を中心とした円形状の領域であるものとしたが、これに限るものではなく、例えばこれに代えて、第1範囲及び第2範囲を、再開位置R1を中心とした四角い形状の領域あるいは楕円形状の領域であるものとしてもよい。また、再開位置R1は、必ずしも第1範囲及び/又は第2範囲の中心に配置されている必要はなく、再開位置R1が第1範囲及び/又は第2範囲の既作業領域寄りに(既に農作業を施している側に偏って)配置されていてもよい。また、第1範囲及び/又は第2範囲の外周は必ずしも連続的である必要はなく、一部の箇所で不連続となっていてもよい。図12及び図13に示した例以外の、第1範囲及び第2範囲の設定例を図14に示す。図14中のハッチングは、第1範囲外かつ第2範囲内の領域を表しており、この範囲内にトラクタ1が配置されている場合に、自動で位置合わせを行うための位置合わせ用経路が作成される。 In the above embodiment, both the first range and the second range are assumed to be a circular region centered on the restart position R1, but the present invention is not limited to this, and for example, instead of this, a first range is used. The first range and the second range may be a square-shaped region or an elliptical-shaped region centered on the restart position R1. Further, the restart position R1 does not necessarily have to be arranged at the center of the first range and / or the second range, and the restart position R1 is closer to the existing work area of the first range and / or the second range (already agricultural work). It may be arranged unevenly toward the side where the above is applied. Further, the outer circumference of the first range and / or the second range does not necessarily have to be continuous, and may be discontinuous at some points. 14 shows examples of setting the first range and the second range other than the examples shown in FIGS. 12 and 13. The hatching in FIG. 14 represents a region outside the first range and within the second range, and when the tractor 1 is arranged within this range, an alignment route for automatically aligning is provided. Will be created.

上記の実施形態では、逸脱判定部51、再開位置設定部52、位置合わせ用経路作成判定部53、及び位置合わせ用経路作成部54はトラクタ1に備えられるものとしたが、これらの構成部分がトラクタ1及び無線通信端末46の何れに備えられるかについてはこれに限定されるものではない。また、これ以外の構成部分についても、トラクタ1及び無線通信端末46の何れに備えられていてもよい。 In the above embodiment, the deviation determination unit 51, the restart position setting unit 52, the alignment route creation determination unit 53, and the alignment route creation unit 54 are provided in the tractor 1, but these components are provided. It is not limited to this whether it is provided in the tractor 1 or the wireless communication terminal 46. Further, other components may be provided in either the tractor 1 or the wireless communication terminal 46.

無線通信端末46に相当する機能を有する装置(即ち、圃場の取得、作業領域の取得、走行経路・作業経路の取得、自動位置合わせ開始の指示、及び自律走行・自律作業再開の指示等を行うことが可能な操作装置)が、例えばトラクタ1に付随して走行する有人のトラクタ1の走行機体2に取外し不能に備えられていてもよい。この場合、無線通信端末46を省略することができる。 A device having a function equivalent to the wireless communication terminal 46 (that is, acquisition of a field, acquisition of a work area, acquisition of a travel route / work route, an instruction to start automatic alignment, an instruction to resume autonomous travel / autonomous work, etc. A capable operating device) may be provided, for example, in a non-removable traveling machine 2 of a manned tractor 1 traveling accompanying the tractor 1. In this case, the wireless communication terminal 46 can be omitted.

走行経路Pが、作業領域での自律作業を全て完了した後に、当該作業領域の周囲の非作業領域について自律作業を行う作業経路(例えば、非作業領域に沿って周回するような作業経路)を含んでも良い。この場合、上記のように枕地及び非耕作地として設定された領域においても最終的にはトラクタ1による自律作業が行われることになるが、トラクタ1が作業領域での自律作業を行っている段階では枕地及び非耕作地の領域で作業が行われないため、当該領域を非作業領域として把握することができる。 After the travel path P completes all autonomous work in the work area, a work path (for example, a work path that goes around along the non-work area) for performing autonomous work on the non-work area around the work area is provided. It may be included. In this case, even in the area set as the headland and the non-cultivated land as described above, the autonomous work by the tractor 1 is finally performed, but the tractor 1 is performing the autonomous work in the work area. Since work is not performed in the headland and non-cultivated land at the stage, the area can be grasped as a non-working area.

上記の実施形態では、作業車両は、ユーザが搭乗せずに自律走行するロボットトラクタ1であるものとした。しかしながら、これに代えて、ユーザが搭乗して作業を行う一般的なトラクタに本発明を適用し、当該トラクタが走行経路Pから逸脱した後に作業を再開させるときにだけ、この自律走行システム99を利用した自律走行(自動走行)を行うこととしてもよい。 In the above embodiment, the work vehicle is a robot tractor 1 that autonomously travels without the user getting on board. However, instead of this, the present invention is applied to a general tractor on which the user boarded and works, and the autonomous driving system 99 is used only when the work is restarted after the tractor deviates from the traveling path P. The autonomous driving (automatic driving) used may be performed.

<発明の付記>
本発明の一態様によれば、以下の構成の自律走行システムが提供される。即ち、この自律走行システムは、位置情報取得部と、制御部と、再開位置設定部と、位置合わせ用経路作成部と、を備える。前記位置情報取得部は、作業車両の位置情報を取得する。前記制御部は、予め定められた走行経路に沿って前記作業車両を自律走行させながら予め定められた作業経路に沿って自律作業させるとともに、前記走行経路に対する前記作業車両の逸脱に基づいて前記作業車両を停止させる。前記再開位置設定部は、前記制御部によって前記作業車両が停止させられる場合における当該作業車両の自律作業の再開位置を設定する。前記位置合わせ用経路作成部は、前記作業車両の停止位置から前記再開位置までの位置合わせ用経路を生成する。前記制御部は、前記作業車両を停止させた後、前記位置合わせ用経路作成部によって生成された前記位置合わせ用経路に沿って前記作業車両を前記再開位置まで自律走行させて、前記作業車両に自律作業を再開させることが可能である。
<Supplementary note of invention>
According to one aspect of the present invention, an autonomous traveling system having the following configuration is provided. That is, this autonomous traveling system includes a position information acquisition unit, a control unit, a restart position setting unit, and a positioning route creation unit. The position information acquisition unit acquires the position information of the work vehicle. The control unit autonomously drives the work vehicle along a predetermined travel path, autonomously performs the work along a predetermined work path, and performs the work based on the deviation of the work vehicle with respect to the travel path. Stop the vehicle. The restart position setting unit sets the restart position of the autonomous work of the work vehicle when the work vehicle is stopped by the control unit. The alignment route creation unit generates an alignment route from the stop position of the work vehicle to the restart position. After stopping the work vehicle, the control unit autonomously causes the work vehicle to travel to the restart position along the alignment route generated by the alignment route creation unit, and causes the work vehicle to travel. It is possible to resume autonomous work.

これにより、ユーザが作業車両を運転して再開位置にピンポイントで移動させなくても、自律作業を再開することができ、停止後、自律作業の再開が容易に行える。 As a result, the autonomous work can be restarted without the user driving the work vehicle and pinpointing the work vehicle to the restart position, and the autonomous work can be easily restarted after the stop.

前記の自律走行システムにおいては、前記制御部は、前記作業車両を停止させたとき、前記作業車両が前記再開位置に対して前記走行経路の進行方向前方にある場合、前記作業車両を前記再開位置まで後進させた後、前記作業経路に沿って前記作業車両に自律作業させることが可能であることが好ましい。 In the autonomous traveling system, when the work vehicle is stopped, the control unit moves the work vehicle to the restart position when the work vehicle is in front of the travel path in the traveling direction with respect to the restart position. It is preferable that the work vehicle can autonomously work along the work path after moving backward to.

これにより、作業車両が、再開位置に対して進行方向前方で、走行経路に対する逸脱に基づいて停止した場合、作業車両の車体の向きによっては、後進して再開位置に到達させることができる。 As a result, when the work vehicle stops in front of the restart position in the traveling direction based on the deviation from the traveling path, the work vehicle can be moved backward to reach the restart position depending on the direction of the vehicle body of the work vehicle.

1 トラクタ(作業車両)
4 制御部
49 位置情報取得部
52 再開位置設定部
99 自律走行システム
P 走行経路
P1 作業経路
P2 非作業経路
R1 再開位置
1 Tractor (working vehicle)
4 Control unit 49 Position information acquisition unit 52 Restart position setting unit 99 Autonomous driving system P Travel route P1 Work route P2 Non-work route R1 Restart position

Claims (5)

作業車両の位置情報を取得する位置情報取得部と、
予め定められた走行経路に沿って前記作業車両を自律走行させながら予め定められた作業経路に沿って自律作業させる制御部と、
前記位置情報取得部で得られる位置情報に基づいて、前記作業車両が前記走行経路から逸脱しているか否かを判定する逸脱判定部と、を備え、
前記逸脱判定部は、前記作業車両の位置が前記走行経路を基準とする逸脱判定幅の範囲外にあれば、前記作業車両が前記走行経路から逸脱していると判定し、
前記制御部は、前記逸脱判定部にて前記作業車両が前記走行経路から逸脱していると判定された場合、前記作業車両を停止させる、
自律走行システム。
The location information acquisition unit that acquires the location information of the work vehicle,
A control unit that autonomously drives the work vehicle along a predetermined travel route and autonomously works along a predetermined work route.
A deviation determination unit for determining whether or not the work vehicle deviates from the travel path based on the position information obtained by the position information acquisition unit is provided.
If the position of the work vehicle is outside the range of the deviation determination width based on the travel path, the deviation determination unit determines that the work vehicle deviates from the travel path.
When the deviation determination unit determines that the work vehicle deviates from the travel path, the control unit stops the work vehicle.
Autonomous driving system.
前記逸脱判定部は、前記走行経路に含まれる前記作業経路及び非作業経路のうち前記作業経路についてのみ、前記作業車両が逸脱しているか否かを判定する、
請求項1に記載の自律走行システム。
The deviation determination unit determines whether or not the work vehicle deviates only from the work route among the work route and the non-work route included in the travel route.
The autonomous driving system according to claim 1.
前記逸脱判定部は、
前記作業車両の位置が前記走行経路を基準とし前記逸脱判定幅よりも狭いマージン幅の範囲内にあるか否かを判定し、
前記作業車両の位置が前記マージン幅の範囲外であって前記逸脱判定幅の範囲内にあれば、前記作業車両が前記走行経路から逸脱していないと判定し、前記制御部に前記作業車両の自律走行を継続させる、
請求項1又は2に記載の自律走行システム。
The deviation determination unit
It is determined whether or not the position of the work vehicle is within the margin width narrower than the deviation determination width with respect to the travel route.
If the position of the work vehicle is outside the range of the margin width and within the range of the deviation determination width, it is determined that the work vehicle does not deviate from the travel path, and the control unit is informed of the work vehicle. Continue autonomous driving,
The autonomous driving system according to claim 1 or 2.
前記制御部は、前記作業車両が前記走行経路から逸脱していると判定されて前記作業車両を停止させた場合、直前に前記作業車両の位置が前記マージン幅の範囲から逸脱したマージン超過位置に基づいて設定される再開位置から、前記作業車両に自律作業を再開させる、
請求項3に記載の自律走行システム。
When the control unit determines that the work vehicle deviates from the travel path and stops the work vehicle, the control unit immediately before the position of the work vehicle deviates from the range of the margin width to the margin excess position. The work vehicle is made to resume autonomous work from the restart position set based on the above.
The autonomous driving system according to claim 3.
前記マージン超過位置に基づいて前記再開位置が設定されるのは、前記走行経路に含まれる前記作業経路及び非作業経路のうち前記作業経路において、前記作業車両が逸脱していると判定された場合のみである、
請求項4に記載の自律走行システム。
The restart position is set based on the margin excess position when it is determined that the work vehicle deviates from the work route among the work route and the non-work route included in the travel route. Only,
The autonomous driving system according to claim 4.
JP2022021977A 2020-04-21 2022-02-16 autonomous driving system Active JP7349518B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2022021977A JP7349518B2 (en) 2020-04-21 2022-02-16 autonomous driving system

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2020075179A JP7248619B2 (en) 2020-04-21 2020-04-21 Autonomous driving system
JP2022021977A JP7349518B2 (en) 2020-04-21 2022-02-16 autonomous driving system

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
JP2020075179A Division JP7248619B2 (en) 2020-04-21 2020-04-21 Autonomous driving system

Publications (2)

Publication Number Publication Date
JP2022063315A true JP2022063315A (en) 2022-04-21
JP7349518B2 JP7349518B2 (en) 2023-09-22

Family

ID=71890990

Family Applications (2)

Application Number Title Priority Date Filing Date
JP2020075179A Active JP7248619B2 (en) 2020-04-21 2020-04-21 Autonomous driving system
JP2022021977A Active JP7349518B2 (en) 2020-04-21 2022-02-16 autonomous driving system

Family Applications Before (1)

Application Number Title Priority Date Filing Date
JP2020075179A Active JP7248619B2 (en) 2020-04-21 2020-04-21 Autonomous driving system

Country Status (1)

Country Link
JP (2) JP7248619B2 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2022043534A (en) * 2020-09-04 2022-03-16 株式会社小松製作所 Work machine, operation method of work machine, and system

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0713619A (en) * 1993-06-25 1995-01-17 Kubota Corp Automatic traveling vehicle
JP2013228821A (en) * 2012-04-24 2013-11-07 Mamiya-Op Nequos Co Ltd Working machine, component device thereof, and computer program
JP2015112069A (en) * 2013-12-12 2015-06-22 株式会社クボタ Field work machine
WO2015118730A1 (en) * 2014-02-06 2015-08-13 ヤンマー株式会社 Remote operation device for parallel travel work system
WO2015119263A1 (en) * 2014-02-06 2015-08-13 ヤンマー株式会社 Method for setting travel path of autonomous travel work vehicle
WO2016002096A1 (en) * 2014-07-04 2016-01-07 マミヤ・オーピー株式会社 Work machine; device, method, and program for determining whether or not work machine can enter movement path; recording medium on which program therefor is recorded; and device for controlling movement of work machine
WO2016009688A1 (en) * 2014-07-16 2016-01-21 株式会社リコー System, machine, control method, and program
JP2016053916A (en) * 2014-09-04 2016-04-14 日立建機株式会社 Transport vehicle and travel control device thereof
JP6440647B2 (en) * 2016-03-22 2018-12-19 ヤンマー株式会社 Autonomous driving system

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE10019011A1 (en) 2000-04-17 2001-10-25 Geo Tec Electronics Gmbh Automatic controls for guidance of agricultural machine along defined path uses signals from global positioning system and makes continuous comparison between actual and reference positions
JP3814230B2 (en) 2002-06-05 2006-08-23 ヤンマー農機株式会社 Agricultural sprayer

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0713619A (en) * 1993-06-25 1995-01-17 Kubota Corp Automatic traveling vehicle
JP2013228821A (en) * 2012-04-24 2013-11-07 Mamiya-Op Nequos Co Ltd Working machine, component device thereof, and computer program
JP2015112069A (en) * 2013-12-12 2015-06-22 株式会社クボタ Field work machine
WO2015118730A1 (en) * 2014-02-06 2015-08-13 ヤンマー株式会社 Remote operation device for parallel travel work system
WO2015119263A1 (en) * 2014-02-06 2015-08-13 ヤンマー株式会社 Method for setting travel path of autonomous travel work vehicle
WO2016002096A1 (en) * 2014-07-04 2016-01-07 マミヤ・オーピー株式会社 Work machine; device, method, and program for determining whether or not work machine can enter movement path; recording medium on which program therefor is recorded; and device for controlling movement of work machine
WO2016009688A1 (en) * 2014-07-16 2016-01-21 株式会社リコー System, machine, control method, and program
JP2016053916A (en) * 2014-09-04 2016-04-14 日立建機株式会社 Transport vehicle and travel control device thereof
JP6440647B2 (en) * 2016-03-22 2018-12-19 ヤンマー株式会社 Autonomous driving system

Also Published As

Publication number Publication date
JP2020119600A (en) 2020-08-06
JP7349518B2 (en) 2023-09-22
JP7248619B2 (en) 2023-03-29

Similar Documents

Publication Publication Date Title
JP6440647B2 (en) Autonomous driving system
KR102380578B1 (en) Task vehicle control system
JP6773574B2 (en) Work vehicle control device
JP6564725B2 (en) Driving instruction device
WO2017159801A1 (en) Autonomous traveling system
JP7155328B2 (en) work vehicle
JP6695248B2 (en) Autonomous driving system
JP7160875B2 (en) work vehicle controller
JP2017204061A (en) Autonomous travel route generation system
JP7349518B2 (en) autonomous driving system
JP6708724B2 (en) Autonomous driving system
JP7122339B2 (en) Autonomous driving system
JP2023052307A (en) Autonomous travel system and generation method of work path
JP7075436B2 (en) Work vehicle control system
JP6997889B2 (en) Route generation system
JP2023129688A (en) Autonomous travelling system and method of autonomous travelling

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20220216

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20230131

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230207

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230329

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230613

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230801

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: 20230829

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20230911

R150 Certificate of patent or registration of utility model

Ref document number: 7349518

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150