JP7349518B2 - autonomous driving system - Google Patents

autonomous driving system Download PDF

Info

Publication number
JP7349518B2
JP7349518B2 JP2022021977A JP2022021977A JP7349518B2 JP 7349518 B2 JP7349518 B2 JP 7349518B2 JP 2022021977 A JP2022021977 A JP 2022021977A JP 2022021977 A JP2022021977 A JP 2022021977A JP 7349518 B2 JP7349518 B2 JP 7349518B2
Authority
JP
Japan
Prior art keywords
tractor
work
route
work vehicle
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.)
Active
Application number
JP2022021977A
Other languages
Japanese (ja)
Other versions
JP2022063315A (en
Inventor
敏史 平松
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Yanmar Co Ltd
Original Assignee
Yanmar 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 Co Ltd filed Critical Yanmar 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

Landscapes

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

Description

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

従来から、予め定められた走行経路に沿って自律走行可能な作業車両の自律走行システムが知られている。特許文献1は、この種の自律走行システムに備えられる作業車両及び作業車両の異常検出・対応方法を開示する。この特許文献1の自律走行システムにおいては、作業車両が設定区間外にはみ出したことを検出した場合、速やかに車両をいったん停止し、異常の発生を報知するとともに対応方法を表示して、管理者や運転者に一時的な手動による運転・操作を含めた対応を求める。管理者や運転者により異常への対応が行われた後は、正常状態への復帰のチェックや、管理者や運転者への確認が行われた上で、作業が再開される構成となっている。 2. Description of the Related Art Autonomous travel systems for work vehicles that can autonomously travel along predetermined travel routes have been known. Patent Document 1 discloses a work vehicle included in this type of autonomous driving system and a method for detecting and responding to an abnormality in the work vehicle. In the autonomous driving system of Patent Document 1, when it is detected that the work vehicle has protruded outside the set area, the vehicle is immediately stopped, the occurrence of an abnormality is notified, and a countermeasure is displayed, and the administrator and drivers are requested to take measures including temporary manual driving/operation. After the manager or driver takes action to deal with the abnormality, work is resumed after checking to see if the situation has returned to normal and confirming with the manager or driver. There is.

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

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

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

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

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

次に、図面を参照して本発明の実施の形態を説明する。以下では、図面の各図において同一の部材には同一の符号を付し、重複する説明を省略することがある。また、同一の符号に対応する部材等の名称が、簡略的に言い換えられたり、上位概念又は下位概念の名称で言い換えられたりすることがある。 Next, embodiments of the present invention will be described with reference to the drawings. Hereinafter, the same members in each figure of the drawings will be denoted by the same reference numerals, and overlapping explanations may be omitted. Further, the names of members and the like corresponding to the same reference numerals may be simply rephrased, or may be rephrased with the name of a more general concept or a lower concept.

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

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

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

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

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

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

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

走行機体2の前部にはボンネット9が配置されている。このボンネット9内には、トラクタ1の駆動源であるエンジン10及び燃料タンク(図略)が収容されている。このエンジン10は、例えばディーゼルエンジンにより構成することができるが、これに限るものではなく、例えばガソリンエンジンにより構成してもよい。また、駆動源としては、エンジンに加えて、又はこれに代えて、電気モータを使用してもよい。 A bonnet 9 is arranged at the front of the traveling body 2. The hood 9 accommodates an engine 10 and a fuel tank (not shown), which is a driving source for the tractor 1. This 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 a driving source, an electric motor may be used in addition to or in place of the engine.

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

上記の操作装置としては、図2に示すモニタ装置14、スロットルレバー15、主変速レバー27、複数の油圧操作レバー16、PTOスイッチ17、PTO変速レバー18、副変速レバー19、及び作業機昇降スイッチ28等を例として挙げることができる。これらの操作装置は、座席13の近傍、又はステアリングハンドル12の近傍に配置されている。 The above operating devices include the monitor device 14 shown in FIG. 2, the throttle lever 15, the main shift lever 27, a plurality of hydraulic operating levers 16, the PTO switch 17, the PTO shift lever 18, the auxiliary shift lever 19, and the work equipment lift switch. 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 monitor device 14 is configured to be able to display various information about the tractor 1. The throttle lever 15 is an operating tool for setting the output rotation speed of the engine 10. The main speed change lever 27 is an operating tool for changing the traveling speed of the tractor 1 steplessly. The hydraulic operating lever 16 is an operating tool for switching an unillustrated external hydraulic pressure valve. The PTO switch 17 is an operating tool for switching between transmitting and cutting off power to an unillustrated PTO shaft (power take-off shaft) 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, the PTO shaft rotates, 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. As a result, the PTO shaft does not rotate, and the work machine 3 is stopped. The PTO speed change lever 18 is used to change the power input to the working machine 3, and specifically is an operating tool for changing the rotational speed of the PTO shaft. The sub-shift lever 19 is an operating tool for switching the gear ratio of the travel sub-shift gear mechanism within the transmission 22. The work implement lift switch 28 is an operating tool for raising and lowering the height of the work implement 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, a chassis 20 of the tractor 1 is provided at the bottom of the traveling body 2. The chassis 20 includes a body 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 body frame 21 is a support member at the front of the tractor 1, and supports the engine 10 directly or via a vibration isolating member or the like. Transmission 22 changes the power from engine 10 and transmits it to front axle 23 and rear axle 24. The front axle 23 is configured to transmit power input from the transmission 22 to the front wheels 7. The rear axle 24 is configured to transmit 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 body 2 (forward movement, reverse movement, stopping, turning, etc.) and the operation of the working machine 3 (elevating, lowering, driving, stopping, etc.) . The control unit 4 includes a CPU, ROM, RAM, I/O, etc. (not shown), and the CPU can read various programs from the ROM and execute them. The control unit 4 is electrically connected to a controller for controlling each component included in the tractor 1 (for example, the engine 10, etc.), and a wireless communication unit 40 capable of wirelessly communicating with other wireless communication devices. ing.

上記のコントローラとして、トラクタ1は少なくとも、図略のエンジンコントローラ、車速コントローラ、操向コントローラ及び昇降コントローラを備える。それぞれのコントローラは、制御部4からの電気信号に応じて、トラクタ1の各構成を制御することができる。 As the above controllers, the tractor 1 includes at least an engine controller, a vehicle speed controller, a steering controller, and a lift controller (not shown). Each controller can control each component of the tractor 1 according to electrical signals 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 including an actuator (not shown) that changes 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 that adjusts the injection timing and injection amount of fuel to be injected (supplied) into the combustion chamber of the engine 10 . By controlling the fuel injection device 45, the engine controller can, for example, stop supplying fuel to the engine 10 and stop driving 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 a transmission 42 that is, for example, a movable swash plate type hydraulic continuously variable transmission. The vehicle speed controller can change the gear ratio of the transmission 22 by changing the angle of the swash plate of the transmission 42 using an unillustrated actuator to achieve a desired vehicle speed.

操向コントローラは、ステアリングハンドル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 rotating shaft (steering shaft) of the steering handle 12 . With this configuration, when the tractor 1 travels along 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 as to achieve the obtained rotation angle. 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 lifting controller controls the lifting and lowering of the working machine 3. Specifically, the tractor 1 includes a lifting actuator 44 made of a hydraulic cylinder or the like near a three-point linkage mechanism that connects the working machine 3 to the traveling body 2. With this configuration, the lifting controller drives the lifting actuator 44 based on the control signal input from the control unit 4 to raise and lower the working equipment 3 as appropriate, thereby allowing the working equipment 3 to carry out agricultural work at a desired height. It can be carried out. With this control, the working machine 3 can be supported at a desired height such as a retreat height (a height at which agricultural work is not performed) and a working height (a height at which agricultural work is performed).

なお、上述した図略の複数のコントローラは、制御部4から入力される信号に基づいてエンジン10等の各部を制御していることから、制御部4が実質的に各部を制御していると把握することができる。 In addition, since the plurality of controllers (not shown) described above control each part such as the engine 10 based on signals input from the control part 4, it is assumed that the control part 4 substantially controls each part. can be grasped.

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

具体的には、図4等に示すように、トラクタ1は、自律走行・自律作業を可能とするための各種の構成を備えている。例えば、トラクタ1は、測位システムに基づいて自ら(走行機体2)の位置情報を取得するために必要な測位用アンテナ6等を備える。このような構成により、トラクタ1は、測位システムに基づいて自らの位置情報を取得して、圃場上を自律走行することが可能となっている。 Specifically, as shown in FIG. 4 and the like, the tractor 1 is equipped with various configurations to enable autonomous travel and autonomous work. For example, the tractor 1 includes a positioning antenna 6 and the like necessary for acquiring position information of itself (the traveling vehicle 2) based on a 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 of the tractor 1 to enable autonomous travel will be described in more detail. Specifically, as shown in FIG. 4 etc., the tractor 1 of this 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 memory. 55 and the like. In addition to these, the tractor 1 is equipped with an inertial measurement unit (IMU) that can specify the attitude (roll angle, pitch angle, yaw angle) of the traveling body 2.

測位用アンテナ6は、例えば衛星測位システム(GNSS)等の測位システムを構成する測位衛星からの信号を受信するものである。図1に示すように、測位用アンテナ6は、トラクタ1のキャビン11のルーフ92の上面に取り付けられている。測位用アンテナ6で受信された測位信号は、図4に示す位置検出部としての位置情報取得部49に入力される。位置情報取得部49は、トラクタ1の走行機体2(厳密には、測位用アンテナ6)の位置情報を、例えば緯度・経度情報として算出し、取得する。当該位置情報取得部49で取得された位置情報は、制御部4に入力されて、自律走行に利用される。 The positioning antenna 6 receives signals from positioning satellites that constitute 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 a position information acquisition section 49 as a position detection section shown in FIG. The position information acquisition unit 49 calculates and acquires the position information of the traveling body 2 (strictly speaking, the positioning antenna 6) of the tractor 1 as latitude and 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 driving.

なお、本実施形態ではGNSS-RTK法を利用した高精度の衛星測位システムが用いられているが、これに限るものではなく、高精度の位置座標が得られる限りにおいて他の測位システムを用いてもよい。例えば、相対測位方式(DGPS)、又は静止衛星型衛星航法補強システム(SBAS)を使用することが考えられる。 Although a high-precision satellite positioning system using the GNSS-RTK method is used in this embodiment, the present invention is not limited to this, and other positioning systems may be used as long as highly accurate position coordinates can be obtained. Good too. For example, it is conceivable to use a relative positioning system (DGPS) or a geostationary 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 signals from the wireless communication terminal 46 operated by the user and transmits signals 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 of the cabin 11 of the tractor 1. A signal from the wireless communication terminal 46 received by the wireless communication antenna 48 is input to the control unit 4 after signal processing by the wireless communication unit 40 shown in FIG. Further, a signal transmitted from the control unit 4 or the like to the wireless communication terminal 46 is processed by the wireless communication unit 40, and 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 is for photographing the front of the tractor 1. The rear camera 57 is for photographing 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 video data captured by the front camera 56 and the rear camera 57 is transmitted by the wireless communication unit 40 to the wireless communication terminal 46 from the wireless communication antenna 48 . The wireless communication terminal 46 that has received the video data displays the content on the display 37.

上記の車速センサは、トラクタ1の車速を検出するものであり、例えば前輪7,7の間の車軸に設けられる。車速センサで得られた検出結果のデータは、無線通信部40で信号処理された後、無線通信用アンテナ48から送信されて無線通信端末46で受信されて、その内容がディスプレイ37に表示される。なお、トラクタ1には車速センサ以外にも、当該トラクタ1の状態を検出(監視)するための種々のセンサが設けられている。 The vehicle speed sensor described above detects the vehicle speed of the tractor 1, and is provided, for example, on the axle between the front wheels 7, 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, received by the wireless communication terminal 46, and its contents are 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 driving the tractor 1 and a work route for autonomously working, and stores changes in the position (traveling trajectory) of the tractor 1 (strictly speaking, the positioning antenna 6) during autonomous travel. It is a memory that can be used to In addition, the storage unit 55 stores various information necessary for causing the tractor 1 to travel autonomously and work autonomously.

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

このように構成されたトラクタ1は、無線通信端末46を用いるユーザの指示に基づいて、圃場上の走行経路Pに沿って走行しつつ、作業経路P1に沿って作業機3による農作業を行うことができる。 The tractor 1 configured in this manner is capable of performing agricultural work using the work implement 3 along the work route P1 while traveling along the travel route P on the field based on instructions from a user using the wireless communication terminal 46. I can do it.

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

以下では、図3から図5までを参照して、無線通信端末46の構成についてより詳細に説明する。図5は、無線通信端末46のディスプレイ37における監視画面100の表示例を示す図である。 Below, 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. As shown in FIG.

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

具体的には、無線通信端末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, ROM, RAM, and the like. Further, the ROM stores an appropriate program for causing the tractor 1 to perform autonomous travel and autonomous work. Through the cooperation of this software and hardware, the wireless communication terminal 46 is controlled by the display control section 31, the storage section 32, the field acquisition section 33, the work area acquisition section 34, the driving route acquisition section 35, the automatic positioning start instruction section 36, It can also be operated as an autonomous running/autonomous work restart instruction section 30, etc.

表示制御部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 controls the display contents as appropriate. For example, the display control unit 31 causes the display 37 to display the monitoring screen 100 shown in FIG. 5 while the tractor 1 is autonomously traveling along the travel route P and working autonomously along the work route P1.

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

圃場取得部33は、トラクタ1が自律走行・自律作業を行う対象となる圃場(走行領域)の位置及び形状を記憶する。圃場の位置及び形状は、例えばユーザがトラクタ1に搭乗して圃場の外周に沿って1回り周回するように運転し、そのときの測位用アンテナ6の位置情報の推移を記録することで、取得することができる。圃場取得部33が取得した圃場の位置及び形状は、圃場情報として記憶部32に記憶される。 The field acquisition unit 33 stores the position and shape of a field (driving area) on which the tractor 1 performs autonomous travel and autonomous work. The position and shape of the field can be acquired, for example, by a user riding the tractor 1 and driving it around once along the outer periphery 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 a work area in which agricultural work is to be performed, which is arranged in a field where the tractor 1 is autonomously traveling. Specifically, the wireless communication terminal 46 of this embodiment is configured to be able to set the width of the headland and the width of the non-cultivated land by performing a predetermined operation. Then, a non-working area consisting of the headland and 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 is divided from the field area. The area excluding the area 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 traveling route acquisition unit 35 acquires a traveling route that alternately connects a working route P1 in which the tractor 1 performs agricultural work autonomously in the field and a non-working route (turning route) P2 that connects the ends of this working route P1. Generate and obtain P. When the user inputs the information necessary to generate the driving route P using the touch panel 39 or the like, the driving route acquisition unit 35 automatically creates the driving route P (work route P1 and non-work route P2) based on the information. . This traveling route P is generated such that a straight or polygonal working route P1 is included in the working area, and a non-working route (turning route) P2 is included in a non-working area such as a headland. The driving route P generated by the driving 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 operates the wireless communication terminal 46 as appropriate to input (transfer) information about the driving route P generated by the driving route acquisition unit 35 to the storage unit 55 of the tractor 1. After that, the user gets on the tractor 1 and drives it, thereby placing the tractor 1 at the starting position of the traveling route P (see FIGS. 9 and 10). Subsequently, the user gets off the tractor 1, operates the wireless communication terminal 46, and instructs the start of autonomous driving and autonomous work. Thereby, the control unit 4 controls the traveling and agricultural work of the tractor 1 so that the tractor 1 performs agricultural work along the working route P1 while traveling along the traveling route P.

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

監視画面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 section 101 and a rear camera display section 102 that display data transmitted from the front camera 56 and the rear camera 57 as video data, respectively, are arranged vertically. On the right side of the monitoring screen 100, a work status display section 103 is arranged that graphically shows the traveling route P, current position, etc. of the tractor 1 using a drawing or the like. A vehicle speed display section 106 that displays the current vehicle speed of the tractor 1 is provided above the front camera display section 101. The vehicle speed display section 106 displays the current vehicle speed of the tractor 1, which is acquired based on data transmitted from the vehicle speed sensor described above.

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

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

更に、本実施形態においては、トラクタ1が走行経路Pから逸脱したことに基づいて自動的に停止された場合、その後に自律走行・自律作業を再開するための再開位置(再開地点)が設定される構成となっている。なお、ここでの再開位置とは、走行経路Pの中途部から走行・作業を再開するためにトラクタ1を配置する位置を意味する。 Furthermore, in this embodiment, when the tractor 1 is automatically stopped based on deviating from the travel route P, a restart position (resume point) for restarting autonomous driving/autonomous work is set. The configuration is as follows. Note that the restart position here means a position where the tractor 1 is placed in order to resume traveling and work from a midway point on the traveling route P.

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

以下では、上記の機能に関連する各構成について、図4等を参照して詳細に説明する。 Each configuration related to the above functions will be described in detail below 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 the position of the tractor 1 (traveling body 2, strictly speaking, the positioning antenna 6) deviates from the traveling route P using 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 section 55. Although FIG. 6 shows a case where a deviation from the linear work route P1 of the travel route P is determined, in this embodiment, the deviation determination unit 51 When the position of the tractor 1 is outside a predetermined deviation determination width (autonomous driving continuation range) JW, it is determined that the tractor 1 has deviated from the work route P1. An example of the deviation judgment width JW set for the work route P1 is shown in FIG. 6, and this deviation judgment width JW is, for example, 1/2 of the vehicle width (width of the traveling aircraft 2) to the left with the work route P1 as the center, The right side can be 1/2 the width of the vehicle. Since running inertia acts on the tractor 1, the position T2 at which the tractor 1 deviates from the departure determination width JW does not, in principle, coincide with the position T3 at which the tractor 1 actually stops after that. The control unit 4 causes the storage unit 55 to store the position coordinates of the position T3 when the tractor 1 deviates from the deviation determination width JW and the traveling body 2 actually stops 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)をマージン超過位置と呼ぶことがある。 Note that the deviation determination unit 51 monitors whether the position of the tractor 1 deviates from the above-mentioned deviation determination width JW, and at the same time monitors whether the position of the tractor 1 deviates from the margin width MW that is determined to be narrower than the deviation determination width JW. We will also monitor whether or not the An example of the margin width MW is shown in FIG. 6, and this margin width MW is set to MA on the left and MA on the right with the work route P1 as the center, so as to cover the range of GNSS error, for example. (However, MA < 1/2 of the vehicle width). Even if the position of the tractor 1 goes outside the margin width MW, the departure determination unit 51 does not determine that the tractor 1 has deviated from the work route as long as it does not go outside the departure determination width JW. Thereby, it is possible to prevent the tractor 1 from stopping due to a deviation from the travel route that exceeds the error range of GNSS but does not need to be treated as a route deviation. However, the position of the tractor 1 at the time when it moves out of the margin width MW is stored in the storage unit 55 as a point at which a certain degree of deviation has occurred in the traveling trajectory of the tractor 1. In the following description, the position at which the position of the tractor 1 protrudes outside the margin width MW (position T1 in FIG. 6) may be referred to as the margin excess position.

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

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

