JP2020103086A - Travelling support device and work vehicle equipped with travelling support device - Google Patents

Travelling support device and work vehicle equipped with travelling support device Download PDF

Info

Publication number
JP2020103086A
JP2020103086A JP2018243526A JP2018243526A JP2020103086A JP 2020103086 A JP2020103086 A JP 2020103086A JP 2018243526 A JP2018243526 A JP 2018243526A JP 2018243526 A JP2018243526 A JP 2018243526A JP 2020103086 A JP2020103086 A JP 2020103086A
Authority
JP
Japan
Prior art keywords
route
traveling
unit
work
planned
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
JP2018243526A
Other languages
Japanese (ja)
Other versions
JP7102332B2 (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 JP2018243526A priority Critical patent/JP7102332B2/en
Publication of JP2020103086A publication Critical patent/JP2020103086A/en
Application granted granted Critical
Publication of JP7102332B2 publication Critical patent/JP7102332B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

To create a scheduled travelling route easily even when a case where travelling cannot be performed, or work cannot be performed occurs in part of a farm field.SOLUTION: A travelling support device that creates a scheduled travelling route for a travelling vehicle to which a work device is connected includes: a map acquisition unit for acquiring a farm field map in a predetermined farm field; and a route creation unit for creating a scheduled travelling route in the farm field map acquired by the map acquisition unit. The route creation unit includes a restriction setting part for setting a restriction associated with either the travelling of the travelling vehicle or the work of the work device to the scheduled travelling route.SELECTED DRAWING: Figure 1

Description

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

従来、トラクタ等の作業車両を自動走行させるための走行経路(走行予定ルート)を作成する技術として特許文献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) is created for the inner area of the field. When traveling cannot be performed or work cannot be performed in a part of the inner area of the field, it is necessary to reset the inner area for creating the planned traveling route, which makes setting the planned traveling route difficult. Further, when the inner region cannot be reset by the tractor, there is a possibility that the work in the field must be interrupted.

そこで、本発明は上記問題点に鑑み、圃場の一部において走行ができない場合、又は、作業ができない場合が生じたときでも簡単に走行予定ルートの作成を行うことができる走行支援装置、走行支援装置を備えた作業車両を提供することを目的とする。 Therefore, in view of the above problems, the present invention provides a travel assistance device and a travel assistance device that can easily create a planned travel route even when traveling cannot be performed in a part of a field or when work cannot be performed. An object of the present invention is to provide a work vehicle equipped with the device.

この技術的課題を解決するための本発明の技術的手段は、以下に示す点を特徴とする。
走行支援装置は、作業装置が連結される走行車両の走行予定ルートを作成する走行支援装置であって、所定の圃場における圃場マップを取得するマップ取得部と、前記マップ取得部が取得した圃場マップに走行予定ルートを作成するルート作成部と、を備え、前記ルート作成部は、前記走行車両の走行及び前記作業装置の作業のいずれかに関する制限を、前記走行予定ルートに設定する制限設定部を有している。
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 creating unit for creating a planned travel route, wherein the route creation unit includes a limit setting unit that sets a restriction relating to either traveling of the traveling vehicle or work of the working device to the planned travel route. Have

前記制限設定部は、前記作業の制限として、前記走行予定ルート上に前記作業装置の作業を行わない非作業部を設定する。
前記制限設定部は、前記走行の制限として、前記走行予定ルート上に前記走行車両の停止を行う停止部を設定する。
走行支援装置は、前記走行予定ルートを表示する表示部を備え、前記制限設定部は、前記表示部に表示された走行予定ルートに対して所定の位置が指定された場合に、前記所定の位置を、前記制限を行う位置に設定する。
The restriction setting unit sets, as a restriction of the work, a non-working unit that does not work the working device on the planned travel route.
The restriction setting unit sets a stop unit that stops the traveling vehicle on the planned traveling route as the traveling restriction.
The travel assistance device includes a display unit that displays the planned travel route, and the limit setting unit, when a predetermined position is designated for the planned travel route displayed on the display unit, the predetermined position. Is set to the position where the restriction is performed.

