JP7019310B2 - Autonomous driving system - Google Patents

Autonomous driving system Download PDF

Info

Publication number
JP7019310B2
JP7019310B2 JP2017105510A JP2017105510A JP7019310B2 JP 7019310 B2 JP7019310 B2 JP 7019310B2 JP 2017105510 A JP2017105510 A JP 2017105510A JP 2017105510 A JP2017105510 A JP 2017105510A JP 7019310 B2 JP7019310 B2 JP 7019310B2
Authority
JP
Japan
Prior art keywords
position information
condition
autonomous
control
communication terminal
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
JP2017105510A
Other languages
Japanese (ja)
Other versions
JP2018200611A (en
Inventor
孝富 宮窪
暢宏 木村
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Yanmar Co Ltd
Original Assignee
Yanmar Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Yanmar Co Ltd filed Critical Yanmar Co Ltd
Priority to JP2017105510A priority Critical patent/JP7019310B2/en
Publication of JP2018200611A publication Critical patent/JP2018200611A/en
Application granted granted Critical
Publication of JP7019310B2 publication Critical patent/JP7019310B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

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

Description

この発明は、自律走行システムに関する。 The present invention relates to an autonomous travel system.

特許文献1には、衛星測位システムを利用して作業車両の位置情報を算出する移動受信機と、移動受信機によって算出された位置情報に基づいて、作業車両を予め作成された自律走行経路に沿って自律走行させる制御装置とを備えた作業車両が開示されている。
特許文献1の移動受信機のように、衛星測位システムを利用して作業車両の位置情報を算出する場合には、天候や障害物等の外部環境に起因して、位置情報の精度が低下するおそれがある。特許文献1に記載の作業車両では、移動受信機によって算出された位置情報の精度が低下したときには、自律走行を停止させるようにしている。
Patent Document 1 describes a mobile receiver that calculates the position information of a work vehicle using a satellite positioning system, and an autonomous travel route that creates a work vehicle in advance based on the position information calculated by the mobile receiver. A work vehicle equipped with a control device for autonomously traveling along the line is disclosed.
When calculating the position information of a work vehicle using a satellite positioning system as in the mobile receiver of Patent Document 1, the accuracy of the position information is lowered due to the external environment such as weather and obstacles. There is a risk. In the work vehicle described in Patent Document 1, autonomous traveling is stopped when the accuracy of the position information calculated by the mobile receiver is lowered.

国際公開第2015/119266号公報International Publication No. 2015/11266

上記特許文献1に記載の作業車両では、外部環境により作業車両の位置情報の精度が低下することによる自律走行の停止が頻発し、作業車両による作業を円滑に行うことができないおそれがある。
この発明の目的は、外部環境により作業車両の位置情報の精度が低下しても自律走行および作業を継続することが可能な自律走行システムを提供することである。
In the work vehicle described in Patent Document 1, the accuracy of the position information of the work vehicle is lowered due to the external environment, so that the autonomous traveling is frequently stopped, and the work by the work vehicle may not be smoothly performed.
An object of the present invention is to provide an autonomous traveling system capable of autonomous traveling and continuing work even if the accuracy of the position information of a working vehicle is lowered due to an external environment.

この発明の一実施形態は、予め定められた走行経路に沿って自律走行する作業車両と、前記作業車両に対して所定の制御信号を送信可能な通信端末を備えた自律走行システムであって、前記作業車両は、前記走行経路に沿って前記作業車両を自律走行させる自律走行制御を実行可能な制御部と、衛星測位システムを利用して前記作業車両の位置を表す第1位置情報を算出する第1算出部とを備え、前記通信端末は、衛星測位システムを利用して前記通信端末の位置を表す第2位置情報を算出する第2算出部を備え、前記制御部は、前記第1位置情報に基づいて自律走行制御を実行しているときに所定条件が成立した場合は、前記第1位置情報に代えて、前記第2位置情報に基づいて自律走行制御を実行することが可能であることを特徴とする自律走行システムを提供する One embodiment of the present invention is an autonomous traveling system including a work vehicle that autonomously travels along a predetermined travel route and a communication terminal capable of transmitting a predetermined control signal to the work vehicle. The work vehicle calculates first position information representing the position of the work vehicle by using a control unit capable of executing autonomous travel control for autonomously traveling the work vehicle along the travel route and a satellite positioning system. The communication terminal includes a first calculation unit, the communication terminal includes a second calculation unit that calculates second position information representing the position of the communication terminal using a satellite positioning system, and the control unit includes the first position. If a predetermined condition is satisfied while executing the autonomous driving control based on the information, it is possible to execute the autonomous driving control based on the second position information instead of the first position information. It provides an autonomous driving system characterized by this.

この構成では、作業車両側で算出される作業車両の位置情報(第1位置情報)に基づいて自律走行制御を行うことが可能であるとともに、通信端末側で算出される通信端末の位置情報(第2位置情報)に基づいて自律走行制御を行うことが可能となる。
この発明の一実施形態では、前記作業車両は、前記第1算出部によって算出された第1位置情報の精度を評価する第1評価部を備え、前記所定条件は少なくとも第1条件を含み、前記第1条件は、前記第1評価部により、前記第1位置情報の精度が低精度であると評価されることである。
In this configuration, it is possible to perform autonomous traveling control based on the position information (first position information) of the work vehicle calculated on the work vehicle side, and the position information of the communication terminal calculated on the communication terminal side (first position information). It is possible to perform autonomous driving control based on the second position information).
In one embodiment of the present invention, the work vehicle includes a first evaluation unit that evaluates the accuracy of the first position information calculated by the first calculation unit, and the predetermined condition includes at least the first condition. The first condition is that the accuracy of the first position information is evaluated to be low by the first evaluation unit.

この構成では、第1位置情報の精度が低精度であると評価されることを、第1位置情報に代えて、第2位置情報に基づいて自律走行制御を実行するための条件に含めることが可能となる。
この発明の一実施形態では、前記通信端末は、前記第2算出部によって算出された第2位置情報の精度を評価する第2評価部を備え、前記所定条件は、前記第1条件とは異なる第2条件をさらに含み、前記第2条件は、前記第2評価部により、前記第2位置情報の精度が高精度であると評価されることである。
In this configuration, the fact that the accuracy of the first position information is evaluated as low accuracy may be included in the condition for executing the autonomous driving control based on the second position information instead of the first position information. It will be possible.
In one embodiment of the present invention, the communication terminal includes a second evaluation unit that evaluates the accuracy of the second position information calculated by the second calculation unit, and the predetermined condition is different from the first condition. Further including the second condition, the second condition is that the accuracy of the second position information is evaluated to be highly accurate by the second evaluation unit.

この構成では、第1位置情報の精度が低精度であると評価されかつ第2位置情報の精度が高精度であると評価されることを、第1位置情報に代えて、第2位置情報に基づいて自律走行制御を実行するための条件に含めることが可能となる。
この発明の一実施形態では、前記作業車両は、前記通信端末を着脱可能に支持する支持部と、前記支持部に対する前記通信端末の装着を検出する検出部を備え、前記複数の条件は、前記第1条件および前記第2条件とは異なる第3条件をさらに含み、前記第3条件は、前記検出部が前記支持部に対する前記通信端末の装着を検出することである。
In this configuration, the accuracy of the first position information is evaluated as low accuracy and the accuracy of the second position information is evaluated as high accuracy, instead of the first position information, the second position information is used. Based on this, it can be included in the conditions for executing autonomous driving control.
In one embodiment of the present invention, the work vehicle includes a support portion that detachably supports the communication terminal and a detection unit that detects attachment of the communication terminal to the support portion, and the plurality of conditions are the same. The first condition and a third condition different from the second condition are further included, and the third condition is that the detection unit detects the attachment of the communication terminal to the support unit.

この構成では、第1位置情報の精度が低精度であると評価されかつ第2位置情報の精度が高精度であると評価されかつ検出部が支持部に対する通信端末の装着を検出することを、第1位置情報に代えて、第2位置情報に基づいて自律走行制御を実行するための条件に含めることが可能となる。
この発明の一実施形態では、前記制御部は、前記第2位置情報に基づいて自律走行制御を実行している場合において、前記第2条件または第3条件が成立しなくなった場合は、自律走行制御を停止し、前記第1条件が成立しなくなった場合は、前記第1位置情報に基づいて自律走行制御を実行することが可能である。
In this configuration, the accuracy of the first position information is evaluated as low accuracy, the accuracy of the second position information is evaluated as high accuracy, and the detection unit detects the attachment of the communication terminal to the support unit. Instead of the first position information, it can be included in the condition for executing the autonomous traveling control based on the second position information.
In one embodiment of the present invention, when the control unit executes autonomous driving control based on the second position information and the second condition or the third condition is no longer satisfied, the control unit autonomously travels. When the control is stopped and the first condition is no longer satisfied, it is possible to execute the autonomous traveling control based on the first position information.

通信端末が支持部に装着されていない場合には、第2位置情報の精度がたとえ高精度であったとしても、第2位置情報に基づいて作業車両の位置を正確に特定することはできなくなる。この構成では、このような場合に、第2位置情報に基づいて自律走行制御が行われるのを防止できる。また、この構成では、第2位置情報の精度が低精度である場合に、第2位置情報に基づいて自律走行制御が行われるのを防止できる。 When the communication terminal is not attached to the support portion, even if the accuracy of the second position information is high, the position of the work vehicle cannot be accurately specified based on the second position information. .. With this configuration, in such a case, it is possible to prevent autonomous travel control from being performed based on the second position information. Further, in this configuration, when the accuracy of the second position information is low, it is possible to prevent autonomous traveling control from being performed based on the second position information.

通信端末は支持部に着脱自在に装着されるので、第2位置情報には通信端末の装着誤差(取付誤差)に起因する誤差が含まれるおそれがある。したがって、第2位置情報に基づいて自律走行制御が行われる場合には、第1位置情報に基づいて自律走行制御が行われる場合に比べて、経路追従性が低下するおそれがある。この構成では、第2位置情報に基づいて自律走行制御が行われているときに、第1位置情報の精度が高精度になったときには、第1位置情報に基づいて自律走行制御を実行することが可能となるため、自律走行時において、経路追従性が低下するのを極力抑制することができる。 Since the communication terminal is detachably mounted on the support portion, the second position information may include an error due to a mounting error (mounting error) of the communication terminal. Therefore, when the autonomous travel control is performed based on the second position information, the route followability may be lower than when the autonomous travel control is performed based on the first position information. In this configuration, when the autonomous driving control is performed based on the second position information and the accuracy of the first position information becomes high, the autonomous driving control is executed based on the first position information. Therefore, it is possible to suppress the deterioration of the route followability as much as possible during autonomous driving.

この発明の一実施形態では、前記制御部は、前記第1位置情報に基づいて自律走行制御を実行している場合において、前記第1条件が成立する一方、前記第2条件または前記第3条件が非成立であるときは自律走行制御を停止する。
この構成では、第1位置情報に基づく自律走行制御の実行中に、第1位置情報の精度が低精度となったときにおいて、第2位置情報の精度が低精度であるかまたは通信端末が支持部に装着されていない場合に、自律走行制御が行われるのを防止できる。
In one embodiment of the present invention, when the control unit executes autonomous driving control based on the first position information, the first condition is satisfied, while the second condition or the third condition is satisfied. If is not established, the autonomous driving control is stopped.
In this configuration, when the accuracy of the first position information becomes low during the execution of the autonomous driving control based on the first position information, the accuracy of the second position information is low or the communication terminal supports it. It is possible to prevent autonomous driving control from being performed when the vehicle is not mounted on the unit.

この発明の一実施形態では、前記第1算出部は、複数の測位衛星から取得した衛星信号に基づいて算出される前記作業車両の測位情報と、所定の第1基準局から取得した測位補正情報とに基づいて、前記第1位置情報を算出するように構成されており、前記第2算出部は、複数の測位衛星から取得した衛星信号に基づいて算出される前記通信端末の測位情報と、前記第1基準局と同じまたは異なる所定の第2基準局から取得した測位補正情報とに基づいて、前記第2位置情報を算出するように構成されており、前記走行経路には特定の第3基準局が対応付けられており、前記制御部は、前記第1基準局と前記第3基準局とが同一である場合に、自律走行制御を実行可能である。 In one embodiment of the present invention, the first calculation unit includes positioning information of the work vehicle calculated based on satellite signals acquired from a plurality of positioning satellites, and positioning correction information acquired from a predetermined first reference station. The first position information is calculated based on the above, and the second calculation unit includes the positioning information of the communication terminal calculated based on satellite signals acquired from a plurality of positioning satellites, and the positioning information of the communication terminal. It is configured to calculate the second position information based on the positioning correction information acquired from the same or different predetermined second reference station as the first reference station, and the specific third reference station corresponds to the traveling route. The control unit can execute autonomous traveling control when the first reference station and the third reference station are the same.

基準局は、測位システムを利用して基準局の位置の測位情報を算出し、予め認識している自己の位置(以下、「認識自己位置」という。)と、算出された測位情報との差を、測位補正情報として送信する。基準局によっては、認識自己位置に誤差が存在している場合がある。
第1基準局と第3基準局とが異なる場合において、少なくとも一方の基準局の認識自己位置に誤差が存在している場合には、走行経路生成時に算出される第1位置情報の実際位置に対するずれ量と、自律走行時に算出される第1位置情報の実際位置に対するずれ量とが異なる。実際位置とは、作業車両の実際の位置をいう。ずれ量とは、主として経度方向のずれ量および緯度方向のずれ量をいう。このため、自律走行時に、作業車両が作業場(例えば、圃場)を逸脱するおそれがある。
The reference station calculates the positioning information of the position of the reference station using the positioning system, and determines the difference between the self-position recognized in advance (hereinafter referred to as "recognized self-position") and the calculated positioning information. It is transmitted as positioning correction information. Depending on the reference station, there may be an error in the recognition self-position.
When the first reference station and the third reference station are different, and there is an error in the recognition self-position of at least one reference station, the amount of deviation of the first position information calculated at the time of traveling route generation with respect to the actual position , The amount of deviation of the first position information calculated during autonomous driving with respect to the actual position is different. The actual position means the actual position of the work vehicle. The amount of deviation mainly refers to the amount of deviation in the longitude direction and the amount of deviation in the latitude direction. Therefore, the work vehicle may deviate from the work place (for example, the field) during autonomous traveling.

