JP2020106974A - Travel assistance device, work vehicle equipped with the same, and travel assistance method - Google Patents

Travel assistance device, work vehicle equipped with the same, and travel assistance method Download PDF

Info

Publication number
JP2020106974A
JP2020106974A JP2018243527A JP2018243527A JP2020106974A JP 2020106974 A JP2020106974 A JP 2020106974A JP 2018243527 A JP2018243527 A JP 2018243527A JP 2018243527 A JP2018243527 A JP 2018243527A JP 2020106974 A JP2020106974 A JP 2020106974A
Authority
JP
Japan
Prior art keywords
route
planned
unit
traveling
map
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2018243527A
Other languages
Japanese (ja)
Other versions
JP7154997B2 (en
Inventor
敦 新海
Atsushi Shinkai
敦 新海
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Kubota Corp
Original Assignee
Kubota Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Kubota Corp filed Critical Kubota Corp
Priority to JP2018243527A priority Critical patent/JP7154997B2/en
Publication of JP2020106974A publication Critical patent/JP2020106974A/en
Application granted granted Critical
Publication of JP7154997B2 publication Critical patent/JP7154997B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

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

Abstract

To allow for generating a planned travel route that allows for performing work while self-driving at any position in a farm field.SOLUTION: A travel assistance device for generating a planned travel route for a travel vehicle coupled with a work machine is provided, the travel assistance device comprising: a map acquisition unit for acquiring a farm field map of a specific farm field; a route generation unit for generating a planned travel route on the farm field map acquired by the map acquisition unit; and a route shifting unit for shifting the planned travel route generated by the route generation unit on the farm field map.SELECTED DRAWING: Figure 1

Description

本発明は、例えば、トラクタ等の作業車両を走行させる場合の走行支援装置、走行支援装置を備えた作業車両及び走行支援方法に関する。 The present invention relates to a travel support device for traveling a work vehicle such as a tractor, a work vehicle including the travel support device, and a travel support method.

従来、トラクタ等の作業車両を自動走行させるための走行経路(走行予定ルート)を作成する技術として特許文献1に示す技術が知られている。特許文献1では、走行経路生成部が、直進経路と各直進経路同士をつなぐUターン経路とからなる内側走行経路と、圃場の外周領域を周回走行するための周回走行経路とを生成する。 BACKGROUND ART Conventionally, a technique disclosed in Patent Document 1 is known as a technique for creating a traveling route (scheduled traveling route) for automatically traveling a work vehicle such as a tractor. In Patent Document 1, the traveling route generation unit generates an inner traveling route including a straight traveling route and a U-turn route connecting the respective straight traveling routes, and a traveling traveling route for traveling around the outer peripheral region of the field.

特開2018−116608号公報JP, 2008-116608, A

特許文献1では、外周領域とは異なる内部領域に走行経路(走行予定ルート)を作成することができる。しかしながら、内部領域のみ、即ち、圃場の中央部のみが走行予定ルートになってしまい。これにより、圃場の中央部のみしか作業が行えないという問題がある。
そこで、本発明は上記問題点に鑑み、圃場に対して任意の位置で自動走行をしながら作業を行うことができるような走行予定ルートを作成することができる走行支援装置、走行支援装置を備えた作業車両及び走行支援方法を提供することを目的とする。
In Patent Document 1, a travel route (scheduled travel route) can be created in an inner area different from the outer circumference area. However, only the inner area, that is, only the central part of the field becomes the planned travel route. As a result, there is a problem that work can be performed only in the central portion of the field.
Therefore, in view of the above problems, the present invention includes a traveling support device and a traveling support device capable of creating a planned traveling route such that work can be performed while automatically traveling at an arbitrary position in a field. It is an object of the present invention to provide a work vehicle and a driving support method.

この技術的課題を解決するための本発明の技術的手段は、以下に示す点を特徴とする。
走行支援装置は、作業装置が連結される走行車両の走行予定ルートを作成する走行支援装置であって、所定の圃場における圃場マップを取得するマップ取得部と、前記マップ取得部が取得した圃場マップに走行予定ルートを作成するルート作成部と、前記ルート作成部によって作成された前記走行予定ルートを前記圃場マップに対して移動させるルート移動部と、を備えている。
The technical means of the present invention for solving this technical problem is characterized by the following points.
The travel support device is a travel support device that creates a planned travel route of a traveling vehicle to which a work device is connected, and includes a map acquisition unit that acquires a field map in a predetermined field, and a field map acquired by the map acquisition unit. And a route moving unit that moves the planned traveling route created by the route creating unit with respect to the farm field map.

走行支援装置は、前記圃場マップ及び前記走行予定ルートを表示する表示部を備え、前記ルート移動部は、前記表示部に表示された前記走行予定ルートが選択されると、前記圃場マップに対する走行予定ルートの移動を許可し、前記許可された走行予定ルートの移動が完了すると、走行予定ルートの位置データを、前記移動前の走行予定ルートの位置データから前記移動後の走行予定ルートに変更する。 The travel support device includes a display unit that displays the farm field map and the planned travel route, and the route moving unit, when the planned travel route displayed on the display unit is selected, travels to the farm field map. When the movement of the route is permitted and the movement of the permitted planned traveling route is completed, the position data of the planned traveling route is changed from the position data of the planned traveling route before the movement to the planned traveling route after the movement.

前記ルート作成部は、前記走行予定ルートを移動することによって前記圃場マップに形成された空きエリアに、新たな走行予定ルートを追加する経路追加部を有している。
走行支援装置は、前記作業装置を識別する機械識別情報を取得する機械取得部を備え、前記ルート移動部は、前記機械取得部が取得した機械識別情報に対応する作業装置が走行予定ルートの変更が許可された作業装置である場合に、前記走行予定ルートが前記圃場マップに対して移動することを許可する。
The route creation unit has a route addition unit that adds a new planned travel route to an empty area formed in the farm field map by moving the planned travel route.
The travel assistance device includes a machine acquisition unit that acquires machine identification information that identifies the work device, and the route moving unit changes the planned travel route of the work device that corresponds to the machine identification information acquired by the machine acquisition unit. When the work device is permitted, the travel scheduled route is permitted to move with respect to the farm field map.

前記ルート移動部は、前記機械識別情報に対応する作業装置が走行予定ルートの変更が許可されていない作業装置である場合に、前記走行予定ルートが前記圃場マップに対して移動することを許可しない。
作業車両は、走行支援装置と、走行車両と、前記走行予定ルートに基づいて前記走行車両の自動走行を行う自動走行制御部と、を備えている。
The route moving unit does not allow the planned traveling route to move with respect to the farm field map when the working device corresponding to the machine identification information is a working device that is not permitted to change the planned traveling route. ..
The work vehicle includes a travel support device, a travel vehicle, and an automatic travel control unit that automatically travels the travel vehicle based on the planned travel route.

走行支援方法は、作業装置が連結される走行車両の走行予定ルートを作成する走行支援方法であって、所定の圃場における圃場マップを取得するステップと、前記マップ取得部が取得した圃場マップに走行予定ルートを作成するステップと、作成された走行予定ルートを前記圃場マップに対して移動させるステップと、を備えている。 The travel support method is a travel support method for creating a planned travel route of a traveling vehicle to which a work device is connected, and a step of acquiring a field map in a predetermined field, and traveling on the field map acquired by the map acquisition unit. The method includes the steps of creating a planned route and the step of moving the created planned traveling route with respect to the farm field map.

本発明によれば、圃場に対して任意の位置で自動走行をしながら作業を行うことができるような走行予定ルートを作成することができる。 According to the present invention, it is possible to create a planned traveling route that enables work to be performed while automatically traveling at an arbitrary position in a field.

走行支援装置を備えた作業車両のブロック図を示す図である。It is a figure showing a block diagram of a work vehicle provided with a run support device. 昇降装置を示す図である。It is a figure which shows a lifting device. 自動走行を説明する図である。It is a figure explaining automatic running. マップ登録画面M1の一例を示す図である。It is a figure which shows an example of the map registration screen M1. 走行軌跡K1から圃場の輪郭H1(圃場マップMP2)を求める図である。It is a figure which calculates|requires the contour H1 (farm field map MP2) of a farm field from the traveling locus K1. 走行軌跡K1の変曲点から圃場の輪郭H1(圃場マップMP2)を求める図である。It is a figure which calculates|requires the contour H1 (field map MP2) of a farm field from the inflection point of the traveling locus K1. 走行時のスイッチ操作から輪郭H1(圃場マップMP2)を求める図である。It is a figure which asks for contour H1 (field map MP2) from switch operation at the time of running. ルート設定画面M3の一例を示す図である。It is a figure which shows an example of the route setting screen M3. 作業エリアA2に単位作業区画A3を作成した図である。It is the figure which created unit work section A3 in work area A2. 図7Aとは異なる単位作業区画A3を示す図である。It is a figure which shows the unit work division A3 different from FIG. 7A. 直進部Lna及び旋回部Lnbの作成を示す図である。It is a figure which shows creation of the straight advance part Lna and the turning part Lnb. 走行予定ルートの移動を示す図である。It is a figure showing movement of a run schedule route. 機械識別情報と許可及び不許可の条件データとの関係を示す図である。It is a figure which shows the relationship between machine identification information and the permission and prohibition condition data. 走行予定ルートL1を追加する図である。It is a figure which adds the planned driving route L1. 走行支援方法を示す図である。It is a figure which shows a driving assistance method. トラクタの側面全体図である。It is an overall side view of the tractor.

以下、本発明の実施の形態を図面に基づいて説明する。
図1は、走行支援装置100を備えた作業車両のブロック図を示している。走行支援装置100は、トラクタ等の作業車両の走行を行う場合の支援を行う装置である。この実施形態では、走行支援装置100は、トラクタ1に設けられているが、トラクタ1以外に設けた装置、例えば、タブレット、スマートフォン、PDA等の携帯型の端末(携帯端末)、パーソナルコンピュータ、サーバ等の固定型のコンピュータ等の固定型の端末(固定端末)であってもよい。
Embodiments of the present invention will be described below with reference to the drawings.
FIG. 1 shows a block diagram of a work vehicle provided with a travel support device 100. The travel support device 100 is a device that assists when a work vehicle such as a tractor travels. In this embodiment, the driving support device 100 is provided in the tractor 1, but devices provided in addition to the tractor 1, for example, portable terminals (portable terminals) such as tablets, smartphones, PDAs, personal computers, and servers. A fixed terminal such as a fixed computer (fixed terminal) may be used.

まず、作業車両の1つであるトラクタをについて説明する。
図13に示すように、トラクタ1は、走行装置7を有する走行車両3と、原動機4と、変速装置5とを備えている。走行装置7は、前輪7F及び後輪7Rを有する装置である。前輪7Fは、タイヤ型であってもクローラ型であってもよい。また、後輪7Rも、タイヤ型であってもクローラ型であってもよい。原動機4は、ディーゼルエンジン、電動モータ等である。変速装置5は、変速によって走行装置7の推進力を切換可能であると共に、走行装置7の前進、後進の切換が可能である。走行車両3にはキャビン9が設けられ、当該キャビン9内には運転席10が設けられている。
First, a tractor, which is one of the work vehicles, will be described.
As shown in FIG. 13, the tractor 1 includes a traveling vehicle 3 having a traveling device 7, a prime mover 4, and a transmission 5. The traveling device 7 is a device having front wheels 7F and rear wheels 7R. The front wheel 7F may be a tire type or a crawler type. Further, the rear wheel 7R may also be a tire type or a crawler type. The prime mover 4 is a diesel engine, an electric motor, or the like. The speed change device 5 can switch the propulsive force of the traveling device 7 by speed change, and can also switch the traveling device 7 between forward and reverse. A cabin 9 is provided in the traveling vehicle 3, and a driver's seat 10 is provided in the cabin 9.

また、走行車両3の後部には、3点リンク機構等で構成された昇降装置8が設けられている。昇降装置8には、作業装置2が着脱可能である。作業装置2を昇降装置8に連結することによって、走行車両3によって作業装置2を牽引することができる。作業装置2は、耕耘する耕耘装置、肥料を散布する肥料散布装置、農薬を散布する農薬散布装置、収穫を行う収穫装置、牧草等の刈取を行う刈取装置、牧草等の拡散を行う拡散装置、牧草等の集草を行う集草装置、牧草等の成形を行う成形装置等である。 Further, an elevating device 8 including a three-point link mechanism or the like is provided at the rear part of the traveling vehicle 3. The working device 2 can be attached to and detached from the lifting device 8. By connecting the work device 2 to the lifting device 8, the work device 2 can be pulled by the traveling vehicle 3. The working device 2 is a tilling device for tilling, a fertilizer spraying device for spraying fertilizer, a pesticide spraying device for spraying pesticides, a harvesting device for harvesting, a mowing device for cutting grass and the like, a diffusing device for spreading grass and the like, A grass collection device for collecting grass and the like, a molding device for molding grass, etc.

図1に示すように、トラクタ1は、操舵装置11を備えている。操舵装置11は、ハンドル(ステアリングホイール)11aと、ハンドル11aの回転に伴って回転する回転軸(操舵軸)11bと、ハンドル11aの操舵を補助する補助機構(パワーステアリング機構)11cと、を有している。補助機構11cは、油圧ポンプ21と、油圧ポンプ21から吐出した作動油が供給される制御弁22と、制御弁22により作動するステアリングシリンダ23とを含んでいる。制御弁22は、制御信号に基づいて作動する電磁弁である。
制御弁22は、例えば、スプール等の移動によって切り換え可能な3位置切換弁である。また、制御弁22は、操舵軸11bの操舵によっても切換可能である。ステアリングシリンダ23は、前輪7Fの向きを変えるアーム(ナックルアーム)24に接続されている。
As shown in FIG. 1, the tractor 1 includes a steering device 11. The steering device 11 has a steering wheel (steering wheel) 11a, a rotating shaft (steering shaft) 11b that rotates with the rotation of the steering wheel 11a, and an auxiliary mechanism (power steering mechanism) 11c that assists the steering of the steering wheel 11a. doing. The auxiliary mechanism 11c includes a hydraulic pump 21, a control valve 22 to which hydraulic oil discharged from the hydraulic pump 21 is supplied, and a steering cylinder 23 operated by the control valve 22. The control valve 22 is a solenoid valve that operates based on a control signal.
The control valve 22 is, for example, a three-position switching valve that can be switched by moving a spool or the like. The control valve 22 can also be switched by steering the steering shaft 11b. The steering cylinder 23 is connected to an arm (knuckle arm) 24 that changes the direction of the front wheels 7F.

したがって、ハンドル11aを操作すれば、当該ハンドル11aに応じて制御弁22の切換位置及び開度が切り換わり、当該制御弁22の切換位置及び開度に応じてステアリングシリンダ23が左又は右に伸縮することによって、前輪7Fの操舵方向を変更することができる。なお、上述した操舵装置11は一例であり、上述した構成に限定されない。
図2に示すように、昇降装置8は、リフトアーム8a、ロアリンク8b、トップリンク8c、リフトロッド8d、リフトシリンダ8eを有している。リフトアーム8aの前端部は、変速装置5を収容するケース(ミッションケース)の後上部に上方又は下方に揺動可能に支持されている。リフトアーム8aは、リフトシリンダ8eの駆動によって揺動(昇降)する。リフトシリンダ8eは、油圧シリンダから構成されている。リフトシリンダ8eは、制御弁を介して油圧ポンプと接続されている。制御弁は、電磁弁等であって、リフトシリンダ8eを伸縮させる。
Therefore, when the handle 11a is operated, the switching position and the opening of the control valve 22 are switched according to the handle 11a, and the steering cylinder 23 is expanded or contracted to the left or right according to the switching position and the opening of the control valve 22. By doing so, the steering direction of the front wheels 7F can be changed. Note that the steering device 11 described above is an example, and the present invention is not limited to the configuration described above.
As shown in FIG. 2, the lifting device 8 includes a lift arm 8a, a lower link 8b, a top link 8c, a lift rod 8d, and a lift cylinder 8e. A front end portion of the lift arm 8a is supported by a rear upper portion of a case (transmission case) accommodating the transmission 5 so as to be swingable upward or downward. The lift arm 8a swings (elevates) by driving the lift cylinder 8e. The lift cylinder 8e is composed of a hydraulic cylinder. The lift cylinder 8e is connected to a hydraulic pump via a control valve. The control valve is an electromagnetic valve or the like, and expands and contracts the lift cylinder 8e.

ロアリンク8bの前端部は、変速装置5の後下部に上方又は下方に揺動可能に支持されている。トップリンク8cの前端部は、ロアリンク8bよりも上方において、変速装置5の後部に上方又は下方に揺動可能に支持されている。リフトロッド8dは、リフトアーム8aとロアリンク8bとを連結している。ロアリンク8bの後部及びトップリンク8cの後部には、作業装置2が連結される。リフトシリンダ8eが駆動(伸縮)すると、リフトアーム8aが昇降するとともに、リフトロッド8dを介してリフトアーム8aと連結されたロアリンク8bが昇降する。これにより、作業装置2がロアリンク8bの前部を支点として、上方又は下方に揺動(昇降)する。 The front end of the lower link 8b is supported on the lower rear portion of the transmission 5 so as to be swingable upward or downward. The front end portion of the top link 8c is supported by the rear portion of the transmission 5 so as to be swingable upward or downward above the lower link 8b. The lift rod 8d connects the lift arm 8a and the lower link 8b. The working device 2 is connected to the rear portion of the lower link 8b and the rear portion of the top link 8c. When the lift cylinder 8e is driven (expanded and contracted), the lift arm 8a moves up and down, and the lower link 8b connected to the lift arm 8a via the lift rod 8d moves up and down. As a result, the work device 2 swings (moves up and down) upward or downward with the front portion of the lower link 8b as a fulcrum.

トラクタ1は、測位装置40を備えている。測位装置40は、D−GPS、GPS、GLONASS、北斗、ガリレオ、みちびき等の衛星測位システム(測位衛星)により、自己の位置(緯度、経度を含む測位情報)を検出可能である。即ち、測位装置40は、測位衛星から送信された衛星信号(測位衛星の位置、送信時刻、補正情報等)を受信し、衛星信号に基づいて、トラクタ1の位置(例えば、緯度、経度)、即ち、車体位置を検出する。測位装置40は、受信装置41と、慣性計測装置(IMU:Inertial Measurement Unit)42とを有している。受信装置41は、アンテナ等を有していて測位衛星から送信された衛星信号を受信する装置であり、慣性計測装置42とは別に走行車両3に取付けられている。この実施形態では、受信装置41は、キャビン9に取付けられている。なお、受信装置41の取付箇所は、実施形態に限定されない。 The tractor 1 includes a positioning device 40. The positioning device 40 can detect its own position (positioning information including latitude and longitude) by a satellite positioning system (positioning satellite) such as D-GPS, GPS, GLONASS, Hokuto, Galileo, and Michibiki. That is, the positioning device 40 receives the satellite signal (position of the positioning satellite, transmission time, correction information, etc.) transmitted from the positioning satellite, and based on the satellite signal, the position of the tractor 1 (for example, latitude, longitude), That is, the vehicle body position is detected. The positioning device 40 includes a reception device 41 and an inertial measurement unit (IMU: Inertial Measurement Unit) 42. The receiving device 41 is a device that has an antenna or the like and receives a satellite signal transmitted from a positioning satellite, and is attached to the traveling vehicle 3 separately from the inertial measuring device 42. In this embodiment, the receiving device 41 is attached to the cabin 9. Note that the mounting location of the receiving device 41 is not limited to the embodiment.

慣性計測装置42は、加速度を検出する加速度センサ、角速度を検出するジャイロセンサ等を有している。慣性計測装置42は、走行車両3に設けられ、慣性計測装置42によって、走行車両3のロール角、ピッチ角、ヨー角等を検出することができる。
図1に示すように、トラクタ1は、制御装置60を備えている。制御装置60は、トラクタ1における走行系の制御、作業系の制御等を行う装置である。
The inertial measurement device 42 has an acceleration sensor that detects acceleration, a gyro sensor that detects angular velocity, and the like. The inertial measurement device 42 is provided in the traveling vehicle 3, and the inertial measurement device 42 can detect the roll angle, the pitch angle, the yaw angle, and the like of the traveling vehicle 3.
As shown in FIG. 1, the tractor 1 includes a control device 60. The control device 60 is a device that controls a traveling system, a work system, and the like in the tractor 1.

制御装置60は、トラクタ1の自動走行を制御する自動走行制御部61を有している。自動走行制御部61は、制御装置60に設けられた電気・電子回路、CPU等に格納されたプログラム等から構成されている。自動走行制御部61は、自動走行を開始すると、走行車両3が走行予定ルートL1に沿って走行するように操舵装置11の制御弁22を制御する。また、自動走行制御部61は、自動走行を開始すると、変速装置の変速段、原動機の回転数等を自動的に変更することによって、トラクタ1の車速(速度)を制御する。 The control device 60 has an automatic travel control unit 61 that controls the automatic travel of the tractor 1. The automatic traveling control unit 61 is composed of an electric/electronic circuit provided in the control device 60, a program stored in a CPU, and the like. When starting the automatic traveling, the automatic traveling control unit 61 controls the control valve 22 of the steering device 11 so that the traveling vehicle 3 travels along the planned traveling route L1. Further, when the automatic running control unit 61 starts the automatic running, the automatic running control unit 61 controls the vehicle speed (speed) of the tractor 1 by automatically changing the shift speed of the transmission, the rotation speed of the prime mover, and the like.

図3に示すように、トラクタ1が自動走行を行っている状況下において、車体位置と走行予定ルートL1との偏差が閾値未満である場合、自動走行制御部61は、操舵軸(回転軸)11bの回転角を維持する。車体位置と走行予定ルートL1との偏差が閾値以上であって、トラクタ1が走行予定ルートL1に対して左側に位置している場合は、自動走行制御部61は、トラクタ1の操舵方向が右方向となるように操舵軸11bを回転する。車体位置と走行予定ルートL1との偏差が閾値以上であって、トラクタ1が走行予定ルートL1に対して右側に位置している場合は、自動走行制御部61は、トラクタ1の操舵方向が
左方向となるように操舵軸11bを回転する。なお、上述した実施形態では、車体位置と走行予定ルートL1との偏差に基づいて操舵装置11の操舵角を変更していたが、走行予定ルートL1の方位とトラクタ1(走行車両3)の進行方向(走行方向)の方位(車体方位)F1とが異なる場合、即ち、走行予定ルートL1に対する車体方位F1の角度θgが閾値以上である場合、自動走行制御部61は、角度θgが零(車体方位F1が走行予定ルートL1の方位に一致)するように操舵角を設定してもよい。また、自動走行制御部61は、偏差(位置偏差)に基づいて求めた操舵角と、方位(方位偏差)に基づいて求めた操舵角とに基づいて、自動操舵における最終の操舵角を設定してもよい。上述した実施形態における自動操舵における操舵角の設定は一例であり、限定されない。
As shown in FIG. 3, when the deviation between the vehicle body position and the planned travel route L1 is less than the threshold value under the condition that the tractor 1 is traveling automatically, the automatic travel control unit 61 causes the steering shaft (rotating shaft) to rotate. The rotation angle of 11b is maintained. When the deviation between the vehicle body position and the planned traveling route L1 is equal to or greater than the threshold value and the tractor 1 is located on the left side of the planned traveling route L1, the automatic traveling control unit 61 determines that the steering direction of the tractor 1 is right. The steering shaft 11b is rotated so as to be oriented. When the deviation between the vehicle body position and the planned travel route L1 is equal to or greater than the threshold value and the tractor 1 is located on the right side of the planned travel route L1, the automatic travel control unit 61 determines that the steering direction of the tractor 1 is left. The steering shaft 11b is rotated so as to be oriented. In the above-described embodiment, the steering angle of the steering device 11 is changed based on the deviation between the vehicle body position and the planned traveling route L1, but the azimuth of the planned traveling route L1 and the progress of the tractor 1 (traveling vehicle 3). When the azimuth (vehicle body direction) F1 in the direction (traveling direction) is different, that is, when the angle θg of the vehicle body direction F1 with respect to the planned travel route L1 is equal to or greater than a threshold value, the automatic traveling control unit 61 determines that the angle θg is zero (vehicle body direction). The steering angle may be set so that the azimuth F1 matches the azimuth of the planned travel route L1. Further, the automatic travel control unit 61 sets the final steering angle in the automatic steering based on the steering angle obtained based on the deviation (positional deviation) and the steering angle obtained based on the azimuth (azimuth deviation). May be. The setting of the steering angle in the automatic steering in the above-described embodiment is an example, and the setting is not limited.

以上のように、制御装置60によって、トラクタ1(走行車両3)を自動走行させることができる。
また、制御装置60は、手動昇降制御、自動上昇制御等を行うことができる。手動昇降制御では、制御装置60に接続された昇降スイッチ72の操作に基づいて昇降装置8による作業装置2の昇降する制御である。具体的には、昇降スイッチ72は、運転席10の周囲に設けられていて、3位置切換スイッチである。昇降スイッチ72を中立位置から一方に切り換えると、昇降装置8(リフトアーム8a)を上昇させる上昇信号が制御装置60に入力される。また、昇降スイッチ72を中立位置から他方に切り換えると、昇降装置8(リフトアーム8a)を下降させる下降信号が制御装置60に入力される。制御装置60は、上昇信号を取得すると制御弁に制御信号を出力することで昇降装置8を上昇させ、下降信号を取得すると制御弁に制御信号を出力することで昇降装置8を下降させる。つまり、制御装置60は、昇降スイッチ72の手動操作に応じて昇降装置8を昇降させる手動昇降制御をすることができる。
As described above, the tractor 1 (traveling vehicle 3) can be automatically driven by the control device 60.
Further, the control device 60 can perform manual lifting control, automatic lifting control, and the like. The manual elevating control is a control for elevating the work device 2 by the elevating device 8 based on the operation of the elevating switch 72 connected to the control device 60. Specifically, the elevating switch 72 is a three-position changeover switch provided around the driver's seat 10. When the raising/lowering switch 72 is switched from the neutral position to one side, a raising signal for raising the raising/lowering device 8 (lift arm 8a) is input to the control device 60. Further, when the lifting switch 72 is switched from the neutral position to the other position, a lowering signal for lowering the lifting device 8 (lift arm 8a) is input to the control device 60. The control device 60 outputs the control signal to the control valve to raise the lifting device 8 when the rising signal is obtained, and outputs the control signal to the control valve to drop the lifting device 8 when the falling signal is obtained. That is, the control device 60 can perform the manual elevating control for elevating the elevating device 8 according to the manual operation of the elevating switch 72.

また、自動上昇制御では、操舵装置11の操舵角が所定以上、例えば、旋回に対応する操舵角である場合に、自動的に昇降装置8を作動させることで作業装置2を上昇する制御である。具体的には、制御装置60には、操舵角検出装置70と、切換スイッチ71とが接続されている。操舵角検出装置70は、操舵装置11の操舵角を検出する装置である。切換スイッチ71は、自動上昇制御の有効/無効を切り換えるスイッチであって、ON/OFFに切り換え可能なスイッチである。切換スイッチ71がONである場合、自動上昇制御が有効に設定され、切換スイッチ71がOFFである場合、自動上昇制御が無効に設定される。 In the automatic raising control, when the steering angle of the steering device 11 is equal to or greater than a predetermined value, for example, the steering angle corresponding to turning, the work device 2 is raised by automatically operating the lifting device 8. .. Specifically, a steering angle detection device 70 and a changeover switch 71 are connected to the control device 60. The steering angle detection device 70 is a device that detects the steering angle of the steering device 11. The changeover switch 71 is a switch that switches between valid/invalid of the automatic raising control and is a switch that can be switched ON/OFF. When the changeover switch 71 is ON, the automatic raising control is set valid, and when the changeover switch 71 is OFF, the automatic raising control is set invalid.

制御装置60は、自動上昇制御が有効であり且つ操舵角検出装置70が検出した操舵角が旋回に相当する操舵角以上である場合、制御弁に制御信号を出力することで昇降装置8を自動的に上昇させる自動上昇制御を行う。
以上のように、制御装置60によって、トラクタ1に関する制御、例えば、手動昇降制御、自動上昇制御を行うことができる。
When the automatic raising control is effective and the steering angle detected by the steering angle detecting device 70 is equal to or larger than the steering angle corresponding to the turning, the control device 60 outputs a control signal to the control valve to automatically move the lifting device 8 automatically. The automatic raising control is performed to raise automatically.
As described above, the control device 60 can perform control related to the tractor 1, for example, manual lifting control and automatic lifting control.

走行支援装置100は、運転席10の近傍に設けられた表示装置である。以下、走行支援装置100が表示装置であるとして説明を進める。
表示装置は、液晶パネル、タッチパネル、その他のパネルのいずれかで構成された表示部50を有する表示装置であり、トラクタ1の走行を、支援をするための情報の他に、トラクタ1、作業装置2に関する様々な情報を表示可能である。
The travel support device 100 is a display device provided near the driver's seat 10. Hereinafter, the description will be given assuming that the driving support device 100 is a display device.
The display device is a display device having a display unit 50 configured by any one of a liquid crystal panel, a touch panel, and other panels, and in addition to information for supporting the traveling of the tractor 1, the tractor 1, the working device. Various information regarding 2 can be displayed.

表示装置は、マップ登録部101と、マップ記憶部102とを備えている。マップ登録部101は、表示装置に設けられた電気・電子部品、表示装置に組み込まれたプログラム等から構成されている。マップ記憶部102は、不揮発性のメモリ等から構成されている。マップ登録部101は、所定の圃場の輪郭、例えば、所定の圃場の輪郭に対応した位置を登録する。 The display device includes a map registration unit 101 and a map storage unit 102. The map registration unit 101 is composed of electric/electronic components provided in the display device, programs installed in the display device, and the like. The map storage unit 102 is composed of a non-volatile memory or the like. The map registration unit 101 registers a contour of a predetermined field, for example, a position corresponding to the contour of the predetermined field.

図4に示すように、作業者(運転者)が表示装置に対して所定の操作を行うと、マップ登録部101は、表示装置の表示部50にマップ登録画面M1を表示する。マップ登録画面M1には、圃場を含むマップMP1、トラクタ1の車体位置VP1、圃場名及び圃場管理番号等の圃場識別情報が表示される。マップMP1には、圃場を示す画像データの他に緯度、経度等の位置情報が対応付けられている。トラクタ1が圃場内に入り、圃場内を周
回すると、マップ登録画面M1には、トラクタ1が周回したときに測位装置40が検出した現在の車体位置VP1が表示される。トラクタ1による圃場内の周回が終了し、マップ登録画面M1に表示された登録ボタン51が選択されると、図5Aに示すように、マップ登録部101は、トラクタ1が周回したときの複数の車体位置によって得られた走行軌跡K1を圃場の輪郭(外形)H1とし、当該輪郭H1で表される圃場マップMP2を圃場識別情報と共に登録する。
As shown in FIG. 4, when the worker (driver) performs a predetermined operation on the display device, the map registration unit 101 displays the map registration screen M1 on the display unit 50 of the display device. On the map registration screen M1, field identification information such as a map MP1 including a field, a vehicle body position VP1 of the tractor 1, a field name and a field management number are displayed. The map MP1 is associated with position information such as latitude and longitude in addition to image data showing a field. When the tractor 1 enters the field and goes around the field, the current vehicle body position VP1 detected by the positioning device 40 when the tractor 1 goes around is displayed on the map registration screen M1. When the tractor 1 completes the orbit in the field and the registration button 51 displayed on the map registration screen M1 is selected, as shown in FIG. The travel locus K1 obtained from the vehicle body position is used as the contour (outer shape) H1 of the field, and the field map MP2 represented by the contour H1 is registered together with the field identification information.

なお、図5Bに示すように、マップ登録部101は、車体位置VP1で示される走行軌跡から変曲点を演算して変曲点を結ぶ輪郭K2を圃場の輪郭H1(圃場マップMP2)として登録してもよいし、図5Cに示すように、トラクタ1が周回する際に運転者等がトラクタ1に設けられたスイッチ等によって圃場の端部を指定し指定された端部を結んだ輪郭K3を輪郭H1(圃場マップMP2)として登録してもよい。上述した圃場の登録方法は、一例であり、限定されない。圃場の輪郭、即ち、圃場マップMP2は、位置(緯度、経度)で示されたデータであっても、座標(X軸、Y軸)系で示されたデータであっても、その他の表現で示されたデータであってもよい。 As shown in FIG. 5B, the map registration unit 101 calculates an inflection point from the traveling locus indicated by the vehicle body position VP1 and registers the contour K2 connecting the inflection points as the field contour H1 (field map MP2). Alternatively, as shown in FIG. 5C, when the tractor 1 orbits, the driver or the like designates the end of the field by a switch or the like provided on the tractor 1, and a contour K3 connecting the designated ends. May be registered as the contour H1 (field map MP2). The field registration method described above is an example, and is not limited. The contour of the field, that is, the field map MP2, may be expressed by other expressions, whether it is the data shown by the position (latitude, longitude) or the data shown by the coordinate system (X axis, Y axis). It may be the data shown.

マップ記憶部102は、マップ登録部101によって登録した輪郭(外形)を示す圃場マップMP2を記憶する。即ち、マップ記憶部102は、圃場マップMP2、圃場の輪郭を示すデータ(所定の圃場を表すためのデータ)を記憶する。
表示装置(走行支援装置100)は、所定の圃場に対してトラクタ1を自動走行する際に用いる走行予定ルートL1の作成を行うことができる。走行支援装置100は、走行予定ルートL1の作成を行うルート作成部105と、マップ取得部120とを備えている。ルート作成部105及びマップ取得部120は、表示装置に設けられた電気・電子回路、表示装置に格納されたプログラム等から構成されている。
The map storage unit 102 stores the field map MP2 indicating the contour (outer shape) registered by the map registration unit 101. That is, the map storage unit 102 stores the farm field map MP2 and data indicating the contour of the farm field (data for representing a predetermined farm field).
The display device (travel support device 100) can create a planned travel route L1 used when the tractor 1 is automatically traveled in a predetermined field. The travel support device 100 includes a route creation unit 105 that creates a planned travel route L1 and a map acquisition unit 120. The route creation unit 105 and the map acquisition unit 120 are configured by electric/electronic circuits provided in the display device, programs stored in the display device, and the like.

図6に示すように、作業者(運転者)が表示装置に対して所定の操作を行うと、ルート作成部105は、ルート設定画面M3を表示する。ルート設定画面M3は、圃場入力部80と、ルート表示部85とを備えている。圃場入力部80は、圃場名、圃場の管理番号等の圃場識別情報を入力可能である。ルート表示部85は、圃場入力部80に入力された圃場識別情報に対応する所定の圃場を示す圃場マップMP2を表示する。マップ取得部120は、圃場識別情報が入力されると、マップ記憶部102を参照し、当該圃場識別情報に対応する圃場マップMP2を取得する。ルート作成部105は、マップ取得部120が取得した圃場マップMP2を、圃場表示部81に表示させる。なお、圃場入力部80は、マップ記憶部102に登録されている圃場マップMP2に対応する圃場識別情報の一覧表を表示して、マップ取得部120は、一覧表の中から選択された圃場識別情報に対応する圃場マップMP2をマップ記憶部102から取得してもよい。また、ルート表示部85は、圃場マップMP2に設定された走行予定ルートL1を表示する。 As shown in FIG. 6, when the worker (driver) performs a predetermined operation on the display device, the route creation unit 105 displays the route setting screen M3. The route setting screen M3 includes a field input unit 80 and a route display unit 85. The field input unit 80 can input field identification information such as a field name and a field management number. The route display unit 85 displays a farm field map MP2 indicating a predetermined farm field corresponding to the farm field identification information input to the farm field input unit 80. When the field identification information is input, the map acquisition unit 120 refers to the map storage unit 102 and acquires the field map MP2 corresponding to the field identification information. The route creation unit 105 causes the farm field display unit 81 to display the farm field map MP2 acquired by the map acquisition unit 120. The farm field input unit 80 displays a list of farm field identification information corresponding to the farm field map MP2 registered in the map storage unit 102, and the map acquisition unit 120 identifies the farm field selected from the list. The field map MP2 corresponding to the information may be acquired from the map storage unit 102. The route display unit 85 also displays the planned travel route L1 set in the farm field map MP2.

ルート設定画面M3は、枕地幅W1を入力する枕地幅入力部82と、作業幅W2を入力する作業幅入力部88とを備えている。枕地幅入力部82に枕地幅W1を入力した後、決定ボタン99が選択されると、ルート作成部105は、ルート表示部85に表示された圃場マップMP2に、枕地エリアA1を除く作業エリアA2を表示する。例えば、ルート作成部105は、圃場マップMP2の輪郭H1を内側に枕地幅W1の距離だけオフセットして形成される輪郭H2で囲まれるエリアを、作業エリアA2に設定する。なお、ルート設定画面M3において、ルート表示部85に表示された圃場マップMP2上に、ポインタ等を用いて作業エリアA2の輪郭の位置を指定することによって、圃場マップMP2に作業エリアA2を設定してもよい。 The route setting screen M3 includes a headland width input unit 82 for inputting the headland width W1 and a work width input unit 88 for inputting the work width W2. When the enter button 99 is selected after the headland width W1 is input to the headland width input unit 82, the route creation unit 105 excludes the headland area A1 from the farm field map MP2 displayed on the route display unit 85. The work area A2 is displayed. For example, the route creation unit 105 sets, as the work area A2, an area surrounded by the contour H2 formed by offsetting the contour H1 of the farm field map MP2 inside by the distance of the headland width W1. In the route setting screen M3, the work area A2 is set in the farm field map MP2 by designating the position of the contour of the work area A2 on the farm field map MP2 displayed on the route display section 85 using a pointer or the like. May be.

また、作業幅入力部88に作業幅W2が入力した後、決定ボタン99が選択されると、ルート作成部105は、作業幅W2に基づいて、所定の圃場、即ち、圃場マップMP2に複数の単位作業区画A3n(n:単位作業区画の個数)を作成する。具体的には、ルート作成部105は、図7Aに示すように、作業エリアA2を作業幅W2で縦方向又は横方向に区切ることによって、作業装置2で作業を行う複数の単位作業区画A3nを作業エリアA2内に作成する。即ち、ルート作成部105は、作業幅W2と同一の幅の単位作業区画A3nを作業エリアA2内に複数作成する。なお、図7Bに示すように、ルート作成部1
05は、作業幅W2からオーバラップ幅W3を除した幅W4の単位作業区画A3nを作業エリアA2内に複数作成してもよい。オーバラップ幅W3は、ルート設定画面M3で入力することが可能である。
Further, when the determination button 99 is selected after the work width W2 is input to the work width input unit 88, the route creation unit 105 causes the route creation unit 105 to select a plurality of fields in a predetermined field, that is, the field map MP2, based on the work width W2. A unit work section A3n (n: number of unit work sections) is created. Specifically, as shown in FIG. 7A, the route creation unit 105 divides the work area A2 into work widths W2 in the vertical direction or the horizontal direction to divide a plurality of unit work sections A3n in which the work device 2 performs work. Created in the work area A2. That is, the route creation unit 105 creates a plurality of unit work sections A3n having the same width as the work width W2 in the work area A2. As shown in FIG. 7B, the route creation unit 1
For 05, a plurality of unit work sections A3n having a width W4 obtained by dividing the work width W2 by the overlap width W3 may be created in the work area A2. The overlap width W3 can be input on the route setting screen M3.

以上のように、ルート作成部105は、作業装置2を連結した走行車両3を走行させた場合に、当該作業装置2によって圃場に対して作業が行われる最小単位の領域を、単位作業区画A3nとして設定する。なお、作業エリアA2の長さL40に対して、単位作業区画A3nの幅(W2,W4)が整数で割り切れず、余りの部分が生じる場合は、ルート作成部105は、単位作業区画A3nにおいて、最初又は最後の単位作業区画A3nは、余りの部分が含むエリアに設定する。 As described above, when the traveling vehicle 3 connected with the work device 2 is run, the route creation unit 105 defines the minimum unit area where work is performed on the field by the work device 2 as the unit work section A3n. Set as. In addition, when the width (W2, W4) of the unit work section A3n is not divisible by an integer with respect to the length L40 of the work area A2, and a surplus portion is generated, the route creating unit 105, in the unit work section A3n, The first or last unit work section A3n is set in the area included in the remaining portion.

単位作業区画A3の設定が完了すると、ルート作成部105は、走行予定ルートL1の作成を行う。図1に示すように、ルート作成部105は、直進作成部105Aと、旋回作成部105Bとを含んでいる。図8に示すように、直進作成部105Aは、走行車両3が直進する直進部(直進ルート)Lna(n=1,2,3・・・)を作成する。直進作成部105Aは、複数の単位作業区画A3n(n=1,2,3・・・)のそれぞれにおいて、長手方向の両端部を結ぶ直進部Lnaを作成する。直進部Lnaの所定位置における位置(緯度、経度)、即ち、位置を示す位置データは、圃場マップMP2の位置(緯度、経度)に対応付けられる。また、ルート作成部105は、ルート設定画面M3に表示された車速入力部97に入力された車速が、直進部Lnaに割り当てられる。つまり、走行車両3が直進部Lnaを走行する際は、当該直進部Lnaに対応付けられた車速で自動走行することになる。 When the setting of the unit work section A3 is completed, the route creation unit 105 creates the planned travel route L1. As shown in FIG. 1, the route creating unit 105 includes a straight travel creating unit 105A and a turning creating unit 105B. As shown in FIG. 8, the straight traveling preparation unit 105A prepares a straight traveling portion (straight traveling route) Lna (n=1, 2, 3,...) In which the traveling vehicle 3 travels straight. The straight advancement creation unit 105A creates a straight advancement part Lna connecting both ends in the longitudinal direction in each of the plurality of unit work sections A3n (n=1, 2, 3,... ). The position (latitude, longitude) at a predetermined position of the straight traveling portion Lna, that is, position data indicating the position is associated with the position (latitude, longitude) of the field map MP2. Further, in the route creating unit 105, the vehicle speed input to the vehicle speed input unit 97 displayed on the route setting screen M3 is assigned to the straight traveling portion Lna. That is, when the traveling vehicle 3 travels in the straight traveling portion Lna, the traveling vehicle 3 automatically travels at the vehicle speed associated with the straight traveling portion Lna.

旋回作成部105Bは、走行車両3が旋回する旋回部(旋回ルート)Lnb(n=1,2,3・・・)を作成する。旋回作成部105Bは、複数の直進部Lnaのうち互いに隣接する直進部Lnaを結ぶ円弧上の旋回部Lnbを枕地エリアA1に作成する。旋回部Lnbの所定位置における位置(緯度、経度)、即ち、位置を示す位置データは、圃場マップMP2の位置(緯度、経度)に対応付けられる。また、ルート作成部105は、自動上昇制御の有効である場合において、走行車両3が旋回部Lnbを通過する際は、自動上昇制御によって作業装置2を上昇させることを自動的に割り当てられる。つまり、走行車両3が旋回部Lnbを走行する際は、作業装置2が自動的に上昇する。 The turning creating unit 105B creates a turning unit (turning route) Lnb (n=1, 2, 3...) In which the traveling vehicle 3 turns. The turning creating unit 105B creates, in the headland area A1, a turning portion Lnb on an arc connecting the straight-moving portions Lna adjacent to each other among the straight-moving portions Lna. The position (latitude, longitude) at a predetermined position of the turning portion Lnb, that is, position data indicating the position is associated with the position (latitude, longitude) of the field map MP2. Further, when the traveling vehicle 3 passes through the turning portion Lnb when the automatic raising control is valid, the route creating unit 105 is automatically assigned to raise the work device 2 by the automatic raising control. That is, when the traveling vehicle 3 travels on the turning portion Lnb, the work device 2 automatically moves up.

以上のように、走行予定ルートL1(直進部L1a、旋回部L1b)が設定された場合、設定された走行予定ルートL1は、表示装置のルート記憶部109に記憶される。また、走行予定ルートL1は、圃場マップMP2と共にルート表示部85に表示される。
さて、ルート作成部105によって作成された走行予定ルートL1は、圃場マップMP2に対して移動させることで、圃場マップMP2に対する走行予定ルートL1の位置を変更可能である。
As described above, when the planned travel route L1 (the straight traveling portion L1a and the turning portion L1b) is set, the set planned travel route L1 is stored in the route storage unit 109 of the display device. Further, the planned travel route L1 is displayed on the route display section 85 together with the farm field map MP2.
The planned travel route L1 created by the route creation unit 105 can be moved with respect to the farm field map MP2 to change the position of the planned travel route L1 with respect to the farm field map MP2.

表示装置は、走行予定ルートL1を圃場マップMP2に対して移動するルート移動部250を備えている。ルート移動部250は、表示装置に設けられた電気・電子回路、表示装置に格納されたプログラム等から構成されている。詳しくは、ルート設定画面M3に表示された移動ボタン251が選択されると、ルート移動部250は、ルート作成部105によって作成された走行予定ルートL1の移動を許可する。走行予定ルートL1の移動は、ルート設定画面M3のルート表示部85に表示されたポインタ252によって行う。図9に示すように、ルート表示部85に表示された走行予定ルートL1をポインタ252で選択すると、ルート移動部250は、走行予定ルートL1の全体(走行予定ルートL1の全体を示すブロックB10)が移動可能な状態(移動が許可された状態)にする。ルート移動部250は、ブロックB10の移動が可能な状態で、ポインタ252を圃場マップMP2において、左、右、上、下に移動させると、当該ポインタ252の移動に伴ってブロックB10を移動させる。ブロックB10は、圃場マップMP2の全体、例えば、圃場マップMP2の縦L40と横L41とで囲まれる全てのエリア内で移動可能であり、作業エリアA2を超えて枕地エリアA1にも移動させることが可能である。 The display device includes a route moving unit 250 that moves the planned traveling route L1 with respect to the farm field map MP2. The route moving unit 250 is composed of an electric/electronic circuit provided in the display device, a program stored in the display device, and the like. Specifically, when the move button 251 displayed on the route setting screen M3 is selected, the route moving unit 250 permits movement of the planned travel route L1 created by the route creating unit 105. The planned traveling route L1 is moved by the pointer 252 displayed on the route display portion 85 of the route setting screen M3. As shown in FIG. 9, when the planned travel route L1 displayed on the route display unit 85 is selected by the pointer 252, the route movement unit 250 causes the entire planned travel route L1 (block B10 indicating the entire planned travel route L1). Is in a movable state (moving is permitted). When the pointer 252 is moved to the left, right, up, and down in the field map MP2 while the block B10 is movable, the route moving unit 250 moves the block B10 along with the movement of the pointer 252. The block B10 is movable in the entire farm field map MP2, for example, in all areas surrounded by the vertical L40 and the horizontal L41 of the farm field map MP2, and may be moved to the headland area A1 beyond the work area A2. Is possible.

ルート表示部85において、ポインタ252を任意の位置まで動かした後、決定ボタン99が選択されると、ルート移動部250は、ブロックB10の移動を完了させる。
ルート移動部250は、ブロックB10の移動が完了すると(許可された走行予定ルートL1の移動が完了)すると、移動前の走行予定ルートL1の位置データを、移動後の走行予定ルートL1に更新する。例えば、移動前の走行予定ルートL1の位置データX1j、Y1k(j=1,2,3・・・、k=1,2,3・・・)とし、移動後の走行予定ルートL1の位置データX2j、Y2k(j=1,2,3・・・、k=1,2,3・・・)とした場合、ルート移動部250は、走行予定ルートL1の位置データを、位置データX1j、Y1kから位置データX2j、Y2kに変更する。走行予定ルートL1の位置データを、位置データX2j、Y2kの変更後は、変更した走行予定ルートL1の位置データは、表示装置のルート記憶部109に記憶される。
When the enter button 99 is selected after moving the pointer 252 to an arbitrary position on the route display unit 85, the route moving unit 250 completes the movement of the block B10.
When the movement of the block B10 is completed (the movement of the permitted planned traveling route L1 is completed), the route moving unit 250 updates the position data of the planned traveling route L1 before the movement to the planned traveling route L1 after the movement. .. For example, the position data X1j, Y1k (j=1, 2, 3..., k=1, 2, 3...) of the planned travel route L1 before the movement and the position data of the planned travel route L1 after the movement are set. When X2j, Y2k (j=1, 2, 3,..., K=1, 2, 3...), the route moving unit 250 converts the position data of the planned travel route L1 into the position data X1j, Y1k. To position data X2j, Y2k. After changing the position data of the planned travel route L1 to the position data X2j and Y2k, the changed position data of the planned travel route L1 is stored in the route storage unit 109 of the display device.

以上によれば、図9に示すように、走行予定ルートL1を作業エリアA2内に設定後、圃場マップMP2内で走行予定ルートL1を移動させたい場合、即ち、走行予定ルートL1の位置を変更した場合は、ルート移動部250によって位置の変更が可能である。
なお、走行予定ルートL1の移動の許可は、作業を行う作業装置2に基づいて行ってもよい。表示装置は、機械取得部254を備えている。機械取得部254は、表示装置に設けられた電気・電子回路、表示装置に格納されたプログラム等から構成されている。機械取得部254は、作業装置2を識別する機械識別情報を取得する。例えば、ルート設定画面M3に表示された機械入力部258に、作業装置2を示す機種、型番、名称等が入力されると、機械取得部254は、機械識別情報である機種、型番、名称等を取得する。
According to the above, as shown in FIG. 9, when the planned travel route L1 is set in the work area A2 and then the planned travel route L1 is to be moved in the field map MP2, that is, the position of the planned travel route L1 is changed. In this case, the route moving unit 250 can change the position.
The permission to move the planned travel route L1 may be given based on the work device 2 that performs the work. The display device includes a machine acquisition unit 254. The machine acquisition unit 254 includes an electric/electronic circuit provided in the display device, a program stored in the display device, and the like. The machine acquisition unit 254 acquires machine identification information that identifies the work device 2. For example, when the model, model number, name or the like indicating the work device 2 is input to the machine input unit 258 displayed on the route setting screen M3, the machine acquisition unit 254 causes the machine identification unit 254 to be the model, model number, name, or the like that is machine identification information. To get.

ルート移動部250は、機械取得部254が取得した機械識別情報に対応する作業装置2が走行予定ルートL1の変更が許可された作業装置2である場合に、走行予定ルートL1が圃場マップMP2に対して移動することを許可する。図10に示すように、表示装置には、機械識別情報(機種、型番、名称等)と、移動の許可/不許可とが対応付けられた条件データが対応付けられて記憶されている。ルート移動部250は、条件データを参照して、機械入力部258に入力された機械識別情報に対応する作業装置2が移動の許可又は不許可であるか否かを検索する。ルート移動部250は、機械識別情報に対応する作業装置2が走行予定ルートL1の変更が許可されていない作業装置2である場合に、走行予定ルートL1が圃場マップに対して移動することを許可しない。 When the work device 2 corresponding to the machine identification information acquired by the machine acquisition unit 254 is the work device 2 that is permitted to change the planned travel route L1, the planned travel route L1 is set in the field map MP2. Allowed to move relative to. As shown in FIG. 10, the display device stores condition identification data in which machine identification information (model, model number, name, etc.) and movement permission/non-permission are associated with each other. The route moving unit 250 refers to the condition data and searches whether the work device 2 corresponding to the machine identification information input to the machine input unit 258 is permitted or not permitted to move. When the work device 2 corresponding to the machine identification information is the work device 2 that is not permitted to change the planned travel route L1, the route moving unit 250 permits the planned travel route L1 to move with respect to the farm field map. do not do.

これによれば、作業装置2の作業に対応して、走行予定ルートL1の移動を許可したり、移動を許可しないようにすることができる。例えば、作業装置2が畝立装置である場合には、走行予定ルートL1の移動を許可することで、当該走行予定ルートL1を圃場マップMP2の端に寄せることができる。一方、作業装置2が耕耘装置である場合には、走行予定ルートL1の移動を不許可にすることで、当該走行予定ルートL1の両側に枕地エリアA1を残すことができ、枕地エリアA1を最後に耕耘することができる。 According to this, it is possible to allow the movement of the planned travel route L1 or not allow the movement according to the work of the work device 2. For example, when the work device 2 is a ridge device, by permitting the movement of the planned traveling route L1, the planned traveling route L1 can be brought close to the end of the field map MP2. On the other hand, when the working device 2 is a cultivating device, the headland area A1 can be left on both sides of the planned travel route L1 by disallowing the movement of the planned travel route L1. Can be cultivated at the end.

図11に示すように、ルート移動部250によって走行予定ルートL1を、例えば、圃場マップMP2の右端に移動させた場合、圃場マップMP2には、空きエリアA8が形成される。ここで、空きエリアA8に新たな走行予定ルートL1を追加することが可能である。
ルート作成部105は、経路追加部105Cを有している。経路追加部105Cは、空きエリアA8に、新たな走行予定ルートL1を追加する。具体的には、ルート設定画面M3に表示された追加ボタン255が選択されると、図11に示すように、経路追加部105Cは、空きエリアA8に単位作業区画A3nを追加し、追加した単位作業区画A3nに直進部Lnaを作成する。また、経路追加部105Cは、追加した直進部Lnaの端部を結ぶ旋回部Lnbを作成する。なお、単位作業区画A3nの幅(W2,W4)は、走行予定ルートL1の追加前の単位作業区画A3nの幅(W2,W4)と同じである。また、単位作業区画A3nを追加する数は、例えば、ルート設定画面M3に入力された追加入力部256によって決定することができる。空きエリアA8の幅を、単位作業区画A3nの幅(W2,W4)で除算して、除算したときの商に基づいて自動的に単位作業区画A3nの追加する数を決定してもよい。
As shown in FIG. 11, when the planned traveling route L1 is moved to the right end of the farm field map MP2 by the route moving unit 250, an empty area A8 is formed in the farm field map MP2. Here, it is possible to add a new scheduled travel route L1 to the empty area A8.
The route creation unit 105 has a route addition unit 105C. The route adding unit 105C adds a new planned traveling route L1 to the empty area A8. Specifically, when the add button 255 displayed on the route setting screen M3 is selected, the route adding unit 105C adds the unit work section A3n to the empty area A8 and adds the added unit, as shown in FIG. The straight-ahead portion Lna is created in the work section A3n. In addition, the route adding unit 105C creates the turning portion Lnb that connects the ends of the added straight traveling portion Lna. The width (W2, W4) of the unit work section A3n is the same as the width (W2, W4) of the unit work section A3n before the planned travel route L1 is added. The number of unit work sections A3n to be added can be determined by, for example, the additional input unit 256 input to the route setting screen M3. The width of the empty area A8 may be divided by the width (W2, W4) of the unit work section A3n, and the number to be added to the unit work section A3n may be automatically determined based on the quotient when the division is performed.

以上によれば、走行予定ルートL1を移動にすることにより、圃場マップMP2に空きエリアA8が形成された場合に、走行予定ルートL1を追加することができる。例えば、
作業装置2が畝立装置である場合、所定の圃場において、畝の本数を増やすことができ、より多くの作物を畝によって作付けすることができる。
図12は、走行予定ルートL1を作成する走行支援方法を示す図である。
According to the above, by moving the planned travel route L1, it is possible to add the planned travel route L1 when the empty area A8 is formed in the farm field map MP2. For example,
When the working device 2 is a ridge forming device, it is possible to increase the number of ridges in a predetermined field and to cultivate a larger number of crops with the ridges.
FIG. 12 is a diagram showing a driving support method for creating the planned driving route L1.

図12に示すように、走行予定ルートL1を作成する圃場マップMP2を取得する(S80)。圃場マップMP2において、枕地エリアA1及び作業エリアA2を設定する(S81)。作業装置2の作業幅W2を取得する(S82)。作業幅W2を用いて、複数の単位作業区画A3nを作業エリアA2内に作成する(S83)
作業エリアA2に基づいて走行予定ルートL1を作成する(S84)。走行予定ルートL1の作成においては、作業エリアA2の単位作業区画A3nのそれぞれに直進部Lnaを作成し(S84−1)、枕地エリアA1に旋回部Lnbを作成する(S84−2)。走行予定ルートL1の作成後、作成された走行予定ルートL1を圃場マップMP2に対して移動させる(S85)。走行予定ルートL1の際しては、ポインタ252により、走行予定ルートL1の全体を示すブロックB10を選択する(S85−1)。ポインタ252を動かすことでブロックB10を圃場マップMP2の任意の位置に移動させる(S85−2)。ブロックB10の移動の完了後は、走行予定ルートL1の位置データを、移動前の走行予定ルートL1の位置データから移動後の走行予定ルートL1の位置データに変更する(S85−3)。
As shown in FIG. 12, the farm field map MP2 that creates the planned travel route L1 is acquired (S80). The headland area A1 and the work area A2 are set in the field map MP2 (S81). The work width W2 of the work device 2 is acquired (S82). A plurality of unit work sections A3n are created in the work area A2 using the work width W2 (S83).
A planned travel route L1 is created based on the work area A2 (S84). In creating the planned travel route L1, the straight-ahead section Lna is created in each of the unit work sections A3n of the work area A2 (S84-1), and the turning section Lnb is created in the headland area A1 (S84-2). After the planned travel route L1 is created, the created planned travel route L1 is moved with respect to the farm field map MP2 (S85). On the planned traveling route L1, the block B10 indicating the entire planned traveling route L1 is selected by the pointer 252 (S85-1). By moving the pointer 252, the block B10 is moved to an arbitrary position on the farm field map MP2 (S85-2). After the movement of the block B10 is completed, the position data of the planned traveling route L1 is changed from the position data of the planned traveling route L1 before the movement to the position data of the planned traveling route L1 after the movement (S85-3).

以上、走行支援装置、作業車両及び走行支援方法によれば、圃場マップMP2に対して走行予定ルートL1を設定後に、設定した走行予定ルートL1を任意の方向に移動させることができる。即ち、圃場マップMP2において、走行予定ルートL1の位置を任意に変更することができる。したがって、畝立作業等などの場合には、走行予定ルートL1を圃場の端に設定することができる。圃場マップMP2内において走行予定ルートL1を移動した場合において、空きエリアA8が形成された場合には、当該空きエリアA8に走行予定ルートL1を追加することができ、圃場の全体に亘って自動走行をしながら作業を行うことができる。 As described above, according to the travel support device, the work vehicle, and the travel support method, after the planned travel route L1 is set in the field map MP2, the set planned travel route L1 can be moved in any direction. That is, the position of the planned travel route L1 can be arbitrarily changed in the field map MP2. Therefore, in the case of ridge work or the like, the planned traveling route L1 can be set at the end of the field. When the planned travel route L1 is moved in the field map MP2 and the empty area A8 is formed, the planned travel route L1 can be added to the empty area A8 and the automatic travel is performed over the entire field. You can work while doing.

今回開示された実施の形態はすべての点で例示であって制限的なものではないと考えられるべきである。本発明の範囲は上記した説明ではなくて特許請求の範囲によって示され、特許請求の範囲と均等の意味及び範囲内でのすべての変更が含まれることが意図される。 The embodiments disclosed this time are to be considered as illustrative in all points and not restrictive. The scope of the present invention is shown not by the above description but by the claims, and is intended to include meanings equivalent to the claims and all modifications within the scope.

1 :作業車両(トラクタ)
50 :表示部
61 :自動走行制御部
100 :走行支援装置
105 :ルート作成部
120 :マップ取得部
250 :ルート移動部
254 :機械取得部
1: Working vehicle (tractor)
50: display unit 61: automatic travel control unit 100: travel support device 105: route creation unit 120: map acquisition unit 250: route moving unit 254: machine acquisition unit

Claims (7)

作業装置が連結される走行車両の走行予定ルートを作成する走行支援装置であって、
所定の圃場における圃場マップを取得するマップ取得部と、
前記マップ取得部が取得した圃場マップに走行予定ルートを作成するルート作成部と、
前記ルート作成部によって作成された前記走行予定ルートを前記圃場マップに対して移動させるルート移動部と、
を備えている走行支援装置。
A travel support device for creating a planned travel route of a traveling vehicle to which a work device is connected,
A map acquisition unit for acquiring a field map in a predetermined field,
A route creation unit that creates a planned travel route in the field map acquired by the map acquisition unit;
A route moving unit that moves the planned traveling route created by the route creating unit with respect to the farm field map;
Driving assistance device.
前記圃場マップ及び前記走行予定ルートを表示する表示部を備え、
前記ルート移動部は、前記表示部に表示された前記走行予定ルートが選択されると、前記圃場マップに対する走行予定ルートの移動を許可し、前記許可された走行予定ルートの移動が完了すると、走行予定ルートの位置データを、前記移動前の走行予定ルートの位置データから前記移動後の走行予定ルートに変更する請求項1に記載の走行支援装置。
A display unit for displaying the farm field map and the planned travel route;
The route moving unit, when the planned traveling route displayed on the display unit is selected, permits movement of the planned traveling route with respect to the field map, and when the permitted planned traveling route is completed, travels. The travel assistance device according to claim 1, wherein the position data of the planned route is changed from the position data of the planned traveling route before the movement to the planned traveling route after the movement.
前記ルート作成部は、前記走行予定ルートを移動することによって前記圃場マップに形成された空きエリアに、新たな走行予定ルートを追加する経路追加部を有している請求項1又は2に記載の走行支援装置。 The route creating unit includes a route adding unit that adds a new planned traveling route to an empty area formed in the farm field map by moving the planned traveling route. Driving support device. 前記作業装置を識別する機械識別情報を取得する機械取得部を備え、
前記ルート移動部は、前記機械取得部が取得した機械識別情報に対応する作業装置が走行予定ルートの変更が許可された作業装置である場合に、前記走行予定ルートが前記圃場マップに対して移動することを許可する請求項1〜3のいずれかに記載の走行支援装置。
A machine acquisition unit for acquiring machine identification information for identifying the working device;
The route moving unit moves the planned traveling route with respect to the farm field map when the working device corresponding to the machine identification information acquired by the machine acquisition unit is a working device permitted to change the planned traveling route. The travel support device according to any one of claims 1 to 3, wherein the travel support device is permitted.
前記ルート移動部は、前記機械識別情報に対応する作業装置が走行予定ルートの変更が許可されていない作業装置である場合に、前記走行予定ルートが前記圃場マップに対して移動することを許可しない請求項4に記載の走行支援装置。 The route moving unit does not allow the planned traveling route to move with respect to the farm field map when the working device corresponding to the machine identification information is a working device that is not permitted to change the planned traveling route. The driving assistance device according to claim 4. 請求項1〜5のいずれかに記載の走行支援装置と、
走行車両と、
前記走行予定ルートに基づいて前記走行車両の自動走行を行う自動走行制御部と、
を備えている作業車両。
A travel support device according to any one of claims 1 to 5,
A traveling vehicle,
An automatic traveling control unit for automatically traveling the traveling vehicle based on the planned traveling route,
Work vehicle equipped with.
作業装置が連結される走行車両の走行予定ルートを作成する走行支援方法であって、
所定の圃場における圃場マップを取得するステップと、
前記マップ取得部が取得した圃場マップに走行予定ルートを作成するステップと、
作成された走行予定ルートを前記圃場マップに対して移動させるステップと、
を備えている走行支援方法。
A driving support method for creating a planned travel route of a traveling vehicle to which a work device is connected,
Acquiring a field map for a given field,
Creating a planned travel route in the field map acquired by the map acquisition unit,
A step of moving the created planned travel route with respect to the farm field map;
A driving support method that is equipped with.
JP2018243527A 2018-12-26 2018-12-26 Driving support device, work vehicle equipped with driving support device, and driving support method Active JP7154997B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2018243527A JP7154997B2 (en) 2018-12-26 2018-12-26 Driving support device, work vehicle equipped with driving support device, and driving support method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2018243527A JP7154997B2 (en) 2018-12-26 2018-12-26 Driving support device, work vehicle equipped with driving support device, and driving support method

Publications (2)

Publication Number Publication Date
JP2020106974A true JP2020106974A (en) 2020-07-09
JP7154997B2 JP7154997B2 (en) 2022-10-18

Family

ID=71449089

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018243527A Active JP7154997B2 (en) 2018-12-26 2018-12-26 Driving support device, work vehicle equipped with driving support device, and driving support method

Country Status (1)

Country Link
JP (1) JP7154997B2 (en)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007073034A (en) * 2005-08-10 2007-03-22 Seiko Epson Corp Image processing content determination apparatus, image processing content determination program, and image processing content determination method
JP2016021891A (en) * 2014-07-17 2016-02-08 株式会社クボタ Travelling work machine and automatic steering system used for the same
JP2017134527A (en) * 2016-01-26 2017-08-03 ヤンマー株式会社 Agricultural work vehicle
JP2017182375A (en) * 2016-03-30 2017-10-05 ヤンマー株式会社 Route generation device

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007073034A (en) * 2005-08-10 2007-03-22 Seiko Epson Corp Image processing content determination apparatus, image processing content determination program, and image processing content determination method
JP2016021891A (en) * 2014-07-17 2016-02-08 株式会社クボタ Travelling work machine and automatic steering system used for the same
JP2017134527A (en) * 2016-01-26 2017-08-03 ヤンマー株式会社 Agricultural work vehicle
JP2017182375A (en) * 2016-03-30 2017-10-05 ヤンマー株式会社 Route generation device

Also Published As

Publication number Publication date
JP7154997B2 (en) 2022-10-18

Similar Documents

Publication Publication Date Title
JP6804999B2 (en) Work driving management system
JP2024054304A (en) Work vehicle support system and work vehicle support method
JP2020103092A (en) Travelling support device, work vehicle equipped with travelling support device, and travelling support method
JP6772105B2 (en) Work management system
JP2019170197A (en) Region registration system
JP2020103088A (en) Control device of work vehicle, and work vehicle equipped with control device
EP3977839A1 (en) Autonomous travel system
JP7154997B2 (en) Driving support device, work vehicle equipped with driving support device, and driving support method
JP7084862B2 (en) Driving support device, work vehicle equipped with driving support device, and driving support method
WO2022059734A1 (en) Traveling line creation system for agricultural machine
JP7106443B2 (en) Driving support device, work vehicle equipped with driving support device, and driving support method
JP7102332B2 (en) Work vehicle equipped with a driving support device and a driving support device
JP7060208B2 (en) Driving support device, work vehicle equipped with driving support device, and driving support method
JP7110088B2 (en) Driving support device, work vehicle equipped with driving support device, and driving support method
JP2021093982A (en) Work machine
JP2020103094A (en) Automated travelling support device, work vehicle, and automated travelling method of work vehicle
JP7336002B2 (en) Driving support device, work vehicle equipped with driving support device, and driving support method
JP7110089B2 (en) Driving support device, work vehicle equipped with driving support device, and driving support method
JP7282660B2 (en) work machine
JP7050874B2 (en) Work management system
JP7116432B2 (en) Autonomous driving system
JP2021009523A (en) Work display device and work machine
JP7238025B2 (en) Agricultural support system
JP7034860B2 (en) Area registration system
KR20230145328A (en) Display method, display terminal, and display program

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20201225

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20210922

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20211005

A601 Written request for extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A601

Effective date: 20211126

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220119

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220621

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220726

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20221005

R150 Certificate of patent or registration of utility model

Ref document number: 7154997

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150