走行支援装置は、所定の圃場における圃場マップを登録するマップ登録部を備え、前記制限設定部は、前記マップ登録部によって登録された圃場マップに対して前記走行予定ルート上に前記制限を設定する。
作業車両は、走行支援装置と、走行車両と、前記走行予定ルートに基づいて前記走行車両の自動走行を行う自動走行制御部と、を備えている。
The travel support device includes a map registration unit that registers a field map in a predetermined field, and the restriction setting unit sets the restriction on the planned travel route for the field map registered by the map registration unit. ..
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 automatic traveling control unit restarts the automatic traveling when the release information for releasing the limitation on traveling set in the planned traveling route is acquired.

本発明によれば、圃場の一部において走行ができない場合、又は、作業ができない場合が生じたときでも簡単に走行予定ルートの作成を行うことができる。 According to the present invention, it is possible to easily create a planned traveling route even when traveling cannot be performed in a part of a farm field or when work cannot be performed.

走行支援装置を備えた作業車両のブロック図を示す図である。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. 走行予定ルートL1上に停止部を設定した図である。It is the figure which set the stop part on the scheduled travel route L1. 走行予定ルートL1上に非作業部を設定した図である。It is the figure which set the non-working part on the scheduled travel route L1. ポインタで走行予定ルートの任意の位置を保持して、保持した保持部分を移動させることを示す図である。It is a figure which shows holding|maintaining the arbitrary positions of the planned driving route with a pointer, and moving the hold|maintained holding part. 保持部分を移動させて走行予定ルートを収縮した図である。It is the figure which moved the holding part and contracted the planned running route. 保持部分を移動させて走行予定ルートを延長した図である。It is the figure which extended the planned travel route by moving the holding part. 作業画面M21の一例を示す図である。It is a figure which shows an example of the work screen M21. 自動走行をまとめた図である。It is the figure which summarized automatic driving. トラクタの側面全体図である。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 cultivating, a ridge coating device for ridge coating, a ridge forming device for ridge coating, a fertilizer spraying device for spraying fertilizer, a pesticide spraying device for spraying pesticides, a harvesting device for harvesting, grass etc. And a spreading device for spreading grass and the like, a grass collecting device for collecting grass and the like, and a molding device for molding grass and the like.

図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 such 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は、マップ取得部120と、走行予定ルートL1の作成を行うルート作成部105を備えている。マップ取得部120は、ルート作成部105は、表示装置に設けられた電気・電子回路、表示装置に格納されたプログラム等から構成されている。
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 map acquisition unit 120 and a route creation unit 105 that creates a planned travel route L1. In the map acquisition unit 120, the route creation unit 105 is composed of an electric/electronic circuit provided in the display device, a program 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から取得してもよい。 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.

また、ルート表示部85は、圃場マップMP2に設定された走行予定ルートL1を表示する。
ルート設定画面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 display unit 85 also displays the planned travel route L1 set in the farm field map MP2.
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 decision 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に示すように、ルート作成部105は、作業幅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 105 may create a plurality of unit work sections A3n having a width W4 obtained by dividing the work width W2 by the overlap width W3 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の作成を行う。ルート作成部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. The route creating unit 105 includes a straight traveling 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は、走行車両3の走行に関する制限(走行制限)、又は、作業装置2の作業の制限(作業制限)を、走行予定ルートL1に設定することができる。ルート作成部105は、制限設定部105Dを備えている。制限設定部105Dは、少なくとも走行制限及び作業制限のいずれかを走行予定ルートL1に行うことができる。制限設定部105Dは、走行の制限として、走行予定ルートL1上に走行車両3の停止を行う停止部410を設定する。また、制限設定部105Dは、作業の制限として、走行予定ルートL1上に作業装置2の作業を行わない非作業部420を設定する。
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.
By the way, the route creation unit 105 can set a limitation on the traveling of the traveling vehicle 3 (travel limitation) or a work limitation of the work device 2 (work limitation) on the planned travel route L1. The route creation unit 105 includes a limit setting unit 105D. The restriction setting unit 105D can perform at least one of the travel restriction and the work restriction on the planned travel route L1. The limit setting unit 105D sets a stop unit 410 that stops the traveling vehicle 3 on the planned traveling route L1 as a restriction on traveling. Further, the restriction setting unit 105D sets, as the work restriction, the non-working unit 420 that does not work the work device 2 on the planned travel route L1.