これに対して、第1基準局と第3基準局とが同一である場合には、当該基準局の認識自己位置に誤差が存在していても、走行経路生成時に算出される第1位置情報の実際位置に対するずれ量と、自律走行時に算出される第1位置情報の実際位置に対するずれ量とはほぼ同じになる。したがって、この構成では、自律走行時に、作業車両が作業場を逸脱するのを防止できる。 On the other hand, when the first reference station and the third reference station are the same, the actual position of the first position information calculated when the traveling route is generated even if there is an error in the recognition self-position of the reference station. The amount of deviation from the actual position and the amount of deviation of the first position information calculated during autonomous driving with respect to the actual position are substantially the same. Therefore, in this configuration, it is possible to prevent the work vehicle from deviating from the work place during autonomous traveling.

図1は、本発明の実施形態に係る自律走行システムに用いられるトラクタを示し、トラクタに装着された作業機が非作業状態である様子を示す側面図である。FIG. 1 is a side view showing a tractor used in an autonomous traveling system according to an embodiment of the present invention, and showing a state in which a working machine mounted on the tractor is in a non-working state. 図2は、トラクタの平面図である。FIG. 2 is a plan view of the tractor. 図3は、トラクタの座席の周囲に配置される各種操作装置および通信端末を示す平面図である。FIG. 3 is a plan view showing various operating devices and communication terminals arranged around the seat of the tractor. 図4は、作業機が作業状態である様子を示すトラクタの側面図である。FIG. 4 is a side view of the tractor showing how the working machine is in a working state. 図5は、トラクタの電気的構成を示すブロック図である。FIG. 5 is a block diagram showing the electrical configuration of the tractor. 図6は、通信端末の電気的構成を示すブロック図である。FIG. 6 is a block diagram showing an electrical configuration of a communication terminal. 図7は、自律走行経路の一例を示す模式図である。FIG. 7 is a schematic diagram showing an example of an autonomous traveling route. 図8Aは、第1制御部の動作の一例を説明するためのフローチャートの一部である。FIG. 8A is a part of a flowchart for explaining an example of the operation of the first control unit. 図8Bは、第1制御部の動作の一例を説明するためのフローチャートの一部である。FIG. 8B is a part of a flowchart for explaining an example of the operation of the first control unit.

以下では、この発明の実施形態を、添付図面を参照して詳細に説明する。
本実施形態では、作業車両としてトラクタを例にとって説明するが、作業車両は、田植え機、コンバイン、土木・建設作業装置、除雪車、乗用型作業機、歩行型作業機等であってもよい。自律走行(自動走行)とは、トラクタが自動的に制御されることにより、予め定められた自律走行経路に沿ってトラクタが走行することをいう。自律作業とは、作業機が自動的に制御されることにより、自律走行経路に予め設定された作業位置において作業機が作業を行うことをいう。これに対して、手動走行・手動作業とは、トラクタおよび作業機が手動操作に基づいて制御されることにより、走行および作業が行われることをいう。
Hereinafter, embodiments of the present invention will be described in detail with reference to the accompanying drawings.
In the present embodiment, the tractor will be described as an example of the work vehicle, but the work vehicle may be a rice transplanter, a combine, a civil engineering / construction work device, a snowplow, a passenger type work machine, a walking type work machine, or the like. Autonomous driving (automatic driving) means that the tractor travels along a predetermined autonomous driving route by automatically controlling the tractor. Autonomous work means that the work machine performs work at a work position preset in the autonomous travel path by automatically controlling the work machine. On the other hand, the manual running / manual work means that the running and the work are performed by controlling the tractor and the working machine based on the manual operation.

図1は、本発明の一実施形態に係る自律走行システムに用いられるトラクタを示し、トラクタに装着された作業機が非作業状態である様子を示す側面図である。図2は、トラクタの平面図である。図3は、トラクタの座席の周囲に配置される各種の操作装置および通信端末を示す平面図である。図4は、作業機が作業状態である様子を示すトラクタの側面図である。 FIG. 1 is a side view showing a tractor used in an autonomous traveling system according to an embodiment of the present invention, and showing a state in which a working machine mounted on the tractor is in a non-working state. FIG. 2 is a plan view of the tractor. FIG. 3 is a plan view showing various operating devices and communication terminals arranged around the seat of the tractor. FIG. 4 is a side view of the tractor showing how the working machine is in a working state.

トラクタ1は、手動走行および自律走行が可能である。本実施形態では、トラクタ1は、ユーザが搭乗した状態で、予め生成された自律走行経路に従って自律走行を行えるように構成されている。
トラクタ1は、圃場内を自律走行する車体部としての走行機体2を備えている。走行機体2には、例えば、耕耘機、プラウ、施肥機、草刈機、播種機等の種々の作業機を選択して装着することができるが、本実施形態においては、作業機3としてロータリ耕耘機が装着されている。
The tractor 1 is capable of manual traveling and autonomous traveling. In the present embodiment, the tractor 1 is configured to be able to autonomously travel according to a pre-generated autonomous traveling route while the user is on board.
The tractor 1 includes a traveling machine body 2 as a vehicle body portion that autonomously travels in the field. Various working machines such as a cultivator, a plow, a fertilizer, a grass mower, and a sowing machine can be selected and mounted on the traveling machine 2, but in the present embodiment, the rotary cultivator 3 can be mounted. The machine is installed.

トラクタ1の走行機体2は、図1に示すように、その前部が左右1対の前輪7で支持され、その後部が左右1対の後輪8で支持されている。
走行機体2の前部にはボンネット9が配置されている。本実施形態では、このボンネット9内に、トラクタ1の駆動源であるエンジン10、燃料タンク(図示略)等が収容されている。このエンジン10は、例えばディーゼルエンジンにより構成することができるが、これに限るものではなく、例えばガソリンエンジンにより構成してもよい。また、駆動源として、エンジン10に代えてまたは加えて電気モータを採用してもよい。
As shown in FIG. 1, the traveling machine body 2 of the tractor 1 is supported by a pair of left and right front wheels 7 and a rear portion supported by a pair of left and right rear wheels 8.
A bonnet 9 is arranged at the front portion of the traveling machine body 2. In the present embodiment, the engine 10, the fuel tank (not shown), and the like, which are the drive sources of the tractor 1, are housed in the bonnet 9. The engine 10 can be configured by, for example, a diesel engine, but is not limited to this, and may be configured by, for example, a gasoline engine. Further, as a drive source, an electric motor may be adopted instead of or in addition to the engine 10.

ボンネット9の後方には、ユーザが搭乗するためのキャビン11が配置されている。このキャビン11の内部には、ユーザが操向操作するためのステアリングハンドル12、ユーザが着座可能な座席13、通信端末100、各種の操作を行うための様々な操作装置等が配置されている。ただし、トラクタ1は、キャビン11付きのものに限られず、キャビン11を備えない構成であってもよい。 Behind the bonnet 9, a cabin 11 for the user to board is arranged. Inside the cabin 11, a steering wheel 12 for the user to steer, a seat 13 for the user to sit on, a communication terminal 100, various operation devices for performing various operations, and the like are arranged. However, the tractor 1 is not limited to the one with the cabin 11, and may be configured not to include the cabin 11.

図3を参照して、前記操作装置としては、モニタ装置70、アクセルレバー15、リバーサレバー26、主変速レバー27、速度回転数選択切換スイッチ29、速度回転数設定変更ダイアル14、ダイアル設定切換スイッチ16、副変速レバー19、PTOスイッチ17、PTO変速レバー18、作業機昇降スイッチ28、作業機下降速度調整ノブ75等を例として挙げることができる。これらの操作装置は、座席13の近傍、またはステアリングハンドル12の近傍に配置されている。 With reference to FIG. 3, the operating device includes a monitor device 70, an accelerator lever 15, a reverser lever 26, a main shift lever 27, a speed rotation speed selection changeover switch 29, a speed rotation speed setting change dial 14, and a dial setting changeover switch. 16. The auxiliary shift lever 19, the PTO switch 17, the PTO shift lever 18, the work equipment elevating switch 28, the work equipment down speed adjustment knob 75, and the like can be mentioned as examples. These operating devices are arranged near the seat 13 or near the steering wheel 12.

モニタ装置70には、トラクタ1の様々な情報が表示される。また、モニタ装置70には、ボタン、ダイアル等の入力部材が備えられており、これらの入力部材をユーザが操作することにより、トラクタ1に各種の指示を入力することができる。
アクセルレバー15は、エンジン10の出力回転数を設定するための操作具である。リバーサレバー26は、トラクタ1の前進、後進および停止を切り換えるための操作具である。主変速レバー27は、リバーサレバー26で指示した方向にトラクタ1が走行する速度を無段階で変更するための操作具である。
Various information about the tractor 1 is displayed on the monitor device 70. Further, the monitor device 70 is provided with input members such as buttons and dials, and the user can operate these input members to input various instructions to the tractor 1.
The accelerator lever 15 is an operating tool for setting the output rotation speed of the engine 10. The reverser lever 26 is an operating tool for switching forward, backward, and stop of the tractor 1. The main shift lever 27 is an operating tool for steplessly changing the speed at which the tractor 1 travels in the direction indicated by the reverser lever 26.

速度回転数選択切換スイッチ29は、トラクタ1の車速とエンジン10の回転数の組合せを、予め設定されている2種類の組合せを交互に切り換えるための操作具である。速度回転数設定変更ダイアル14は、前記2種類の組合せのそれぞれに関して、トラクタ1の車速およびエンジン10の回転数の設定値を調整するための操作具である。ダイアル設定切換スイッチ16は、速度回転数設定変更ダイアル14が、トラクタ1の車速の設定値を変更するか、エンジン10の回転数の設定値を変更するかを切り換えるための操作具である。 The speed rotation speed selection selector switch 29 is an operating tool for alternately switching the combination of the vehicle speed of the tractor 1 and the rotation speed of the engine 10 between two preset combinations. The speed rotation speed setting change dial 14 is an operating tool for adjusting the vehicle speed of the tractor 1 and the setting values of the rotation speed of the engine 10 for each of the above two types of combinations. The dial setting changeover switch 16 is an operation tool for switching whether the speed rotation speed setting change dial 14 changes the vehicle speed setting value of the tractor 1 or the engine 10 rotation speed setting value.

ただし、速度回転数設定変更ダイアル14およびダイアル設定切換スイッチ16は、自律走行を行う場合に、作業状態および非作業状態における車速およびエンジン数の設定を指示するためにも用いられる。
副変速レバー19は、トランスミッション22内の走行副変速ギア機構の変速比を切り換えるための操作具である。
However, the speed rotation speed setting change dial 14 and the dial setting changeover switch 16 are also used to instruct the setting of the vehicle speed and the number of engines in the working state and the non-working state in the case of autonomous traveling.
The auxiliary transmission lever 19 is an operating tool for switching the gear ratio of the traveling auxiliary transmission gear mechanism in the transmission 22.

PTOスイッチ17は、トランスミッション22の後端から突出したPTO軸(動力伝達軸(図示略))への動力の伝達/遮断を切換操作するための操作具である。PTO変速レバー18は、PTO軸の回転速度の変速操作を行うための操作具である。
作業機昇降スイッチ28は、走行機体2に装着された作業機3の高さを所定範囲内で昇降操作するための操作具である。作業機下降速度調整ノブ75は、作業機3が下降するときの速度を調整するための操作具である。
The PTO switch 17 is an operating tool for switching between transmission / disconnection of power to a PTO shaft (power transmission shaft (not shown)) protruding from the rear end of the transmission 22. The PTO shift lever 18 is an operating tool for shifting the rotation speed of the PTO shaft.
The work machine elevating switch 28 is an operating tool for raising and lowering the height of the work machine 3 mounted on the traveling machine body 2 within a predetermined range. The work equipment descending speed adjusting knob 75 is an operating tool for adjusting the speed at which the work equipment 3 descends.

キャビン11の屋根5上には、衛星信号受信用アンテナ46、基準局信号受信用アンテナ47および無線通信用アンテナ48が設けられている。衛星信号受信用アンテナ46および基準局信号受信用アンテナ47は、走行機体2の位置情報の算出に使用されるアンテナである。無線通信用アンテナ48は、後述するトラクタ1の制御装置4(図5参照)が通信端末100と無線通信を行うために使用されるアンテナである。 A satellite signal receiving antenna 46, a reference station signal receiving antenna 47, and a wireless communication antenna 48 are provided on the roof 5 of the cabin 11. The satellite signal receiving antenna 46 and the reference station signal receiving antenna 47 are antennas used for calculating the position information of the traveling machine body 2. The wireless communication antenna 48 is an antenna used by the control device 4 (see FIG. 5) of the tractor 1, which will be described later, to perform wireless communication with the communication terminal 100.

衛星信号受信用アンテナ46は、ステアリングハンドル12の上方に配置されている。基準局信号受信用アンテナ47は、衛星信号受信用アンテナ46よりも後方に配置されている。無線通信用アンテナ48は、基準局信号受信用アンテナ47よりも後方に配置されている。なお、アンテナ46~48の配置位置はこれに限られるものではなく、例えばアンテナ46~48を屋根5の前部において走行機体2の幅方向に所定間隔を隔てて配置することとしてもよい。 The satellite signal receiving antenna 46 is arranged above the steering wheel 12. The reference station signal receiving antenna 47 is arranged behind the satellite signal receiving antenna 46. The wireless communication antenna 48 is arranged behind the reference station signal receiving antenna 47. The arrangement positions of the antennas 46 to 48 are not limited to this, and for example, the antennas 46 to 48 may be arranged at the front portion of the roof 5 at predetermined intervals in the width direction of the traveling machine body 2.