位置合わせ用経路作成判定部53は、走行経路Pに対して走行機体2が逸脱したことに基づいてトラクタ1が停止した後、必要に応じて、トラクタ1を現在位置から再開位置R1まで走行させるための位置合わせ用経路の作成を位置合わせ用経路作成部54に指示する。具体的には、図12に示すように再開位置R1を基準とした2つの範囲(第1範囲、及び、前記第1範囲より大きい第2範囲)を考えたときに、位置合わせ用経路作成判定部53は、トラクタ1の現在位置が第1範囲内であるときには、位置合わせ用経路の作成を位置合わせ用経路作成部54に指示しない。一方、位置合わせ用経路作成判定部53は、トラクタ1の現在位置が第1範囲外かつ第2範囲内にあるときには、位置合わせ用経路の作成を位置合わせ用経路作成部54に指示する。 After the tractor 1 has stopped based on the deviation of the traveling machine body 2 from the traveling route P, the alignment route creation determination unit 53 causes the tractor 1 to travel from the current position to the restart position R1 as necessary. The positioning route creating unit 54 is instructed to create a positioning route for the purpose. Specifically, as shown in FIG. 12, when considering two ranges (a first range and a second range larger than the first range) based on the restart position R1, the positioning 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 creating 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 positioning route creation determining unit 53 instructs the positioning route creating unit 54 to create a positioning route.

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

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

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

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