具体的には、ルート設定画面M3には、制限を示す制限項目を表示する制限項目部401が表示される。制限項目部401には、例えば、作業制限として作業を行わないことを示す作業停止Q1が表示され、走行制限として、走行車両3の停止を示す走行停止Q2が表示される。また、ルート設定画面M3には、ポインタ402が表示される。
図9Aに示すように、制限設定部105Dは、制限項目部401において、走行停止Q2が選択され且つ走行予定ルートL1の所定の位置がポインタ402によって指定された場合、指定された所定の位置(所定位置)P71に停止部410を設定する。制限設定部105Dは、走行予定ルートL1において、複数の所定位置P71が指定された場合、複数の所定位置P71を停止部410として設定する。つまり、制限設定部105Dは、走行予定ルートL1の所定位置P71において、走行車両3が停止するという停止部410の位置データを付与する。このように、制限設定部105Dによって、走行予定ルートL1上に停止部410が設定された場合、停止部410の位置データを含む走行予定ルートL1の位置データがルート記憶部109に記憶される。
Specifically, on the route setting screen M3, a restriction item section 401 that displays a restriction item indicating a restriction is displayed. In the limit item section 401, for example, a work stop Q1 indicating that work is not performed is displayed as a work limit, and a travel stop Q2 indicating that the traveling vehicle 3 is stopped is displayed as a travel limit. Further, a pointer 402 is displayed on the route setting screen M3.
As shown in FIG. 9A, when the travel stop Q2 is selected and the predetermined position of the planned travel route L1 is specified by the pointer 402 in the restriction item section 401, the restriction setting unit 105D specifies the specified predetermined position ( The stop portion 410 is set at (predetermined position) P71. When a plurality of predetermined positions P71 are designated in the planned travel route L1, the limit setting unit 105D sets the plurality of predetermined positions P71 as the stop unit 410. That is, the limit setting unit 105D gives the position data of the stopping unit 410 that the traveling vehicle 3 stops at the predetermined position P71 of the planned traveling route L1. In this way, when the limit setting unit 105D sets the stop unit 410 on the planned travel route L1, the position data of the planned travel route L1 including the position data of the stop unit 410 is stored in the route storage unit 109.

図9Bに示すように、制限設定部105Dは、制限項目部401において、作業停止Q1が選択され且つ走行予定ルートL1の所定の位置がポインタ402によって指定された場合、指定された所定の位置(所定位置)P72に非作業部420を設定する。つまり、制限設定部105Dは、走行予定ルートL1の所定位置P72において、作業装置2の作業を行わないという非作業部420の情報を付与する。なお、制限設定部105Dは、走行予定ルートL1において選択された所定位置P72aと、P72bとを結ぶ部分が、非作業部420として設定してもよい。このように、制限設定部105Dによって、走行予定ルートL1上に非作業部420が設定された場合、非作業部420の位置データを含む走行予定ルートL1の位置データがルート記憶部109に記憶される。 As shown in FIG. 9B, when the work stop Q1 is selected and the predetermined position of the planned travel route L1 is specified by the pointer 402 in the restriction item section 401, the restriction setting unit 105D specifies the specified predetermined position ( The non-working section 420 is set at (predetermined position) P72. That is, the restriction setting unit 105D gives the information of the non-working unit 420 that the work device 2 does not work at the predetermined position P72 of the planned travel route L1. Note that the restriction setting unit 105D may set the portion connecting the predetermined position P72a selected on the planned travel route L1 and P72b as the non-working unit 420. In this way, when the non-working section 420 is set on the planned travel route L1 by the restriction setting unit 105D, the position data of the planned travel route L1 including the position data of the non-working section 420 is stored in the route storage unit 109. It

なお、ルート作成部105は、走行予定ルートL1の延長、短縮(収縮)を行うことができるようにしてもよい。ルート作成部105は、ルート変形部105Eを備えている。ルート変形部105Eは、走行予定ルートL1の延長、短縮を行う。具体的には、ルート設定画面M3に表示された延長ボタン405を選択後、図10Aに示すように、走行予定ルートL1上をポインタ402で選択すると、ルート変形部105Eは、選択した選択位置P75に対応する走行予定ルートL1の一部を保持する。例えば、走行予定ルートL1において、選択位置P75に対応する位置が旋回部Lnbである場合、ルート変形部105Eは、旋回部Lnbを保持する。 The route creation unit 105 may be capable of extending or shortening (contracting) the planned travel route L1. The route creating unit 105 includes a route transforming unit 105E. The route transformation unit 105E extends or shortens the planned travel route L1. Specifically, after selecting the extension button 405 displayed on the route setting screen M3 and selecting the planned traveling route L1 with the pointer 402 as shown in FIG. 10A, the route deforming unit 105E causes the selected selection position P75. A part of the planned travel route L1 corresponding to is held. For example, in the planned traveling route L1, when the position corresponding to the selected position P75 is the turning portion Lnb, the route deforming portion 105E holds the turning portion Lnb.

以降、説明の便宜上、旋回部Lnbが、ポインタ402によって保持された保持部分425であるとして説明を進める。当然の如く、ポインタ402によって保持された保持部分425は、旋回部Lnbでなくても様々な個所が適用可能である。
ルート表示部85に表示された圃場マップMP上において、ポインタ402を上、下、右、左に移動させると、ルート変形部105Eは、図10Aに示すように、保持部分425を、ポインタ402の移動に伴って、選択位置P75から任意の位置に移動させ、保持部分425の任意の位置に応じて走行予定ルートL1の長さを延長したり、短縮(収縮)する。図10Bに示すように、例えば、保持部分425を選択位置P75よりも作業エリアA2側に移動させた場合は、ルート変形部105Eは、保持部分425の移動に伴って、保持部分425に繋がる直進部Lnaを短縮(収縮)する。図10Cに示すように、例えば、保持部分425を選択位置P75よりも作業エリアA2の内側に移動させた場合は、ルート変形部105Eは、保持部分425の移動に伴って、保持部分425に繋がる直進部Lnaを短縮する。このように、ルート変形部105Eによって、走行予定ルートL1上が延長、短縮(収縮)された場合、短縮(収縮)された走行予定ルートL1の位置データがルート記憶部109に記憶される。
Hereinafter, for convenience of explanation, the description will proceed assuming that the turning portion Lnb is the holding portion 425 held by the pointer 402. As a matter of course, the holding portion 425 held by the pointer 402 is not limited to the turning portion Lnb, and various places can be applied.
When the pointer 402 is moved up, down, right, or left on the field map MP displayed on the route display unit 85, the route deforming unit 105E moves the holding portion 425 to the pointer 402 as shown in FIG. 10A. Along with the movement, the selected position P75 is moved to an arbitrary position, and the length of the planned traveling route L1 is extended or shortened (contracted) according to the arbitrary position of the holding portion 425. As illustrated in FIG. 10B, for example, when the holding portion 425 is moved to the work area A2 side from the selection position P75, the route deforming unit 105E causes the holding portion 425 to move, and thus the straight-moving straight portion connected to the holding portion 425. The part Lna is shortened (contracted). As shown in FIG. 10C, for example, when the holding portion 425 is moved to the inside of the work area A2 from the selection position P75, the route deforming unit 105E is connected to the holding portion 425 as the holding portion 425 moves. The straight-ahead portion Lna is shortened. In this way, when the planned route L1 is extended or shortened (contracted) by the route deforming unit 105E, the position data of the shortened (contracted) planned route L1 is stored in the route storage unit 109.

さて、自動走行を行う場合、図11に示すように、表示装置には、作業画面M21が表示される。作業画面M21は、作業表示部197を備えている。作業表示部197は、ルート記憶部109に記憶された走行予定ルートL1を表示する。作業表示部197は、走行制限が走行予定ルートL1に設定されている場合は、走行制限が設定された走行予定ルートL1、例えば、停止部410の位置が付与された走行予定ルートL1を表示する。作業表示部197は、作業制限が走行予定ルートL1に設定されている場合は、作業制限が設定された走行予定ルートL1、例えば、非作業部420の位置が付与された走行予定ルートL1を表示する。作業表示部197において、停止部410を示す図形D21、非作業部420を示す図形D22を走行予定ルートL1上に表示してもよい。また、作業表示部197は、走行予定ルートL1が延長又は短縮されている場合は、延長又は短縮された走行予定ルートL1を表示する。作業表示部197は、自動走行を行ったときの測位装置40が検出した車体位置、即ち、自動作業軌跡K11を表示する。なお、作業表示部197は、走行予定ルートL1に対するトラクタ1の現在の位置を表示してもよい。 Now, in the case of performing automatic traveling, a work screen M21 is displayed on the display device as shown in FIG. The work screen M21 includes a work display unit 197. The work display unit 197 displays the planned travel route L1 stored in the route storage unit 109. When the travel restriction is set on the planned travel route L1, the work display unit 197 displays the planned travel route L1 for which the travel restriction is set, for example, the planned travel route L1 to which the position of the stop unit 410 is given. .. When the work restriction is set on the planned travel route L1, the work display unit 197 displays the planned travel route L1 for which the work restriction is set, for example, the planned travel route L1 to which the position of the non-work unit 420 is given. To do. The work display unit 197 may display a graphic D21 indicating the stopping unit 410 and a graphic D22 indicating the non-working unit 420 on the planned travel route L1. In addition, the work display unit 197 displays the extended or shortened planned traveling route L1 when the planned traveling route L1 is extended or shortened. The work display unit 197 displays the vehicle body position detected by the positioning device 40 during automatic traveling, that is, the automatic work trajectory K11. The work display unit 197 may display the current position of the tractor 1 with respect to the planned travel route L1.

自動走行を行っている状況下において、走行車両3が停止部410に到達した場合は、自動走行制御部61は、車速を零にすることによって走行車両3を停止させることで、自動走行を一旦停止する。
なお、直進部Lna、旋回部Lnbにおいて、停止部410が設定されていない場合は、緊急の場合を除き、走行車両3は、停止することなく直進及び旋回を行う。緊急の場合とは、走行車両3が自動走行中に人、動物等の障害物を検出した場合である。障害物の検出は、トラクタ1に設けられた障害物検出装置77によって検出される。障害物検出装置77によって障害物を検出した場合は、自動走行制御部61は、車速を零にすることによって走行車両3を停止させることで、自動走行を一旦停止する。
When the traveling vehicle 3 reaches the stop portion 410 under the condition of automatic traveling, the automatic traveling control unit 61 stops the traveling vehicle 3 by setting the vehicle speed to zero, so that the automatic traveling is temporarily stopped. Stop.
In addition, when the stop portion 410 is not set in the straight traveling portion Lna and the turning portion Lnb, the traveling vehicle 3 performs straight traveling and turning without stopping unless an emergency occurs. The emergency case is a case where an obstacle such as a person or an animal is detected while the traveling vehicle 3 is automatically traveling. The detection of the obstacle is detected by the obstacle detection device 77 provided in the tractor 1. When the obstacle detection device 77 detects an obstacle, the automatic traveling control unit 61 stops the traveling vehicle 3 by setting the vehicle speed to zero, thereby temporarily stopping the automatic traveling.

即ち、自動走行制御部61は、障害物検出装置77によって障害物が検出されておらず且つ直進部Lna、旋回部Lnbに停止部410が設定されていない定常走行の場合は、車速に応じて走行車両3の走行を継続し、定常走行において、走行車両3が停止部410に到達した場合は、自動走行制御部61は、自動走行を一旦停止する。
自動走行を一旦停止した場合、走行車両3を停止した場合において、走行に関する制限を解除する解除情報を取得した場合には、自動走行制御部61は、自動走行を再開する。例えば、リモコン等の外部端末を操作することによって、外部からトラクタ1に向けて解除情報が送信され、トラクタ1に設けた通信装置を介して自動走行制御部61が解除情報を取得した場合、当該自動走行制御部61は解除情報を取得した時点で、走行に関する制御、例えば、走行車両3の停止を解除し、走行予定ルートL1に対応した車速で走行車両3を自動走行させる。
That is, in the case of steady traveling in which no obstacle is detected by the obstacle detection device 77 and the stopping portion 410 is not set in the straight traveling portion Lna and the turning portion Lnb, the automatic traveling control portion 61 responds to the vehicle speed. When the traveling vehicle 3 continues to travel and the traveling vehicle 3 reaches the stop portion 410 in the steady traveling, the automatic traveling control unit 61 temporarily stops the automatic traveling.
When the automatic traveling is once stopped, when the traveling vehicle 3 is stopped, and when the release information for releasing the limitation on traveling is acquired, the automatic traveling control unit 61 restarts the automatic traveling. For example, when the release information is transmitted from the outside to the tractor 1 by operating an external terminal such as a remote controller, and the automatic traveling control unit 61 acquires the release information via the communication device provided in the tractor 1, When the automatic traveling control unit 61 acquires the release information, the automatic traveling control unit 61 releases control regarding traveling, for example, releases the stop of the traveling vehicle 3 and causes the traveling vehicle 3 to automatically travel at a vehicle speed corresponding to the planned traveling route L1.

また、自動走行を行っている状況下において、走行車両3が非作業部420に到達した場合、自動走行制御部61は、制御装置60に対して作業装置2における作業停止を通知する。制御装置60は、自動走行制御部61からの通知を受けて、例えば、クラッチ等を切断することによりPTOの動力を作業装置2に伝達しないようにすることで作業装置2の作業を停止したり、自動上昇制御によって作業装置2を自動的に上昇させることで対地作業を行わないようにすることで作業装置2の作業を停止する。直進部Lnaにおいて、非作業部420が設定されていない場合は、作業装置2の作業は連続して行われる。なお、上述した実施形態では、自動走行制御部61が制御装置60に作業停止を通知することによって、作業装置2の作業を停止していたが、自動走行制御部61が制御装置60と同様な制御を行うことによって、作業装置2の作業を停止してもよい。 In addition, when the traveling vehicle 3 reaches the non-working section 420 under the condition of automatic traveling, the automatic traveling control section 61 notifies the control device 60 of work stoppage in the work device 2. Upon receiving the notification from the automatic travel control unit 61, the control device 60 stops the work of the work device 2 by not transmitting the power of the PTO to the work device 2, for example, by disengaging the clutch or the like. The work of the work device 2 is stopped by automatically raising the work device 2 by the automatic raising control so that the ground work is not performed. When the non-working section 420 is not set in the straight traveling section Lna, the work of the working apparatus 2 is continuously performed. In the above-described embodiment, the work of the work device 2 is stopped by the automatic travel control unit 61 notifying the control device 60 of the work stoppage, but the automatic travel control unit 61 is similar to the control device 60. The work of the work device 2 may be stopped by performing the control.

図12は、自動走行の動作をまとめた図である。図12に示すように、自動走行の開始が指令されると(S120)、自動走行制御部61は、障害物検出装置77によって、障害物を検出していないか否かを判定する(S121)。障害物検出装置77が障害物を検出していない場合(S121、No)、自動走行制御部61は、走行予定ラインL1と走行車両3との偏差(位置偏差、方位偏差)に基づいて、自動操舵を行う(S122)。また、自動走行制御部61は、走行車両3の車速を、走行予定ラインL1に対応した車速に設定する(S123)。自動走行制御部61は、自動走行中に、走行予定ラインL1に設定された制限に対応する位置(制限位置)に走行車体3が達したか否かを判断する(S124)。走行車体3が制限位置に達した場合(S124、Yes)、トラクタ1、例えば、自動走行制御部61は、制限位置に対応する制限(走行制限、作業制限)を実行する(S125)。走行車体3が制限位置に達していない場合(S124、No)、自動走行制御部61は、自動走行を継続する。 FIG. 12 is a diagram summarizing the operation of automatic traveling. As shown in FIG. 12, when the start of the automatic traveling is instructed (S120), the automatic traveling control unit 61 determines whether or not the obstacle is detected by the obstacle detection device 77 (S121). .. When the obstacle detection device 77 has not detected an obstacle (S121, No), the automatic traveling control unit 61 automatically determines the deviation between the planned traveling line L1 and the traveling vehicle 3 (positional deviation, azimuth deviation). Steering is performed (S122). Further, the automatic traveling control unit 61 sets the vehicle speed of the traveling vehicle 3 to the vehicle speed corresponding to the planned traveling line L1 (S123). The automatic traveling control unit 61 determines whether or not the traveling vehicle body 3 has reached a position (limit position) corresponding to the limit set on the planned traveling line L1 during automatic traveling (S124). When the traveling vehicle body 3 reaches the limit position (S124, Yes), the tractor 1, for example, the automatic traveling control unit 61 executes the limit (travel limit, work limit) corresponding to the limit position (S125). When the traveling vehicle body 3 has not reached the limit position (S124, No), the automatic traveling control unit 61 continues the automatic traveling.

自動走行制御部61は、走行制限が行われて走行車両3が停止している場合、走行制限の解除があったか否かを判断する(S126)。走行制限の解除があった場合(S126、Yes)、自動走行制御部61は、走行制限を解除する(S127)、走行制限の解除後は、自動走行に戻る。
なお、作業制限が行われている場合、走行車両3が、作業制限が設定されていない位置に到達した場合には、作業制限が自動的に解除される。
When the traveling vehicle 3 is stopped due to traveling limitation, the automatic traveling control unit 61 determines whether or not the traveling limitation has been released (S126). When the traveling restriction has been released (S126, Yes), the automatic traveling control unit 61 releases the traveling restriction (S127), and after the traveling restriction is released, the automatic traveling control returns to the automatic traveling.
In addition, when the work limitation is performed and the traveling vehicle 3 reaches the position where the work limitation is not set, the work limitation is automatically released.

以上のように、トラクタ1は、走行予定ルート及び当該走行予定ルートに設定された制限に対応した走行を行うことができる。
今回開示された実施の形態はすべての点で例示であって制限的なものではないと考えられるべきである。本発明の範囲は上記した説明ではなくて特許請求の範囲によって示され、特許請求の範囲と均等の意味及び範囲内でのすべての変更が含まれることが意図される。例えば、上述した走行制限及び作業制限は一例であり、他の内容であってもよい。
As described above, the tractor 1 can travel according to the planned travel route and the restrictions set on the planned travel route.
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. For example, the travel restrictions and work restrictions described above are examples, and other contents may be used.

1 :作業車両(トラクタ)
50 :表示部
61 :自動走行制御部
100 :走行支援装置
101 :マップ登録部
105 :ルート作成部
105D :制限設定部
1: Working vehicle (tractor)
50: Display unit 61: Automatic driving control unit 100: Driving support device 101: Map registration unit 105: Route creation unit 105D: Limit setting 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;
Equipped with
The travel support device, wherein the route creation unit includes a limit setting unit that sets a limit on either travel of the traveling vehicle or work of the work device to the planned travel route.
前記制限設定部は、前記作業の制限として、前記走行予定ルート上に前記作業装置の作業を行わない非作業部を設定する請求項1に走行支援装置。 The travel support device according to claim 1, wherein the restriction setting unit sets, as a restriction on the work, a non-working unit that does not work the work device on the planned travel route. 前記制限設定部は、前記走行の制限として、前記走行予定ルート上に前記走行車両の停止を行う停止部を設定する請求項1又は2に走行支援装置。 The travel support device according to claim 1, wherein the restriction setting unit sets a stop unit that stops the traveling vehicle on the planned travel route as the travel restriction. 前記走行予定ルートを表示する表示部を備え、
前記制限設定部は、前記表示部に表示された走行予定ルートに対して所定の位置が指定された場合に、前記所定の位置を、前記制限を行う位置に設定する請求項1〜3のいずれかに記載の走行支援装置。
A display unit for displaying the planned traveling route,
The said limit setting part sets the said predetermined position to the position which performs the said limit, when a predetermined position is designated with respect to the planned driving route displayed on the said display part. The driving assistance device according to claim 1.
所定の圃場における圃場マップを登録するマップ登録部を備え、
前記制限設定部は、前記マップ登録部によって登録された圃場マップに対して前記走行予定ルート上に前記制限を設定する請求項1〜4のいずれかに記載の走行支援装置。
A map registration unit for registering a field map in a predetermined field is provided,
The travel support device according to claim 1, wherein the restriction setting unit sets the restriction on the planned travel route for the field map registered by the map registration unit.
請求項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.
前記自動走行制御部は、前記走行予定ルートに設定された走行に関する制限を解除する解除情報を取得した場合に、前記自動走行を再開する請求項6に記載の作業車両。 The work vehicle according to claim 6, wherein the automatic traveling control unit restarts the automatic traveling when the release information for releasing the limitation on traveling set in the planned traveling route is acquired.
JP2018243526A 2018-12-26 2018-12-26 Work vehicle equipped with a driving support device and a driving support device Active JP7102332B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2018243526A JP7102332B2 (en) 2018-12-26 2018-12-26 Work vehicle equipped with a driving support device and a driving support device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2018243526A JP7102332B2 (en) 2018-12-26 2018-12-26 Work vehicle equipped with a driving support device and a driving support device

Publications (2)

Publication Number Publication Date
JP2020103086A true JP2020103086A (en) 2020-07-09
JP7102332B2 JP7102332B2 (en) 2022-07-19

Family

ID=71447550

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018243526A Active JP7102332B2 (en) 2018-12-26 2018-12-26 Work vehicle equipped with a driving support device and a driving support device

Country Status (1)

Country Link
JP (1) JP7102332B2 (en)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6417106A (en) * 1987-07-10 1989-01-20 Kubota Ltd Drive controller for self-traveling working vehicle
JP2015112071A (en) * 2013-12-12 2015-06-22 株式会社クボタ Field work machine
JP2016007196A (en) * 2014-06-26 2016-01-18 株式会社クボタ Planting/sowing paddy working machine
JP2016168883A (en) * 2015-03-11 2016-09-23 株式会社クボタ Work vehicle
JP2017161987A (en) * 2016-03-07 2017-09-14 ヤンマー株式会社 Travel area form registration system of work vehicle
JP2018013833A (en) * 2016-07-19 2018-01-25 株式会社クボタ Service car and inclination travel management system for service car
JP2019187352A (en) * 2018-04-27 2019-10-31 井関農機株式会社 Work vehicle

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6417106A (en) * 1987-07-10 1989-01-20 Kubota Ltd Drive controller for self-traveling working vehicle
JP2015112071A (en) * 2013-12-12 2015-06-22 株式会社クボタ Field work machine
JP2016007196A (en) * 2014-06-26 2016-01-18 株式会社クボタ Planting/sowing paddy working machine
JP2016168883A (en) * 2015-03-11 2016-09-23 株式会社クボタ Work vehicle
JP2017161987A (en) * 2016-03-07 2017-09-14 ヤンマー株式会社 Travel area form registration system of work vehicle
JP2018013833A (en) * 2016-07-19 2018-01-25 株式会社クボタ Service car and inclination travel management system for service car
JP2019187352A (en) * 2018-04-27 2019-10-31 井関農機株式会社 Work vehicle

Also Published As

Publication number Publication date
JP7102332B2 (en) 2022-07-19

Similar Documents

Publication Publication Date Title
CN113826460B (en) work vehicle
JP6804999B2 (en) Work driving management system
JP6594805B2 (en) Work vehicle
JP2017161987A (en) Travel area form registration system of work vehicle
KR20180100355A (en) Path generating device
JP2018169826A (en) Working vehicle for agricultural use
JP2017174229A (en) Route generation device
JP7039454B2 (en) Driving support device, work vehicle equipped with driving support device, and driving support method
JP7102333B2 (en) Work vehicle with control device and control device
JP7102332B2 (en) Work vehicle equipped with a driving support device and a driving support device
JP7084862B2 (en) Driving support device, work vehicle equipped with driving support device, and driving support method
WO2021125124A1 (en) Work machine
JP7106443B2 (en) Driving support device, work vehicle equipped with driving support device, and driving support method
JP7154997B2 (en) Driving support device, work vehicle equipped with driving support device, and driving support method
JP7084863B2 (en) Automatic driving support device, work vehicle and automatic driving method of work vehicle
KR20230029589A (en) Harvester, automatic driving method of harvester, program, recording medium, system, agricultural machine, automatic driving method of agricultural machine, method, automatic steering management system
JP7110088B2 (en) Driving support device, work vehicle equipped with driving support device, and driving support method
JP7060208B2 (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
JP7336002B2 (en) Driving support device, work vehicle equipped with driving support device, and driving support method
JP2019135670A (en) Travel area registration system for work vehicle
JP7238025B2 (en) Agricultural support system
JP7282660B2 (en) work machine
JP7341873B2 (en) work equipment
WO2021106361A1 (en) Area registration system

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

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20211109

A601 Written request for extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A601

Effective date: 20211224

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220302

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20220706

R150 Certificate of patent or registration of utility model

Ref document number: 7102332

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150