通信端末100は、自律走行経路の生成、トラクタ1の遠隔操作等を行うものである。本実施形態では、通信端末100は、トラクタ1と通信する機能、自律走行経路を生成する機能、衛星測位システムによって通信端末100の位置情報を算出する機能等を備えている。通信端末100は、本実施形態では、タブレット型パーソナルコンピュータ(タブレット型PC)から構成されている。 The communication terminal 100 generates an autonomous traveling route, remotely controls the tractor 1, and the like. In the present embodiment, the communication terminal 100 has a function of communicating with the tractor 1, a function of generating an autonomous traveling route, a function of calculating the position information of the communication terminal 100 by a satellite positioning system, and the like. In the present embodiment, the communication terminal 100 is composed of a tablet-type personal computer (tablet-type PC).

キャビン11の屋根5の下面には、通信端末支持部(以下、「支持部6」という)が固定されている。通信端末100は、支持部6に着脱可能に装着されている。通信端末100が支持部6に装着されている状態においては、通信端末100(より厳密には、後述する通信端末100の衛星信号受信用アンテナ103)は、衛星信号受信用アンテナ46のほぼ真下位置に配置される。 A communication terminal support portion (hereinafter referred to as "support portion 6") is fixed to the lower surface of the roof 5 of the cabin 11. The communication terminal 100 is detachably attached to the support portion 6. When the communication terminal 100 is mounted on the support portion 6, the communication terminal 100 (more strictly, the satellite signal receiving antenna 103 of the communication terminal 100 described later) is located substantially directly below the satellite signal receiving antenna 46. Placed in.

支持部6には、通信端末100が支持部6に装着されているか否かを検出するための着脱センサ30(図5参照)が設けられている。着脱センサ30は、例えば、リミットスイッチであってもよい。通信端末100が支持部6に装着されているときには、通信端末100が充電器(図示略)に電気的に接続されるような構成であってもよい。このような場合には、着脱センサ30は、通信端末100が充電器に電気的に接続されたか否かを検出することにより、通信端末100が支持部6に装着されているか否かを検出するものであってもよい。 The support portion 6 is provided with a detachable sensor 30 (see FIG. 5) for detecting whether or not the communication terminal 100 is attached to the support portion 6. The detachable sensor 30 may be, for example, a limit switch. When the communication terminal 100 is attached to the support portion 6, the communication terminal 100 may be configured to be electrically connected to a charger (not shown). In such a case, the detachable sensor 30 detects whether or not the communication terminal 100 is attached to the support portion 6 by detecting whether or not the communication terminal 100 is electrically connected to the charger. It may be a thing.

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

図1に示すように、トラクタ1の走行機体2の後部には作業機3が装着されている。前述したように、エンジン10の駆動力の一部をPTO軸を介して作業機3に伝達することによって、作業機3を駆動して耕耘作業を行うことができる。作業機3の下部には、水平に配置された軸を中心に回転駆動される耕耘爪(作業体)25が複数設けられている。
耕耘爪25の回転軸線25cが、図1、図2および図4に示されている。この作業機3を図4に示す作業高さまで下降させることで、回転する耕耘爪25が土壌に接触し、当該作業高さに対応する所定深さでの圃場の耕耘作業を行うことができる。また、耕耘爪25の回転を停止したり、作業機3を図1に示す非作業高さまで上昇させたりすることで、耕耘作業を停止させることができる。ユーザは、作業機昇降スイッチ28を操作することによって、作業機3を昇降させることができる。また、後述する制御装置4(図5参照)による自動制御によって、作業機3を昇降させることができる。
As shown in FIG. 1, a working machine 3 is mounted on the rear portion of the traveling machine body 2 of the tractor 1. As described above, by transmitting a part of the driving force of the engine 10 to the working machine 3 via the PTO shaft, the working machine 3 can be driven and the tilling work can be performed. At the lower part of the working machine 3, a plurality of tilling claws (working bodies) 25 that are rotationally driven around a horizontally arranged shaft are provided.
The rotation axis 25c of the tiller claw 25 is shown in FIGS. 1, 2 and 4. By lowering the working machine 3 to the working height shown in FIG. 4, the rotating tilling claw 25 comes into contact with the soil, and the field can be cultivated at a predetermined depth corresponding to the working height. Further, the tilling work can be stopped by stopping the rotation of the tilling claw 25 or raising the working machine 3 to the non-working height shown in FIG. The user can raise and lower the work machine 3 by operating the work machine up / down switch 28. Further, the working machine 3 can be raised and lowered by automatic control by the control device 4 (see FIG. 5) described later.

図5は、トラクタ1の電気的構成を示すブロック図である。
トラクタ1は、走行機体2の動作(前進、後進、停止、旋回等の動作)と、作業機3の動作(昇降、駆動、停止等の動作)とを制御するための制御装置4を備える。
制御装置4には、トラクタ1の各部を制御するための複数のコントローラが電気的に接続されている。複数のコントローラは、エンジンコントローラ31、車速コントローラ32、操向コントローラ33、昇降コントローラ34およびPTOコントローラ35を含む。
FIG. 5 is a block diagram showing an electrical configuration of the tractor 1.
The tractor 1 includes a control device 4 for controlling the operation of the traveling machine body 2 (movements such as forward movement, reverse movement, stop, turning, etc.) and the movement of the work machine 3 (operations such as raising / lowering, driving, stopping, etc.).
A plurality of controllers for controlling each part of the tractor 1 are electrically connected to the control device 4. The plurality of controllers include an engine controller 31, a vehicle speed controller 32, a steering controller 33, an elevating controller 34, and a PTO controller 35.

エンジンコントローラ31は、エンジン10の回転数等を制御するものである。エンジンコントローラ31は、エンジン10に設けられる燃料噴射装置としてのコモンレール装置41に電気的に接続されている。コモンレール装置41は、エンジン10の各気筒に燃料を噴射するものである。この場合、エンジン10の各気筒に対するインジェクタの燃料噴射バルブが開閉制御されることによって、燃料供給ポンプによって燃料タンクからコモンレール装置41に供給された高圧燃料が、各インジェクタからエンジン10の各気筒に噴射され、各インジェクタから供給される燃料の噴射圧力、噴射時期、噴射期間(噴射量)が高精度に制御される。エンジンコントローラ31は、コモンレール装置41を制御することによって、例えばエンジン10への燃料の供給を停止させ、エンジン10の駆動を停止させることができる。 The engine controller 31 controls the rotation speed of the engine 10 and the like. The engine controller 31 is electrically connected to a common rail device 41 as a fuel injection device provided in the engine 10. The common rail device 41 injects fuel into each cylinder of the engine 10. In this case, the fuel injection valve of the injector for each cylinder of the engine 10 is controlled to open and close, so that the high-pressure fuel supplied from the fuel tank to the common rail device 41 by the fuel supply pump is injected from each injector to each cylinder of the engine 10. The injection pressure, injection timing, and injection period (injection amount) of the fuel supplied from each injector are controlled with high accuracy. By controlling the common rail device 41, the engine controller 31 can, for example, stop the supply of fuel to the engine 10 and stop the driving of the engine 10.

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

操向コントローラ33は、トラクタ1の前輪7の転舵角を制御するものである。具体的には、ステアリングハンドル12の回転軸(ステアリングシャフト)の中途部には、操向アクチュエータ43が設けられている。自律走行時には、制御装置4(後述する第1制御部54)は、予め定められた自律走行経路に沿ってトラクタ1を走行させるための目標操舵角を演算して、操向コントローラ33に設定する。操向コントローラ33は、ステアリングハンドル12の回転角が目標操舵角となるように操向アクチュエータ43を制御する。これにより、トラクタ1の前輪7の転舵角が制御される。 The steering controller 33 controls the steering angle of the front wheel 7 of the tractor 1. Specifically, a steering actuator 43 is provided in the middle of the rotation shaft (steering shaft) of the steering handle 12. At the time of autonomous traveling, the control device 4 (first control unit 54 described later) calculates a target steering angle for traveling the tractor 1 along a predetermined autonomous traveling path and sets it in the steering controller 33. .. The steering controller 33 controls the steering actuator 43 so that the rotation angle of the steering handle 12 becomes the target steering angle. As a result, the steering angle of the front wheel 7 of the tractor 1 is controlled.

なお、操向アクチュエータは、ステアリングハンドル12を回転させることなしに、トラクタ1の前輪7の転舵角を変化させるものであってもよい。その場合、制御装置4(後述する第1制御部54)は、予め定められた自律走行経路に沿ってトラクタ1を走行させるための目標転舵角を演算して、操向コントローラ33に設定する。操向コントローラ33は、前輪7の転舵角が目標転舵角となるように操向アクチュエータを制御する。この場合には、旋回走行を行ったとしてもステアリングハンドル12は回転されない。 The steering actuator may change the steering angle of the front wheel 7 of the tractor 1 without rotating the steering handle 12. In that case, the control device 4 (first control unit 54, which will be described later) calculates a target steering angle for traveling the tractor 1 along a predetermined autonomous travel path and sets it in the steering controller 33. .. The steering controller 33 controls the steering actuator so that the steering angle of the front wheels 7 becomes the target steering angle. In this case, the steering handle 12 is not rotated even if the steering wheel is turned.

昇降コントローラ34は、作業機3の昇降を制御するものである。具体的には、トラクタ1は、作業機3を走行機体2に連結している3点リンク機構の近傍に、公知の油圧式のリフトシリンダからなる昇降アクチュエータ44を備えている。昇降コントローラ34は、制御装置4から与えられる昇降制御信号に基づいて、リフトシリンダを駆動制御することによって、作業機3を昇降させる。リフトシリンダは単動式とされており、リフトシリンダに作動油を供給することで作業機3を上昇させ、シリンダから作動油を排出することで作業機3が自重で下降するように構成されている。図示しないが、リフトシリンダからの作動油の排出経路には公知の下降速度調整弁が配置されており、この下降速度調整弁の開度をユーザが図3の作業機下降速度調整ノブ75によって操作することで、作業機3が下降する場合の速度を調整することができる。 The elevating controller 34 controls the elevating and lowering of the working machine 3. Specifically, the tractor 1 includes an elevating actuator 44 made of a known hydraulic lift cylinder in the vicinity of a three-point link mechanism that connects the working machine 3 to the traveling machine body 2. The elevating controller 34 raises and lowers the work machine 3 by driving and controlling the lift cylinder based on the elevating control signal given from the control device 4. The lift cylinder is a single-acting type, and it is configured so that the working machine 3 is raised by supplying hydraulic oil to the lift cylinder, and the working machine 3 is lowered by its own weight by discharging the hydraulic oil from the cylinder. There is. Although not shown, a known descending speed adjusting valve is arranged in the discharge path of hydraulic oil from the lift cylinder, and the user operates the opening degree of the descending speed adjusting valve by the working machine descending speed adjusting knob 75 of FIG. By doing so, the speed when the working machine 3 descends can be adjusted.

昇降コントローラ34により、作業機3がトラクタ1に支持される高さを、作業を行わない非作業高さ、作業を行う作業高さ等の所望の高さに設定することが可能である。なお、本実施形態において走行機体2に装着されている作業機3はロータリ耕耘機として構成されているので、作業機3による作業は耕耘作業を意味する。
PTOコントローラ35は、PTO軸の回転を制御するものである。具体的には、トラクタ1は、PTO軸(動力伝達軸)への動力の伝達/遮断を切り換えるためのPTOクラッチ45を備えている。この構成で、PTOコントローラ35は、制御装置4から入力される制御信号に基づいて、PTOクラッチ45を切り換えて、PTO軸を介して作業機3を回転駆動させたり、停止させたりすることができる。
The elevating controller 34 makes it possible to set the height at which the work machine 3 is supported by the tractor 1 to a desired height such as a non-work height where work is not performed and a work height where work is performed. Since the working machine 3 mounted on the traveling machine body 2 in the present embodiment is configured as a rotary cultivator, the work by the working machine 3 means the cultivating work.
The PTO controller 35 controls the rotation of the PTO axis. Specifically, the tractor 1 includes a PTO clutch 45 for switching the transmission / disconnection of power to the PTO shaft (power transmission shaft). With this configuration, the PTO controller 35 can switch the PTO clutch 45 based on the control signal input from the control device 4 to rotationally drive or stop the work machine 3 via the PTO axis. ..

制御装置4には、着脱センサ30が電気的に接続されている。制御装置4には、衛星信号受信用アンテナ46および基準局信号受信用アンテナ47が電気的に接続されている。また、制御装置4には、無線通信用アンテナ48が無線通信部49を介して電気的に接続されている。本実施形態では、無線通信部49は、無線LANルータ(Wi-Fiルータ)から構成されている。 The attachment / detachment sensor 30 is electrically connected to the control device 4. A satellite signal receiving antenna 46 and a reference station signal receiving antenna 47 are electrically connected to the control device 4. Further, the wireless communication antenna 48 is electrically connected to the control device 4 via the wireless communication unit 49. In the present embodiment, the wireless communication unit 49 is composed of a wireless LAN router (Wi-Fi router).

制御装置4は、キャビン11内に搭乗したユーザの各種操作に基づいて、トラクタ1および作業機3を制御する機能、トラクタ1を予め作成された自律走行経路に沿って自動的に走行させながら、作業機3を自動的に制御する自律走行機能等を備えている。以下においては、自律走行機能について詳しく説明する。
制御装置4は、マイクロコンピュータを含んでいる。マイクロコンピュータは、CPU、記憶部(ROM、RAM、不揮発性メモリ)51を備えている。記憶部51には、プログラムおよび各種データが記憶される。本実施形態では、記憶部51には、通信端末100によって生成された1または複数の自律走行経路データが記憶されている。マイクロコンピュータは、記憶部51に記憶されている所定のプログラムを実行することによって、複数の機能処理部として機能するようになっている。この複数の機能処理部には、第1算出部52と、第1評価部53と、第1制御部(自律走行制御部)54とが含まれる。
The control device 4 has a function of controlling the tractor 1 and the work machine 3 based on various operations of the user boarded in the cabin 11, and the tractor 1 is automatically driven along a pre-created autonomous travel path. It is equipped with an autonomous traveling function that automatically controls the work machine 3. In the following, the autonomous driving function will be described in detail.
The control device 4 includes a microcomputer. The microcomputer includes a CPU and a storage unit (ROM, RAM, non-volatile memory) 51. The storage unit 51 stores programs and various data. In the present embodiment, the storage unit 51 stores one or more autonomous travel path data generated by the communication terminal 100. The microcomputer functions as a plurality of functional processing units by executing a predetermined program stored in the storage unit 51. The plurality of functional processing units include a first calculation unit 52, a first evaluation unit 53, and a first control unit (autonomous travel control unit) 54.