トラクタ1の自律走行時において、逸脱判定部51は、位置情報取得部49により得られた測位用アンテナ6の位置を所定の時間間隔で反復して取得し、測位用アンテナ6の位置が上記の逸脱判定幅JWからはみ出していないかを監視する。トラクタ1が走行経路Pから逸脱した(即ち、測位用アンテナ6の位置が逸脱判定幅JWから外れた)と逸脱判定部51により判定された場合、トラクタ1の制御部4は、走行機体2を停止させるための停止制御を直ちに行う。 When the tractor 1 is autonomously traveling, 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 determines whether the position of the positioning antenna 6 is as described above. Monitor whether it is outside the deviation judgment width JW. When the deviation determination section 51 determines that the tractor 1 has deviated from the traveling route P (that is, the position of the positioning antenna 6 has deviated from the deviation determination width JW), the control section 4 of the tractor 1 causes the traveling body 2 to Immediately perform stop control to stop it.

トラクタ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 driving route P, when the tractor 1 deviates from the deviation judgment width JW, it must also deviate from the margin width MW at a previous stage. . At the time when the deviation determining 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 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 it is confirmed by the detection result of the vehicle speed sensor that the tractor 1 is stopped based on the deviation from the traveling route P and the traveling body 2 has actually stopped, the process shown in FIG. 7 is started. The restart position setting unit 52 first determines whether the route on which the tractor 1 was traveling immediately before deviating from the travel route P was a straight or polygonal work route (a route where agricultural work is performed) P1. (Step S101). That is, the tractor 1 deviates from the driving route P when it deviates from the working route (route where agricultural work is performed) P1 as shown in FIG. The restart position setting unit 52 determines which of the above cases occurred.

