JP6872911B2 - Travel route generator - Google Patents

Travel route generator Download PDF

Info

Publication number
JP6872911B2
JP6872911B2 JP2017008338A JP2017008338A JP6872911B2 JP 6872911 B2 JP6872911 B2 JP 6872911B2 JP 2017008338 A JP2017008338 A JP 2017008338A JP 2017008338 A JP2017008338 A JP 2017008338A JP 6872911 B2 JP6872911 B2 JP 6872911B2
Authority
JP
Japan
Prior art keywords
route
point
exit
field
traveling
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2017008338A
Other languages
Japanese (ja)
Other versions
JP2018116606A (en
Inventor
安久 魚谷
安久 魚谷
出 島本
出 島本
健二 玉谷
健二 玉谷
めぐみ 鈴川
めぐみ 鈴川
敦 新海
敦 新海
和央 阪口
和央 阪口
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
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 JP2017008338A priority Critical patent/JP6872911B2/en
Priority to CN201711237966.7A priority patent/CN108334068B/en
Priority to EP17001991.3A priority patent/EP3351078B1/en
Priority to US15/841,294 priority patent/US11168992B2/en
Publication of JP2018116606A publication Critical patent/JP2018116606A/en
Application granted granted Critical
Publication of JP6872911B2 publication Critical patent/JP6872911B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0221Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34Route searching; Route guidance
    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01BSOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
    • A01B69/00Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
    • A01B69/007Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow
    • A01B69/008Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow automatic
    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01BSOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
    • A01B79/00Methods for working soil
    • A01B79/005Precision agriculture
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/005Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0219Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/0274Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0278Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0285Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using signals transmitted via a public communication network, e.g. GSM network

Description

本発明は、圃場作業車の自動走行のための走行経路を生成する走行経路生成装置に関する。 The present invention relates to a traveling route generating device that generates a traveling route for automatic traveling of a field work vehicle.

トラクタによる耕耘作業やコンバインによる刈取り収穫作業などを、自動走行によって行うことが提案されている。圃場の形状はそれぞれ異なっており、自動走行を行うためには、圃場の外形に関連づけられた走行経路を生成する必要がある。 It has been proposed that tilling work by tractors and harvesting work by combine harvesters be carried out by automatic driving. The shapes of the fields are different from each other, and it is necessary to generate a traveling route associated with the outer shape of the field in order to perform automatic traveling.

特許文献1には、圃場における耕耘作業を自動走行によって行うトラクタが開示されている。この耕耘作業は、圃場周辺領域を周回作業する回り作業と、圃場周辺領域(枕地とも称せられる)で180°旋回を行いながら圃場の中央領域(圃場周辺領域の内側領域)の直進作業を繰り返す往復直進作業とに分けて行われる。その際、往復直進作業の開始点から終了点に至る折り返し行程数、及び回り作業の開始点から終了点に至る周回数が、作業車両の諸元を含む作業条件に基づいて決定される。往復直進作業を先に行い、その後に回り作業を行うこと、及びこの回り作業の開始点を圃場の出入口に最も近い角部近傍とすることも提案されている。 Patent Document 1 discloses a tractor that performs tillage work in a field by automatic traveling. This tillage work repeats the rotating work of orbiting the area around the field and the straight-ahead work of the central area of the field (the inner area of the area around the field) while turning 180 ° in the area around the field (also called a headland). It is divided into round-trip straight-ahead work. At that time, the number of turn-back strokes from the start point to the end point of the round-trip straight-ahead work and the number of laps from the start point to the end point of the turning work are determined based on the work conditions including the specifications of the work vehicle. It is also proposed that the reciprocating straight-ahead work is performed first, and then the turning work is performed, and that the starting point of this turning work is near the corner closest to the entrance and exit of the field.

特許文献2による圃場作業車は、圃場情報格納部から読み出された圃場の地形データを基本条件として、自動走行のための走行経路を算出する経路算出部を備えている。この経路算出部は、地形データから圃場の外形を求め、設定された走行開始地点から始まって走行終了地点で終わる走行経路を算出する。その際、圃場には、その畦や農道から圃場に出入りするための場所が決められている場合が少なくないので、特許文献2では、走行開始地点が圃場の入口位置によって規定され、走行終了地点が圃場の出口位置によって規定されることが提案されている。経路算出部により走行経路が算出されると、GPSモジュールから得られる測位データ(緯度経度データ)に基づいて自車位置を求め、当該走行経路上を走行機体が正確に走行するように、運転支援ユニットがこの圃場作業車の運転を支援する。 The field work vehicle according to Patent Document 2 includes a route calculation unit that calculates a travel route for automatic travel based on the topographical data of the field read from the field information storage unit as a basic condition. This route calculation unit obtains the outer shape of the field from the topographical data, and calculates a travel route starting from the set travel start point and ending at the travel end point. At that time, in many cases, a place for entering and exiting the field from the ridge or the farm road is determined in the field. Therefore, in Patent Document 2, the running start point is defined by the entrance position of the field, and the running end point is defined. Is proposed to be defined by the exit position of the field. When the travel route is calculated by the route calculation unit, the position of the own vehicle is obtained based on the positioning data (latitude / longitude data) obtained from the GPS module, and driving support is provided so that the traveling aircraft travels accurately on the traveling route. The unit assists in the operation of this field work vehicle.

特開平10−66405号公報Japanese Unexamined Patent Publication No. 10-66405 特開2015−112071号公報Japanese Unexamined Patent Publication No. 2015-112071

一般的に、圃場作業車が圃場に出入りするための出入口が圃場毎に決まっている。一般的に、圃場は周辺の農道や畦から低くなっており、出入口の走行面は傾斜しており、その幅も狭い。そのような出入口を通過するために高度な操舵が必要となる。したがって、そのような出入口を圃場作業車が通過する際には、自動走行は困難であり、手動走行に頼ることになる。このため、出入口を出発点とし、出入口を終点とする、圃場を網羅する走行経路を生成しても、出入口と、圃場作業車が自動走行で容易に走行できる地点との間の区間は、運転者が圃場作業車に乗り込んで手動走行することになる。つまり、圃場作業車は手動走行で出入口を通過して圃場に入り、自動走行が開始する地点で運転者は圃場作業車を降りて徒歩で畦に戻る。さらに、自動走行が容易な走行経路部分の自動走行が終了すると、運転者は圃場作業車まで徒歩で向かい、圃場作業車に乗り込んで、手動走行で出入口を通り抜けて圃場作業車を圃場の外に出す。特許文献1や特許文献2からも明らかなように、従来の技術では、このような手動運転と自動運転との切り替わりは考慮されておらず、ましてやそのような切り替わりの際に生じる運転者の圃場内の歩行は、全く考慮されていなかった。運転者が待機する場所から遠く離れた位置で、手動運転と自動運転との切り替わりが行われると、運転者は、圃場内を長く歩行しなければならない不都合が生じる。 Generally, the entrance / exit for the field work vehicle to enter / exit the field is determined for each field. Generally, the field is low from the surrounding farm roads and ridges, and the running surface of the entrance is sloping and its width is narrow. Advanced steering is required to pass through such doorways. Therefore, when a field work vehicle passes through such an entrance / exit, automatic traveling is difficult and manual traveling is relied on. For this reason, even if a traveling route covering the field is generated with the entrance and exit as the starting point and the entrance and exit as the ending point, the section between the entrance and exit and the point where the field work vehicle can easily travel by automatic driving is operated. A person will get into a field work vehicle and drive manually. That is, the field work vehicle manually passes through the doorway and enters the field, and at the point where the automatic driving starts, the driver gets off the field work vehicle and returns to the ridge on foot. Furthermore, when the automatic driving of the traveling route part where automatic driving is easy is completed, the driver walks to the field work vehicle, gets into the field work vehicle, manually passes through the doorway, and moves the field work vehicle out of the field. put out. As is clear from Patent Document 1 and Patent Document 2, in the conventional technique, such switching between manual operation and automatic operation is not considered, much less the driver's field that occurs at the time of such switching. Walking inside was not considered at all. If the switching between manual driving and automatic driving is performed at a position far away from the place where the driver waits, the driver has the inconvenience of having to walk in the field for a long time.

本発明の課題は、手動運転と自動運転との切り替わり時に必要となる運転者の圃場内の歩行を考慮した、走行経路生成装置を提供することである。 An object of the present invention is to provide a traveling route generating device in consideration of a driver's walking in a field, which is required when switching between manual driving and automatic driving.

本発明による、圃場作業車の自動走行のための走行経路を生成する走行経路生成装置は、圃場の外形データ及び出入口を含む圃場データを入力する圃場データ入力部と、前記圃場を網羅する前記走行経路を生成する走行経路生成部と、前記走行経路において前記圃場作業車から運転者が降りる降り地点を決定する降り地点決定部と、前記走行経路において前記圃場作業車に運転者が乗り込む乗り地点を決定する乗り地点決定部と、前記走行経路における前記降り地点から前記乗り地点までの間の走行経路部分を自動走行用走行経路と規定するとともに、前記走行経路における前記出入口と前記降り地点との間及び前記乗り地点と前記出入口との間の走行経路部分を手動走行用走行経路と規定する走行経路区分け部とを備え、
前記走行経路生成部には、周回経路決定部と基準直線決定部と内側経路決定部と進入・退出経路決定部とが含まれており、
前記周回経路決定部は、前記圃場の外周領域を周回走行するための周回走行経路を決定し、
前記内側経路決定部は、直進経路と当該直進経路同士をつなぐUターン経路とからなる、前記外周領域の内側に位置する中央領域を走行するための内側走行経路を決定し、
前記進入・退出経路決定部は、農道から前記出入口の通過方向に沿って延びて前記圃場内で前記内側走行経路と接続する進入経路と、前記周回走行経路に接続して前記圃場から前記出入口の前記通過方向に沿って延びて農道に抜ける退出経路とを決定し、
前記走行経路生成部は、前記進入経路、前記内側走行経路、前記周回走行経路、前記退出経路を順次つなぐことにより、前記走行経路を生成し、
前記降り地点が前記出入口のスロープの延長線上である前記進入経路における前記出入口を過ぎた付近で畦に近接するように決定され、前記乗り地点が前記出入口の前記スロープの延長線上である前記退出経路における前記出入口の手前で前記畔に近接するように決定され、かつ、前記降り地点及び前記乗り地点における前記圃場作業車の乗降口が前記畦に向き合うように決定される。
According to the present invention, travel route generating device for generating a travel route for automatic traveling of the field work vehicle includes a field data input unit for inputting field data including a field of contour data and doorways, the travel to cover the field A travel route generation unit that generates a route, a landing point determination unit that determines a landing point at which the driver gets off from the field work vehicle on the travel route, and a boarding point at which the driver gets into the field work vehicle on the travel route. The landing point determination unit to be determined and the travel path portion between the landing point and the landing point on the travel route are defined as an automatic driving travel route, and between the entrance and exit and the landing point on the travel route. And a traveling route dividing portion that defines a traveling route portion between the riding point and the entrance / exit as a traveling route for manual driving.
The traveling route generation unit includes a circuit route determination unit, a reference straight line determination unit, an inner route determination unit, and an entry / exit route determination unit.
The orbital route determination unit determines an orbital travel route for orbiting the outer peripheral region of the field.
The inner route determining unit determines an inner traveling route for traveling in a central region located inside the outer peripheral region, which is composed of a straight route and a U-turn route connecting the straight routes.
The entry / exit route determination unit extends from the farm road along the passage direction of the entrance / exit and connects to the inner travel path in the field, and connects to the circuit travel path to connect the field to the entrance / exit. Determine the exit route that extends along the passage direction and exits to the farm road.
The travel route generation unit generates the travel route by sequentially connecting the approach route, the inner travel route, the circuit travel route, and the exit route .
The exit route is determined so that the exit point is on an extension of the slope of the entrance and exit and is close to the ridge in the vicinity of passing the entrance and exit in the approach route, and the boarding point is on the extension of the slope of the entrance and exit. the determined to be close in front of the doorway to the banks, and the down point and the field work vehicle door opening in the seat point is Ru are determined to face the ridge in.

この構成によれば、出入口を考慮して圃場を網羅するように生成された走行経路において、運転者が圃場作業車から降りる降り位置及び運転者が圃場作業車に乗り込む乗り位置が適切に決定され、これに基づいて、手動走行用走行経路と自動運転用走行経路とが規定される。このため、運転者の圃場作業車に対する乗り降りが行われる手動運転と自動運転との移行場所は、適切な位置となり、運転者の圃場内での不適切な歩行が回避される。さらに、先に決定された周回走行経路の内側に位置する内側走行経路が、基準直線に基づいて決定され、周回走行経路の走行方向は、出入口の通過方向に基づいて、作業車が周回走行経路からスムーズに出入口を通り抜けて圃場外に出るように、決定することができる。これにより、作業済みの地面を荒らしてしまうような作業車の出入口付近での大きな操舵角による作業車の旋回が回避される。 According to this configuration, in the traveling route generated so as to cover the field in consideration of the entrance and exit, the descending position where the driver gets off the field work vehicle and the riding position where the driver gets into the field work vehicle are appropriately determined. Based on this, a traveling route for manual driving and a traveling route for automatic driving are defined. Therefore, the transition location between the manual driving and the automatic driving in which the driver gets on and off the field work vehicle is an appropriate position, and the driver's improper walking in the field is avoided. Further, the inner traveling path located inside the previously determined orbital traveling path is determined based on the reference straight line, and the traveling direction of the orbiting traveling path is based on the passing direction of the entrance / exit, and the work vehicle makes the orbiting traveling path. It can be decided to smoothly pass through the doorway and go out of the field. As a result, it is possible to avoid turning of the work vehicle due to a large steering angle near the entrance / exit of the work vehicle, which would damage the ground on which the work has been completed.

本発明の好適な実施形態の1つでは、前記降り地点決定部による降り地点の決定、及び前記乗り地点決定部による乗り地点の決定が、ユーザの操作入力に基づいて行われる。この構成では、圃場の特性や出入口の形状や圃場作業車の仕様に応じて、運転者が所望する位置で、運転者の圃場作業車に対する乗り降りが行われる。 In one of the preferred embodiments of the present invention, the landing point determination unit determines the landing point and the landing point determination unit determines the landing point based on the user's operation input. In this configuration, the driver gets on and off the field work vehicle at a position desired by the driver according to the characteristics of the field, the shape of the entrance / exit, and the specifications of the field work vehicle.

また、種々の条件を考慮して、最適な位置で、手動走行用走行経路と自動運転用走行経路が自動的に区分けされ、当該位置で運転者の圃場作業車に対する乗り降りが行われることも、好適である。これにより、運転者の不注意によって、不適切な位置に、降り地点と乗り地点とが決まってしまうことが回避される。この目的のため、本発明の好適な実施形態の1つでは、前記降り地点決定部による前記降り地点の決定、及び前記乗り地点決定部による前記乗り地点の決定が、選択された降り地点条件及び乗り地点条件に基づいて自動的に行われる。その際に用いられる好ましい乗り地点条件と降り地点条件として、前記出入口のスロープの延長線上に近接すること、前記出入口の付近の畦に近接すること、及び前記圃場作業車の乗降口が畦に向き合うことなどが挙げられる。このような条件を満たすことで、圃場作業車から畦からへの徒歩、及び畦から圃場作業車への徒歩が、運転者や圃場にとって適切なものとなる。 In addition, in consideration of various conditions, the driving route for manual driving and the driving route for automatic driving are automatically separated at the optimum position, and the driver can get on and off the field work vehicle at that position. Suitable. This prevents the driver from inadvertently determining the landing point and the boarding point at inappropriate positions. For this purpose, in one of the preferred embodiments of the present invention, the determination of the landing point by the landing point determination unit and the determination of the landing point by the landing point determination unit are the selected landing point conditions and It is done automatically based on the boarding point conditions. Preferable boarding point conditions and getting-off point conditions used at that time are that they are close to the extension of the slope of the entrance and exit, that they are close to the ridges near the entrance and exit, and that the entrance and exit of the field work vehicle face the ridges. And so on. By satisfying such conditions, walking from the field work vehicle to the ridge and walking from the ridge to the field work vehicle become appropriate for the driver and the field.

自動走行と手動走行との切り替わり時に圃場内で運転者が乗り降りする位置を示す走行経路と、その走行経路に沿った圃場作業車の動きを示す模式図である。It is a schematic diagram which shows the traveling path which shows the position where a driver gets on and off in a field at the time of switching between automatic driving and manual driving, and the movement of a field work vehicle along the traveling path. 圃場作業車の一例であるトラクタの側面図である。It is a side view of the tractor which is an example of a field work platform. 走行経路生成装置として機能する制御機能部を示す機能ブロック図である。It is a functional block diagram which shows the control function part which functions as a travel path generator. 走行経路生成装置によって生成される走行経路の一例を説明する説明図である。It is explanatory drawing explaining an example of the travel path generated by the travel path generation apparatus.

図面を用いて、本発明による走行経路生成装置の実施形態の1つを説明する。この実施形態では、圃場作業車は、車体1に作業装置30を装備したトラクタであり、圃場を走行経路に沿って作業走行する。図1には、圃場の出入口の外に停車したトラクタが、手動走行で出入口を通過して圃場内に入り、自動走行に切り替えて、圃場の大部分を作業走行し、最後に再び手動走行に切り替えて、自動走行で困難なコーナ領域を手動走行し、出入口を通過して圃場外に抜け出す走行経路の例が示されている。図1の例では、手動運転で、農道から出入口を通過し、出入口近くの畦際に設定された降り地点(図1においてOPで示されている)で停車し、運転者がトラクタを降りる。この降り地点からトラクタは自動走行に切り替えられ、設定された走行経路に沿って、作業走行を開始する。最外周の畦に隣接する領域だけを残す走行経路の位置に乗り地点(図1においてIPで示されている)が設定されており、この乗り地点でトラクタは停車し、自動走行から手動走行に切り替えられる。この乗り地点は、畦際に設定されているので、畦から運転者はトラクタに乗り込む。最外周の畦に隣接する領域は、手動走行で作業され、最終的には出入口を通り抜けて農道に入る。もちろん、最外周の畦に隣接する領域も、自動走行で作業し、出入口を通り抜ける経路だけを手動走行で走行するようにしてもよい。しかしながら、圃場の出入口は幅の狭いスロープになっており、自動走行が困難であるため、手動走行が用いられる。 One of the embodiments of the traveling route generator according to the present invention will be described with reference to the drawings. In this embodiment, the field work vehicle is a tractor in which the vehicle body 1 is equipped with the work device 30, and the field work vehicle travels along the travel path in the field. In FIG. 1, a tractor stopped outside the doorway of a field passes through the doorway by manual driving, enters the field, switches to automatic driving, works on most of the field, and finally returns to manual driving. An example of a traveling route is shown in which the vehicle is switched, manually travels in a corner area that is difficult to drive automatically, passes through an entrance and exit, and exits the field. In the example of FIG. 1, the driver passes through the doorway from the farm road, stops at a landing point (indicated by OP in FIG. 1) set at the ridge near the doorway, and the driver gets off the tractor. From this landing point, the tractor is switched to automatic driving and starts working driving along the set driving route. A riding point (indicated by IP in Fig. 1) is set at the position of the traveling route that leaves only the area adjacent to the outermost ridge, and the tractor stops at this riding point and changes from automatic driving to manual driving. Can be switched. Since this landing point is set at the ridge, the driver gets on the tractor from the ridge. The area adjacent to the outermost ridge is manually driven and eventually passes through the doorway to enter the farm road. Of course, the area adjacent to the outermost ridge may also be operated by automatic traveling, and only the route passing through the doorway may be manually traveled. However, since the entrance and exit of the field has a narrow slope and automatic running is difficult, manual running is used.

図1に例示された走行経路は、圃場作業では良く用いられている走行経路であり、実質的には、直進経路と各直進経路同士をつなぐUターン経路とからなる内側走行経路、圃場の外周領域を周回する周回走行経路、農道から出入口を通過して圃場に進入する進入経路、圃場から出入口を通過して農道に抜ける退出経路から構成される。つまり、圃場は、外周領域と、外周領域の内側に位置する中央領域とに区分けされ、中央領域には内側走行経路が設定され、外周領域には周回走行経路が設定される。外周領域は、Uターン経路に必要なスペースを確保するための領域であり、その幅は、作業車の作業幅と最小旋回半径とに基づいて決定される。内側走行経路における直進経路の間隔は作業車の作業幅、詳しくはオーバーラップを考慮した作業幅となる。なお、図1においては、直進経路は記号SL、Uターン経路は記号TL、内側走行経路は記号IL、周回走行経路は記号CL、進入経路は記号ML1、退出経路は記号ML2で示されている。直進経路とUターン経路とからなる内側走行経路は、自動走行に適した走行経路であり、実際の圃場では、この内側走行経路が圃場を網羅する走行経路の大部分となる。 The traveling route illustrated in FIG. 1 is a traveling route that is often used in field work, and is substantially an inner traveling route consisting of a straight route and a U-turn route connecting each straight route, and an outer circumference of the field. It consists of a circuit route that goes around the area, an approach route that passes through the doorway from the farm road and enters the field, and an exit route that passes through the doorway from the field and exits to the farm road. That is, the field is divided into an outer peripheral region and a central region located inside the outer peripheral region, an inner traveling route is set in the central region, and a circular traveling route is set in the outer peripheral region. The outer peripheral region is an region for securing the space required for the U-turn path, and the width thereof is determined based on the working width of the work vehicle and the minimum turning radius. The interval of the straight route in the inner traveling route is the working width of the work vehicle, specifically, the working width considering the overlap. In FIG. 1, the straight route is indicated by the symbol SL, the U-turn route is indicated by the symbol TL, the inner travel route is indicated by the symbol IL, the orbital travel route is indicated by the symbol CL, the approach route is indicated by the symbol ML1, and the exit route is indicated by the symbol ML2. .. The inner traveling route including the straight route and the U-turn route is a traveling route suitable for automatic traveling, and in an actual field, this inner traveling route is the majority of the traveling route covering the field.

図2に示されているように、このトラクタは、前輪11と後輪12とによって支持された車体1の中央部に運転室20が設けられている。車体1の後部には油圧式の昇降機構31を介してロータリ耕耘装置である作業装置30が装備されている。前輪11は操向輪として機能し、その操舵角を変更することでトラクタの走行方向が変更される。前輪11の操舵角は操舵機構13の動作によって変更される。操舵機構13には自動操舵のための操舵モータ14が含まれている。手動走行の際には、前輪11の操舵は運転室20に配置されているステアリングホイール22の操作によって行われる。運転室20には、ユーザによる指令を受け付けるとともにユーザに情報を提供する汎用端末4が装備されている。トラクタのキャビン21には、衛星測位モジュール80が設けられている。衛星測位モジュール80の構成要素として、GNSS(global navigation satellite system)信号(GPS信号を含む)を受信するための衛星用アンテナがキャビン21の天井領域に取り付けられている。なお、この衛星測位モジュール80には、衛星航法を補完するために、ジャイロ加速度センサや磁気方位センサを組み込んだ慣性航法モジュールを含めることができる。もちろん、慣性航法モジュールは、衛星測位モジュール80とは別の場所に設けてもよい。 As shown in FIG. 2, this tractor is provided with a driver's cab 20 in a central portion of a vehicle body 1 supported by front wheels 11 and rear wheels 12. The rear part of the vehicle body 1 is equipped with a work device 30 which is a rotary tillage device via a hydraulic elevating mechanism 31. The front wheel 11 functions as a steering wheel, and the traveling direction of the tractor is changed by changing the steering angle thereof. The steering angle of the front wheels 11 is changed by the operation of the steering mechanism 13. The steering mechanism 13 includes a steering motor 14 for automatic steering. During manual driving, the front wheels 11 are steered by operating the steering wheel 22 arranged in the driver's cab 20. The driver's cab 20 is equipped with a general-purpose terminal 4 that receives commands from the user and provides information to the user. A satellite positioning module 80 is provided in the cabin 21 of the tractor. As a component of the satellite positioning module 80, a satellite antenna for receiving GNSS (global navigation satellite system) signals (including GPS signals) is attached to the ceiling area of the cabin 21. The satellite positioning module 80 can include an inertial navigation module incorporating a gyro acceleration sensor and a magnetic orientation sensor in order to complement satellite navigation. Of course, the inertial navigation module may be provided at a place different from the satellite positioning module 80.

図3には、このトラクタに構築されている制御系が示されている。この実施形態の制御系は、グラフィカルユーザインターフェースを備えた汎用端末4である第1制御ユニットと、トラクタの車体1や作業装置30の制御を行う制御ユニット5と、トラクタの走行開始と走行停止とを外部から無線で制御するためのリモコン84とを備えている。本発明による走行経路生成装置は経路生成モジュール6としてモジュール化され、汎用端末4に組み込まれている。 FIG. 3 shows a control system built on this tractor. The control system of this embodiment includes a first control unit which is a general-purpose terminal 4 having a graphical user interface, a control unit 5 which controls a vehicle body 1 of a tractor and a work device 30, and a start and stop of running of the tractor. It is equipped with a remote controller 84 for wirelessly controlling the device from the outside. The traveling route generation device according to the present invention is modularized as a route generation module 6 and incorporated in a general-purpose terminal 4.

汎用端末4は、経路生成モジュール6以外に、通信制御部40やタッチパネル60など、一般的なコンピュータシステムの諸機能を備えている。汎用端末4は、車載LAN、無線通信、有線通信などによって、制御ユニット5とデータ交換可能に接続されている。さらに、汎用端末4は、遠隔地の管理センタKSに構築された管理コンピュータ100とも、無線回線やインターネットを通じて、データ交換可能である。また、汎用端末4をタブレットコンピュータや携帯電話などで構成し、トラクタの制御系とデータ交換可能に接続すれば、汎用端末4をトラクタの外に持ち出して、使用することも可能である。 In addition to the route generation module 6, the general-purpose terminal 4 has various functions of a general computer system such as a communication control unit 40 and a touch panel 60. The general-purpose terminal 4 is connected to the control unit 5 in a data exchangeable manner by an in-vehicle LAN, wireless communication, wired communication, or the like. Further, the general-purpose terminal 4 can exchange data with the management computer 100 constructed in the remote management center KS via a wireless line or the Internet. Further, if the general-purpose terminal 4 is composed of a tablet computer, a mobile phone, or the like and is connected to the control system of the tractor so that data can be exchanged, the general-purpose terminal 4 can be taken out of the tractor and used.

この実施形態では、圃場の地図上の位置や圃場を取り巻く農道等の配置などを含む圃場情報が、管理コンピュータ100の圃場情報格納部101に格納されており、この圃場情報は、作業すべき圃場を見つけ出すために必要となる。管理コンピュータ100は、指定された圃場での作業内容を記述した作業計画書を管理している作業計画管理部102も備えている。汎用端末4は、管理コンピュータ100にアクセスし、圃場情報格納部101から圃場情報を、そして作業計画管理部102から作業計画書をダウンロードすることができる。あるいは、汎用端末4は、USBメモリなどの記録媒体を通じて圃場情報や作業計画書を入力することも可能である。 In this embodiment, the field information including the position on the map of the field and the arrangement of the farm roads surrounding the field is stored in the field information storage unit 101 of the management computer 100, and this field information is the field to be worked on. You will need it to find out. The management computer 100 also includes a work plan management unit 102 that manages a work plan that describes the work contents in the designated field. The general-purpose terminal 4 can access the management computer 100 and download the field information from the field information storage unit 101 and the work plan from the work plan management unit 102. Alternatively, the general-purpose terminal 4 can input field information and a work plan through a recording medium such as a USB memory.

経路生成モジュール6は、走行経路を生成する機能部として、圃場データ入力部61、走行経路生成部62、降り地点決定部63、乗り地点決定部64、走行経路区分け部65を備えている。走行経路生成部62は、基本的な走行経路を生成するため、周回経路決定部621、基準直線決定部622、内側経路決定部623、進入・退出経路決定部624を備えている。経路生成モジュール6の各機能部の基本的な役割を、図4に示されている走行経路生成処理の流れ図を用いて説明する。 The route generation module 6 includes a field data input unit 61, a travel route generation unit 62, a landing point determination unit 63, a boarding point determination unit 64, and a travel route division unit 65 as functional units for generating a travel route. The travel route generation unit 62 includes a circuit route determination unit 621, a reference straight line determination unit 622, an inner route determination unit 623, and an entry / exit route determination unit 624 in order to generate a basic travel route. The basic role of each functional unit of the route generation module 6 will be described with reference to the flow chart of the travel route generation process shown in FIG.

圃場データ入力部61は、作業対象となる圃場の外形とを示す圃場外形データと当該圃場の出入口の位置や形状を示す出入口位置データを入力し、ワーキングメモリエリアに展開する。周回経路決定部621は、圃場の外周領域を周回走行するための周回走行経路を決定する。トラクタの作業幅(正確にはオーバーラップ幅を考慮した作業幅)と適正旋回半径とに基づいて、Uターンに必要な距離を算出し、その距離が確保できる作業幅の整数倍の値を幅とする周回領域が周回走行経路のために割り与えられる外周領域として決定される。外周領域が決定されると周回走行経路の周回数が決まる。一般的な耕耘作業では、2周から3周の周回走行経路に相当する領域が外周領域として設定される。図1に示しているように、外周領域の内側の領域が中央領域となる。 The field data input unit 61 inputs field outline data indicating the outer shape of the field to be worked on and entrance / exit position data indicating the position and shape of the entrance / exit of the field, and develops the data in the working memory area. The orbital route determination unit 621 determines an orbital travel route for orbiting the outer peripheral region of the field. The distance required for a U-turn is calculated based on the working width of the tractor (to be exact, the working width considering the overlap width) and the appropriate turning radius, and the width is an integral multiple of the working width that can secure that distance. The orbital region to be determined is determined as the outer peripheral region allocated for the orbital travel path. When the outer peripheral region is determined, the number of laps of the lap traveling path is determined. In general tillage work, a region corresponding to a lap traveling path of 2 to 3 laps is set as an outer peripheral region. As shown in FIG. 1, the region inside the outer peripheral region is the central region.

基準直線決定部622は、圃場の基準辺に平行に延びるとともに、所定間隔で中央領域を埋め尽くす基準直線を決定する。この基準直線は、中央領域における走行経路のベースとなる。このような基準直線の決定は、内側走行経路を生成するための前処理である。その際、圃場の基準辺として、一般的には、圃場の外形が作り出す近似多角形の最長辺が採用される。図4の例では、外形が台形(四角形)の最長辺が基準辺として選択されており、この基準辺に平行で、かつ作業幅で中央領域を埋め尽くす基準直線が設定されている。内側経路決定部623は、中央領域内の基準直線を直進経路とし、各直線経路をUターン経路でつないで連続した内側走行経路を生成する。 The reference straight line determining unit 622 extends parallel to the reference side of the field and determines a reference straight line that fills the central region at predetermined intervals. This reference straight line serves as the basis for the travel path in the central region. The determination of such a reference straight line is a preprocessing for generating an inner traveling path. At that time, as the reference side of the field, the longest side of the approximate polygon created by the outer shape of the field is generally adopted. In the example of FIG. 4, the longest side having a trapezoidal outer shape (quadrangle) is selected as the reference side, and a reference straight line parallel to this reference side and filling the central region with the working width is set. The inner route determining unit 623 uses a reference straight line in the central region as a straight line, and connects each straight line with a U-turn path to generate a continuous inner traveling path.

次いで、進入・退出経路決定部624が、農道から出入口を通過して圃場に進入し、内側走行経路と接続する進入経路、及び周回走行経路に接続して圃場から出入口を通過して農道に抜ける退出経路を決定する。耕耘作業の場合、先に内側走行経路の沿った作業走行を行い、次いで周回走行経路に沿った作業走行を行って、そのまま出入口を通って圃場から出るやり方が一般的である。したがって、進入経路は、出入口の通過方向に沿って延びて内側走行経路の端点にスムーズにつながるように決定され、退出経路は、出入口の通過方向に沿って延びて周回走行経路にスムーズにつながるように決定される。走行経路生成部62は、このようにして決定された、進入経路、内側走行経路、周回走行経路、退出経路を順次つなぐことにより、この圃場をトラクタが走行するための基本的な走行経路を生成する。 Next, the entry / exit route determination unit 624 passes through the entrance / exit from the farm road and enters the field, and connects to the inner travel route and the circuit traveling route to pass through the entrance / exit from the field and exit to the farm road. Determine the exit route. In the case of tillage work, it is common to first carry out work running along the inner running path, then carry out work running along the orbiting running path, and then leave the field as it is through the doorway. Therefore, the approach route is determined to extend along the passage direction of the doorway and smoothly connect to the end point of the inner travel route, and the exit route extends along the passage direction of the doorway and smoothly connects to the orbital travel route. Will be decided. The travel route generation unit 62 generates a basic travel route for the tractor to travel in this field by sequentially connecting the approach route, the inner travel route, the circuit travel route, and the exit route determined in this way. To do.

降り地点決定部63は、走行経路生成部62によって生成された基本的な走行経路において、好ましくは進入経路の出入口を通過して外周領域に入った経路部分において、所定の降り地点条件に適合する位置を降り地点として決定する。農道でトラクタに乗り込んだ運転者は、進入経路に沿ってトラクタを外周領域に進入させ、この降り地点でトラクタを停車させ、手動運転から自動運転に切り替えた後、トラクタから降りる。その後、リモコン84を用いて自動運転をスタートさせる。 The landing point determination unit 63 conforms to a predetermined landing point condition in the basic travel route generated by the travel route generation unit 62, preferably in the route portion that has passed through the entrance / exit of the approach route and entered the outer peripheral region. Determine the position as the landing point. A driver who gets into a tractor on a farm road causes the tractor to enter the outer peripheral area along the approach route, stops the tractor at this drop-off point, switches from manual driving to automatic driving, and then disembarks from the tractor. After that, the automatic operation is started using the remote controller 84.

乗り地点決定部64は、走行経路生成部62によって生成された基本的な走行経路において、好ましくは退出経路の出入口から離れた外周領域における経路部分において、所定の乗り地点条件に適合する位置を乗り地点として決定する。この乗り位置でトラクタは停止する。停止したトラクタに乗り込んだ運転者は、退出経路に沿ってトラクタを手動走行し、出入口を通過して、トラクタを農道まで走行させる。図1の例では、退出経路に一周分の周回走行経路を含まれているが、出入口を通過するだけの短い退出経路を選択してもよい。 The boarding point determination unit 64 rides on a position that meets a predetermined landing point condition in the basic travel route generated by the travel route generation unit 62, preferably in the route portion in the outer peripheral region away from the entrance / exit of the exit route. Determined as a point. The tractor stops at this riding position. The driver who gets into the stopped tractor manually drives the tractor along the exit route, passes through the doorway, and drives the tractor to the farm road. In the example of FIG. 1, the exit route includes a circuit route for one round, but a short exit route that only passes through the entrance / exit may be selected.

降り地点及び乗り地点を決定するための降り地点条件及び乗り地点条件は、入口のスロープの延長線上に近接すること、出入口の付近の畦に近接すること、圃場作業車の乗降口が畦に向き合うことなどである。基本的には、圃場作業車から畦からへの徒歩、及び畦から圃場作業車への徒歩が運転者とって容易となるように降り地点条件及び乗り地点条件が設定される。なお、降り地点条件及び乗り地点条件を共通にしてもよいし、降り地点及び乗り地点を共通の地点としてもよい。 The landing point conditions and boarding point conditions for determining the landing point and boarding point are that they are close to the extension of the slope of the entrance, that they are close to the ridges near the doorway, and that the boarding / alighting points of the field work vehicle face the ridges. And so on. Basically, the landing point condition and the landing point condition are set so that the driver can easily walk from the field work vehicle to the ridge and from the ridge to the field work vehicle. The landing point condition and the boarding point condition may be the same, or the landing point and the boarding point may be the same point.

降り地点決定部63及び乗り地点決定部64は、予め設定された条件とアルゴリズムによって自動的に降り地点及び乗り地点を決定する代わりに、ユーザの操作入力に基づいて決定することも可能である。そのようなユーザの操作入力は、タッチパネル60に表示された進入経路、退出経路、周回走行経路に対して、降り地点及び乗り地点を指定することで、実現する。 The landing point determination unit 63 and the landing point determination unit 64 can also determine the landing point and the landing point based on the user's operation input, instead of automatically determining the landing point and the landing point according to preset conditions and algorithms. Such user operation input is realized by designating a landing point and a boarding point with respect to the approach route, exit route, and circuit traveling route displayed on the touch panel 60.

さらに、走行経路区分け部65は、走行経路における降り地点から乗り地点までの間の走行経路部分を自動走行経路(自動走行用走行経路)と規定するとともに、走行経路における出入口と降り地点との間及び乗り地点と出入口との間の走行経路部分を手動走行経路(手動走行用走行経路)と規定する。つまり、走行経路区分け部65は、降り地点と乗り地点とに基づいて、走行経路生成部62によって生成された基本的な走行経路を、手動走行経路と自動走行経路とに区分けし、最終的な走行経路を生成し、制御ユニット5に与える。 Further, the traveling route dividing unit 65 defines the traveling route portion from the getting-off point to the riding point in the traveling route as an automatic traveling route (traveling route for automatic traveling), and between the entrance / exit and the getting-off point in the traveling route. And the part of the traveling route between the boarding point and the entrance / exit is defined as a manual traveling route (traveling route for manual driving). That is, the travel route division unit 65 divides the basic travel route generated by the travel route generation unit 62 into a manual travel route and an automatic travel route based on the landing point and the riding point, and finally A traveling route is generated and given to the control unit 5.

図3に示すように、トラクタの制御系の中核要素である制御ユニット5には、入出力インタフェースとして機能する、出力処理部7、入力処理部8、通信処理部70が備えられている。出力処理部7は、トラクタに装備されている、車両走行機器群71、作業装置機器群72、報知デバイス73などと接続している。車両走行機器群71には、操舵モータ14や、図示されていないが変速機構やエンジンユニットなど車両走行のために制御される機器が含まれている。作業装置機器群72には、作業装置30の駆動機構や、作業装置30を昇降させる昇降機構31などが含まれている。報知デバイス73には、ディスプレイやランプやスピーカが含まれている。報知デバイス73は、走行注意事項や自動操舵走行での目標走行経路からの外れなど、注意情報や警告情報を運転者や監視者に報知するために用いられる。通信処理部70は、制御ユニット5で処理されたデータを管理コンピュータ100に送信するとともに、管理コンピュータ100から種々のデータを受信する機能を有する。さらに、通信処理部70は、リモコン84からのリモコン指令を入力する。 As shown in FIG. 3, the control unit 5, which is a core element of the control system of the tractor, includes an output processing unit 7, an input processing unit 8, and a communication processing unit 70 that function as input / output interfaces. The output processing unit 7 is connected to a vehicle traveling device group 71, a working device device group 72, a notification device 73, and the like, which are equipped on the tractor. The vehicle traveling device group 71 includes a steering motor 14, and although not shown, devices controlled for vehicle traveling such as a transmission mechanism and an engine unit. The work device group 72 includes a drive mechanism for the work device 30, an elevating mechanism 31 for raising and lowering the work device 30, and the like. The notification device 73 includes a display, a lamp, and a speaker. The notification device 73 is used to notify the driver and the observer of caution information and warning information such as driving precautions and deviation from the target traveling route in automatic steering traveling. The communication processing unit 70 has a function of transmitting the data processed by the control unit 5 to the management computer 100 and receiving various data from the management computer 100. Further, the communication processing unit 70 inputs a remote control command from the remote control 84.

入力処理部8は、衛星測位モジュール80、走行系検出センサ群81、作業系検出センサ群82、自動/手動切替操作具83などと接続している。走行系検出センサ群81には、エンジン回転数や変速状態などの走行状態を検出するセンサが含まれている。作業系検出センサ群82には、作業装置30の位置や傾きを検出するセンサ、作業負荷などを検出するセンサなどが含まれている。自動/手動切替操作具83は、自動操舵で走行する自動走行モードと手動操舵で走行する手動操舵モードとのいずれかを選択するスイッチである。 The input processing unit 8 is connected to the satellite positioning module 80, the traveling system detection sensor group 81, the working system detection sensor group 82, the automatic / manual switching operation tool 83, and the like. The traveling system detection sensor group 81 includes a sensor that detects a traveling state such as an engine speed and a shifting state. The work system detection sensor group 82 includes a sensor that detects the position and inclination of the work device 30, a sensor that detects a work load, and the like. The automatic / manual switching operation tool 83 is a switch for selecting either an automatic traveling mode in which the vehicle travels by automatic steering or a manual steering mode in which the vehicle travels by manual steering.

さらに、制御ユニット5には、走行制御部50、作業制御部54、自車位置算出部53、走行経路設定部55、報知部56が備えられている。自車位置算出部53は、衛星測位モジュール80から送られてくる測位データに基づいて、自車位置を算出する。車両走行機器群71を制御する走行制御部50には、このトラクタが自動走行(自動操舵)と手動走行(手動操舵)の両方で走行可能に構成されているため、手動走行制御部51と自動走行制御部52とが含まれている。手動走行制御部51は、運転者による操作に基づいて車両走行機器群71を制御する。自動走行制御部52は、走行経路設定部55で設定された走行経路と自車位置との間の方位ずれ及び位置ずれを算出し、自動操舵指令を生成する。この自動操舵指令は、出力処理部7を介して操舵モータ14に出力される。自動走行制御部52は、リモコン84からの停止指令に基づいてトラクタを停止させるとともに、リモコン84からの開始指令に基づいてトラクタの走行を開始させる。作業制御部54は、作業装置30の動きを制御するために、作業装置機器群72に制御信号を与える。報知部56は、運転者や監視者に必要な情報を報知するための報知信号(表示データや音声データ)を生成して、計器パネルに組み込まれた報知デバイス73に与える。 Further, the control unit 5 is provided with a travel control unit 50, a work control unit 54, a vehicle position calculation unit 53, a travel route setting unit 55, and a notification unit 56. The own vehicle position calculation unit 53 calculates the own vehicle position based on the positioning data sent from the satellite positioning module 80. The travel control unit 50 that controls the vehicle travel equipment group 71 is configured to allow the tractor to travel in both automatic travel (automatic steering) and manual travel (manual steering). A travel control unit 52 is included. The manual driving control unit 51 controls the vehicle traveling device group 71 based on the operation by the driver. The automatic traveling control unit 52 calculates the directional deviation and the positional deviation between the traveling route set by the traveling route setting unit 55 and the position of the own vehicle, and generates an automatic steering command. This automatic steering command is output to the steering motor 14 via the output processing unit 7. The automatic traveling control unit 52 stops the tractor based on the stop command from the remote controller 84, and starts the traveling of the tractor based on the start command from the remote controller 84. The work control unit 54 gives a control signal to the work device group 72 in order to control the movement of the work device 30. The notification unit 56 generates a notification signal (display data or voice data) for notifying the driver or the monitor of necessary information, and supplies the notification signal (display data or voice data) to the notification device 73 incorporated in the instrument panel.

走行経路設定部55は、経路生成モジュール6によって生成された手動走行経路(手動走行用走行経路)と自動走行経路(自動走行用走行経路)を汎用端末4から通信処理部70を介して受け取り、トラクタの目標走行経路として設定する。 The travel route setting unit 55 receives the manual travel route (travel route for manual travel) and the automatic travel route (travel route for automatic travel) generated by the route generation module 6 from the general-purpose terminal 4 via the communication processing unit 70. Set as the target travel route for the tractor.

〔別実施の形態〕
(1)上述した実施形態では、1台の圃場作業車で圃場を作業走行するための走行経路の生成が取り扱われていた。最近提案されている、自動走行可能な圃場作業車を複数台用いて、圃場を作業走行する協調走行制御システムは、運転者によって手動走行される親作業車と、この親作業車の管理下で無人で自動走行される1台以上の子作業車とから構成されている。子作業車は、実際の作業走行を実施する前に、圃場外で乗り込んだ運転者による手動走行で、出入口を通過して、圃場内の適当な位置まで移動する。その後、運転者が子作業車から降りて、親作業車に乗り換える。子作業車は無人で、有人の親作業車と協調して自動走行を実施する。子作業車は作業走行の終了後に、適当な位置で停車する。停車した子作業車に再び運転者が乗り込んで、手動走行で出入口を通過して、圃場を抜け出す。このような子作業車における手動走行と自動走行の切り替え時に必要となる運転者の乗り降りは、本発明の走行経路生成装置によって生成される走行経路によって、スムーズに行われることができ、運転者の負担が軽減される。つまり、本発明の走行経路生成装置は、協調走行制御システムにおける子作業車に、良好に適用することができる。
(2)図3で示された機能ブロック図における各機能部は、主に説明目的で区分けされている。実際には、各機能部は他の機能部と統合または複数の機能部に分けることができる。例えば、経路生成モジュール6を管理コンピュータ100に構築し、管理コンピュータ100で生成された走行経路を作業車の制御ユニット5にダウンロードする構成を採用してもよい。また、経路生成モジュール6を作業車の制御ユニット5内に構築してもよい。
(3)上述した実施形態では、多角形で示された圃場の最長辺を基準辺としていたが、多角形で示された圃場の、ユーザによって指定された辺を基準辺としてもよい。さらには、多角形の辺に基づく仮想辺(例えば、多角形の対辺や隣接する辺を繋ぐ辺など)を基準辺とすることも可能である。
(4)上述した実施形態では、作業走行する走行経路は、実質的に、直進経路と各直進経路同士をつなぐUターン経路とからなる内側走行経路と、圃場の外周領域を周回走行するための周回走行経路とから構成されていたが、これに代えて、圃場を渦巻き状に走行する渦巻き走行経路やその他の走行経路を採用してもよい。
(5)上述した実施形態では、作業車として、ロータリ耕耘機を作業装置30として装備したトラクタを、作業車として取り上げたが、そのようなトラクタ以外にも、例えば、田植機、施肥機、コンバインなどの農作業車にも適用可能である。
[Another Embodiment]
(1) In the above-described embodiment, the generation of a travel route for working in a field with one field work vehicle has been dealt with. A recently proposed coordinated driving control system that uses multiple self-driving field work vehicles to work in the field is a parent work vehicle that is manually driven by the driver and is under the control of the parent work vehicle. It consists of one or more child work vehicles that run unmanned and automatically. The child work vehicle passes through the doorway and moves to an appropriate position in the field by manual driving by the driver who got in outside the field before carrying out the actual work run. After that, the driver gets off the child work vehicle and transfers to the parent work vehicle. The child work platform is unmanned and automatically runs in cooperation with the manned parent work platform. The child work vehicle stops at an appropriate position after the work run is completed. The driver gets into the stopped child work vehicle again, passes through the doorway by manual driving, and exits the field. The driver's getting on and off required when switching between manual driving and automatic driving in such a child work vehicle can be smoothly performed by the traveling route generated by the traveling route generator of the present invention, and the driver's getting on and off can be performed smoothly. The burden is reduced. That is, the travel route generation device of the present invention can be satisfactorily applied to a child work vehicle in a cooperative travel control system.
(2) Each functional unit in the functional block diagram shown in FIG. 3 is mainly divided for explanatory purposes. In practice, each functional unit can be integrated with other functional units or divided into a plurality of functional units. For example, a configuration may be adopted in which the route generation module 6 is constructed on the management computer 100, and the travel route generated by the management computer 100 is downloaded to the control unit 5 of the work vehicle. Further, the route generation module 6 may be constructed in the control unit 5 of the work vehicle.
(3) In the above-described embodiment, the longest side of the field indicated by the polygon is used as the reference side, but the side of the field indicated by the polygon may be used as the reference side. Further, it is also possible to use a virtual side based on the side of the polygon (for example, the opposite side of the polygon or the side connecting adjacent sides) as the reference side.
(4) In the above-described embodiment, the travel route for work travel is substantially an inner travel route including a straight route and a U-turn route connecting the straight routes, and a traveling route for traveling around the outer peripheral region of the field. Although it was composed of a circular traveling route, a spiral traveling route or another traveling route that travels in a spiral shape in the field may be adopted instead.
(5) In the above-described embodiment, a tractor equipped with a rotary tiller as a work device 30 is taken up as a work vehicle, but in addition to such a tractor, for example, a rice transplanter, a fertilizer applicator, and a combine harvester are taken up. It can also be applied to agricultural work vehicles such as.

本発明による走行経路生成装置は、設定された走行経路に沿って圃場を作業する圃場作業車のために適用可能である。 The travel route generation device according to the present invention is applicable to a field work vehicle that works in a field along a set travel route.

4 :汎用端末
5 :制御ユニット
50 :走行制御部
51 :手動走行制御部
52 :自動走行制御部
53 :自車位置算出部
55 :走行経路設定部
6 :経路生成モジュール
61 :圃場データ入力部
62 :走行経路生成部
621 :周回経路決定部
622 :基準直線決定部
623 :内側経路決定部
624 :進入・退出経路決定部
63 :降り地点決定部
64 :乗り地点決定部
65 :走行経路区分け部
80 :衛星測位モジュール
4: General-purpose terminal 5: Control unit 50: Travel control unit 51: Manual travel control unit 52: Automatic travel control unit 53: Own vehicle position calculation unit 55: Travel route setting unit 6: Route generation module 61: Field data input unit 62 : Travel route generation unit 621: Circular route determination unit 622: Reference straight line determination unit 623: Inner route determination unit 624: Enter / exit route determination unit 63: Exit point determination unit 64: Boarding point determination unit 65: Travel route division unit 80 : Satellite positioning module

Claims (3)

圃場作業車の自動走行のための走行経路を生成する走行経路生成装置であって、
圃場の外形データ及び出入口を含む圃場データを入力する圃場データ入力部と、
前記圃場を網羅する前記走行経路を生成する走行経路生成部と、
前記走行経路において前記圃場作業車から運転者が降りる降り地点を決定する降り地点決定部と、
前記走行経路において前記圃場作業車に運転者が乗り込む乗り地点を決定する乗り地点決定部と
前記走行経路における前記降り地点から前記乗り地点までの間の走行経路部分を自動走行用走行経路と規定するとともに、前記走行経路における前記出入口と前記降り地点との間及び前記乗り地点と前記出入口との間の走行経路部分を手動走行用走行経路と規定する走行経路区分け部と、を備え、
前記走行経路生成部には、周回経路決定部と基準直線決定部と内側経路決定部と進入・退出経路決定部とが含まれており、
前記周回経路決定部は、前記圃場の外周領域を周回走行するための周回走行経路を決定し、
前記内側経路決定部は、直進経路と当該直進経路同士をつなぐUターン経路とからなる、前記外周領域の内側に位置する中央領域を走行するための内側走行経路を決定し、
前記進入・退出経路決定部は、農道から前記出入口の通過方向に沿って延びて前記圃場内で前記内側走行経路と接続する進入経路と、前記周回走行経路に接続して前記圃場から前記出入口の前記通過方向に沿って延びて農道に抜ける退出経路とを決定し、
前記走行経路生成部は、前記進入経路、前記内側走行経路、前記周回走行経路、前記退出経路を順次つなぐことにより、前記走行経路を生成し、
前記降り地点が前記出入口のスロープの延長線上である前記進入経路における前記出入口を過ぎた付近で畦に近接するように決定され、前記乗り地点が前記出入口の前記スロープの延長線上である前記退出経路における前記出入口の手前で前記畔に近接するように決定され、かつ、前記降り地点及び前記乗り地点における前記圃場作業車の乗降口が前記畦に向き合うように決定される、走行経路生成装置。
It is a travel route generator that generates a travel route for automatic driving of aerial work platforms.
A field data input unit for inputting field data including field outline data and entrance / exit, and a field data input unit.
A travel route generation unit that generates the travel route covering the field, and a travel route generation unit.
A landing point determination unit that determines a landing point at which the driver descends from the field work vehicle in the traveling route,
The riding point determination unit that determines the riding point on which the driver gets into the field work vehicle in the traveling route and the traveling route portion between the getting-off point and the riding point in the traveling route are defined as the traveling route for automatic driving. In addition, a traveling route dividing portion that defines a traveling path portion between the entrance and the exit point and the riding point and the entrance / exit in the traveling route as a driving route for manual driving is provided.
The traveling route generation unit includes a circuit route determination unit, a reference straight line determination unit, an inner route determination unit, and an entry / exit route determination unit.
The orbital route determination unit determines an orbital travel route for orbiting the outer peripheral region of the field.
The inner route determining unit determines an inner traveling route for traveling in a central region located inside the outer peripheral region, which is composed of a straight route and a U-turn route connecting the straight routes.
The entry / exit route determination unit extends from the farm road along the passage direction of the entrance / exit and connects to the inner travel path in the field, and connects to the circuit travel path to connect the field to the entrance / exit. Determine the exit route that extends along the passage direction and exits to the farm road.
The travel route generation unit generates the travel route by sequentially connecting the approach route, the inner travel route, the circuit travel route, and the exit route .
The exit route is determined so that the exit point is on an extension of the slope of the entrance and exit and is close to the ridge in the vicinity of passing the entrance and exit in the approach route, and the boarding point is on the extension of the slope of the entrance and exit. the determined to be close in front of the doorway to the banks, and wherein the field work vehicle door opening at the point and the ride point descended Ru are determined to face the ridge, traveling route generation device in.
前記降り地点決定部による前記降り地点の決定、及び前記乗り地点決定部による前記乗り地点の決定が、ユーザの操作入力に基づいて行われる請求項1に記載の走行経路生成装置。 Wherein said determining point down by point determining unit down, and the determination of the seat point by the passenger point determining unit, travel route generating device according to claim 1 which is performed based on the operation input of the user. 前記降り地点決定部による前記降り地点の決定、及び前記乗り地点決定部による前記乗り地点の決定が、選択された降り地点条件及び乗り地点条件に基づいて自動的に行われる請求項1に記載の走行経路生成装置。 The first aspect of claim 1, wherein the determination of the landing point by the landing point determination unit and the determination of the landing point by the landing point determination unit are automatically performed based on the selected landing point condition and the landing point condition. Travel route generator.
JP2017008338A 2017-01-20 2017-01-20 Travel route generator Active JP6872911B2 (en)

Priority Applications (4)

Application Number Priority Date Filing Date Title
JP2017008338A JP6872911B2 (en) 2017-01-20 2017-01-20 Travel route generator
CN201711237966.7A CN108334068B (en) 2017-01-20 2017-11-30 Travel route generation device
EP17001991.3A EP3351078B1 (en) 2017-01-20 2017-12-06 Travel route generation device
US15/841,294 US11168992B2 (en) 2017-01-20 2017-12-14 Travel route generation device and method for generating travel route for field work vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017008338A JP6872911B2 (en) 2017-01-20 2017-01-20 Travel route generator

Publications (2)

Publication Number Publication Date
JP2018116606A JP2018116606A (en) 2018-07-26
JP6872911B2 true JP6872911B2 (en) 2021-05-19

Family

ID=60629388

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017008338A Active JP6872911B2 (en) 2017-01-20 2017-01-20 Travel route generator

Country Status (4)

Country Link
US (1) US11168992B2 (en)
EP (1) EP3351078B1 (en)
JP (1) JP6872911B2 (en)
CN (1) CN108334068B (en)

Families Citing this family (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20200089222A1 (en) * 2018-09-17 2020-03-19 Subsite, Llc Virtual Path Guidance System
JP7113708B2 (en) * 2018-09-19 2022-08-05 株式会社クボタ field work vehicle
JP6982908B2 (en) * 2018-10-23 2021-12-17 株式会社ナイルワークス Driving route generator, driving route generation method, and driving route generation program, and drone
JP7265348B2 (en) 2018-11-22 2023-04-26 井関農機株式会社 Agricultural work support system
JP7356829B2 (en) * 2019-07-10 2023-10-05 ヤンマーパワーテクノロジー株式会社 automatic driving system
CN110825091A (en) * 2019-11-29 2020-02-21 洛阳中科龙网创新科技有限公司 Intelligent tractor intelligent routing method and device based on unmanned aerial vehicle
JP7409879B2 (en) 2020-01-14 2024-01-09 株式会社クボタ Work equipment travel route management system
JP7403323B2 (en) * 2020-01-14 2023-12-22 株式会社クボタ Driving route management system
CN111256700B (en) * 2020-03-26 2021-11-02 洛阳智能农业装备研究院有限公司 Edge narrowing planning method for planning operation path of automatic driving agricultural machine
JP7363683B2 (en) * 2020-06-30 2023-10-18 井関農機株式会社 work vehicle
JP7401422B2 (en) 2020-11-27 2023-12-19 株式会社クボタ work equipment
JP2022096512A (en) * 2020-12-17 2022-06-29 井関農機株式会社 Work vehicle
JP2022183955A (en) * 2021-05-31 2022-12-13 ヤンマーホールディングス株式会社 Path generation method, path generation device, and path generation program
US20230000007A1 (en) * 2021-06-30 2023-01-05 Deere & Company Pre-charging technique for dispensing product from tractor tool prior to reaching plant site
WO2023283200A1 (en) * 2021-07-06 2023-01-12 Bear Flag Robotics, Inc. Agricultural path planning
JP2023032924A (en) 2021-08-27 2023-03-09 株式会社クボタ Travel control system
CN113892399B (en) * 2021-09-13 2023-05-16 中国一冶集团有限公司 Precise positioning spray-seeding grass planting method and pulse pressure spray-seeding machine
JP7294386B2 (en) 2021-11-10 2023-06-20 株式会社明電舎 Busbar positioning structure and electrical equipment

Family Cites Families (27)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3656332B2 (en) 1996-08-28 2005-06-08 独立行政法人農業・生物系特定産業技術研究機構 Unmanned work method by unmanned working vehicle
JP3582325B2 (en) * 1997-09-03 2004-10-27 井関農機株式会社 Paddy working machine
JP4295911B2 (en) * 2000-12-19 2009-07-15 ヤンマー農機株式会社 Agricultural work vehicle
JP3814230B2 (en) * 2002-06-05 2006-08-23 ヤンマー農機株式会社 Agricultural sprayer
US7010425B2 (en) * 2003-03-31 2006-03-07 Deere & Company Path planner and a method for planning a path of a work vehicle
KR100796266B1 (en) * 2005-12-02 2008-01-21 주식회사 비전라이드 System and method of parking control
JP2010186363A (en) * 2009-02-13 2010-08-26 Denso Corp Vehicular control device
US9026302B2 (en) * 2009-11-06 2015-05-05 Irobot Corporation Methods and systems for complete coverage of a surface by an autonomous robot
CN103879403B (en) * 2011-03-16 2017-01-11 丰田自动车株式会社 Remote vehicle operating device
JP2013188143A (en) * 2012-03-12 2013-09-26 Kubota Corp Harvester
JP2013228821A (en) * 2012-04-24 2013-11-07 Mamiya-Op Nequos Co Ltd Working machine, component device thereof, and computer program
DE102012016039B4 (en) * 2012-08-14 2022-06-30 Audi Ag Autonomous operation of a motor vehicle in a car wash
JP5530551B2 (en) * 2013-06-14 2014-06-25 株式会社クボタ Work vehicle
JP2015029456A (en) * 2013-08-01 2015-02-16 株式会社クボタ Combine harvester
CN103636307B (en) * 2013-11-28 2016-01-20 王维国 Kind, shovel, boring one corn fertilizing seeder
JP6278682B2 (en) * 2013-12-12 2018-02-14 株式会社クボタ Field work machine
KR102340161B1 (en) * 2014-02-06 2021-12-15 얀마 파워 테크놀로지 가부시키가이샤 Parallel travel work system
EP3104245A4 (en) * 2014-02-06 2017-11-01 Yanmar Co., Ltd. Method for setting travel path of autonomous travel work vehicle
JP6416558B2 (en) * 2014-09-11 2018-10-31 株式会社駐車場綜合研究所 Self-driving car management device, self-driving car management system, self-driving car management method, self-driving car management program
CN104442908B (en) * 2014-12-05 2017-03-29 李新亚 Continuous operation underground railway track car and induction system of getting on or off the bus
US9448559B2 (en) * 2015-01-15 2016-09-20 Nissan North America, Inc. Autonomous vehicle routing and navigation using passenger docking locations
US10386844B2 (en) * 2015-09-30 2019-08-20 Deere & Company System and method for using geo-fenced guidance lines
US10368475B2 (en) * 2016-04-19 2019-08-06 CropZilla Software, Inc. Machine guidance for optimal working direction of travel
CN105911985B (en) * 2016-04-22 2019-03-01 扬州大学 Automatic driving of agricultural machinery control method based on Beidou navigation
CN106013883A (en) * 2016-06-13 2016-10-12 方芳 Tube box serial connection type intelligent overhead stereo parking lot
EP3518647B1 (en) * 2016-09-29 2020-12-23 Agro Intelligence ApS A system and a method for determining a trajectory to be followed by an agricultural work vehicle
CN108502426A (en) * 2018-04-19 2018-09-07 上海中荷环保有限公司 A kind of refuse disposal installation and its waste disposal method

Also Published As

Publication number Publication date
US11168992B2 (en) 2021-11-09
CN108334068A (en) 2018-07-27
EP3351078A1 (en) 2018-07-25
CN108334068B (en) 2022-06-14
EP3351078B1 (en) 2020-03-25
JP2018116606A (en) 2018-07-26
US20180209799A1 (en) 2018-07-26

Similar Documents

Publication Publication Date Title
JP6872911B2 (en) Travel route generator
JP6812247B2 (en) Travel route generator and travel route generation program
JP6971577B2 (en) Travel route generator and travel route generation program
JP6727944B2 (en) Field travel route generation system and field work vehicle
CN107613751B (en) Work vehicle assistance system
JP6837767B2 (en) Inclined driving management system for work vehicles and work vehicles
CN108777935B (en) Work vehicle and travel area determination device
KR102283928B1 (en) Autonomous travel route generating system
US10598505B2 (en) Travel route generation apparatus and method for generating travel route
JP2018073050A (en) Running route creating device
JP6832884B2 (en) Automatic driving system and status notification device
WO2019111563A1 (en) Traveling route setting device
KR20180100355A (en) Path generating device
JP7069285B2 (en) Field work vehicle
JP2018073008A (en) Travel route generation device
JP2021073602A (en) Automatic travel system and status notification device
JP7069002B2 (en) Field work vehicle and field map data generation system
JP7100539B2 (en) Autonomous driving system
JP6879896B2 (en) Satellite positioning system for work platforms
JP2020068693A (en) Display device and automatic travelling system
WO2021020333A1 (en) Automatic traveling system
JP7036707B2 (en) Travel route generator
JP7344453B2 (en) work vehicle
JP6952597B2 (en) Work platform
JP2022075733A (en) Work support system

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190626

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20200520

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200526

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20200717

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20201201

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210128

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210420

R150 Certificate of patent or registration of utility model

Ref document number: 6872911

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150