第1算出部52は、衛星測位システムに基づいて走行機体2の位置情報を算出する。本実施形態では、衛星測位システムは、RTK(Real Time Kinematic)-GNSS(Global Navigation Satellite System)である。RTK-GNSS(リアルタイム・キネマティクGNSS)では、所定位置に設置された基準局が利用される。基準局は、所定時間間隔毎に、複数のGNSS衛星(測位衛星)から受信されたGNSS衛星信号に基づいて算出した当該基準局の測位情報と、予め認識している自己の位置(認識自己位置)との差分を演算し、その差分情報を測位補正信号として送信する。 The first calculation unit 52 calculates the position information of the traveling machine 2 based on the satellite positioning system. In this embodiment, the satellite positioning system is RTK (Real Time Kinematic) -GNSS (Global Navigation Satellite System). In RTK-GNSS (real-time kinematic GNSS), a reference station installed at a predetermined position is used. The reference station has the positioning information of the reference station calculated based on the GNSS satellite signals received from a plurality of GNSS satellites (positioning satellites) at predetermined time intervals, and its own position (recognized self-position) recognized in advance. The difference is calculated and the difference information is transmitted as a positioning correction signal.

衛星信号受信用アンテナ46は、GNSS衛星からの衛星信号を受信する。基準局信号受信用アンテナ47は、基準局からの測位補正情報を受信する。第1算出部52は、衛星信号受信用アンテナ46を介して、複数のGNSS衛星からの衛星信号を取得する。また、第1算出部52は、基準局信号受信用アンテナ47を介して、所定の第1基準局からの測位補正情報を取得する。第1算出部52は、複数のGNSS衛星から取得された衛星信号に基づいて走行機体2の測位情報を算出し、得られた走行機体2の測位情報を、第1基準局から取得された測位補正情報を用いて補正することにより、走行機体2の位置を表す第1位置情報を算出する。 The satellite signal receiving antenna 46 receives a satellite signal from the GNSS satellite. The reference station signal receiving antenna 47 receives the positioning correction information from the reference station. The first calculation unit 52 acquires satellite signals from a plurality of GNSS satellites via the satellite signal receiving antenna 46. Further, the first calculation unit 52 acquires the positioning correction information from the predetermined first reference station via the reference station signal reception antenna 47. The first calculation unit 52 calculates the positioning information of the traveling machine 2 based on the satellite signals acquired from a plurality of GNSS satellites, and the obtained positioning information of the traveling machine 2 is the positioning correction acquired from the first reference station. By correcting using the information, the first position information representing the position of the traveling machine body 2 is calculated.

第1位置情報は、厳密には、走行機体2における衛星信号受信用アンテナ46の位置(以下、「機体基準位置」という)を表す情報である。第1位置情報は、例えば、機体基準位置の経度情報および緯度情報を含む。本実施形態では、説明の便宜上、第1位置情報は、機体基準位置の経度情報および緯度情報から構成されているものとする。
第1評価部53は、第1算出部52によって算出された第1位置情報の精度が高いか低いかを評価する。例えば、第1算出部52によって算出された走行機体2の測位情報の精度が所定精度以上である場合には、第1評価部53は、第1算出部52によって算出された第1位置情報の精度が高いと評価する。一方、第1算出部52によって算出された走行機体2の測位情報の精度が所定精度よりも低い場合には、第1評価部53は、第1算出部52によって算出された第1位置情報の精度が低いと評価する。より具体的には、GNSS-RTK法においては、第1位置情報としてFIX解が得られることにより精度が高いと評価され、FIX解が得られるまで(例えば推測解が得られているとき)は精度が低いと評価される。
Strictly speaking, the first position information is information representing the position of the satellite signal receiving antenna 46 (hereinafter, referred to as “airframe reference position”) in the traveling aircraft 2. The first position information includes, for example, longitude information and latitude information of the aircraft reference position. In the present embodiment, for convenience of explanation, the first position information is composed of the longitude information and the latitude information of the aircraft reference position.
The first evaluation unit 53 evaluates whether the accuracy of the first position information calculated by the first calculation unit 52 is high or low. For example, when the accuracy of the positioning information of the traveling machine 2 calculated by the first calculation unit 52 is equal to or higher than a predetermined accuracy, the first evaluation unit 53 is the first position information calculated by the first calculation unit 52. Evaluate with high accuracy. On the other hand, when the accuracy of the positioning information of the traveling machine 2 calculated by the first calculation unit 52 is lower than the predetermined accuracy, the first evaluation unit 53 is the first position information calculated by the first calculation unit 52. Evaluate as low accuracy. More specifically, in the GNSS-RTK method, it is evaluated that the accuracy is high because the FIX solution is obtained as the first position information, and until the FIX solution is obtained (for example, when the guess solution is obtained). It is evaluated as having low accuracy.

第1制御部54は、各コントローラ31~35を制御することにより、トラクタ1を予め生成された自律走行経路に沿って自律走行させたり、自律走行を停止させたりする。また、第1制御部54は、後述する通信端末100の第2制御部124(図6参照)と通信を行う。
本実施形態では、制御装置4の電源がオンされると、第1制御部54は、基準局信号受信用アンテナ47によって受信される信号に基づいて、第1位置情報の算出のために使用される第1基準局を自動的に選択する。第1位置情報の算出のために使用される第1基準局とは、第1位置情報の算出のために使用される測位補正情報の送信元の基準局をいう。通常、トラクタ1に最も近い位置に存在する基準局が第1基準局として設定される。このようにして選択された第1基準局を特定するための情報は、記憶部51に記憶される。なお、ユーザによる通信端末100の操作に基づいて、第1位置情報の算出のために使用される第1基準局を変更できるようになっている。
By controlling each of the controllers 31 to 35, the first control unit 54 autonomously causes the tractor 1 to travel along the autonomous traveling path generated in advance, or stops the autonomous traveling. Further, the first control unit 54 communicates with the second control unit 124 (see FIG. 6) of the communication terminal 100, which will be described later.
In the present embodiment, when the power of the control device 4 is turned on, the first control unit 54 is used for calculating the first position information based on the signal received by the reference station signal receiving antenna 47. The first reference station is automatically selected. The first reference station used for calculating the first position information means the reference station of the transmission source of the positioning correction information used for calculating the first position information. Normally, the reference station located closest to the tractor 1 is set as the first reference station. The information for identifying the first reference station selected in this way is stored in the storage unit 51. It should be noted that the first reference station used for calculating the first position information can be changed based on the operation of the communication terminal 100 by the user.

図6は、通信端末100の電気的構成を示すブロック図である。
通信端末100は、制御装置101を備えている。制御装置101には、操作表示装置102、衛星信号受信用アンテナ103、基準局信号受信用アンテナ104、図示しない操作キー等が電気的に接続されている。また、制御装置101には、無線通信用アンテナ105が無線通信部106を介して接続されている。本実施形態では、無線通信部106は、無線LANアダプタ(Wi-Fiアダプタ)から構成されている。
FIG. 6 is a block diagram showing an electrical configuration of the communication terminal 100.
The communication terminal 100 includes a control device 101. An operation display device 102, a satellite signal receiving antenna 103, a reference station signal receiving antenna 104, an operation key (not shown), and the like are electrically connected to the control device 101. Further, the wireless communication antenna 105 is connected to the control device 101 via the wireless communication unit 106. In the present embodiment, the wireless communication unit 106 is composed of a wireless LAN adapter (Wi-Fi adapter).

操作表示装置102は、各種データを表示したり、ユーザによる操作を受け付けたりするものである。本実施形態では、操作表示装置102は、タッチパネル式ディプレイによって構成されている。
衛星信号受信用アンテナ103および基準局信号受信用アンテナ104は、通信端末100の位置情報の算出に使用されるアンテナである。無線通信部106および無線通信用アンテナ105は、通信端末100がトラクタ1の制御装置4と無線通信を行うために使用されるアンテナである。
The operation display device 102 displays various data and accepts operations by the user. In the present embodiment, the operation display device 102 is configured by a touch panel type display.
The satellite signal receiving antenna 103 and the reference station signal receiving antenna 104 are antennas used for calculating the position information of the communication terminal 100. The wireless communication unit 106 and the wireless communication antenna 105 are antennas used by the communication terminal 100 to perform wireless communication with the control device 4 of the tractor 1.

制御装置101は、マイクロコンピュータを含んでいる。マイクロコンピュータは、CPU、記憶部(ROM、RAM、不揮発性メモリ)121を備えている。記憶部121には、プログラムおよび各種データが記憶される。本実施形態では、記憶部121には、通信端末100によって生成された1または複数の自律走行経路データが記憶されている。マイクロコンピュータは、記憶部121に記憶されている所定のプログラムを実行することによって、複数の機能処理部として機能するようになっている。この複数の機能処理部には、第2算出部122と、第2評価部123と、第2制御部(走行経路生成部)124とが含まれる。 The control device 101 includes a microcomputer. The microcomputer includes a CPU and a storage unit (ROM, RAM, non-volatile memory) 121. The storage unit 121 stores programs and various data. In the present embodiment, the storage unit 121 stores one or more autonomous travel path data generated by the communication terminal 100. The microcomputer functions as a plurality of functional processing units by executing a predetermined program stored in the storage unit 121. The plurality of functional processing units include a second calculation unit 122, a second evaluation unit 123, and a second control unit (travel path generation unit) 124.

第2算出部122は、衛星測位システムに基づいて通信端末100の位置情報を算出する。本実施形態では、衛星測位システムは、RTK-GNSS(リアルタイム・キネマティクGNSS)である。第2算出部122は、衛星信号受信用アンテナ103を介して、複数のGNSS衛星からの衛星信号を取得する。また、第2算出部122は、基準局信号受信用アンテナ104を介して、所定の第2基準局からの測位補正情報を取得する。 The second calculation unit 122 calculates the position information of the communication terminal 100 based on the satellite positioning system. In this embodiment, the satellite positioning system is RTK-GNSS (real-time kinematic GNSS). The second calculation unit 122 acquires satellite signals from a plurality of GNSS satellites via the satellite signal receiving antenna 103. Further, the second calculation unit 122 acquires the positioning correction information from the predetermined second reference station via the reference station signal reception antenna 104.

第2算出部122は、複数のGNSS衛星から取得された衛星信号に基づいて通信端末100の測位情報を算出し、得られた通信端末100の測位情報を、第2基準局から取得された測位補正情報を用いて補正することにより、通信端末100の位置を表す第2位置情報を算出する。第2位置情報は、通信端末100の経度情報および緯度情報を含む。説明の便宜上、本実施形態では、第2位置情報は、経度情報および緯度情報から構成されているものとする。 The second calculation unit 122 calculates the positioning information of the communication terminal 100 based on the satellite signals acquired from a plurality of GNSS satellites, and the obtained positioning information of the communication terminal 100 is the positioning correction acquired from the second reference station. By correcting using the information, the second position information representing the position of the communication terminal 100 is calculated. The second position information includes the longitude information and the latitude information of the communication terminal 100. For convenience of explanation, in the present embodiment, the second position information is composed of longitude information and latitude information.

本実施形態では、通信端末100は、トラクタ1の衛星信号受信用アンテナ46のほぼ真下位置に配置されているので、第2位置情報における経度情報および緯度情報を、機体基準位置の経度情報および緯度情報とみなすことができる。
第2評価部123は、第2算出部122によって算出された第2位置情報の精度が高いか低いかを評価する。例えば、第2算出部122によって算出された通信端末100の測位情報の精度が所定精度以上である場合には、第2評価部123は、第2算出部122によって算出された第2位置情報の精度が高いと評価する。一方、第2算出部122によって算出された通信端末100の測位情報の精度が所定精度よりも低い場合には、第2評価部123は、第2算出部122によって算出された第2位置情報の精度が低いと評価する。
In the present embodiment, since the communication terminal 100 is arranged at a position substantially directly below the satellite signal receiving antenna 46 of the tractor 1, the longitude information and the latitude information in the second position information are used as the longitude information and the latitude of the aircraft reference position. It can be regarded as information.
The second evaluation unit 123 evaluates whether the accuracy of the second position information calculated by the second calculation unit 122 is high or low. For example, when the accuracy of the positioning information of the communication terminal 100 calculated by the second calculation unit 122 is equal to or higher than the predetermined accuracy, the second evaluation unit 123 is the second position information calculated by the second calculation unit 122. Evaluate with high accuracy. On the other hand, when the accuracy of the positioning information of the communication terminal 100 calculated by the second calculation unit 122 is lower than the predetermined accuracy, the second evaluation unit 123 is the second position information calculated by the second calculation unit 122. Evaluate as low accuracy.

第2制御部124は、自律走行経路の生成、自律走行のための各種設定の受け付け、トラクタ1側の第1制御部54との通信等を行う。
本実施形態では、通信端末100の電源がオンされると、第2制御部124は、基準局信号受信用アンテナ104によって受信される信号に基づいて、第2位置情報の算出のために使用される第2基準局を自動的に選択する。第2位置情報の算出のために使用される第2基準局とは、第2位置情報の算出のために使用される測位補正情報の送信元の基準局をいう。通常、通信端末100に最も近い位置に存在する基準局が第2基準局として設定される。このようにして選択された第2基準局を特定するための情報は、記憶部121に記憶される。なお、ユーザによる通信端末100の操作に基づいて、第2位置情報の算出のために使用される第2基準局を変更できるようになっている。
The second control unit 124 generates an autonomous travel route, accepts various settings for autonomous travel, communicates with the first control unit 54 on the tractor 1 side, and the like.
In the present embodiment, when the power of the communication terminal 100 is turned on, the second control unit 124 is used for calculating the second position information based on the signal received by the reference station signal receiving antenna 104. The second reference station is automatically selected. The second reference station used for calculating the second position information means the reference station of the transmission source of the positioning correction information used for calculating the second position information. Normally, the reference station located closest to the communication terminal 100 is set as the second reference station. The information for identifying the second reference station selected in this way is stored in the storage unit 121. The second reference station used for calculating the second position information can be changed based on the operation of the communication terminal 100 by the user.