ステップS101の判断で、走行経路Pから逸脱した直前にトラクタ1が走行していた経路が作業経路P1であると判断された場合(ステップS101、Yes)、再開位置設定部52は、再開位置を算出するために必要な情報として、上記のマージン超過位置(図6の例では、位置T1)の位置情報を記憶部55から取得する(ステップS102)。 If 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 (step S101, Yes), the restart position setting unit 52 sets the restart position. As information necessary for calculation, the position information of the above-mentioned 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 specifies the work route P1 on which the tractor 1 was traveling immediately before deviating from the travel route P from among the plurality of work routes P1, P1, . . . A virtual perpendicular line is drawn from the margin excess position T1 acquired in step S102 to the route P1 (step S103). Note that FIG. 6 is an enlarged view of the vicinity of the margin excess position T1 in FIG. 11, and the above-mentioned perpendicular line is explained in this FIG. Then, the restart position setting unit 52 sets the foot position of the perpendicular line drawn in step S103 (the position of the intersection of the perpendicular line and the work route 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 it is determined in step S101 that the route on which the tractor 1 was traveling immediately before deviating from the traveling route P is a non-working route P2 (a route in which the direction of the traveling machine body 2 is changed without performing agricultural work), then The restart position setting unit 52 determines whether the position where the tractor 1 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 stopping position of the tractor 1 is in the non-work area (step S105, No), the restart position setting unit 52 sets an appropriate position on the non-work route P2 as the restart position. (Step S106). As a method of setting the restart position, for example, when there is a straight line part in the non-work path P2 as shown in FIG. 10, it is possible to set the point closest to the stop position in the straight line part as the restart position R1. However, the restart position is not limited to the above method, and the restart position may be determined by other methods.

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

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

その後、ユーザが自律走行・自律作業の再開を望む場合、トラクタ1に搭乗して手動で運転し、再開位置R1又はその近傍まで移動させ、停止させる。このとき、再開位置R1(好ましくは、更に、図8のステップS112における第2範囲)とともにトラクタ1の現在位置を無線通信端末46のディスプレイ37にリアルタイムで表示すると、ユーザがトラクタ1を再開位置R1までどのように移動させるべきかを理解し易くなる点で好ましい。 After that, if the user wishes to resume autonomous driving/autonomous work, he/she gets on the tractor 1 and manually drives the tractor 1 to move it to or near the restart position R1 and then stop it. 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 in FIG. 8), the user moves the tractor 1 to the restart position R1. This is preferable because it makes it easier to understand how to move it.

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

