JP2018200274A - Satellite positioning system for automatic travelling work vehicle - Google Patents

Satellite positioning system for automatic travelling work vehicle Download PDF

Info

Publication number
JP2018200274A
JP2018200274A JP2017105910A JP2017105910A JP2018200274A JP 2018200274 A JP2018200274 A JP 2018200274A JP 2017105910 A JP2017105910 A JP 2017105910A JP 2017105910 A JP2017105910 A JP 2017105910A JP 2018200274 A JP2018200274 A JP 2018200274A
Authority
JP
Japan
Prior art keywords
unit
satellite positioning
setting
base station
setting state
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2017105910A
Other languages
Japanese (ja)
Other versions
JP6812303B2 (en
Inventor
敦 新海
Atsushi Shinkai
敦 新海
めぐみ 鈴川
Megumi Suzukawa
めぐみ 鈴川
孝文 森下
Takafumi Morishita
孝文 森下
幸太郎 山口
Kotaro Yamaguchi
幸太郎 山口
和央 阪口
Kazuo Sakaguchi
和央 阪口
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Kubota Corp
Original Assignee
Kubota Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Kubota Corp filed Critical Kubota Corp
Priority to JP2017105910A priority Critical patent/JP6812303B2/en
Publication of JP2018200274A publication Critical patent/JP2018200274A/en
Priority to JP2020208129A priority patent/JP6980087B2/en
Application granted granted Critical
Publication of JP6812303B2 publication Critical patent/JP6812303B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Position Fixing By Use Of Radio Waves (AREA)
  • Guiding Agricultural Machines (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

To provide a technology for, even when position coordinates set in a satellite positioning base station unit shared by a plurality of vehicles are rewritten from the outside, enabling all the vehicles to share the rewriting state of the position coordinates.SOLUTION: A satellite positioning system comprises: a satellite positioning base station unit 9B for transmitting correction data on the basis of position coordinates indicating a position where the satellite positioning system is installed and an electric wave from a satellite AS; on-vehicle satellite positioning units 9A for calculating positioning data by using the correction data; position coordinate setting parts 62 for setting the position coordinates of the satellite positioning base station unit 9B from the outside; and setting state management modules 63 each including a setting state transmission part 64 and a setting state reception part 65. The setting state transmission part 64 transmits a setting state of the position coordinates in the satellite positioning base station unit 9B, and the setting state reception part 65 receives the setting state from the setting state transmission part 64 of the other setting state management module 63.SELECTED DRAWING: Figure 5

Description

本発明は、衛星からの電波を受信して補正データを生成する移動式の衛星測位基地局ユニットと、衛星からの電波と衛星測位基地局ユニットからの補正データとを用いて測位データを算出する車載衛星測位ユニットとからなる、自動走行作業車両のための衛星測位システムに関する。衛星測位基地局ユニットは自動走行作業車両の作業現場付近に設置され、衛星測位基地局ユニットは自動走行作業車両に搭載され、当該自動走行作業車両の自車位置を算出するために利用される。   The present invention calculates positioning data using a mobile satellite positioning base station unit that receives radio waves from a satellite and generates correction data, and radio waves from the satellite and correction data from the satellite positioning base station unit. The present invention relates to a satellite positioning system for an automatic traveling work vehicle, which includes an in-vehicle satellite positioning unit. The satellite positioning base station unit is installed in the vicinity of the work site of the automatic traveling work vehicle, and the satellite positioning base station unit is mounted on the automatic traveling work vehicle and is used to calculate the position of the self-driving working vehicle.

この衛星測位システムは、複数の衛星からの電波の受信情報に基づいて、地球上での自車の位置を計測する全地球航法衛星システム(GNSS:Global Navigation Satellite System)に属するものであり、地上の所定位置に設置された基地局ユニットと、車両などの移動体に搭載される車載測位ユニットとから構成される。このシステムは、車載測位ユニットにおける衛星電波を用いた測位演算において、基地局ユニットから送られてくる補正データが用いられる方式であり、単独の測位方式に比べて、高い測位精度が得られる。この方式には、リアルタイムキネマティック方式GPS(以下、RTK−GPSと略称する)やディファレンシャル方式GPS(以下、DGPSと略称する)等が含まれる。RTK−GPSを自動走行作業車両に適用した例が、例えば、特許文献1に開示されている。RTK−GPSを用いた測位方式の運用においては、自動走行作業車両の走行対象となる作業地の近くに、衛星測位基地局ユニットが設置される。この自動走行作業車両が、遠く離れた次の作業地で作業を行う場合には、衛星測位基地局ユニットが取り外され、次の作業地へ搬送され、その適所に設置される。   This satellite positioning system belongs to the Global Navigation Satellite System (GNSS) that measures the position of the vehicle on the earth based on reception information of radio waves from a plurality of satellites. The base station unit is installed at a predetermined position, and an in-vehicle positioning unit mounted on a moving body such as a vehicle. This system is a method in which correction data transmitted from a base station unit is used in a positioning calculation using satellite radio waves in an in-vehicle positioning unit, and higher positioning accuracy can be obtained compared to a single positioning method. This method includes real-time kinematic GPS (hereinafter abbreviated as RTK-GPS), differential GPS (hereinafter abbreviated as DGPS), and the like. An example in which RTK-GPS is applied to an automatic traveling work vehicle is disclosed in Patent Document 1, for example. In the operation of the positioning method using RTK-GPS, a satellite positioning base station unit is installed near the work site to be traveled by the automatic traveling work vehicle. When this automatic traveling work vehicle performs work at the next work place far away, the satellite positioning base station unit is removed, transported to the next work place, and installed at the appropriate place.

特開2016−31649号公報(段落番号0035参照)JP 2016-31649 A (see paragraph 0035)

この衛星測位基地局ユニットは、所定位置に設置された後、起動されると、自動で設置位置の座標を算出する自動位置座標算出機能、及び、外部からの操作(無線操作を含む)による手動位置座標算出機能を備えている。自動位置座標算出機能によって算出された位置座標が正確でないとみなされると、この衛星測位基地局ユニットを利用する車載測位ユニット側からの操作で、自動で設定された位置座標が書き換えられる。この位置座標の書き換え前に、この衛星測位基地局ユニットを利用する別の車両が、それまでに設定されていた位置座標に基づいて算出された補正データを用いて自車位置を算出し、この自車位置と走行経路とを用いて自動走行している可能性がある。そのような場合、外部操作(衛星測位基地局ユニット以外からの無線等による操作)により衛星測位基地局ユニットの位置座標が書き換えられると、それ以前とそれ以後の自車位置の算出結果に矛盾が生じ、この車両(位置座標の書き換えを行っている車両とは異なる車両)の正常な自動走行ができなくなってしまう。また、一方の車両が衛星測位基地局ユニットの位置座標を書き換えている途中で、他方の車両も衛星測位基地局ユニットの位置座標の書き換えを行えば、手動位置座標算出機能がエラーを生じる可能性もある。   When the satellite positioning base station unit is installed at a predetermined position and then activated, the satellite positioning base station unit automatically calculates the coordinates of the installation position, and is manually operated by an external operation (including wireless operation). A position coordinate calculation function is provided. If the position coordinates calculated by the automatic position coordinate calculation function are regarded as inaccurate, the position coordinates set automatically are rewritten by an operation from the in-vehicle positioning unit side using this satellite positioning base station unit. Before rewriting this position coordinate, another vehicle using this satellite positioning base station unit calculates its own vehicle position using the correction data calculated based on the position coordinates set so far. There is a possibility that the vehicle is automatically traveling using the own vehicle position and the traveling route. In such a case, if the position coordinates of the satellite positioning base station unit are rewritten by an external operation (operation by radio from other than the satellite positioning base station unit), there is a contradiction in the calculation results of the vehicle position before and after that. As a result, this vehicle (a vehicle different from the vehicle in which the position coordinates are being rewritten) cannot be automatically operated normally. In addition, if one vehicle is rewriting the position coordinates of the satellite positioning base station unit while the other vehicle is rewriting the position coordinates of the satellite positioning base station unit, the manual position coordinate calculation function may cause an error. There is also.

このことから、複数の車両によって共用されている衛星測位基地局ユニットに設定されている位置座標が、外部から書き換えられた場合でも、全ての車両が、そのような位置座標の書き換え状態を共有することができる技術が要望されている。   From this, even if the position coordinates set in the satellite positioning base station unit shared by a plurality of vehicles are rewritten from the outside, all the vehicles share the rewriting state of such position coordinates. There is a need for technology that can do this.

本発明による、自動走行作業車両のための衛星測位システムは、設置された位置を示すパラメータである位置座標と衛星からの電波とに基づいて生成された補正データを送信する衛星測位基地局ユニットと、前記衛星からの電波と前記補正データとを用いて測位データを算出する車載衛星測位ユニットと、無線通信を用いて前記衛星測位基地局ユニットの前記位置座標を外部から設定する位置座標設定部と、設定状態送信部及び設定状態受信部を有する設定状態管理モジュールとを備え、前記設定状態送信部は前記衛星測位基地局ユニットにおける前記位置座標の設定状態を送信し、前記設定状態受信部は他の設定状態管理モジュールの前記設定状態送信部から送信されてきた前記設定状態を受信するように構成されている。   A satellite positioning system for an autonomous traveling vehicle according to the present invention includes a satellite positioning base station unit that transmits correction data generated based on position coordinates that are parameters indicating an installed position and radio waves from the satellite; A vehicle-mounted satellite positioning unit that calculates positioning data using radio waves from the satellite and the correction data, and a position coordinate setting unit that sets the position coordinates of the satellite positioning base station unit from the outside using wireless communication; A setting state management module having a setting state transmitting unit and a setting state receiving unit, wherein the setting state transmitting unit transmits a setting state of the position coordinates in the satellite positioning base station unit, and the setting state receiving unit is other The setting state transmitted from the setting state transmitter of the setting state management module is received.

この構成によれば、衛星測位基地局ユニットが設置された位置を示すパラメータである位置座標が、衛星測位基地局ユニットの外部から、位置座標設定部によって設定(新規設定または書き換え設定)された場合、その設定状態が設定状態送信部によって送信される。この送信された設定状態を設定状態受信部が受信することで、その時点での衛星測位基地局ユニットにおける位置座標の設定状態は、この衛星測位基地局ユニットを利用している全ての車載衛星測位ユニット側で把握できる。つまり、任意の自動走行作業車両(以下、単に車両とも称する)側から、衛星測位基地局ユニットの位置座標を設定した場合でも、それ以外の車両側は、その設定状態を実質的にリアルタイムで共有できる。これにより、任意の車両側から、衛星測位基地局ユニットの位置座標の設定が行われても、この衛星測位システムを利用している全ての車両における自車位置算出の混乱は回避される。   According to this configuration, when position coordinates, which are parameters indicating the position where the satellite positioning base station unit is installed, are set (new setting or rewriting setting) from the outside of the satellite positioning base station unit by the position coordinate setting unit The setting state is transmitted by the setting state transmission unit. When the setting state receiving unit receives this transmitted setting state, the setting state of the position coordinates in the satellite positioning base station unit at that time is all the in-vehicle satellite positioning using this satellite positioning base station unit. It can be grasped on the unit side. In other words, even if the position coordinates of the satellite positioning base station unit are set from the side of any automated traveling work vehicle (hereinafter also simply referred to as a vehicle), the other vehicles share the setting state substantially in real time. it can. Thereby, even if the position coordinates of the satellite positioning base station unit are set from an arbitrary vehicle side, the confusion of the own vehicle position calculation in all the vehicles using this satellite positioning system is avoided.

本発明の好適な実施形態の1つでは、前記設定状態を示すフラグには、前記位置座標の設定前及び設定中を示す座標未設定フラグと前記位置座標の設定完了を示す座標設定済フラグとが含まれている。この構成では、座標未設定フラグが与えられている場合は、衛星測位基地局ユニットにおいて位置座標が設定されておらず、補正データは生成されないと判断できる。このように判断されると、車両側では、衛星測位基地局ユニットにおいて位置座標が設定されるのを待つか、あるいは、位置座標設定部が衛星測位基地局ユニットの前記位置座標を外部から設定することになる。座標設定済フラグが与えられている場合は、衛星測位基地局ユニットにおいて位置座標が設定されているので、補正データは生成され、送信されてくると判断できる。このように判断されると、車両側では、送られてくる補正データを利用することになる。但し、その際、衛星測位基地局ユニットで設定されている位置座標に問題があるとみなされると、位置座標設定部による位置座標の外部からの設定が行われる。このように座標未設定フラグと座標設定済フラグとの2つのフラグにより、この衛星測位システムを利用している全ての車両側が同時に衛星測位基地局ユニットにおける位置座標の設定状態を把握することができる。   In one preferred embodiment of the present invention, the flag indicating the setting state includes a coordinate unset flag indicating that the position coordinate is not set and being set, and a coordinate set flag indicating completion of the position coordinate setting. It is included. In this configuration, when the coordinate non-setting flag is given, it can be determined that the position coordinates are not set in the satellite positioning base station unit and correction data is not generated. If determined in this way, the vehicle side waits for the position coordinates to be set in the satellite positioning base station unit, or the position coordinate setting unit sets the position coordinates of the satellite positioning base station unit from the outside. It will be. When the coordinate set flag is given, it can be determined that the correction data is generated and transmitted because the position coordinates are set in the satellite positioning base station unit. If judged in this way, the correction data sent will be used on the vehicle side. However, at this time, if it is considered that there is a problem with the position coordinates set in the satellite positioning base station unit, the position coordinates setting unit sets the position coordinates from the outside. In this way, with the two flags, the coordinate non-set flag and the coordinate set flag, all the vehicles using this satellite positioning system can simultaneously grasp the position coordinate setting state in the satellite positioning base station unit. .

さらに、本発明の好適な実施形態の1つでは、前記座標未設定フラグには、前記衛星測位基地局ユニットにおける前記位置座標の初期化中を示す初期化中フラグと、設定されている前記位置座標の前記位置座標設定部による変更中を示す変更中フラグが含まれている。この構成では、初期化中フラグが与えられている場合は、衛星測位基地局ユニットが初期化処理を通じて位置座標を設定中であるので、当該初期化処理が終了するまで、待機するべきであると判断できる。変更中フラグが与えられている場合は、任意の位置座標設定部によって位置座標が変更されている途中であるので、当該位置座標設定部による位置座標の変更が終了するまで待機するべきであると判断できる。位置座標の設定中に、別な位置座標の設定が入り込むことを回避するためには、前記位置座標設定部の1つが前記位置座標の設定中または変更中である場合、他の前記位置座標設定部による前記位置座標の設定または変更が禁止されるとよい。   Furthermore, in one of the preferred embodiments of the present invention, the coordinate non-setting flag includes an initializing flag indicating that the position coordinates in the satellite positioning base station unit are being initialized, and the set position. A changing flag indicating that the coordinates are being changed by the position coordinate setting unit is included. In this configuration, when the in-initialization flag is given, the satellite positioning base station unit is setting the position coordinates through the initialization process, so it should wait until the initialization process ends. I can judge. If the changing flag is given, the position coordinate is being changed by an arbitrary position coordinate setting unit, so it should wait until the change of the position coordinate by the position coordinate setting unit is completed. I can judge. In order to avoid the setting of another position coordinate during the setting of the position coordinate, when one of the position coordinate setting units is setting or changing the position coordinate, the other position coordinate setting is performed. Setting or changing the position coordinates by the unit may be prohibited.

本発明の好適な実施形態の1つでは、前記衛星測位基地局ユニットは複数台の前記自動走行作業車両によって共用され、当該自動走行作業車両のそれぞれが、制御ユニット及び前記制御ユニットに接続される汎用端末装置を備え、かつ、前記汎用端末装置が前記位置座標設定部と前記パラメータ設定状態通知部とを有し、前記汎用端末装置同士の間で、前記設定状態が無線通信を通じて共有される。この構成では、各自動走行作業車両に備えられた汎用端末装置が、それぞれデータ交換可能に接続されている(ペアリング状態)ので、汎用端末装置により、衛星測位基地局ユニットの位置座標の設定状態を取得や位置座標の変更が可能となる。したがって、各自動走行作業車両に搭載されている車載衛星測位ユニットには手を加える必要がないので、従来の車載衛星測位ユニットがそのまま流用される。   In one preferred embodiment of the present invention, the satellite positioning base station unit is shared by a plurality of the automatic traveling work vehicles, and each of the automatic traveling work vehicles is connected to the control unit and the control unit. A general-purpose terminal device is provided, the general-purpose terminal device includes the position coordinate setting unit and the parameter setting state notification unit, and the setting state is shared between the general-purpose terminal devices through wireless communication. In this configuration, since the general-purpose terminal devices provided in each automatic traveling work vehicle are connected to each other so as to be able to exchange data (pairing state), the general-purpose terminal device sets the position coordinates of the satellite positioning base station unit. Can be acquired and position coordinates can be changed. Therefore, since there is no need to modify the in-vehicle satellite positioning unit mounted on each automatic traveling work vehicle, the conventional in-vehicle satellite positioning unit is used as it is.

2台のトラクタによる協調作業の様子を示す説明図である。It is explanatory drawing which shows the mode of the cooperative work by two tractors. 2台のトラクタによる協調作業走行時の互いの関係を示す説明図である。It is explanatory drawing which shows the mutual relationship at the time of cooperative work driving | running | working by two tractors. 協調走行する作業車の側面図である。It is a side view of the work vehicle which carries out cooperative running. 衛星測位システムとトラクタの制御系の機能ブロック図である。It is a functional block diagram of a satellite positioning system and a tractor control system. 衛星測位基地局と汎用端末装置の基地局管理モジュールとの間のデータの流れを示す模式図である。It is a schematic diagram which shows the flow of data between a satellite positioning base station and the base station management module of a general purpose terminal device. 衛星測位基地局ユニットの初期化処理における位置座標設定のタイムチャートの一例を示す説明図である。It is explanatory drawing which shows an example of the time chart of the position coordinate setting in the initialization process of a satellite positioning base station unit. 位置座標設定コマンドによる衛星測位基地局ユニットの位置座標設定過程におけるタイムチャートの一例を示す説明図である。It is explanatory drawing which shows an example of the time chart in the position coordinate setting process of the satellite positioning base station unit by a position coordinate setting command.

以下、図面に基づいて、本発明に係る自動走行作業車両のための衛星測位システムの実施形態を説明する。この実施形態では、走行車体の後部に耕耘装置を装備した2台のトラクタが、自動走行作業車両として、衛星測位システムを利用している。2台のトラクタは、作業地である圃場に対して協調して耕耘作業を行う。   Hereinafter, an embodiment of a satellite positioning system for an automatic traveling work vehicle according to the present invention will be described based on the drawings. In this embodiment, two tractors equipped with a tillage device at the rear of the traveling vehicle body use a satellite positioning system as an automatic traveling work vehicle. The two tractors perform the tilling work in cooperation with the farm field that is the work site.

この協調耕耘作業では、図1と図2に示すように、2台のトラクタのうち、符号「A」を付与されたトラクタが先行して走行し、符号「B」を付与されたトラクタが、先行するトラクタによって耕耘された領域に対してわずかなオーバーラップ幅をもって、追従走行する。圃場での耕耘作業では、一般に、圃場の中央側に位置する中央作業地CLと、その中央作業地CLの周囲で畦に沿って規定される枕地HLとに区分けされる。各トラクタは、中央作業地CLにおいて予め設定された目標走行経路に沿って直進走行し、枕地HLに達するとUターン走行し、再び中央作業地CLでの直進走行に戻る。なお、2台のトタクタは、設定された目標走行経路に沿って自動走行可能であるが、2台のトラクタのうちのいずれか一方に運転者が乗り込んで手動走行され、他方が自動走行される作業方法と、2台のトラクタの両方が自動走行される作業方法が可能である。また、自動走行されるトラクタには、監視目的で監視者が乗り込むこともある。さらに一般的には、農道から圃場の所定位置(自動走行開始点)までは、運転者が乗り込んで、手動走行される。手動走行と自動走行とにかかわらず、各トラクタの自車位置は、衛星測位システムを用いて算出されるので、圃場における現在位置と目標走行経路や目標地点との間の偏差は、正確に求められる。   In this cooperative tillage work, as shown in FIG. 1 and FIG. 2, the tractor given the code “A” of the two tractors travels first, and the tractor given the code “B” The vehicle follows the vehicle with a slight overlap width with respect to the area cultivated by the preceding tractor. In the tilling work on the farm field, generally, it is divided into a central work area CL located on the center side of the farm field and a headland HL defined along the fence around the central work place CL. Each tractor travels straight along a preset target travel route at the central work site CL, travels a U-turn when reaching the headland HL, and returns to straight travel at the central work site CL again. The two tactors can automatically travel along the set target travel route, but the driver gets on one of the two tractors and travels manually, and the other travels automatically. A working method and a working method in which both tractors are automatically driven are possible. In addition, a supervisor may get on a tractor that automatically travels for monitoring purposes. More generally, the driver gets in and travels manually from the farm road to a predetermined position (automatic travel start point) on the field. Regardless of manual driving or automatic driving, the vehicle position of each tractor is calculated using a satellite positioning system, so the deviation between the current position on the field and the target driving route or target point can be obtained accurately. It is done.

この実施形態では、2つのトラクタは、実質的に同じ構成である。図3に示すように、このトラクタは、前輪11と後輪12とによって支持された車体10の中央部に操縦部20が設けられている。車体10の後部には油圧式の昇降機構31を介して作業装置としてのロータリ式の耕耘装置30が装備されている。前輪11は操向輪として機能し、操舵機構13によって操舵角が変更されることでトラクタの走行方向が変更される。操舵機構13には自動操舵のための操舵モータ14が含まれている。手動走行では、前輪11の操舵は操縦部20に配置されているステアリングホイール22を用いて行われる。操縦部20には、この実施形態では、タブレットコンピュータによって構成されている汎用端末装置6が操縦席に設置されたクレードルに装着されている。この汎用端末装置6は、無線データ伝送機能を備えており、クレードルから取り外して、トラクタの外部に持ち出しても、トラクタの制御系との間でデータ通信可能である。汎用端末装置6は、運転者に情報を提供する機能と、運転者からの情報を入力する機能とを有する。   In this embodiment, the two tractors have substantially the same configuration. As shown in FIG. 3, this tractor is provided with a steering unit 20 at the center of a vehicle body 10 supported by a front wheel 11 and a rear wheel 12. At the rear of the vehicle body 10, a rotary tiller 30 as a working device is provided via a hydraulic lifting mechanism 31. The front wheel 11 functions as a steered wheel, and the steering angle is changed by the steering mechanism 13 so that the traveling direction of the tractor is changed. The steering mechanism 13 includes a steering motor 14 for automatic steering. In manual travel, the front wheels 11 are steered using a steering wheel 22 disposed in the control unit 20. In this embodiment, the general-purpose terminal device 6 constituted by a tablet computer is attached to the control unit 20 in a cradle installed at the control seat. The general-purpose terminal device 6 has a wireless data transmission function, and can perform data communication with the control system of the tractor even if it is removed from the cradle and taken out of the tractor. The general-purpose terminal device 6 has a function of providing information to the driver and a function of inputting information from the driver.

図1に示すように、この実施形態での衛星測位システムは、GNSS(global navigation satellite system)における、RTK−GPS方式を採用しているので、基本構成要素として、衛星測位基地局ユニット9Bと車載衛星測位ユニット9Aとを備えている。衛星測位基地局ユニット9Bは、圃場近くに設置され、その設置された位置を示すパラメータである位置座標と衛星ASからの電波とに基づいて生成された補正データを車載衛星測位ユニット9Aに送信する。車載衛星測位ユニット9Aは、トラクタに装備されており、GNSS信号(GPS信号も含む)を受信するための衛星用アンテナが、トタクタキャビン21の天井領域に取り付けられている。なお、衛星測位システムを用いた衛星航法を補完するために、車載衛星測位ユニット9Aに、ジャイロ加速度センサや磁気方位センサを組み込んだ慣性航法モジュールを組み合わせることも可能である。そのような慣性航法モジュールは、車載衛星測位ユニット9Aとは別の場所に設けてもよい。   As shown in FIG. 1, since the satellite positioning system in this embodiment employs the RTK-GPS method in GNSS (global navigation satellite system), the satellite positioning base station unit 9B and the vehicle-mounted system are used as basic components. And a satellite positioning unit 9A. The satellite positioning base station unit 9B is installed near the agricultural field, and transmits correction data generated based on position coordinates, which are parameters indicating the installed position, and radio waves from the satellite AS to the in-vehicle satellite positioning unit 9A. . The in-vehicle satellite positioning unit 9 </ b> A is mounted on the tractor, and a satellite antenna for receiving a GNSS signal (including a GPS signal) is attached to the ceiling area of the tactor cabin 21. In order to complement satellite navigation using a satellite positioning system, an in-vehicle satellite positioning unit 9A can be combined with an inertial navigation module incorporating a gyro acceleration sensor or a magnetic bearing sensor. Such an inertial navigation module may be provided at a location different from the in-vehicle satellite positioning unit 9A.

衛星測位基地局ユニット9Bは、持ち運び可能であり地面上の任意の箇所に設置することができるように構成されている。このように構成することで、複数の圃場のそれぞれに衛星測位基地局ユニット9Bが設置される必要がなく、1台の衛星測位基地局ユニット9Bが各圃場に運搬車等により搬送され、設置される。複数の車載衛星測位ユニット9Aは、1台の衛星測位基地局ユニット9Bを共用することができる。また、作業すべき複数の圃場が隣接する場合には、各圃場を走行するトラクタの車載衛星測位ユニット9Aとの間で通信可能な場所に1台の衛星測位基地局ユニット9Bが設置される。   The satellite positioning base station unit 9B is portable and is configured to be installed at an arbitrary location on the ground. With this configuration, there is no need to install a satellite positioning base station unit 9B in each of a plurality of fields, and one satellite positioning base station unit 9B is transported and installed in each field by a transport vehicle or the like. The A plurality of in-vehicle satellite positioning units 9A can share one satellite positioning base station unit 9B. In addition, when a plurality of fields to be worked are adjacent to each other, one satellite positioning base station unit 9B is installed at a place where it can communicate with the in-vehicle satellite positioning unit 9A of the tractor traveling in each field.

このため、作業対象となる圃場の地図データに、当該圃場に対応する衛星測位基地局ユニット9Bの適正設置位置とが対応付けられたものが、圃場情報として管理されている。しかしながら、このように持ち運び可能で地面上の任意の箇所に設置することが可能な衛星測位基地局ユニット9Bであれば、作業者が前回の設置位置と異なる位置に誤って設置するおそれがある。衛星測位基地局ユニット9Bから送信される衛星測位基地局ユニット9Bの設置位置の位置座標が、圃場情報に記述されている適正設置位置と異なれば、衛星測位基地局ユニット9Bを適正な設置位置に移動させることになる。また、衛星測位基地局ユニット9Bで算定された設置位置の位置座標に誤りがあるとみなされる場合には、後述する構成を用いて、トラクタ側から、衛星測位基地局ユニット9Bの設置位置の位置座標を書き換えることも可能である。   For this reason, information in which the map data of the field to be worked is associated with the proper installation position of the satellite positioning base station unit 9B corresponding to the field is managed as field information. However, if the satellite positioning base station unit 9B is portable and can be installed at an arbitrary location on the ground, there is a risk that the operator will erroneously install it at a position different from the previous installation position. If the position coordinate of the installation position of the satellite positioning base station unit 9B transmitted from the satellite positioning base station unit 9B is different from the appropriate installation position described in the field information, the satellite positioning base station unit 9B is set to the appropriate installation position. Will be moved. Further, when it is considered that there is an error in the position coordinates of the installation position calculated by the satellite positioning base station unit 9B, the position of the installation position of the satellite positioning base station unit 9B from the tractor side using the configuration described later. It is also possible to rewrite the coordinates.

図4には、衛星測位システムとトラクタの制御系の機能ブロック図が示されている。トラクタの制御系の中核要素である制御ユニット5は、入出力インタフェースとして、出力処理部7と入力処理部8とを備えている。異なるタイプの無線通信機器と無線通信を行うために、複数の通信方式で動作可能な無線モジュール4が制御ユニット5と接続している。無線モジュール4は、他のトラクタの無線モジュール4とも無線通信可能であり、トラクタ間のデータ交換に用いられる。さらに、制御ユニット5は、汎用端末装置6及び衛星測位システムの車両側構成要素である車載衛星測位ユニット9Aと車載LANなどを介して接続している。   FIG. 4 shows a functional block diagram of a satellite positioning system and a tractor control system. The control unit 5 which is a core element of the control system of the tractor includes an output processing unit 7 and an input processing unit 8 as input / output interfaces. In order to perform wireless communication with different types of wireless communication devices, a wireless module 4 operable with a plurality of communication methods is connected to the control unit 5. The wireless module 4 can wirelessly communicate with the wireless modules 4 of other tractors, and is used for data exchange between tractors. Further, the control unit 5 is connected to the general-purpose terminal device 6 and the in-vehicle satellite positioning unit 9A, which is a vehicle side component of the satellite positioning system, through an in-vehicle LAN.

衛星測位システムの地上設置される構成要素である衛星測位基地局ユニット9Bは、無線通信を用いて、車載衛星測位ユニット9Aに補正データを送信する。   The satellite positioning base station unit 9B, which is a component installed on the ground of the satellite positioning system, transmits correction data to the in-vehicle satellite positioning unit 9A using wireless communication.

汎用端末装置6には、衛星測位基地局ユニット9Bの各種パラメータ、特に衛星測位基地局ユニット9Bの設置位置を示す位置座標を外部から設定管理する基地局管理モジュール61がインストールされている。基地局管理モジュール61の詳しい機能は後述される。汎用端末装置6と衛星測位基地局ユニット9Bとの間のデータ通信は、図4では、トラクタの制御系に組み込まれている無線モジュール4を介して行われるように構成されている。汎用端末装置6にも無線モジュール4は備えられているので、汎用端末装置6と衛星測位基地局ユニット9Bとの間で直接データ通信を行うことも可能である。   The general-purpose terminal device 6 is installed with a base station management module 61 for setting and managing various parameters of the satellite positioning base station unit 9B, in particular, position coordinates indicating the installation position of the satellite positioning base station unit 9B. Detailed functions of the base station management module 61 will be described later. In FIG. 4, the data communication between the general-purpose terminal device 6 and the satellite positioning base station unit 9B is configured to be performed via the wireless module 4 incorporated in the control system of the tractor. Since the general-purpose terminal device 6 also includes the wireless module 4, direct data communication can be performed between the general-purpose terminal device 6 and the satellite positioning base station unit 9B.

出力処理部7は、車両走行機器群71、作業装置機器群72、及び液晶ディスプレイなどの報知デバイス73と接続している。車両走行機器群71には、車両走行に関する制御機器、例えばエンジン制御機器、変速制御機器、制動制御機器、操舵制御機器などが含まれている。作業装置機器群72には、この実施形態では、耕耘装置30への動力伝達を入り切りするPTOクラッチなどの動力制御機器や、耕耘装置30を昇降させる昇降機構31の昇降シリンダ制御機器などが含まれている。   The output processing unit 7 is connected to a vehicle traveling device group 71, a work device group 72, and a notification device 73 such as a liquid crystal display. The vehicle travel device group 71 includes control devices related to vehicle travel, such as engine control devices, shift control devices, braking control devices, steering control devices, and the like. In this embodiment, the work device group 72 includes a power control device such as a PTO clutch that turns power transmission to the tilling device 30 on and off, and a lifting cylinder control device of the lifting mechanism 31 that moves the tilling device 30 up and down. ing.

入力処理部8には、走行系検出センサ群81、作業系検出センサ群82、走行モード切替器83などが接続されている。走行モード切替器83は、自動操舵で走行する自動走行モードと、手動操舵で走行する手動操舵モードとのいずれかを選択するスイッチである。例えば、自動操舵モードで走行中に走行モード切替器83を操作することで、手動操舵での走行に切り替えられ、手動操舵での走行中に走行モード切替器83を操作することで、自動操舵での走行に切り替えられる。走行系検出センサ群81には、エンジン回転数調整具、アクセルペダル、ブレーキペダル、ステアリングホイール22などの操作具の状態を検出するセンサが含まれている。作業系検出センサ群82には、耕耘装置30の駆動状態や姿勢を検出するセンサが含まれている。   The input processing unit 8 is connected to a travel system detection sensor group 81, a work system detection sensor group 82, a travel mode switch 83, and the like. The travel mode switch 83 is a switch that selects either an automatic travel mode in which the vehicle travels by automatic steering or a manual steering mode in which the vehicle travels by manual steering. For example, by operating the travel mode switch 83 while traveling in the automatic steering mode, the travel mode can be switched to manual steering, and by operating the travel mode switch 83 during the manual steering, It can be switched to running. The traveling system detection sensor group 81 includes sensors that detect states of operation tools such as an engine speed adjusting tool, an accelerator pedal, a brake pedal, and the steering wheel 22. The work system detection sensor group 82 includes sensors that detect the drive state and posture of the tilling device 30.

制御ユニット5には、作業走行制御モジュール50、自車位置算出部57、報知部58が備えられている。自車位置算出部57は、車載衛星測位ユニット9Aから逐次送られてくる測位データに基づいて、車体10の座標位置(地図座標または圃場座標)である自車位置を算出する。報知部58は、運転者や監視者に対して報知すべき情報を生成し、報知デバイス73を通じて、視覚的方法や聴覚的方法で情報を報知する。   The control unit 5 includes a work travel control module 50, a host vehicle position calculation unit 57, and a notification unit 58. The own vehicle position calculation unit 57 calculates the own vehicle position which is the coordinate position (map coordinate or field coordinate) of the vehicle body 10 based on the positioning data sequentially transmitted from the in-vehicle satellite positioning unit 9A. The notification unit 58 generates information to be notified to the driver or the supervisor, and notifies the information through a notification device 73 by a visual method or an auditory method.

作業走行制御モジュール50には、走行制御部51、作業制御部52、エンジン制御部53、自動作業走行指令部54、走行経路生成部55、協調走行管理部56が含まれている。走行制御部51は、操舵モータ14などの車両走行機器群71を制御する。このトラクタは自動走行(自動操舵)と手動走行(手動操舵)の両方で走行可能である。このため、走行制御部51は、手動走行制御機能と自動走行制御機能とを有する。手動走行制御機能が実行されている場合、運転者による操作に基づいて車両走行機器群71が制御される。自動走行制御機能が実行されている場合、自動作業走行指令部54から与えられる自動操舵指令に基づいて、走行制御部51が車両走行機器群71を制御する。作業制御部52は、耕耘装置30の動きを制御するために、作業装置機器群72に作業制御信号を与える。エンジン制御部53は、エンジンの動作機器にエンジン制御信号を与える。   The work travel control module 50 includes a travel control unit 51, a work control unit 52, an engine control unit 53, an automatic work travel command unit 54, a travel route generation unit 55, and a cooperative travel management unit 56. The travel control unit 51 controls the vehicle travel device group 71 such as the steering motor 14. The tractor can travel both automatically (automatic steering) and manually (manually). For this reason, the traveling control unit 51 has a manual traveling control function and an automatic traveling control function. When the manual travel control function is executed, the vehicle travel device group 71 is controlled based on an operation by the driver. When the automatic travel control function is executed, the travel control unit 51 controls the vehicle travel device group 71 based on the automatic steering command given from the automatic work travel command unit 54. The work control unit 52 gives a work control signal to the work device group 72 in order to control the movement of the tilling device 30. The engine control unit 53 gives an engine control signal to an engine operating device.

走行経路生成部55は、入力された圃場情報から、圃場の外形データを読み出し、この圃場における適正な走行経路を生成する。この走行経路は、運転者によって入力される基本的な初期パラメータに基づいて生成される。別なコンピュータで生成された走行経路をダウンロードして、利用することも可能である。いずれにしても、走行経路生成部55が得た走行経路は、メモリに展開され、自動走行における目標走行経路に利用される。もちろん、この走行経路は、手動走行であっても、トラクタが当該走行経路に沿って走行するためのガイダンスのために利用できる。   The travel route generation unit 55 reads out the contour data of the field from the input field information, and generates an appropriate travel route in the field. This travel route is generated based on basic initial parameters input by the driver. It is also possible to download and use a travel route generated by another computer. In any case, the travel route obtained by the travel route generation unit 55 is expanded in the memory and used as a target travel route in automatic travel. Of course, this travel route can be used for guidance for the tractor to travel along the travel route even in manual travel.

自動作業走行指令部54は、走行経路生成部55によって目標走行経路として設定された走行経路と、自車位置算出部57によって算出された自車位置との間の方位ずれ及び位置ずれを算出し、その方位ずれ及び位置ずれを解消する自動操舵指令を生成して、走行制御部51に与える。   The automatic work travel command unit 54 calculates an azimuth shift and a position shift between the travel route set as the target travel route by the travel route generation unit 55 and the own vehicle position calculated by the own vehicle position calculation unit 57. Then, an automatic steering command for eliminating the azimuth shift and the position shift is generated and given to the travel control unit 51.

協調走行管理部56は、協調相手のトラクタと協調作業を行う際に、協調走行のパターンに基づいて、協調相手のトラクタの走行経路を考慮した、走行経路の生成を走行経路生成部55に要求する。また、協調走行管理部56は、協調相手のトラクタの走行状態や作業状態を取得し、協調相手のトラクタの作業走行を制御する機能または協調相手のトラクタから自己の作業走行を制御させる機能も有する。   The cooperative traveling management unit 56 requests the traveling route generation unit 55 to generate a traveling route in consideration of the traveling route of the cooperative tractor based on the cooperative traveling pattern when performing the cooperative work with the cooperative tractor. To do. The cooperative traveling management unit 56 also has a function of acquiring a traveling state and a working state of the cooperative partner tractor and controlling a working traveling of the cooperative partner tractor or a function of controlling the own working traveling from the cooperative partner tractor. .

次に、図4と図5とを用いて、衛星測位基地局ユニット9Bの設置位置を示す位置座標が、汎用端末装置6の基地局管理モジュール61によって設定管理される際のデータの流れを説明する。   Next, the flow of data when the position coordinates indicating the installation position of the satellite positioning base station unit 9B are set and managed by the base station management module 61 of the general-purpose terminal device 6 will be described using FIG. 4 and FIG. To do.

GNSS衛星ASからの電波を受信する衛星測位基地局ユニット9Bには、無線モジュール90、補正データ生成部91、パラメータ管理部92などが備えられている。無線モジュール90は、各トラクタの車載衛星測位ユニット9A及び無線モジュール4との間でデータ通信を行う。なお、衛星測位基地局ユニット9Bは、電源ON時やリセット時には、初期化処理として、衛星ASからの電波に基づいて、設置された位置の位置座標を演算する機能を有する。演算によって得られた位置座標は、パラメータ管理部92によって初期位置座標として設定され、要求があれば外部に送信される。なお、この初期位置座標が、前もって衛星測位基地局ユニット9Bの設置位置として規定されている位置座標と許容以上に異なっていれば、設置ミスとみなすことができる。   The satellite positioning base station unit 9B that receives radio waves from the GNSS satellite AS includes a wireless module 90, a correction data generation unit 91, a parameter management unit 92, and the like. The wireless module 90 performs data communication between the in-vehicle satellite positioning unit 9A of each tractor and the wireless module 4. The satellite positioning base station unit 9B has a function of calculating the position coordinates of the installed position based on the radio wave from the satellite AS as initialization processing when the power is turned on or reset. The position coordinates obtained by the calculation are set as initial position coordinates by the parameter management unit 92, and transmitted to the outside if requested. If the initial position coordinates are different from the position coordinates previously defined as the installation position of the satellite positioning base station unit 9B, it can be regarded as an installation error.

補正データ生成部91は、予め設定されている衛星測位基地局ユニット9Bの設置位置を示す位置座標と、衛星ASからの電波に基づいて演算される位置座標との相違に基づき、RTK−GPSの補正アルゴリズムを用いて、補正データを算出する。算出された補正データは、無線モジュール90を通じて、各トラクタに搭載されている車載衛星測位ユニット9Aに送信される。補正データを受け取った車載衛星測位ユニット9Aは、補正データと衛星ASからの電波とを用いてより正確な測位データを生成し、自車位置算出部57に与える。   The correction data generation unit 91 is based on the difference between the position coordinates indicating the installation position of the satellite positioning base station unit 9B set in advance and the position coordinates calculated based on the radio wave from the satellite AS. Correction data is calculated using a correction algorithm. The calculated correction data is transmitted through the wireless module 90 to the in-vehicle satellite positioning unit 9A mounted on each tractor. The on-vehicle satellite positioning unit 9 </ b> A that has received the correction data generates more accurate positioning data using the correction data and the radio wave from the satellite AS, and provides the vehicle position calculation unit 57 with it.

パラメータ管理部92は、衛星測位基地局ユニット9Bにおいて設定される各種パラメータを管理する。このパラメータには、衛星測位基地局ユニット9Bの設置位置を示す位置座標の値(経緯度値)、この位置座標が初期化処理として自動的に算出されたものかあるいは外部からのコマンドで変更されたものであるかを示す値、無線モジュール90の無線パラメータ値などが含まれている。   The parameter management unit 92 manages various parameters set in the satellite positioning base station unit 9B. This parameter includes a position coordinate value (coordinate value) indicating the installation position of the satellite positioning base station unit 9B, whether this position coordinate is automatically calculated as an initialization process, or changed by an external command. A value indicating whether the wireless module is a wireless module, a wireless parameter value of the wireless module 90, and the like.

汎用端末装置6にインストールされている基地局管理モジュール61には、位置座標設定部62と設定状態管理モジュール63とが含まれている。設定状態管理モジュール63は、設定状態送信部64と設定状態受信部65を有する。   The base station management module 61 installed in the general-purpose terminal device 6 includes a position coordinate setting unit 62 and a setting state management module 63. The setting state management module 63 includes a setting state transmission unit 64 and a setting state reception unit 65.

位置座標設定部62は、汎用端末装置6側から、つまり各トラクタ側から、新たな位置座標を含む位置座標設定コマンドを衛星測位基地局ユニット9Bに送り、衛星測位基地局ユニット9Bで設定されている位置座標を変更設定する。この位置座標設定コマンドを生成する際には、汎用端末装置6のタッチパネル60によって具現化されるマンマシンインターフェースを用いて、各種データが入力される。   The position coordinate setting unit 62 sends a position coordinate setting command including a new position coordinate from the general-purpose terminal device 6 side, that is, from each tractor side, to the satellite positioning base station unit 9B, and is set by the satellite positioning base station unit 9B. Change the position coordinates. When the position coordinate setting command is generated, various data are input using a man-machine interface embodied by the touch panel 60 of the general-purpose terminal device 6.

上述したように、衛星測位基地局ユニット9Bの設置位置を示す位置座標として、初期化処理によって算出された位置座標(初期位置座標)、または、汎用端末装置6の位置座標設定部62によって設定された位置座標が用いられる。このため、パラメータ管理部92で管理されている位置座標には複数の設定状態がある。その設定状態を示す設定フラグとして、座標未設定フラグと座標設定済フラグとが規定されている。座標未設定フラグは、衛星測位基地局ユニット9Bにおける位置座標の設定前及び設定中を示し、座標設定済フラグは位置座標の設定完了を示す。さらに、座標未設定フラグには、衛星測位基地局ユニット9Bにおける位置座標の初期化中を示す初期化中フラグと、その時点において設定されている位置座標が位置座標設定部62から与えられる位置座標設定コマンドによって変更されている途中であることを示す変更中フラグが含まれている。   As described above, the position coordinates indicating the installation position of the satellite positioning base station unit 9B are set by the position coordinates (initial position coordinates) calculated by the initialization process or the position coordinate setting unit 62 of the general-purpose terminal device 6. Position coordinates are used. Therefore, the position coordinates managed by the parameter management unit 92 have a plurality of setting states. As setting flags indicating the setting state, a coordinate non-set flag and a coordinate set flag are defined. The coordinate unset flag indicates before and during setting of the position coordinates in the satellite positioning base station unit 9B, and the coordinate set flag indicates completion of setting of the position coordinates. Further, in the coordinate non-setting flag, an initializing flag indicating that the position coordinates in the satellite positioning base station unit 9B are being initialized, and a position coordinate in which the position coordinates set at that time are given from the position coordinate setting unit 62 A changing flag indicating that the setting command is being changed is included.

任意のトラクタの位置座標設定部62からの位置座標設定コマンドに基づく位置座標の設定状態は、設定フラグとして、当該トラクタの設定状態送信部64から他のトラクタの設定状態送信部64に送られる。つまり、衛星測位基地局ユニット9Bにおける位置座標の設定状態を示すこれらの設定フラグは、無線モジュール4を用いた無線通信によって、基地局管理モジュール61を利用している全てのトラクタに共有される。これにより、任意のトラクタ側からの位置座標設定コマンドによる設定状態は、実質的にリアルタイムで、その他のトラクタに共有されることなる。   The position coordinate setting state based on the position coordinate setting command from the position coordinate setting unit 62 of an arbitrary tractor is sent as a setting flag from the setting state transmission unit 64 of the tractor to the setting state transmission unit 64 of another tractor. That is, these setting flags indicating the setting state of the position coordinates in the satellite positioning base station unit 9B are shared by all tractors using the base station management module 61 by wireless communication using the wireless module 4. Thereby, the setting state by the position coordinate setting command from the arbitrary tractor side is shared by the other tractors substantially in real time.

衛星測位基地局ユニット9Bにおける設定状態が、全てのトラクタ、詳しくは全ての汎用端末装置6によって共有されることから、任意の位置座標設定部62が位置座標の設定中または変更中である場合、他の位置座標設定部62による位置座標の設定または変更を禁止することができる。これにより、外部からの位置座標設定コマンドにより衛星測位基地局ユニット9Bの位置座標が変更されたとしても、その事実が設定フラグを通じて、全トラクタに把握されるので、自車位置算出における混乱が回避される。また、複数のトタクタから位置座標設定コマンドが衛星測位基地局ユニット9Bに与えられる不都合も回避される。   Since the setting state in the satellite positioning base station unit 9B is shared by all the tractors, specifically all the general-purpose terminal devices 6, when any position coordinate setting unit 62 is setting or changing the position coordinates, Setting or changing the position coordinates by another position coordinate setting unit 62 can be prohibited. As a result, even if the position coordinates of the satellite positioning base station unit 9B are changed by an external position coordinate setting command, the fact is grasped by all the tractors through the setting flag, so that confusion in calculating the position of the vehicle is avoided. Is done. Further, the inconvenience that the position coordinate setting command is given to the satellite positioning base station unit 9B from a plurality of tactors is also avoided.

図6には、衛星測位基地局ユニット9Bの初期化処理における位置座標設定のタイムチャートの一例が示されている。このタイムチャートには、状態遷移と、フラグ遷移Aと、フラグ遷移Bとが示されている。状態遷移は、衛星測位基地局ユニット9Bの初期の位置座標設定状態を示す。フラグ遷移Aは、一方のトラクタに属する基地局管理モジュール61が衛星測位基地局ユニット9Bにアクセスすることで得られる設定フラグの内容が状態遷移によって変化する様子を示している。フラグ遷移Bは、他方のトラクタに属する基地局管理モジュール61が一方のトラクタに属する基地局管理モジュール61から転送される設定フラグの内容を示している。   FIG. 6 shows an example of a time chart for setting the position coordinates in the initialization process of the satellite positioning base station unit 9B. In this time chart, state transition, flag transition A, and flag transition B are shown. The state transition indicates an initial position coordinate setting state of the satellite positioning base station unit 9B. The flag transition A shows how the contents of the setting flag obtained by the base station management module 61 belonging to one tractor accessing the satellite positioning base station unit 9B change due to the state transition. The flag transition B indicates the contents of the setting flag transferred from the base station management module 61 belonging to one tractor to the base station management module 61 belonging to the other tractor.

(状態遷移)衛星測位基地局ユニット9Bが適所に設置され、電源がONされると、衛星ASからの電波に基づいて、設置された位置の位置座標を自動的に演算する初期化処理が行われる。これによって求められた位置座標は初期位置座標として設定される。
(フラグ遷移A)基地局管理モジュール61が衛星測位基地局ユニット9Bにアクセスすることで、パラメータ管理部92から衛星測位基地局ユニット9Bの状態に応じた内容の設定フラグが取得される。例えば、電源ONに対応して「初期化前」フラグ、初期化の開始に対応して「初期化中」、初期位置座標設定に対応して「座標設定済」フラグが与えられる。なお、「初期化前」フラグ及び「初期化中」フラグは「座標未設定」フラグとみなすことができる。
(フラグ遷移B)一方のトラクタに属する基地局管理モジュール61が取得した設定フラグは、無線モジュール4を介しての無線通信で、当該基地局管理モジュール61から他方のトラクタに属する基地局管理モジュール61に転送される。これによって、全てのトタクタの基地局管理モジュール61は、状態遷移にともなって変化する設定フラグの内容を共有することができる。
(State transition) When the satellite positioning base station unit 9B is installed in a proper place and the power is turned on, an initialization process is performed to automatically calculate the position coordinates of the installed position based on the radio wave from the satellite AS. Is called. The position coordinates obtained in this way are set as initial position coordinates.
(Flag Transition A) When the base station management module 61 accesses the satellite positioning base station unit 9B, a setting flag having contents corresponding to the state of the satellite positioning base station unit 9B is acquired from the parameter management unit 92. For example, a “pre-initialization” flag is given in response to power ON, a “initializing” flag is given in response to the start of initialization, and a “coordinates already set” flag is given in response to initial position coordinate settings. Note that the “before initialization” flag and the “initializing” flag can be regarded as “coordinate not set” flags.
(Flag Transition B) The setting flag acquired by the base station management module 61 belonging to one tractor is a wireless communication via the wireless module 4, and the base station management module 61 belonging to the other tractor from the base station management module 61. Forwarded to As a result, the base station management modules 61 of all the tactors can share the contents of the setting flag that changes with the state transition.

図7には、位置座標設定コマンドによる衛星測位基地局ユニット9Bの位置座標設定過程のタイムチャートの一例が示されている。このタイムチャートにおいても、状態遷移、フラグ遷移A、フラグ遷移Bの意味は、図6のものと同様である。
(状態遷移)一方のトラクタに属する基地局管理モジュール61からの位置座標設定コマンドによって、位置座標を書き換える位置座標変更が行われ、座標変更が完了すると新しい位置座標が設定される。
(フラグ遷移A)位置座標設定コマンドが衛星測位基地局ユニット9Bに送信されることで、位置座標変更処理が始まると、基地局管理モジュール61には、「座標変更中」フラグが与えられる。この「座標変更中」フラグは、新しい位置座標が設定されるまで与えられ、新しい位置座標が設定されると、「座標設定済」フラグが与えられる。なお、「座標変更中」フラグが与えられるまでは、「座標設定済」フラグが有効であり、「座標変更中」フラグから「座標設定済」フラグまで間は、「座標未設定」フラグまたは「変更中」フラグが有効であるとみなされる。
(フラグ遷移B)ここでも、一方の基地局管理モジュール61が与えられている設定フラグは、他方の基地局管理モジュール61に転送されるので、全ての基地局管理モジュール61は、状態遷移にともなって変化する設定フラグの内容を共有する。これにより、いずれかの基地局管理モジュール61が位置座標の変更を行っている間は、他の基地局管理モジュール61が位置座標の変更を行うことを禁止できる。
FIG. 7 shows an example of a time chart of the position coordinate setting process of the satellite positioning base station unit 9B by the position coordinate setting command. Also in this time chart, the meanings of state transition, flag transition A, and flag transition B are the same as those in FIG.
(State Transition) A position coordinate change for rewriting the position coordinate is performed by a position coordinate setting command from the base station management module 61 belonging to one tractor, and a new position coordinate is set when the coordinate change is completed.
(Flag transition A) When the position coordinate change process starts by transmitting the position coordinate setting command to the satellite positioning base station unit 9B, the base station management module 61 is given a “coordinate changing” flag. This “coordinate changing” flag is given until a new position coordinate is set. When a new position coordinate is set, a “coordinate has been set” flag is given. Until the “coordinate changing” flag is given, the “coordinate setting completed” flag is valid. From the “coordinate changing” flag to the “coordinate setting completed” flag, the “coordinate not set” flag or “ The “changing” flag is considered valid.
(Flag Transition B) Again, since the setting flag given by one base station management module 61 is transferred to the other base station management module 61, all the base station management modules 61 are accompanied by a state transition. Share the contents of setting flags that change. Thereby, while any of the base station management modules 61 is changing the position coordinates, it is possible to prohibit other base station management modules 61 from changing the position coordinates.

上記実施形態(別実施形態を含む、以下同じ)で開示される構成は、矛盾が生じない限り、他の実施形態で開示される構成と組み合わせて適用することが可能であり、また、本明細書において開示された実施形態は例示であって、本発明の実施形態はこれに限定されず、本発明の目的を逸脱しない範囲内で適宜改変することが可能である。   The configuration disclosed in the above embodiment (including another embodiment, the same applies hereinafter) can be applied in combination with the configuration disclosed in the other embodiment as long as no contradiction arises. The embodiment disclosed in the document is an exemplification, and the embodiment of the present invention is not limited to this, and can be appropriately modified without departing from the object of the present invention.

〔別実施の形態〕
(1)上述した実施形態では、基地局管理モジュール61が汎用端末装置6に構築されていたが、これに代えて、基地局管理モジュール61が制御ユニット5に構築されてもよい。
(2)上述した実施形態では、衛星測位システムの測位データ生成方式としてRTK−GPS方式が採用されていたが、DGPS方式など他の方式が採用されてもよい。
(3)図4や図5で示された機能ブロック図における各機能部は、主に説明目的で区分けされている。実際には、各機能部は他の機能部と統合してもよいし、またはさらに複数の機能部に分けてもよい。
(4)上述した実施形態では、自動走行作業車両として、耕耘装置30を作業装置として装備したトラクタを取り上げたが、そのようなトラクタ以外にも、例えば、田植機、施肥機、コンバインなどの農作業車、建設作業車両、などの種々の作業車両にも、本願発明を適用することができる。また、協調作業を行う複数台の自動走行作業車両は同一種類の作業車でなくてもよく、例えば、一方がコンバインで他方がトラクタでもよい。
[Another embodiment]
(1) In the embodiment described above, the base station management module 61 is constructed in the general-purpose terminal device 6, but instead, the base station management module 61 may be constructed in the control unit 5.
(2) In the above-described embodiment, the RTK-GPS method is adopted as the positioning data generation method of the satellite positioning system, but other methods such as the DGPS method may be adopted.
(3) Each functional unit in the functional block diagrams shown in FIGS. 4 and 5 is divided mainly for the purpose of explanation. Actually, each functional unit may be integrated with other functional units, or may be further divided into a plurality of functional units.
(4) In the above-described embodiment, a tractor equipped with the tilling device 30 as a working device is taken up as an automatic traveling work vehicle. The present invention can also be applied to various work vehicles such as cars and construction work vehicles. Further, the plurality of automatic traveling work vehicles that perform the cooperative work may not be the same type of work vehicle, for example, one may be a combine and the other may be a tractor.

本発明は、無線端末機器との間で無線通信可能な無線通信部を備えた作業車両に適用することができる。   The present invention can be applied to a work vehicle including a wireless communication unit capable of wireless communication with a wireless terminal device.

4 :無線モジュール
5 :制御ユニット
50 :作業走行制御モジュール
51 :走行制御部
52 :作業制御部
53 :エンジン制御部
54 :自動作業走行指令部
55 :走行経路生成部
56 :協調走行管理部
57 :自車位置算出部
6 :汎用端末装置
60 :タッチパネル
61 :基地局管理モジュール
62 :位置座標設定部
63 :設定状態管理モジュール
64 :設定状態送信部
65 :設定状態受信部
7 :出力処理部
8 :入力処理部
9A :車載衛星測位ユニット
9B :衛星測位基地局ユニット
90 :無線モジュール
91 :補正データ生成部
92 :パラメータ管理部
AS :衛星(GNSS衛星)
4: Wireless module 5: Control unit 50: Work travel control module 51: Travel control unit 52: Work control unit 53: Engine control unit 54: Automatic work travel command unit 55: Travel route generation unit 56: Cooperative travel management unit 57: Own vehicle position calculation unit 6: general-purpose terminal device 60: touch panel 61: base station management module 62: position coordinate setting unit 63: setting state management module 64: setting state transmission unit 65: setting state receiving unit 7: output processing unit 8: Input processing unit 9A: vehicle-mounted satellite positioning unit 9B: satellite positioning base station unit 90: wireless module 91: correction data generation unit 92: parameter management unit AS: satellite (GNSS satellite)

Claims (5)

自動走行作業車両のための衛星測位システムであって、
設置された位置を示すパラメータである位置座標と衛星からの電波とに基づいて生成された補正データを送信する衛星測位基地局ユニットと、
前記衛星からの電波と前記補正データとを用いて測位データを算出する車載衛星測位ユニットと、
無線通信を用いて前記衛星測位基地局ユニットの前記位置座標を外部から設定する位置座標設定部と、
設定状態送信部及び設定状態受信部を有する設定状態管理モジュールと、
を備え、
前記設定状態送信部は前記衛星測位基地局ユニットにおける前記位置座標の設定状態を送信し、前記設定状態受信部は他の設定状態管理モジュールの前記設定状態送信部から送信されてきた前記設定状態を受信する自動走行作業車両のための衛星測位システム。
A satellite positioning system for an automatic traveling work vehicle,
A satellite positioning base station unit that transmits correction data generated based on position coordinates that are parameters indicating the installed position and radio waves from the satellite;
An in-vehicle satellite positioning unit that calculates positioning data using radio waves from the satellite and the correction data;
A position coordinate setting unit for setting the position coordinates of the satellite positioning base station unit from the outside using wireless communication;
A setting state management module having a setting state transmitting unit and a setting state receiving unit;
With
The setting state transmission unit transmits the setting state of the position coordinates in the satellite positioning base station unit, and the setting state reception unit displays the setting state transmitted from the setting state transmission unit of another setting state management module. Satellite positioning system for automatic traveling work vehicles to receive.
前記設定状態を示すフラグには、前記位置座標の設定前及び設定中を示す座標未設定フラグと前記位置座標の設定完了を示す座標設定済フラグとが含まれている請求項1に記載の衛星測位システム。   2. The satellite according to claim 1, wherein the flag indicating the setting state includes a coordinate unset flag indicating that the position coordinates are not set and being set, and a coordinate set flag indicating completion of the setting of the position coordinates. Positioning system. 前記座標未設定フラグには、前記衛星測位基地局ユニットにおける前記位置座標の初期化中を示す初期化中フラグと、設定されている前記位置座標の前記位置座標設定部による変更中を示す変更中フラグが含まれている請求項2に記載の衛星測位システム。   The coordinate non-setting flag includes an initializing flag indicating that the position coordinates in the satellite positioning base station unit are being initialized, and a change indicating that the set position coordinates are being changed by the position coordinate setting unit. The satellite positioning system according to claim 2, wherein a flag is included. 前記位置座標設定部の1つが前記位置座標の設定中または変更中である場合、他の前記位置座標設定部による前記位置座標の設定または変更は禁止される請求項3に記載の衛星測位システム。   4. The satellite positioning system according to claim 3, wherein when one of the position coordinate setting units is setting or changing the position coordinate, setting or changing the position coordinate by another position coordinate setting unit is prohibited. 前記衛星測位基地局ユニットは複数台の前記自動走行作業車両によって共用され、当該自動走行作業車両のそれぞれが、制御ユニット及び前記制御ユニットに接続される汎用端末装置を備え、かつ、
前記汎用端末装置が前記位置座標設定部と前記設定状態送信部と前記設定状態受信部とを有し、前記汎用端末装置同士の間で、前記設定状態が無線通信を通じて共有できる請求項1〜4のいずれか一項に記載の衛星測位システム。
The satellite positioning base station unit is shared by a plurality of the automatic traveling work vehicles, each of the automatic traveling work vehicles includes a control unit and a general-purpose terminal device connected to the control unit, and
5. The general-purpose terminal device includes the position coordinate setting unit, the setting state transmission unit, and the setting state reception unit, and the setting state can be shared between the general-purpose terminal devices through wireless communication. The satellite positioning system according to any one of the above.
JP2017105910A 2017-05-29 2017-05-29 Satellite positioning system for autonomous driving vehicles Active JP6812303B2 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2017105910A JP6812303B2 (en) 2017-05-29 2017-05-29 Satellite positioning system for autonomous driving vehicles
JP2020208129A JP6980087B2 (en) 2017-05-29 2020-12-16 Satellite positioning system for self-driving work vehicles

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017105910A JP6812303B2 (en) 2017-05-29 2017-05-29 Satellite positioning system for autonomous driving vehicles

Related Child Applications (1)

Application Number Title Priority Date Filing Date
JP2020208129A Division JP6980087B2 (en) 2017-05-29 2020-12-16 Satellite positioning system for self-driving work vehicles

Publications (2)

Publication Number Publication Date
JP2018200274A true JP2018200274A (en) 2018-12-20
JP6812303B2 JP6812303B2 (en) 2021-01-13

Family

ID=64667117

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017105910A Active JP6812303B2 (en) 2017-05-29 2017-05-29 Satellite positioning system for autonomous driving vehicles

Country Status (1)

Country Link
JP (1) JP6812303B2 (en)

Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08334342A (en) * 1995-06-06 1996-12-17 Matsushita Electric Ind Co Ltd Dgps position-measuring apparatus
JPH09512072A (en) * 1994-04-18 1997-12-02 キャタピラー インコーポレイテッド Method and apparatus for monitoring and collaborating multiple geometry changing machines in a work place
US20030229435A1 (en) * 2002-06-06 2003-12-11 Lely Enterprises Ag A system for and a method of performing a first and a second agricultural operation on an agricultural parcel
JP2004144622A (en) * 2002-10-24 2004-05-20 Kokusai Kogyo Co Ltd Monitoring system for sloped face
JP2006322753A (en) * 2005-05-17 2006-11-30 Fuji Heavy Ind Ltd Traveling controller for vehicle
US20070085734A1 (en) * 2005-10-14 2007-04-19 Csi Wireless, Inc. Portable reference station for local differential GPS corrections
JP2009175071A (en) * 2008-01-28 2009-08-06 Hitachi Industrial Equipment Systems Co Ltd Gps data processing apparatus
JP2010501751A (en) * 2006-08-24 2010-01-21 キャタピラー トリンブル コントロール テクノロジーズ、 エルエルシー Excavator 3D integrated laser and wireless positioning guidance system
JP2011165256A (en) * 2010-02-08 2011-08-25 Clarion Co Ltd In-vehicle information terminal
JP2015169503A (en) * 2014-03-06 2015-09-28 三菱電機株式会社 correction data distribution server
JP2016031649A (en) * 2014-07-29 2016-03-07 株式会社クボタ Working vehicle cooperation system
JP2017003448A (en) * 2015-06-11 2017-01-05 株式会社岩崎 Ground survey device, ground survey system, ground survey program, and ground survey method
JP2018113940A (en) * 2017-01-20 2018-07-26 株式会社クボタ Position measurement device for work vehicle

Patent Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09512072A (en) * 1994-04-18 1997-12-02 キャタピラー インコーポレイテッド Method and apparatus for monitoring and collaborating multiple geometry changing machines in a work place
JPH08334342A (en) * 1995-06-06 1996-12-17 Matsushita Electric Ind Co Ltd Dgps position-measuring apparatus
US20030229435A1 (en) * 2002-06-06 2003-12-11 Lely Enterprises Ag A system for and a method of performing a first and a second agricultural operation on an agricultural parcel
JP2004144622A (en) * 2002-10-24 2004-05-20 Kokusai Kogyo Co Ltd Monitoring system for sloped face
JP2006322753A (en) * 2005-05-17 2006-11-30 Fuji Heavy Ind Ltd Traveling controller for vehicle
US20070085734A1 (en) * 2005-10-14 2007-04-19 Csi Wireless, Inc. Portable reference station for local differential GPS corrections
JP2010501751A (en) * 2006-08-24 2010-01-21 キャタピラー トリンブル コントロール テクノロジーズ、 エルエルシー Excavator 3D integrated laser and wireless positioning guidance system
JP2009175071A (en) * 2008-01-28 2009-08-06 Hitachi Industrial Equipment Systems Co Ltd Gps data processing apparatus
JP2011165256A (en) * 2010-02-08 2011-08-25 Clarion Co Ltd In-vehicle information terminal
JP2015169503A (en) * 2014-03-06 2015-09-28 三菱電機株式会社 correction data distribution server
JP2016031649A (en) * 2014-07-29 2016-03-07 株式会社クボタ Working vehicle cooperation system
JP2017003448A (en) * 2015-06-11 2017-01-05 株式会社岩崎 Ground survey device, ground survey system, ground survey program, and ground survey method
JP2018113940A (en) * 2017-01-20 2018-07-26 株式会社クボタ Position measurement device for work vehicle

Also Published As

Publication number Publication date
JP6812303B2 (en) 2021-01-13

Similar Documents

Publication Publication Date Title
JP6749256B2 (en) Work vehicle position measuring device
KR102287412B1 (en) Parallel travel work system
JP6694328B2 (en) Autonomous driving system
JP2018169826A (en) Working vehicle for agricultural use
JP7069364B2 (en) Work vehicle
JP2022091836A (en) Automatic travelling system
JP2019170197A (en) Region registration system
JP6879896B2 (en) Satellite positioning system for work platforms
EP3410247B1 (en) Master work vehicle performing work in cooperation with slave work vehicle
JP2018200639A (en) Work management system
JP2020194253A (en) Obstacle determination system and autonomous travelling system
JP7083001B2 (en) Autonomous driving system
JP6948837B2 (en) Work vehicle cooperation system
JP2018198582A (en) Automatic traveling work vehicle
JP7045979B2 (en) Traveling work machine
JP6980087B2 (en) Satellite positioning system for self-driving work vehicles
JP6812303B2 (en) Satellite positioning system for autonomous driving vehicles
WO2020129704A1 (en) Travel working machine
WO2020129684A1 (en) Traveling operation machine
JP7282660B2 (en) work machine
JP2020099227A (en) Travel implement
JP2020030643A (en) Automated traveling system
JP7238025B2 (en) Agricultural support system
WO2021106361A1 (en) Area registration system
JP7110088B2 (en) Driving support device, work vehicle equipped with driving support device, and driving support method

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190626

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20200626

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200818

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20201015

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20201216

R150 Certificate of patent or registration of utility model

Ref document number: 6812303

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150