自律走行経路の生成方法の一例について説明する。自律走行経路を生成するには、自律走行経路を生成すべき圃場の周囲に沿って、トラクタ1を走行させる。この際、通信端末100の第2制御部124は、トラクタ1の第1制御部54から第1位置情報を取得する。これにより、通信端末100は、圃場の輪郭の位置データを得ることができる。通信端末100は、圃場の輪郭の位置データから、圃場の大きさおよび形状を特定し、その圃場内部において自律走行経路データを生成する。このような自律走行経路データの生成方法は、公知なので、その詳細な説明を省略する。 An example of a method of generating an autonomous traveling route will be described. To generate an autonomous travel route, the tractor 1 is driven along the perimeter of the field in which the autonomous travel route should be generated. At this time, the second control unit 124 of the communication terminal 100 acquires the first position information from the first control unit 54 of the tractor 1. As a result, the communication terminal 100 can obtain the position data of the contour of the field. The communication terminal 100 identifies the size and shape of the field from the position data of the contour of the field, and generates autonomous travel route data inside the field. Since such a method of generating autonomous travel route data is known, detailed description thereof will be omitted.

このようにして、自律走行経路データが生成されると、第2制御部124は、生成された自律走行経路データを記憶部121に記憶させる。この際、当該自律走行経路の生成時に、第1位置情報の算出のために使用された第1基準局を自律走行経路データに対応付けて記憶部121に記憶させる。第2制御部124によって生成された自律走行経路データは、自動的にまたはユーザによる通信端末100の操作によって、トラクタ1の第1制御部54に送られて、記憶部51に記憶される。この際、当該自律走行経路の生成時に第1位置情報の算出のために使用された第1基準局が、当該自律走行経路データに対応付けられて記憶されてもよい。 When the autonomous travel route data is generated in this way, the second control unit 124 stores the generated autonomous travel route data in the storage unit 121. At this time, when the autonomous travel route is generated, the first reference station used for calculating the first position information is stored in the storage unit 121 in association with the autonomous travel route data. The autonomous travel route data generated by the second control unit 124 is sent to the first control unit 54 of the tractor 1 and stored in the storage unit 51 automatically or by the operation of the communication terminal 100 by the user. At this time, the first reference station used for calculating the first position information at the time of generating the autonomous travel route may be stored in association with the autonomous travel route data.

図7は、自律走行経路の一例を示す模式図である。
自律走行経路Pは、圃場60内において、作業開始位置Sと作業終了位置Eとを結ぶように生成される。この自律走行経路Pは、直線状の複数の作業路P1と、互いに隣接する2つの作業路P1の端部同士を交互に接続する接続路P2とから構成されている。複数の作業路P1は圃場60内の作業領域61に設定され、複数の接続路P2は圃場60内の非作業領域62に設定される。なお、本実施形態において作業領域とは自律作業が行われる領域であることを意味し、非作業領域とは、自律作業が行われない領域であることを意味するものとする。従って非作業領域は手動作業が行われる領域であってよい。以下、特筆なき限り、「走行」は自律走行を意味し、「作業」は自律作業を意味するものとする。
FIG. 7 is a schematic diagram showing an example of an autonomous traveling route.
The autonomous travel path P is generated so as to connect the work start position S and the work end position E in the field 60. The autonomous traveling path P is composed of a plurality of linear work paths P1 and a connection path P2 that alternately connects the ends of two work paths P1 adjacent to each other. The plurality of work paths P1 are set in the work area 61 in the field 60, and the plurality of connection paths P2 are set in the non-work area 62 in the field 60. In the present embodiment, the work area means an area where autonomous work is performed, and the non-work area means an area where autonomous work is not performed. Therefore, the non-working area may be an area where manual work is performed. Hereinafter, unless otherwise specified, "running" means autonomous running, and "work" means autonomous work.

作業路P1は作業機3による作業が行われる経路である。接続路P2は、旋回・切返し操作が行われる円弧状部分を含む旋回路である。このように作成された自律走行経路Pにおいては、それぞれの接続路P2において180°の方向転換が行われるので、トラクタ1の走行方向は、ある作業路P1と、それに隣接する作業路P1との間で、互いに逆方向になる。 The work path P1 is a path on which work is performed by the work machine 3. The connection path P2 is a turning circuit including an arc-shaped portion where a turning / turning operation is performed. In the autonomous traveling path P created in this way, the direction of the tractor 1 is changed by 180 ° in each connecting path P2, so that the traveling direction of the tractor 1 is a working path P1 and an adjacent working path P1. In between, they are in opposite directions.

トラクタ1の第1制御部54は、トラクタ1の第1算出部52によって算出される第1位置情報または通信端末100の第2算出部122によって算出される第2位置情報に基づいて自律走行制御を行って、トラクタ1を所定の自律走行経路に沿って自律走行させる。
以下において、第1算出部52によって算出される第1位置情報に基づいて自律走行制御が行われる制御モードを第1自律走行制御モードといい、第2算出部122によって算出される第2位置情報に基づいて自律走行制御が行われる制御モードを第2自律走行制御モードという場合がある。第1制御部54は、第1評価部53の評価結果、第2評価部123の評価結果および着脱センサ30の出力信号に基づいて、自律走行制御モードを切り換えたり、自律走行制御を停止させたりする。自律走行制御モードの切換および自律走行制御の停止に関する第1制御部54の動作の詳細については、後述する。
The first control unit 54 of the tractor 1 autonomously travels and controls based on the first position information calculated by the first calculation unit 52 of the tractor 1 or the second position information calculated by the second calculation unit 122 of the communication terminal 100. To make the tractor 1 autonomously travel along a predetermined autonomous travel path.
In the following, a control mode in which autonomous driving control is performed based on the first position information calculated by the first calculation unit 52 is referred to as a first autonomous driving control mode, and a second position information calculated by the second calculation unit 122. A control mode in which autonomous driving control is performed based on the above may be referred to as a second autonomous driving control mode. The first control unit 54 switches the autonomous driving control mode or stops the autonomous driving control based on the evaluation result of the first evaluation unit 53, the evaluation result of the second evaluation unit 123, and the output signal of the attachment / detachment sensor 30. do. The details of the operation of the first control unit 54 regarding the switching of the autonomous driving control mode and the stop of the autonomous driving control will be described later.

第1制御部54は、自律走行制御が行われている場合には、制御モードにかかわらず、作業機3の状態を作業状態と非作業状態との間で切り換えるための作業機状態切換制御を行う。作業状態とは、作業機3が作業高さ(図4に示す作業機3の高さ)にまで下降し、かつ、作業機3の耕耘爪25が回転駆動されている状態をいう。また、非作業状態とは、上記の作業状態以外の状態を意味し、例えば、作業機3が非作業高さにまで上昇し、かつ、耕耘爪25が回転駆動されていない状態をいう。具体的には、第1制御部54は、PTOクラッチ45に信号を送ってPTO軸への動力の伝達/遮断を切換制御し、また、昇降アクチュエータ44に信号を送って作業機3を昇降制御する。 When the autonomous traveling control is performed, the first control unit 54 performs a work machine state switching control for switching the state of the work machine 3 between a work state and a non-work state regardless of the control mode. conduct. The working state means a state in which the working machine 3 is lowered to the working height (the height of the working machine 3 shown in FIG. 4) and the tilling claw 25 of the working machine 3 is rotationally driven. Further, the non-working state means a state other than the above-mentioned working state, for example, a state in which the working machine 3 is raised to the non-working height and the tilling claw 25 is not rotationally driven. Specifically, the first control unit 54 sends a signal to the PTO clutch 45 to switch and control the transmission / disconnection of power to the PTO shaft, and also sends a signal to the elevating actuator 44 to elevate and control the work machine 3. do.

また、第1制御部54は、自律走行制御が行われている場合には、制御モードにかかわらず、トラクタ1の車速を、作業状態における速度(以下、第1速度という)または非作業状態における速度(以下、第2速度という)との間で、切り換えるための車速切換制御を行う。第1速度および第2速度は、ユーザによって設定可能である。耕耘作業において、通常は、第2速度は、第1速度よりも遅い速度に設定される。 Further, when the autonomous traveling control is performed, the first control unit 54 sets the vehicle speed of the tractor 1 in the working state (hereinafter referred to as the first speed) or in the non-working state regardless of the control mode. Vehicle speed switching control for switching between the speed (hereinafter referred to as the second speed) is performed. The first speed and the second speed can be set by the user. In the tilling operation, the second speed is usually set to a speed slower than the first speed.

作業機状態切換制御および車速切換制御の具体例について説明する。第1制御部54は、例えば、トラクタ1の位置が作業路P1から接続路P2に至ったときまたはそれより後の所定のタイミングで、作業機3の状態を作業状態から非作業状態に切り換えるための切換制御と、車速を第1速度から第2速度に切り換えるための切換制御を開始する。一方、第1制御部54は、例えば、トラクタ1の位置が接続路P2から作業路P1に至る前の所定のタイミングで、作業機3の状態を非作業状態から作業状態に切り換える切換制御と、車速を第2速度から第1速度に切り換えるための切換制御を開始する。 Specific examples of the work equipment state switching control and the vehicle speed switching control will be described. The first control unit 54 switches the state of the working machine 3 from the working state to the non-working state, for example, when the position of the tractor 1 reaches the connecting path P2 from the working path P1 or at a predetermined timing after that. Switching control and switching control for switching the vehicle speed from the first speed to the second speed are started. On the other hand, the first control unit 54 has, for example, switching control for switching the state of the working machine 3 from the non-working state to the working state at a predetermined timing before the position of the tractor 1 reaches the connecting path P2 to the working path P1. Switching control for switching the vehicle speed from the second speed to the first speed is started.

ユーザは、自律走行を行いたい場合には、通信端末100を操作して、走行経路選択画面を表示させる。走行経路選択画面には、記憶部121に記憶されている自律走行経路データのうち、現在、選択されている第1基準局と同じ基準局が対応付けられている自律走行経路データのみが、選択可能な状態で表示される。ユーザは、選択可能な状態で表示されている自律走行経路データの中から、トラクタ1を自律走行させるべき自律走行経路データを選択する。 When the user wants to perform autonomous driving, he / she operates the communication terminal 100 to display a traveling route selection screen. Of the autonomous travel route data stored in the storage unit 121, only the autonomous travel route data to which the same reference station as the currently selected first reference station is associated can be selected on the travel route selection screen. It is displayed in the state. The user selects the autonomous travel route data in which the tractor 1 should be autonomously traveled from the autonomous travel route data displayed in the selectable state.

第2制御部124は、走行経路選択画面上で自律走行経路データが選択されると、選択された自律走行経路データを特定するための経路特定情報を、トラクタ1の第1制御部54に送信する。第1制御部54は、第2制御部124から送信されてきた経路特定情報に基づいて、記憶部51に記憶されている自律走行経路データのうちから、自律走行を行うべき自律走行経路データを特定する。経路特定情報は、例えば、選択された自律走行経路データの容量を表す容量データであってもよい。この場合には、第1制御部54は、記憶部51に記憶されている自律走行経路データのうち、第2制御部124から送信されてきた容量データと、容量が一致する自律走行経路データを、自律走行を行うべき自律走行経路データとして特定する。 When the autonomous travel route data is selected on the travel route selection screen, the second control unit 124 transmits the route identification information for specifying the selected autonomous travel route data to the first control unit 54 of the tractor 1. do. Based on the route identification information transmitted from the second control unit 124, the first control unit 54 selects the autonomous travel route data to be autonomously traveled from the autonomous travel route data stored in the storage unit 51. Identify. The route identification information may be, for example, capacity data representing the capacity of the selected autonomous travel route data. In this case, the first control unit 54 uses the capacity data transmitted from the second control unit 124 among the autonomous travel route data stored in the storage unit 51, and the autonomous travel route data having the same capacity. , Specify as autonomous travel route data for autonomous travel.

なお、第1基準局とは異なる基準局が対応付けられている自律走行経路データも選択可能な状態で表示し、選択されることで対応付けられた基準局情報を確認可能としてもよい。その場合、異なる基準局が対応付けられている自律走行経路データは選択可能であっても、その後、トラクタ1の第1制御部54に対して送信不可に設定されるか、或いは、後述する自律走行開始ボタンが操作不能な状態で表示されることとすればよい。 It should be noted that the autonomous travel route data to which the reference station different from the first reference station is associated may also be displayed in a selectable state, and the associated reference station information may be confirmed by being selected. In that case, even if the autonomous travel route data to which different reference stations are associated can be selected, it is subsequently set to be non-transmissionable to the first control unit 54 of the tractor 1, or autonomous travel described later. It suffices that the start button is displayed in an inoperable state.

この後、第1制御部54は、自律走行制御を開始できる条件が整っているときには、自律走行制御の開始が可能な状態であることを示す開始可能状態信号を第2制御部124に送信する。自律走行制御を開始できる条件には、第1評価部53によって第1位置情報の精度が高精度であると評価されているという条件が含まれている。第2制御部124は、開始可能状態信号を受信しているときには、操作表示装置102に自律走行開始ボタンを操作可能な状態で表示する。 After that, when the conditions for starting the autonomous driving control are satisfied, the first control unit 54 transmits a startable state signal indicating that the autonomous driving control can be started to the second control unit 124. .. The condition that the autonomous traveling control can be started includes the condition that the accuracy of the first position information is evaluated to be high by the first evaluation unit 53. When the second control unit 124 receives the start enable state signal, the second control unit 124 displays the autonomous travel start button on the operation display device 102 in an operable state.

ユーザが、操作表示装置102上の自律走行開始ボタンを操作すると、第2制御部124は自律走行開始指令をトラクタ1の第1制御部54に送信する。第1制御部54は、自律走行開始指令を受信すると、自律走行制御処理を開始する。第2制御部124は、自律走行制御処理が開始されると、第2算出部122によって第2位置情報が算出される度に、当該第2位置情報と第2評価部123の評価結果を表す評価情報を、トラクタ1の第1制御部54に送信する。 When the user operates the autonomous travel start button on the operation display device 102, the second control unit 124 transmits the autonomous travel start command to the first control unit 54 of the tractor 1. Upon receiving the autonomous travel start command, the first control unit 54 starts the autonomous travel control process. The second control unit 124 represents the evaluation result of the second position information and the second evaluation unit 123 every time the second position information is calculated by the second calculation unit 122 when the autonomous traveling control process is started. The evaluation information is transmitted to the first control unit 54 of the tractor 1.