ユーザがトラクタ1から降車し、無線通信端末46の自律走行・自律作業再開指示部30を操作して自律走行を再開する旨の指示を行った場合は(ステップS108、Yes)、位置合わせ用経路作成判定部53はトラクタ1の現在位置を取得する(ステップS109)。 If the user gets off the tractor 1 and instructs to resume autonomous driving by operating the autonomous driving/autonomous work restart instruction unit 30 of the wireless communication terminal 46 (step S108, Yes), the positioning route is 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 positioning route creation determining unit 53 determines whether the current position of the tractor 1 is within the first range based on the restart position R1 (step S110). Note that the first range in this embodiment is set to a range with a radius of about 2 cm centered on the restart position R1. If 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 reposition the tractor 1 to the restart position R1. lacking in sex. Therefore, in this case, the alignment route creation determination unit 53 does not instruct the alignment route creation unit 54 to create an alignment route.

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

ステップ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, if the current position of the tractor 1 is not within the first range (step S110, No), the alignment route creation determination unit 53 determines that the current position of the tractor 1 is based on the restart position R1. It is determined whether it is within the second range (step S112). Note that in the second range of the present embodiment, the radius around the restart position R1 is set to be approximately 1/2 of the vehicle width. As a result of the determination in step S112, if the current position of the tractor 1 is not within the second range (step S112, No), the tractor 1 deviates from the traveling route P and remains stopped, and the process proceeds to step S108. return.