図8Aおよび図8Bは、自律走行制御モードの切換および自律走行制御の停止に関する第1制御部54の動作を説明するためのフローチャートである。
ここでは、説明の便宜上、第2位置情報を算出するために使用される第2基準局は、第1位置情報を算出するために使用される第1基準局と同一の基準局であるとする。
自律走行制御処理が開始されると、第1制御部54は、第1位置情報に基づいて、トラクタ1が自律走行終了位置に到達したか否かを判別する(ステップS1)。自律走行終了位置は、自律走行を終了すべき位置を意味し、例えば、図7で説明した作業終了位置Eである。
8A and 8B are flowcharts for explaining the operation of the first control unit 54 regarding the switching of the autonomous travel control mode and the stop of the autonomous travel control.
Here, for convenience of explanation, it is assumed that the second reference station used for calculating the second position information is the same reference station as the first reference station used for calculating the first position information.
When the autonomous travel control process is started, the first control unit 54 determines whether or not the tractor 1 has reached the autonomous travel end position based on the first position information (step S1). The autonomous travel end position means a position where autonomous travel should be completed, and is, for example, the work end position E described with reference to FIG. 7.

トラクタ1が自律走行終了位置に到達していなければ(ステップS1:NO)、第1制御部54は、第1位置情報に基づいて自律走行制御を行う(ステップS2)。つまり、第1制御部54は、第1自律走行制御モードで動作する。
次に、第1制御部54は、第1評価部53によって第1位置情報の精度が高精度であると評価されているか否かを判別する(ステップS3)。第1位置情報の精度が高精度であると評価されている場合には(ステップS3:YES)、第1制御部54はステップS1に戻る。ステップS1でトラクタ1が自律走行終了位置に到達していなければ(ステップS1:NO)、第1制御部54はステップS2に移行するので、第1位置情報に基づく自律走行制御が継続して実行されることになる。
If the tractor 1 has not reached the autonomous travel end position (step S1: NO), the first control unit 54 performs autonomous travel control based on the first position information (step S2). That is, the first control unit 54 operates in the first autonomous travel control mode.
Next, the first control unit 54 determines whether or not the accuracy of the first position information is evaluated to be high by the first evaluation unit 53 (step S3). If the accuracy of the first position information is evaluated to be high (step S3: YES), the first control unit 54 returns to step S1. If the tractor 1 has not reached the autonomous travel end position in step S1 (step S1: NO), the first control unit 54 shifts to step S2, so that autonomous travel control based on the first position information is continuously executed. Will be done.

ステップS3において、第1位置情報の精度が低精度であると評価されている場合には(ステップS3:NO)、第1制御部54は、第2評価部123によって第2位置情報の精度が高精度であると評価されているか否かを判別する(ステップS4)。第2位置情報の精度が高精度であると評価されている場合には(ステップS4:YES)、第1制御部54は、通信端末100が支持部6(走行機体2)に装着されているか否かを判別する(ステップS5)。この判別は、着脱センサ30の出力信号に基づいて行われる。 If the accuracy of the first position information is evaluated to be low in step S3 (step S3: NO), the accuracy of the second position information of the first control unit 54 is improved by the second evaluation unit 123. It is determined whether or not it is evaluated as having high accuracy (step S4). When the accuracy of the second position information is evaluated to be high (step S4: YES), is the communication terminal 100 mounted on the support unit 6 (traveling machine body 2) in the first control unit 54? Whether or not it is determined (step S5). This determination is made based on the output signal of the attachment / detachment sensor 30.

通信端末100が支持部6に装着されている場合には(ステップS5:YES)、第1制御部54は、第2位置情報に基づいて、トラクタ1が自律走行終了位置に到達したか否かを判別する(ステップS6)。トラクタ1が自律走行終了位置に到達していなければ(ステップS6:NO)、第1制御部54は、第2位置情報に基づいて自律走行制御を行う(ステップS7)。つまり、第1自律走行制御モードから第2自律走行制御モードに制御モードが切り換えられる。 When the communication terminal 100 is attached to the support unit 6 (step S5: YES), the first control unit 54 determines whether or not the tractor 1 has reached the autonomous travel end position based on the second position information. (Step S6). If the tractor 1 has not reached the autonomous travel end position (step S6: NO), the first control unit 54 performs autonomous travel control based on the second position information (step S7). That is, the control mode is switched from the first autonomous travel control mode to the second autonomous travel control mode.

次に、第1制御部54は、第1評価部53によって第1位置情報の精度が高精度であると評価されているか否かを判別する(ステップS8)。第1位置情報の精度が低精度であると評価されている場合には(ステップS8:NO)、第1制御部54は、第2評価部123によって第2位置情報の精度が高精度であると評価されているか否かを判別する(ステップS9)。第2位置情報の精度が高精度であると評価されている場合には(ステップS9:YES)、第1制御部54は、通信端末100が支持部6に装着されているか否かを判別する(ステップS10)。 Next, the first control unit 54 determines whether or not the accuracy of the first position information is evaluated to be high by the first evaluation unit 53 (step S8). When the accuracy of the first position information is evaluated to be low (step S8: NO), the accuracy of the second position information of the first control unit 54 is high by the second evaluation unit 123. It is determined whether or not it is evaluated as (step S9). When the accuracy of the second position information is evaluated to be high (step S9: YES), the first control unit 54 determines whether or not the communication terminal 100 is attached to the support unit 6. (Step S10).

通信端末100が支持部6に装着されている場合には(ステップS10:YES)、第1制御部54はステップS6に戻る。ステップS6でトラクタ1が自律走行終了位置に到達していなければ(ステップS6:NO)、第1制御部54はステップS7に移行するので、第2位置情報に基づく自律走行制御が継続して実行されることになる。
前記ステップS8において、第1位置情報の精度が高精度であると評価されている場合には(ステップS8:YES)、第1制御部54はステップS1に戻る。ステップS1でトラクタ1が自律走行終了位置に到達していなければ(ステップS1:NO)、第1制御部54はステップS2に移行するので、第2自律走行制御モードから第1自律走行制御モードに制御モードが切り換えられることになる。
When the communication terminal 100 is attached to the support unit 6 (step S10: YES), the first control unit 54 returns to step S6. If the tractor 1 has not reached the autonomous travel end position in step S6 (step S6: NO), the first control unit 54 shifts to step S7, so that autonomous travel control based on the second position information is continuously executed. Will be done.
If the accuracy of the first position information is evaluated to be high in step S8 (step S8: YES), the first control unit 54 returns to step S1. If the tractor 1 has not reached the autonomous travel end position in step S1 (step S1: NO), the first control unit 54 shifts to step S2, so that the second autonomous travel control mode is changed to the first autonomous travel control mode. The control mode will be switched.

前記ステップS4またはステップS9において、第2位置情報の精度が低精度であると評価されている場合には(ステップS4またはS9:NO)、第1制御部54は、ステップS11に移行する。また、前記ステップS5またはステップS10において通信端末100が支持部6から取り外されていると判別された場合にも(ステップS5またはS10:NO)、第1制御部54は、ステップS11に移行する。 If the accuracy of the second position information is evaluated to be low in step S4 or step S9 (step S4 or S9: NO), the first control unit 54 shifts to step S11. Further, even when it is determined in step S5 or step S10 that the communication terminal 100 has been removed from the support unit 6 (step S5 or S10: NO), the first control unit 54 shifts to step S11.

ステップS11では、第1制御部54は、自律走行制御を停止(異常停止)させる。具体的には、第1制御部54は、トラクタ1の走行を停止させる。なお、第1制御部54は併せて作業機3の自律作業を停止させる。このとき、自律作業が停止している、すなわちPTO軸への動力は遮断されているが、PTOスイッチ17はオンの位置にあるため、自律作業を開始するためにユーザは、PTOスイッチ17を一旦オフの位置に変更した後、再びPTOスイッチ17をオンの位置に変更しなければならない。 In step S11, the first control unit 54 stops the autonomous traveling control (abnormal stop). Specifically, the first control unit 54 stops the traveling of the tractor 1. The first control unit 54 also stops the autonomous work of the work machine 3. At this time, the autonomous work is stopped, that is, the power to the PTO axis is cut off, but since the PTO switch 17 is in the on position, the user temporarily presses the PTO switch 17 to start the autonomous work. After changing to the off position, the PTO switch 17 must be changed to the on position again.

また、トラクタ1が自律走行経路からずれている場合には、ユーザは、手動操作によって自律走行経路上にトラクタ1を移動させる。第1制御部54は、自律走行制御を再開できる条件が整っているときには、自律走行制御の再開が可能な状態であることを示す再開可能状態信号を第2制御部124に送信する。自律走行制御を再開できる条件には、第1評価部53によって第1位置情報の精度が高精度であると評価されているという条件が含まれている。第2制御部124は、再開可能状態信号を受信しているときには、操作表示装置102に自律走行再開ボタンを操作可能な状態で表示する。 When the tractor 1 deviates from the autonomous travel path, the user manually moves the tractor 1 onto the autonomous travel path. When the conditions for resuming the autonomous driving control are satisfied, the first control unit 54 transmits a resumable state signal indicating that the autonomous driving control can be restarted to the second control unit 124. The condition that the autonomous traveling control can be restarted includes the condition that the accuracy of the first position information is evaluated to be high by the first evaluation unit 53. When the second control unit 124 receives the restartable state signal, the second control unit 124 displays the autonomous travel restart button on the operation display device 102 in an operable state.

ユーザが、操作表示装置102上の自律走行再開ボタンを操作すると、第2制御部124は自律走行再開指令をトラクタ1の第1制御部54に送信する。第1制御部54は、自律走行再開指令を受信すると、自律走行制御処理を再開する。具体的には、第1制御部54は、図8AのステップS1に進む。
前記ステップS3または前記ステップS8において、トラクタ1が自律走行終了位置に到達していると判別された場合には(ステップS2またはS7:YES)、第1制御部54は、自律走行制御を終了する(ステップS12)。具体的には、第1制御部54は、トラクタ1の走行を停止させる。これにより、今回の自律走行制御処理は終了する。
When the user operates the autonomous travel restart button on the operation display device 102, the second control unit 124 transmits the autonomous travel restart command to the first control unit 54 of the tractor 1. Upon receiving the autonomous travel restart command, the first control unit 54 restarts the autonomous travel control process. Specifically, the first control unit 54 proceeds to step S1 in FIG. 8A.
If it is determined in step S3 or step S8 that the tractor 1 has reached the autonomous travel end position (step S2 or S7: YES), the first control unit 54 ends the autonomous travel control. (Step S12). Specifically, the first control unit 54 stops the traveling of the tractor 1. This completes the autonomous driving control process this time.

前述の実施形態では、自律走行制御処理が開始されると、第1算出部52によって算出される第1位置情報に基づいて自律走行制御が開始される(図8AのS1,S2参照)。これにより、制御モードは第1自律走行制御モードとなる。
第1位置情報に基づく自律走行制御中に、第1位置情報の精度が低精度になったときには、第2位置情報の精度が高精度でありかつ通信端末100が支持部6に装着されているという条件を満たしているか否かが判別される(図8AのS3~S5参照)。この条件を満たしていれば、第2算出部122によって算出される第2位置情報に基づいて自律走行制御が行われる(図8BのS7参照)。これにより、制御モードが第1自律制御モードから第2自律制御モードに切り換えられる。
In the above-described embodiment, when the autonomous travel control process is started, the autonomous travel control is started based on the first position information calculated by the first calculation unit 52 (see S1 and S2 in FIG. 8A). As a result, the control mode becomes the first autonomous driving control mode.
When the accuracy of the first position information becomes low during the autonomous travel control based on the first position information, the accuracy of the second position information is high and the communication terminal 100 is mounted on the support portion 6. It is determined whether or not the condition is satisfied (see S3 to S5 in FIG. 8A). If this condition is satisfied, autonomous travel control is performed based on the second position information calculated by the second calculation unit 122 (see S7 in FIG. 8B). As a result, the control mode is switched from the first autonomous control mode to the second autonomous control mode.

つまり、前述の実施形態では、トラクタ1側の第1算出部52によって算出される第1位置情報の精度が低下したとしても、所定の条件を満たせば、通信端末100側の第2算出部122によって算出される第2位置情報に基づいて自律走行制御を行えるようになる。言い換えれば、第1位置情報の精度が低下したとしても所定の条件を満たせば、自律走行を継続させることができる。これにより、第1位置情報に基づく自律走行制御のみが可能な作業車両に比べて、自律走行制御が停止される頻度を低減することが可能となる。 That is, in the above-described embodiment, even if the accuracy of the first position information calculated by the first calculation unit 52 on the tractor 1 side is lowered, the second calculation unit 122 on the communication terminal 100 side is satisfied if the predetermined conditions are satisfied. Autonomous driving control can be performed based on the second position information calculated by. In other words, even if the accuracy of the first position information is lowered, autonomous traveling can be continued if a predetermined condition is satisfied. This makes it possible to reduce the frequency with which the autonomous travel control is stopped as compared with a work vehicle capable of only autonomous travel control based on the first position information.

前述の実施形態では、第2位置情報に基づく自律走行制御中に、第1位置情報の精度が高精度になったときには、制御モードが第2自律制御モードから第1自律制御モードに切り換えられる(図8BのS8参照)。
通信端末100は支持部6に着脱可能に装着されるので、第2位置情報には通信端末100の装着誤差(取付誤差)に起因する誤差が含まれるおそれがある。したがって、第2位置情報に基づいて自律走行制御が行われる場合には、第1位置情報に基づいて自律走行制御が行われる場合に比べて、経路追従性が低下するおそれがある。前述の実施形態では、第2位置情報に基づいて自律走行制御が行われているときに、第1位置情報の精度が高精度になったときには、第1位置情報に基づいて自律走行制御が実行されるため、自律走行時において、経路追従性が低下するのを極力抑制することができる。
In the above-described embodiment, the control mode is switched from the second autonomous control mode to the first autonomous control mode when the accuracy of the first position information becomes high during the autonomous driving control based on the second position information (the second autonomous control mode is switched to the first autonomous control mode). See S8 in FIG. 8B).
Since the communication terminal 100 is detachably mounted on the support portion 6, the second position information may include an error due to a mounting error (mounting error) of the communication terminal 100. Therefore, when the autonomous travel control is performed based on the second position information, the route followability may be lower than when the autonomous travel control is performed based on the first position information. In the above-described embodiment, when the autonomous driving control is performed based on the second position information and the accuracy of the first position information becomes high, the autonomous driving control is executed based on the first position information. Therefore, it is possible to suppress the deterioration of the route followability as much as possible during autonomous traveling.

前述の実施形態では、第1位置情報に基づく自律走行制御中に、第1位置情報の精度が低精度になったときにおいて、第2位置情報の精度が高精度であるという条件および通信端末100が支持部6に装着されているという条件のうちの少なくとも一方の条件を満たしていない場合には、自律走行制御が停止される(S3~S5,S11参照)。また、第2位置情報に基づく自律走行制御中に、第2位置情報の精度が高精度であるという条件および通信端末100が支持部6に装着されているという条件のうちの少なくとも一方の条件を満たしていない場合には、自律走行制御が停止される(S9,S10,S11参照)。 In the above-described embodiment, the condition that the accuracy of the second position information is high when the accuracy of the first position information becomes low during the autonomous travel control based on the first position information and the communication terminal 100 If at least one of the conditions that is mounted on the support portion 6 is not satisfied, the autonomous traveling control is stopped (see S3 to S5 and S11). Further, during the autonomous travel control based on the second position information, at least one of the condition that the accuracy of the second position information is high and the condition that the communication terminal 100 is mounted on the support portion 6 is satisfied. If it is not satisfied, the autonomous driving control is stopped (see S9, S10, S11).

これにより、精度の低い位置情報に基づいて自律走行制御が行われるのを防止できる。また、通信端末100が支持部6に装着されていない状態において、第2位置情報に基づいて自律走行制御が行われるのを防止できる。この理由は、通信端末100が支持部6に装着されていないときには、第2位置情報の精度が高くても、第2位置情報に基づいて走行機体2の正確な位置を特定できなくなるからである。 This makes it possible to prevent autonomous driving control from being performed based on low-precision position information. Further, it is possible to prevent autonomous travel control from being performed based on the second position information in a state where the communication terminal 100 is not attached to the support portion 6. The reason for this is that when the communication terminal 100 is not attached to the support portion 6, even if the accuracy of the second position information is high, the accurate position of the traveling machine body 2 cannot be specified based on the second position information. ..

前述の実施形態では、通信端末100の記憶部121に記憶されている自律走行経路データのうち、現在選択されている第1基準局と同じ基準局が対応付けられている自律走行経路データだけしか、自律走行すべき自律走行経路として選択できないようになっている。言い換えれば、第1制御部54は、第1基準局と自律走行経路データに対応付けられている基準局(以下において、「第3基準局」という場合がある)とが同一である場合に、自律走行制御を実行可能となっている。これにより、自律走行時に、トラクタ1が圃場を逸脱するのを防止できる。この点について詳しく説明する。 In the above-described embodiment, among the autonomous travel route data stored in the storage unit 121 of the communication terminal 100, only the autonomous travel route data to which the same reference station as the currently selected first reference station is associated is autonomous. It cannot be selected as an autonomous driving route to be traveled. In other words, the first control unit 54 controls autonomous travel when the first reference station and the reference station associated with the autonomous travel route data (hereinafter, may be referred to as "third reference station") are the same. Can be executed. This makes it possible to prevent the tractor 1 from deviating from the field during autonomous traveling. This point will be described in detail.

前述したように、基準局は、測位システムを利用して基準局の位置の測位情報を算出し、予め認識している自己の位置(認識自己位置)と、算出された測位情報との差を、測位補正情報として送信する。ところが、基準局によっては、認識自己位置に誤差が存在している場合がある。第1基準局と第3基準局とが異なる場合において、少なくとも一方の基準局の認識自己位置に誤差が存在している場合には、走行経路生成時に算出される第1位置情報の実際位置に対するずれ量と、自律走行時に算出される第1位置情報の実際位置に対するずれ量とが異なる。実際位置とは、作業車両の実際の位置をいう。ずれ量とは、主として経度方向のずれ量および緯度方向のずれ量をいう。このため、自律走行時に、トラクタ1が圃場を逸脱するおそれがある。 As described above, the reference station calculates the positioning information of the position of the reference station using the positioning system, and positions the difference between the self-position (recognized self-position) recognized in advance and the calculated positioning information. Send as correction information. However, depending on the reference station, there may be an error in the recognition self-position. When the first reference station and the third reference station are different, and there is an error in the recognition self-position of at least one reference station, the amount of deviation of the first position information calculated at the time of traveling route generation with respect to the actual position , The amount of deviation of the first position information calculated during autonomous driving with respect to the actual position is different. The actual position means the actual position of the work vehicle. The amount of deviation mainly refers to the amount of deviation in the longitude direction and the amount of deviation in the latitude direction. Therefore, the tractor 1 may deviate from the field during autonomous traveling.

これに対して、第1基準局と第3基準局とが同一である場合には、当該基準局の認識自己位置に誤差が存在していても、走行経路生成時に算出される第1位置情報の実際位置に対するずれ量と、自律走行時に算出される第1位置情報の実際位置に対するずれ量とはほぼ同じになる。したがって、前述の実施形態では、自律走行時に、トラクタ1が圃場を逸脱するのを防止できる。 On the other hand, when the first reference station and the third reference station are the same, the actual position of the first position information calculated when the traveling route is generated even if there is an error in the recognition self-position of the reference station. The amount of deviation from the actual position and the amount of deviation of the first position information calculated during autonomous driving with respect to the actual position are substantially the same. Therefore, in the above-described embodiment, it is possible to prevent the tractor 1 from deviating from the field during autonomous traveling.

以上、この発明の実施形態について説明したが、この発明はさらに他の形態で実施することもできる。例えば、前述の実施形態では、自律走行制御を開始または再開するためには、第1位置情報の精度が高精度であるという条件を満たしている必要がある。しかし、この条件を、第1位置情報の精度および第2位置情報の精度のうち少なくとも一方が高精度であるという条件に代えてもよい。この場合において、第1位置情報の精度が低精度でありかつ第2位置情報の精度が高精度である状態で、自律走行制御が開始または再開されたときには、図8AにSTARTの直後の破線で示すように、第1制御部54はステップS6に移行すればよい。 Although the embodiment of the present invention has been described above, the present invention can also be implemented in other embodiments. For example, in the above-described embodiment, in order to start or restart the autonomous traveling control, it is necessary to satisfy the condition that the accuracy of the first position information is high. However, this condition may be replaced with the condition that at least one of the accuracy of the first position information and the accuracy of the second position information is high accuracy. In this case, when the autonomous driving control is started or restarted in a state where the accuracy of the first position information is low and the accuracy of the second position information is high, the broken line immediately after START is shown in FIG. 8A. As shown, the first control unit 54 may proceed to step S6.

前述の実施形態では、通信端末100は、支持部6に装着された状態では、衛星信号受信用アンテナ46のほぼ真下の所定位置に装着されているが、通信端末100は、衛星信号受信用アンテナ46の真下位置とは異なる所定位置に装着されるようになっていてもよい。この場合には、第2算出部122によって算出される第2位置情報を、機体基準位置の位置情報としてみなすことができない。そこで、この場合には、第1制御部54または第2制御部124は、第2算出部122によって算出された第2位置情報を、機体基準位置の位置情報に変換することが好ましい。そして、第1制御部54は、第2位置情報に基づいて自律走行制御を行うときには、変換後の位置情報(機体基準位置の位置情報)を用いて自律走行制御を行うことが好ましい。 In the above-described embodiment, the communication terminal 100 is mounted at a predetermined position substantially directly below the satellite signal receiving antenna 46 in a state of being mounted on the support portion 6, but the communication terminal 100 is mounted on the satellite signal receiving antenna. It may be mounted at a predetermined position different from the position directly below the 46. In this case, the second position information calculated by the second calculation unit 122 cannot be regarded as the position information of the aircraft reference position. Therefore, in this case, it is preferable that the first control unit 54 or the second control unit 124 converts the second position information calculated by the second calculation unit 122 into the position information of the aircraft reference position. When the first control unit 54 performs autonomous travel control based on the second position information, it is preferable that the first control unit 54 performs autonomous travel control using the converted position information (position information of the aircraft reference position).

第2位置情報の走行機体2の位置情報への変換は、例えば、次のように行われる。機体基準位置と通信端末100の装着位置との相対位置関係(前後方向距離および左右方向距離)を予め測定して記憶部に設定しておく。そして、第1制御部54または第2制御部124は、機体基準位置と通信端末100との相対位置関係と、トラクタ1の進行方向とに基づいて、第2算出部122によって算出された第2位置情報を機体基準位置の位置情報に変換する。 The conversion of the second position information into the position information of the traveling machine body 2 is performed, for example, as follows. The relative positional relationship (distance in the front-rear direction and distance in the left-right direction) between the machine reference position and the mounting position of the communication terminal 100 is measured in advance and set in the storage unit. Then, the first control unit 54 or the second control unit 124 is calculated by the second calculation unit 122 based on the relative positional relationship between the aircraft reference position and the communication terminal 100 and the traveling direction of the tractor 1. Converts the position information into the position information of the aircraft reference position.

また、前述の実施形態では、第2基準局は第1基準局と同一の基準局であったが、第2基準局は第1基準局とは異なる基準局であってもよい。この場合には、第2位置情報に基づいて特定される機体基準位置の位置情報(以下、「第3位置情報」という。)は、第1位置情報に基づいて特定される機体基準位置の位置情報(第1位置情報に等しい)に対してずれ(誤差)が生じるおそれがある。そこで、このような場合には、第3位置情報が第1位置情報と等しくなるように、次のようにして、第3位置情報を補正することが好ましい。なお、前述の実施形態では、第2位置情報は、第2位置情報に基づいて特定される機体基準位置の位置情報と等しいので、第3位置情報は第2位置情報と等しい。 Further, in the above-described embodiment, the second reference station is the same reference station as the first reference station, but the second reference station may be a reference station different from the first reference station. In this case, the position information of the aircraft reference position specified based on the second position information (hereinafter referred to as "third position information") is the position of the aircraft reference position specified based on the first position information. There is a possibility that a deviation (error) may occur with respect to the information (equal to the first position information). Therefore, in such a case, it is preferable to correct the third position information as follows so that the third position information becomes equal to the first position information. In the above-described embodiment, the second position information is equal to the position information of the aircraft reference position specified based on the second position information, so that the third position information is equal to the second position information.

すなわち、自律走行時において、第1位置情報および第2位置情報の精度がともに高精度であると評価されているときに、第1制御部54は、第1位置情報に対する第3位置情報のずれ量(経度方向および緯度方向のずれ量)を誤差補正情報として算出して、記憶部51に記憶する。記憶部51に記憶された誤差補正情報は、補正情報が新たに算出される度に、最新の補正情報に更新されることが好ましい。そして、第2位置情報に基づいて自律走行制御が行われる際には、第1制御部54は、誤差補正情報を用いて、第2位置情報に基づいて特定される第3位置情報を補正し、補正後の第3位置情報を用いて自律走行制御を行う。 That is, when the accuracy of both the first position information and the second position information is evaluated to be high in autonomous driving, the first control unit 54 shifts the third position information with respect to the first position information. The amount (the amount of deviation in the longitude direction and the latitude direction) is calculated as error correction information and stored in the storage unit 51. It is preferable that the error correction information stored in the storage unit 51 is updated with the latest correction information each time the correction information is newly calculated. Then, when the autonomous traveling control is performed based on the second position information, the first control unit 54 corrects the third position information specified based on the second position information by using the error correction information. , Autonomous driving control is performed using the corrected third position information.

前述の本実施形態では、測位システムとして、RTK-GNSSが用いられているが、相対測位方式(DGPS)、静止衛星型衛星航法補強システム(SBAS)等のようなRTK-GNSS以外の測位システムを用いてもよい。
その他、特許請求の範囲に記載された事項の範囲で種々の設計変更を施すことが可能である。
In the above-described embodiment, RTK-GNSS is used as the positioning system, but a positioning system other than RTK-GNSS such as a relative positioning method (DGPS), a geostationary satellite navigation augmentation system (SBAS), etc. is used. You may use it.
In addition, various design changes can be made within the scope of the matters described in the claims.

1 トラクタ(作業車両)
2 走行機体
3 作業機
6 通信端末支持部
30 着脱センサ
52 第1算出部
53 第1評価部
54 第1制御部(制御部)
100 通信端末
122 第2算出部
123 第2評価部
124 第2制御部
1 Tractor (working vehicle)
2 Traveling machine 3 Working machine 6 Communication terminal support part 30 Detachable sensor 52 First calculation unit 53 First evaluation unit 54 First control unit (control unit)
100 Communication terminal 122 2nd calculation unit 123 2nd evaluation unit 124 2nd control unit

Claims (10)