トラクタ1の現在位置が第1範囲外かつ第2範囲内である場合(ステップS112、Yes)、トラクタ1の現在位置が再開位置R1からやや離れているので、自動で再開位置R1に位置合わせを行うことが望ましいと考えられる。そこで、位置合わせ用経路作成判定部53は、位置合わせ用経路作成部54に位置合わせ用経路を作成させるための指示を行う。これを受けて、位置合わせ用経路作成部54は、トラクタ1の現在位置(始点)から再開位置R1(終点)までを繋ぐ一連の位置合わせ用経路を作成する(ステップS113)。 If 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 a little far from the restart position R1, so the positioning is automatically performed to the restart position R1. It is considered desirable to do so. Therefore, the alignment route creation determination unit 53 instructs the alignment route creation unit 54 to create an alignment route. In response to this, the alignment route creation unit 54 creates a series of alignment routes that connect the current position (starting 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, if the current position of the tractor 1 is located ahead of the restart position R1 in the traveling direction (forward in the traveling direction on the traveling route P), the positioning route creation unit 54 , a positioning route including a route for reversing the tractor 1 is created. In the example of FIG. 12, the created alignment path is drawn with a thick broken line. The positioning route created by the positioning route creation unit 54 is calculated so that when the tractor 1 reaches the end point, the traveling body 2 faces forward in the traveling direction.

一方、例えば図13に示すように、トラクタ1の現在位置が再開位置R1に対して進行方向後方(走行経路Pにおける進行方向後方)に位置している場合、位置合わせ用経路作成部54は、トラクタ1を前進させて再開位置R1に到達させるような位置合わせ用経路を作成する。位置合わせ用経路作成部54で作成された位置合わせ用経路は、記憶部55に記憶される。 On the other hand, as shown in FIG. 13, for example, when the current position of the tractor 1 is located behind the restart position R1 in the traveling direction (backward in the traveling direction on the traveling route P), the positioning route creation unit 54 A positioning route is created that allows the tractor 1 to move forward and 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 causes the tractor 1 to autonomously 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 this embodiment, as shown in the example of FIG. A working machine 3 is caused to perform agricultural work while autonomously traveling along a matching route. On the other hand, as shown in the example of FIG. 12, in the case of a positioning route in which the tractor 1 is moved backward while reaching the restart position R1, the positioning of the tractor 1 is performed with the working machine 3 stopped.

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

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

また、本実施形態においては、再開位置R1に対して進行方向前方にトラクタ1が位置している場合、手動操作では難しい後進走行を自動(自律走行)で行うことにより、トラクタ1を再開位置R1に正確に到達させることができる。よって、切返し操作等を多用することなく、トラクタ1を再開位置R1に配置することができるので、圃場を過剰に傷めてしまうおそれが軽減される。 In addition, in this 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 (autonomously) performing backward travel, which is difficult to do with manual operation. can be reached accurately. Therefore, the tractor 1 can be placed at the restart position R1 without making frequent use of turning operations and the like, thereby reducing the risk of excessive damage to the field.

また、本実施形態においては、トラクタ1が非作業経路P2から逸脱してから実際に停止するまでの間にトラクタ1が非作業領域と作業領域の境界を跨いで作業領域に入り込んだ場合に、非作業領域と作業領域の境界に設定された再開位置R1まで自動で移動させて、その位置から自律作業を再開することができる。よって、未作業領域が生じることなく農作業を行うことができる。 Furthermore, in the present embodiment, if 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 route 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 resume autonomous work from that position. Therefore, agricultural work can be performed without leaving any unworked areas.

また、本実施形態においては、トラクタ1が走行経路Pから逸脱したことに基づいて停止された場合に限り、再開位置R1を設定する。即ち、トラクタ1が走行経路Pから逸脱していないが、例えばユーザが無線通信端末46に対して適宜の停止操作を行ったために一時停止や緊急停止がされたような場合には、再開位置は設定されない。よって、再開位置の設定(算出)に伴う計算負荷を減らすことができる。 Further, in this embodiment, the restart position R1 is set only when the tractor 1 is stopped based on deviating from the traveling route P. That is, in the case where the tractor 1 has not deviated from the traveling route P but is temporarily stopped or emergency stopped because the user performs an appropriate stop operation on the wireless communication terminal 46, the restart position is Not set. Therefore, the calculation load associated with setting (calculating) 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 driving system 99 of this embodiment includes the position information acquisition section 49, the control section 4, and the restart position setting section 52. The position information acquisition unit 49 acquires position information of the tractor (work vehicle) 1. The control unit 4 causes the tractor 1 to autonomously travel along a predetermined travel route P and work autonomously along a predetermined work route P1, and also causes the tractor 1 to perform autonomous work along a predetermined work route P1 based on a deviation of the tractor 1 from the travel route P. to stop. The restart position setting unit 52 sets a restart position R1 for autonomous work by the tractor 1 after the stop. After the stop, if the current position of the tractor 1 is within a first range based on the restart position R1, the control unit 4 can restart the autonomous work of the tractor 1 from the current position of the tractor 1. Further, when the current position of the tractor 1 is outside the first range and within a second range based on the restart position R1, the control unit 4 causes the tractor 1 to autonomously travel from the current position to the restart position R1. After that, autonomous work can be resumed.

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

また、本実施形態の自律走行システム99においては、制御部4は、前記停止後のトラクタ1の現在位置が、再開位置R1から第1範囲外かつ第2範囲内であって、再開位置R1に対して走行経路Pの進行方向前方である場合、図12に示すように、トラクタ1を再開位置R1まで後進させた後、作業経路P1に沿ってトラクタ1に自律作業させることが可能である。 Furthermore, in the autonomous driving 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 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. On the other hand, if the vehicle is ahead in the traveling direction of the travel route P, as shown in FIG. 12, it is possible to cause the tractor 1 to perform autonomous work along the work route P1 after the tractor 1 is moved backward to the restart position R1.

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

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

これにより、トラクタ1の逸脱に基づいてトラクタ1の停止制御が行われてから実際にトラクタ1が停止するまでの間に、トラクタ1が非作業領域と作業領域との境界を跨いで作業領域に入り込んだ場合、再開位置R1が両領域の境界に設定されるので、適切に作業が行われる。 As a result, the tractor 1 straddles the boundary between the non-working area and the working area and enters the working area 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. If the object enters the area, the restart position R1 is set at the boundary between the two areas, so that the work can be performed appropriately.

また、本実施形態の自律走行システム99においては、再開位置設定部52は、トラクタ1が走行経路P上に位置するときに停止信号に基づいて制御部4により停止された場合、再開位置R1を設定しない。 Further, in the autonomous driving 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 a stop signal when the tractor 1 is located on the travel route P. Not set.

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

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

上記の実施形態では、トラクタ1の現在位置が再開位置R1に対して進行方向の後方の位置にあり、当該位置から再開位置R1に自動で位置合わせが行われる場合には、トラクタ1を当該位置合わせ用経路に沿って自律走行させながら作業機3で農作業を行わせるものとした。しかしながら、必ずしもこれに限るものではなく、トラクタ1を現在位置から再開位置R1まで位置合わせ用経路に沿って走行させる際に、農作業を行わせずに走行させる(空走させる)ものとしてもよい。 In the above embodiment, when the current position of the tractor 1 is behind the restart position R1 in the traveling direction and the positioning is automatically performed from this position to the restart position R1, the tractor 1 is moved to the restart position R1. The farm work is performed using the work machine 3 while autonomously traveling along the alignment route. However, the invention is not necessarily limited to this, and when the tractor 1 is made to travel along the alignment route from the current position to the restart position R1, it may be made to travel (idle run) 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 the direction in which the current position of the tractor 1 is relative to the restart position R1 in the traveling direction. It is very convenient to run the vehicle while doing agricultural 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 has touched the ground.

あるいは、上記に代えて、トラクタ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 has 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 enters the working route and stops after deviating from the non-working route, the vehicle starts from the downstream end of the non-working route P2 that the tractor 1 was traveling on immediately before deviating from the traveling route P. The position of the upstream end of the work route P1 is set as the restart position R1. However, the restart position R1 may be set on the work route P1 and 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 downstream end of another work route P1. In that case, the traveling route P after resuming autonomous work is regenerated so that agricultural work is finally performed on all the work routes P1, P1, ... (for the unworked work route P1). The order in which the operations are 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 circular regions centered on the restart position R1, but the invention is not limited to this. The first range and the second range may be square-shaped regions or elliptical-shaped regions centered on the restart position R1. Further, the restart position R1 does not necessarily have to be located at the center of the first range and/or the second range, and the restart position R1 is located closer to the already worked area of the first range and/or the second range (already agricultural work It may also be arranged (biased to the side where it is applied). Further, the outer periphery of the first range and/or the second range does not necessarily need to be continuous, and may be discontinuous at some locations. FIG. 14 shows an example 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 an area outside the first range and within the second range, and when the tractor 1 is placed within this range, the positioning path for automatic positioning is determined. 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 It is not limited to which of the tractor 1 and the wireless communication terminal 46 is provided. Furthermore, other components may be included in either the tractor 1 or the wireless communication terminal 46.

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

走行経路Pが、作業領域での自律作業を全て完了した後に、当該作業領域の周囲の非作業領域について自律作業を行う作業経路(例えば、非作業領域に沿って周回するような作業経路)を含んでも良い。この場合、上記のように枕地及び非耕作地として設定された領域においても最終的にはトラクタ1による自律作業が行われることになるが、トラクタ1が作業領域での自律作業を行っている段階では枕地及び非耕作地の領域で作業が行われないため、当該領域を非作業領域として把握することができる。 The traveling route P is a work route (for example, a work route that goes around the non-work area) that performs autonomous work on a non-work area around the work area after all autonomous work in the work area is completed. May be included. In this case, autonomous work by tractor 1 will eventually be performed in the area set as headland and non-cultivated land as described above, but tractor 1 is performing autonomous work in the work area. At this stage, no work is performed on the headland or non-cultivated land, so these areas can be understood as non-work areas.

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

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

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

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

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

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

Claims (3)

作業車両の位置情報を取得する位置情報取得部と、
予め定められた走行経路に沿って前記作業車両を自律走行させながら予め定められた作業経路に沿って自律作業させる制御部と、
前記位置情報取得部で得られる位置情報に基づいて、前記作業車両が前記走行経路から逸脱しているか否かを判定する逸脱判定部と、を備え、
前記逸脱判定部は、前記作業車両の位置が前記走行経路を基準とする逸脱判定幅の範囲外にあれば、前記作業車両が前記走行経路から逸脱していると判定し、
前記制御部は、前記逸脱判定部にて前記作業車両が前記走行経路から逸脱していると判定された場合、前記作業車両を停止させ、
前記逸脱判定部は、
前記作業車両の位置が前記走行経路を基準とし前記逸脱判定幅よりも狭いマージン幅の範囲内にあるか否かを判定し、
前記作業車両の位置が前記マージン幅の範囲外であって前記逸脱判定幅の範囲内にあれば、前記作業車両が前記走行経路から逸脱していないと判定し、前記制御部に前記作業車両の自律走行を継続させ
前記作業車両が前記走行経路から逸脱していると判定されて前記作業車両を停止させた後の処理に、前記マージン幅を利用する、
自律走行システム。
a position information acquisition unit that acquires position information of the work vehicle;
a control unit that causes the work vehicle to autonomously travel along a predetermined travel route and perform autonomous work along the predetermined work route;
a departure determination unit that determines whether the work vehicle has deviated from the travel route based on the position information obtained by the position information acquisition unit;
The deviation determination unit determines that the work vehicle has deviated from the travel route if the position of the work vehicle is outside a deviation determination range based on the travel route;
The control unit stops the work vehicle when the deviation determination unit determines that the work vehicle has deviated from the travel route;
The deviation determination unit includes:
Determining whether the position of the work vehicle is within a margin width narrower than the departure determination width based on the travel route;
If the position of the work vehicle is outside the range of the margin width but within the range of the departure determination width, it is determined that the work vehicle has not deviated from the travel route, and the control unit Continue autonomous driving ,
Utilizing the margin width in processing after the work vehicle is determined to have deviated from the travel route and the work vehicle is stopped;
Autonomous driving system.
前記制御部は、前記作業車両が前記走行経路から逸脱していると判定されて前記作業車両を停止させた場合、直前に前記作業車両の位置が前記マージン幅の範囲から逸脱したマージン超過位置に基づいて設定される再開位置から、前記作業車両に自律作業を再開させる、
請求項1に記載の自律走行システム。
When the work vehicle is determined to have deviated from the travel route and the work vehicle is stopped, the control unit may control the control unit to control the work vehicle to a position exceeding the margin where the work vehicle has deviated from the range of the margin width immediately before. causing the work vehicle to resume autonomous work from a restart position set based on the
The autonomous driving system according to claim 1 .
前記マージン超過位置に基づいて前記再開位置が設定されるのは、前記走行経路に含まれる前記作業経路及び非作業経路のうち前記作業経路において、前記作業車両が逸脱していると判定された場合のみである、
請求項2に記載の自律走行システム。
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 non-work route included in the travel route. Only,
The autonomous driving system according to claim 2 .
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 JP2022063315A (en) 2022-04-21
JP7349518B2 true 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 (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2015112069A (en) 2013-12-12 2015-06-22 株式会社クボタ Field work machine
WO2015119263A1 (en) 2014-02-06 2015-08-13 ヤンマー株式会社 Method for setting travel path of autonomous travel work vehicle
WO2015118730A1 (en) 2014-02-06 2015-08-13 ヤンマー株式会社 Remote operation device for parallel travel work system
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
JP2016053916A (en) 2014-09-04 2016-04-14 日立建機株式会社 Transport vehicle and travel control device thereof

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3032407B2 (en) * 1993-06-25 2000-04-17 株式会社クボタ Self-driving vehicles
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
JP2013228821A (en) 2012-04-24 2013-11-07 Mamiya-Op Nequos Co Ltd Working machine, component device thereof, and computer program
EP3171241A4 (en) 2014-07-16 2017-12-13 Ricoh Company, Ltd. System, machine, control method, and program
JP6440647B2 (en) * 2016-03-22 2018-12-19 ヤンマー株式会社 Autonomous driving system

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2015112069A (en) 2013-12-12 2015-06-22 株式会社クボタ Field work machine
WO2015119263A1 (en) 2014-02-06 2015-08-13 ヤンマー株式会社 Method for setting travel path of autonomous travel work vehicle
WO2015118730A1 (en) 2014-02-06 2015-08-13 ヤンマー株式会社 Remote operation device for parallel travel work system
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
JP2016053916A (en) 2014-09-04 2016-04-14 日立建機株式会社 Transport vehicle and travel control device thereof

Also Published As

Publication number Publication date
JP7248619B2 (en) 2023-03-29
JP2020119600A (en) 2020-08-06
JP2022063315A (en) 2022-04-21

Similar Documents

Publication Publication Date Title
JP6440647B2 (en) Autonomous driving system
KR102380578B1 (en) Task vehicle control system
JP6773574B2 (en) Work vehicle control device
WO2018139024A1 (en) Path generation system, and autonomous travel system enabling work vehicle to travel along path generated therewith
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
JP7492043B2 (en) Autonomous driving system and method for generating work route
JP7122339B2 (en) Autonomous driving system
JP7022161B2 (en) Autonomous driving system
JP7075436B2 (en) Work vehicle control system
JP6997889B2 (en) Route generation system
JP2021083343A (en) Region registration system

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