予め定められた走行経路に沿って自律走行する作業車両と、前記作業車両に対して所定の制御信号を送信可能な通信端末を備えた自律走行システムであって、
前記作業車両は、前記走行経路に沿って前記作業車両を自律走行させる自律走行制御を実行可能な制御部と、衛星測位システムを利用して前記作業車両の位置を表す第1位置情報を算出する第1算出部と、前記第1算出部によって算出された第1位置情報の精度を評価する第1評価部と、前記通信端末の前記作業車両への装着を検出する検出部と、を備え、
前記通信端末は、衛星測位システムを利用して前記通信端末の位置を表す第2位置情報を算出する第2算出部と、前記第2算出部によって算出された第2位置情報の精度を評価する第2評価部と、を備え、
前記制御部は、前記第1位置情報に基づいて自律走行制御を実行しているときに所定条件が成立した場合は、前記第1位置情報に代えて、前記第2位置情報に基づいて自律走行制御を実行することが可能であり、
前記所定条件は少なくとも第1条件と、前記第1条件とは異なる第2条件と、前記第1条件および前記第2条件とは異なる第3条件と、を含み、
前記第1条件は、前記第1評価部により、前記第1位置情報の精度が低精度であると評価されることであり、
前記第2条件は、前記第2評価部により、前記第2位置情報の精度が高精度であると評価されることであり、
前記第3条件は、前記検出部が前記通信端末の前記作業車両への装着を検出することであり、
前記制御部は、前記第1位置情報に基づいて自律走行制御を実行している場合において、前記第1条件が成立する一方、前記第2条件または前記第3条件が非成立であるときは自律走行制御を停止することを特徴とする自律走行システム。
An autonomous traveling system including a work vehicle that autonomously travels along a predetermined travel route and a communication terminal capable of transmitting a predetermined control signal to the work vehicle.
The work vehicle calculates first position information representing the position of the work vehicle by using a control unit capable of executing autonomous travel control for autonomously traveling the work vehicle along the travel route and a satellite positioning system. It includes a first calculation unit, a first evaluation unit that evaluates the accuracy of the first position information calculated by the first calculation unit, and a detection unit that detects the attachment of the communication terminal to the work vehicle.
The communication terminal evaluates the accuracy of the second calculation unit that calculates the second position information representing the position of the communication terminal using the satellite positioning system and the second position information calculated by the second calculation unit. With a second evaluation department,
If a predetermined condition is satisfied while the control unit is executing autonomous travel control based on the first position information, the control unit autonomously travels based on the second position information instead of the first position information. It is possible to carry out control,
The predetermined condition includes at least a first condition, a second condition different from the first condition, and a third condition different from the first condition and the second condition.
The first condition is that the accuracy of the first position information is evaluated to be low by the first evaluation unit.
The second condition is that the accuracy of the second position information is evaluated to be highly accurate by the second evaluation unit.
The third condition is that the detection unit detects the attachment of the communication terminal to the work vehicle.
When the control unit executes autonomous driving control based on the first position information, the first condition is satisfied, while the second condition or the third condition is not satisfied, the control unit is autonomous. An autonomous driving system characterized by stopping driving control.
前記制御部は、前記第2位置情報に基づいて自律走行制御を実行している場合において、前記第2条件または第3条件が成立しなくなった場合は、自律走行制御を停止し、前記第1条件が成立しなくなった場合は、前記第1位置情報に基づいて自律走行制御を実行することが可能であることを特徴とする請求項1に記載の自律走行システム。 When the control unit is executing the autonomous driving control based on the second position information, if the second condition or the third condition is no longer satisfied, the control unit stops the autonomous driving control and the first one. The autonomous traveling system according to claim 1, wherein when the condition is no longer satisfied, the autonomous traveling control can be executed based on the first position information. 前記第1算出部は、複数の測位衛星から受信した衛星信号に基づいて算出される前記作業車両の測位情報と、所定の第1基準局から受信した測位補正情報とに基づいて、前記第1位置情報を算出するように構成されており、
前記走行経路には特定の第3基準局が対応付けられており、
前記制御部は、前記第1基準局と前記第3基準局とが同一である場合に、自律走行制御を実行可能であることを特徴とする請求項1または2に記載の自律走行システム。
The first calculation unit is the first position based on the positioning information of the work vehicle calculated based on satellite signals received from a plurality of positioning satellites and the positioning correction information received from a predetermined first reference station. It is configured to calculate information and
A specific third reference station is associated with the traveling route.
The autonomous driving system according to claim 1 or 2, wherein the control unit can execute autonomous driving control when the first reference station and the third reference station are the same.
予め定められた走行経路に沿って自律走行する作業車両と、前記作業車両に対して所定の制御信号を送信可能な通信端末を備えた自律走行システムであって、
前記作業車両は、前記走行経路に沿って前記作業車両を自律走行させる自律走行制御を実行可能な制御部と、衛星測位システムを利用して前記作業車両の位置を表す第1位置情報を算出する第1算出部とを備え、
前記通信端末は、衛星測位システムを利用して前記通信端末の位置を表す第2位置情報を算出する第2算出部を備え、
前記第1算出部は、第1衛星信号受信用アンテナを介して複数の測位衛星から受信した衛星信号に基づいて算出される前記作業車両の測位情報を用いて、前記第1位置情報を算出するように構成されており、
前記第2算出部は、第2衛星信号受信用アンテナを介して複数の測位衛星から受信した衛星信号に基づいて算出される前記通信端末の測位情報を用いて、前記第2位置情報を算出するように構成されており、
前記第2衛星信号受信用アンテナは、前記第1衛星信号受信用アンテナのほぼ真下位置に配置されており、
前記制御部は、前記第1位置情報に基づいて自律走行制御を実行しているときに所定条件が成立した場合は、前記第1位置情報に代えて、前記第2位置情報に基づいて自律走行制御を実行することが可能であることを特徴とする自律走行システム。
An autonomous traveling system including a work vehicle that autonomously travels along a predetermined travel route and a communication terminal capable of transmitting a predetermined control signal to the work vehicle.
The work vehicle calculates first position information representing the position of the work vehicle by using a control unit capable of executing autonomous travel control for autonomously traveling the work vehicle along the travel route and a satellite positioning system. Equipped with a first calculation unit
The communication terminal includes a second calculation unit that calculates second position information representing the position of the communication terminal using a satellite positioning system.
The first calculation unit calculates the first position information by using the positioning information of the work vehicle calculated based on the satellite signals received from a plurality of positioning satellites via the first satellite signal receiving antenna . It is configured as
The second calculation unit calculates the second position information using the positioning information of the communication terminal calculated based on the satellite signals received from a plurality of positioning satellites via the second satellite signal receiving antenna . It is configured as
The second satellite signal receiving antenna is arranged at a position substantially directly below the first satellite signal receiving antenna.
If a predetermined condition is satisfied while the control unit is executing autonomous travel control based on the first position information, the control unit autonomously travels based on the second position information instead of the first position information. An autonomous driving system characterized in that it is possible to execute control.
前記作業車両は、前記第1算出部によって算出された第1位置情報の精度を評価する第1評価部を備え、
前記所定条件は少なくとも第1条件を含み、
前記第1条件は、前記第1評価部により、前記第1位置情報の精度が低精度であると評価されることであることを特徴とする請求項4に記載の自律走行システム。
The work vehicle includes a first evaluation unit that evaluates the accuracy of the first position information calculated by the first calculation unit.
The predetermined condition includes at least the first condition, and the predetermined condition includes at least the first condition.
The autonomous traveling system according to claim 4, wherein the first condition is that the accuracy of the first position information is evaluated by the first evaluation unit as having low accuracy.
前記通信端末は、前記第2算出部によって算出された第2位置情報の精度を評価する第2評価部を備え、
前記所定条件は、前記第1条件とは異なる第2条件を含み、
前記第2条件は、前記第2評価部により、前記第2位置情報の精度が高精度であると評価されることであることを特徴とする請求項5に記載の自律走行システム。
The communication terminal includes a second evaluation unit that evaluates the accuracy of the second position information calculated by the second calculation unit.
The predetermined condition includes a second condition different from the first condition.
The autonomous traveling system according to claim 5, wherein the second condition is that the accuracy of the second position information is evaluated to be highly accurate by the second evaluation unit.
前記作業車両は、前記通信端末を着脱可能に支持する支持部と、前記支持部に対する前記通信端末の装着を検出する検出部を備え、
前記複数の条件は、前記第1条件および前記第2条件とは異なる第3条件を含み、
前記第3条件は、前記検出部が前記支持部に対する前記通信端末の装着を検出することであることを特徴とする請求項6に記載の自律走行システム。
The work vehicle includes a support portion that detachably supports the communication terminal and a detection unit that detects attachment of the communication terminal to the support portion.
The plurality of conditions include the first condition and a third condition different from the second condition.
The autonomous traveling system according to claim 6, wherein the third condition is that the detection unit detects the attachment of the communication terminal to the support unit.
前記制御部は、前記第2位置情報に基づいて自律走行制御を実行している場合において、前記第2条件または第3条件が成立しなくなった場合は、自律走行制御を停止し、前記第1条件が成立しなくなった場合は、前記第1位置情報に基づいて自律走行制御を実行することが可能であることを特徴とする請求項7に記載の自律走行システム。 When the control unit is executing the autonomous driving control based on the second position information, if the second condition or the third condition is no longer satisfied, the control unit stops the autonomous driving control and the first one. The autonomous traveling system according to claim 7, wherein when the condition is no longer satisfied, the autonomous traveling control can be executed based on the first position information. 前記制御部は、前記第1位置情報に基づいて自律走行制御を実行している場合において、前記第1条件が成立する一方、前記第2条件または前記第3条件が非成立であるときは自律走行制御を停止することを特徴とする請求項7または請求項8に記載の自律走行システム。 When the control unit executes autonomous driving control based on the first position information, the first condition is satisfied, while the second condition or the third condition is not satisfied, the control unit is autonomous. The autonomous driving system according to claim 7 or 8, wherein the traveling control is stopped. 前記第1算出部は、前記作業車両の測位情報と、所定の第1基準局から受信した測位補正情報とに基づいて、前記第1位置情報を算出するように構成されており、
前記第2算出部は、前記通信端末の測位情報と、前記第1基準局と異なる所定の第2基準局から受信した測位補正情報とに基づいて、前記第2位置情報を算出するように構成されており、
前記走行経路には特定の第3基準局が対応付けられており、
前記制御部は、前記第1基準局と前記第3基準局とが同一である場合に、自律走行制御を実行可能であることを特徴とする請求項4~請求項9のいずれか1項に記載の自律走行システム。
The first calculation unit is configured to calculate the first position information based on the positioning information of the work vehicle and the positioning correction information received from the predetermined first reference station.
The second calculation unit is configured to calculate the second position information based on the positioning information of the communication terminal and the positioning correction information received from a predetermined second reference station different from the first reference station. Ori,
A specific third reference station is associated with the traveling route.
The invention according to any one of claims 4 to 9, wherein the control unit can execute autonomous driving control when the first reference station and the third reference station are the same. Autonomous driving system.
JP2017105510A 2017-05-29 2017-05-29 Autonomous driving system Active JP7019310B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2017105510A JP7019310B2 (en) 2017-05-29 2017-05-29 Autonomous driving system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017105510A JP7019310B2 (en) 2017-05-29 2017-05-29 Autonomous driving system

Publications (2)

Publication Number Publication Date
JP2018200611A JP2018200611A (en) 2018-12-20
JP7019310B2 true JP7019310B2 (en) 2022-02-15

Family

ID=64667239

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017105510A Active JP7019310B2 (en) 2017-05-29 2017-05-29 Autonomous driving system

Country Status (1)

Country Link
JP (1) JP7019310B2 (en)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7227070B2 (en) * 2019-05-17 2023-02-21 ヤンマーパワーテクノロジー株式会社 Autonomous driving system
JP7282660B2 (en) * 2019-11-29 2023-05-29 株式会社クボタ work machine
JP2021100391A (en) * 2019-12-24 2021-07-08 三菱マヒンドラ農機株式会社 Work vehicle
JP2022183958A (en) * 2021-05-31 2022-12-13 ヤンマーホールディングス株式会社 Automatic traveling method, automatic traveling system, and automatic traveling program

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005215742A (en) 2004-01-27 2005-08-11 Yanmar Co Ltd Agricultural work car
WO2016129671A1 (en) 2015-02-13 2016-08-18 ヤンマー株式会社 Control system for autonomously traveling work vehicle
WO2017026120A1 (en) 2015-08-10 2017-02-16 セイコーエプソン株式会社 System using position information, gateway device, and wearable device
JP2017070304A (en) 2016-12-19 2017-04-13 ヤンマー株式会社 Work vehicle
JP2017083212A (en) 2015-10-23 2017-05-18 エヌ・ティ・ティ・データ・カスタマサービス株式会社 Positioning system and positioning method

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0913751B1 (en) * 1997-11-03 2003-09-03 Volkswagen Aktiengesellschaft Autonomous vehicle and guiding method for an autonomous vehicle

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005215742A (en) 2004-01-27 2005-08-11 Yanmar Co Ltd Agricultural work car
WO2016129671A1 (en) 2015-02-13 2016-08-18 ヤンマー株式会社 Control system for autonomously traveling work vehicle
WO2017026120A1 (en) 2015-08-10 2017-02-16 セイコーエプソン株式会社 System using position information, gateway device, and wearable device
JP2017083212A (en) 2015-10-23 2017-05-18 エヌ・ティ・ティ・データ・カスタマサービス株式会社 Positioning system and positioning method
JP2017070304A (en) 2016-12-19 2017-04-13 ヤンマー株式会社 Work vehicle

Also Published As

Publication number Publication date
JP2018200611A (en) 2018-12-20

Similar Documents

Publication Publication Date Title
KR102325719B1 (en) work vehicle
JP7019310B2 (en) Autonomous driving system
JP7108096B2 (en) autonomous work vehicle
JP6564725B2 (en) Driving instruction device
JP7467266B2 (en) Autonomous driving system and control method
JP2017127290A (en) Agricultural working vehicle
JP6718838B2 (en) Driving support system for agricultural vehicles
KR102548019B1 (en) Path generation device and work vehicle
JP6876547B2 (en) Autonomous driving system
WO2018179777A1 (en) Autonomous travel system for agricultural work vehicles
JP2017135995A (en) Agricultural work vehicle
JP2018170992A (en) Autonomous travel system for farm work vehicle
JP2021040654A (en) Autonomous traveling system of farm work vehicle
WO2018139039A1 (en) Work vehicle
JP2017182375A (en) Route generation device
JP6840276B2 (en) Work vehicle
JP2017182374A (en) Service vehicle
JP7177198B2 (en) Autonomous working system
JP2021093179A (en) Autonomous travel system
JP2020035485A (en) Autonomous travel system
US20240085910A1 (en) Route Generation Method, Route Generation System, And Route Generation Program
CN117826868A (en) Travel control method, travel control system, and travel control program

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20200212

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20201217

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20201216

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210209

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210323

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20210701

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210826

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20220202

R150 Certificate of patent or registration of utility model

Ref document number: 7019310

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150