JP6812303B2 - Satellite positioning system for autonomous driving vehicles - Google Patents

Satellite positioning system for autonomous driving vehicles Download PDF

Info

Publication number
JP6812303B2
JP6812303B2 JP2017105910A JP2017105910A JP6812303B2 JP 6812303 B2 JP6812303 B2 JP 6812303B2 JP 2017105910 A JP2017105910 A JP 2017105910A JP 2017105910 A JP2017105910 A JP 2017105910A JP 6812303 B2 JP6812303 B2 JP 6812303B2
Authority
JP
Japan
Prior art keywords
unit
satellite positioning
setting
base station
position coordinates
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
JP2017105910A
Other languages
Japanese (ja)
Other versions
JP2018200274A (en
Inventor
敦 新海
敦 新海
めぐみ 鈴川
めぐみ 鈴川
孝文 森下
孝文 森下
幸太郎 山口
幸太郎 山口
和央 阪口
和央 阪口
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Kubota Corp
Original Assignee
Kubota Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Kubota Corp filed Critical Kubota Corp
Priority to 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

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 comprises an in-vehicle satellite positioning unit. The satellite positioning base station unit is installed near 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 used to calculate the own vehicle position of the automatic traveling work 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), which measures the position of the vehicle on the earth based on the received information of radio waves from multiple satellites, and belongs to the ground. It is composed of a base station unit installed at a predetermined position of the above and an in-vehicle positioning unit mounted on a moving body such as a vehicle. This system is a method in which correction data sent 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 as compared with 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 of applying RTK-GPS to an automatic traveling work vehicle is disclosed in, for example, Patent Document 1. In the operation of the positioning method using RTK-GPS, a satellite positioning base station unit is installed near the work site to which the automatic traveling work vehicle travels. When this self-driving work vehicle works at the next work site far away, the satellite positioning base station unit is removed, transported to the next work site, and installed in the appropriate place.

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

この衛星測位基地局ユニットは、所定位置に設置された後、起動されると、自動で設置位置の座標を算出する自動位置座標算出機能、及び、外部からの操作(無線操作を含む)による手動位置座標算出機能を備えている。自動位置座標算出機能によって算出された位置座標が正確でないとみなされると、この衛星測位基地局ユニットを利用する車載測位ユニット側からの操作で、自動で設定された位置座標が書き換えられる。この位置座標の書き換え前に、この衛星測位基地局ユニットを利用する別の車両が、それまでに設定されていた位置座標に基づいて算出された補正データを用いて自車位置を算出し、この自車位置と走行経路とを用いて自動走行している可能性がある。そのような場合、外部操作(衛星測位基地局ユニット以外からの無線等による操作)により衛星測位基地局ユニットの位置座標が書き換えられると、それ以前とそれ以後の自車位置の算出結果に矛盾が生じ、この車両(位置座標の書き換えを行っている車両とは異なる車両)の正常な自動走行ができなくなってしまう。また、一方の車両が衛星測位基地局ユニットの位置座標を書き換えている途中で、他方の車両も衛星測位基地局ユニットの位置座標の書き換えを行えば、手動位置座標算出機能がエラーを生じる可能性もある。 This satellite positioning base station unit has an automatic position coordinate calculation function that automatically calculates the coordinates of the installation position when it is started after being installed at a predetermined position, and a manual operation (including wireless operation) from the outside. It has a position coordinate calculation function. If the position coordinates calculated by the automatic position coordinate calculation function are deemed to be inaccurate, the position coordinates automatically set are rewritten by the operation from the in-vehicle positioning unit side using this satellite positioning base station unit. Before rewriting the position coordinates, 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 up to that point, and this There is a possibility that the vehicle is automatically traveling using the vehicle position and the travel 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 etc. from other than the satellite positioning base station unit), there is a contradiction in the calculation result of the own vehicle position before and after that. As a result, this vehicle (a vehicle different from the vehicle whose position coordinates are being rewritten) cannot normally run automatically. Also, if one vehicle rewrites the position coordinates of the satellite positioning base station unit while the other vehicle also rewrites 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 such a rewritten state of the position coordinates. There is a demand for technology that can be used.

本発明による、自動走行作業車両のための衛星測位システムは、設置された位置を示すパラメータである位置座標と衛星からの電波とに基づいて生成された補正データを送信する衛星測位基地局ユニットと、前記衛星からの電波と前記補正データとを用いて測位データを算出する車載衛星測位ユニットと、無線通信を用いて前記衛星測位基地局ユニットの前記位置座標を外部から設定する位置座標設定部と、設定状態送信部及び設定状態受信部を有する設定状態管理モジュールとを備え、前記自動走行作業車両のそれぞれに、前記車載衛星測位ユニットと前記位置座標設定部と前記設定状態管理モジュールとが搭載され、前記設定状態送信部は前記位置座標設定部によって設定された前記衛星測位基地局ユニットにおける前記位置座標の設定状態を他の前記自動走行作業車両に送信し、前記設定状態受信部は他の前記自動走行作業車両の前記設定状態管理モジュールの前記設定状態送信部から送信されてきた前記設定状態を受信し、前記設定状態が複数台の前記自動走行作業車両によって共用されるように構成されている。 The satellite positioning system for an automatic traveling work vehicle according to the present invention includes a satellite positioning base station unit that transmits correction data generated based on position coordinates, which are parameters indicating an 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, 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 is provided, and the in- vehicle satellite positioning unit, the position coordinate setting unit, and the setting state management module are mounted on each of the automatic traveling work vehicles. , The setting state transmitting unit transmits the setting state of the position coordinates in the satellite positioning base station unit set by the position coordinate setting unit to the other automatic traveling work vehicle, and the setting state receiving unit is the other said. receiving the setting state transmitted from the setting status transmission unit of the setting state management module of the automatic traveling working vehicle, wherein the setting condition is configured so that is shared by a plurality of said automatic traveling working vehicle ..

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

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

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

本発明の好適な実施形態の1つでは、前記衛星測位基地局ユニットは複数台の前記自動走行作業車両によって共用され、当該自動走行作業車両のそれぞれが、制御ユニット及び前記制御ユニットに接続される汎用端末装置を備え、かつ、前記汎用端末装置が前記位置座標設定部と前記パラメータ設定状態通知部とを有し、前記汎用端末装置同士の間で、前記設定状態が無線通信を通じて共有される。この構成では、各自動走行作業車両に備えられた汎用端末装置が、それぞれデータ交換可能に接続されている(ペアリング状態)ので、汎用端末装置により、衛星測位基地局ユニットの位置座標の設定状態を取得や位置座標の変更が可能となる。したがって、各自動走行作業車両に搭載されている車載衛星測位ユニットには手を加える必要がないので、従来の車載衛星測位ユニットがそのまま流用される。 In one of the preferred embodiments 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. The general-purpose terminal device is provided, and the general-purpose terminal device has 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, the general-purpose terminal devices provided in each automatic traveling work vehicle are connected so that data can be exchanged (pairing state). Therefore, the general-purpose terminal device is used to set the position coordinates of the satellite positioning base station unit. Can be obtained and the position coordinates can be changed. Therefore, since it is not necessary to modify the in-vehicle satellite positioning unit mounted on each automatic traveling work vehicle, the conventional in-vehicle satellite positioning unit can be used as it is.

2台のトラクタによる協調作業の様子を示す説明図である。It is explanatory drawing which shows the state of the cooperative work by two tractors. 2台のトラクタによる協調作業走行時の互いの関係を示す説明図である。It is explanatory drawing which shows the mutual relationship at the time of cooperative work running by two tractors. 協調走行する作業車の側面図である。It is a side view of the work vehicle which runs cooperatively. 衛星測位システムとトラクタの制御系の機能ブロック図である。It is a functional block diagram of the control system of a satellite positioning system and a tractor. 衛星測位基地局と汎用端末装置の基地局管理モジュールとの間のデータの流れを示す模式図である。It is a schematic diagram which shows the flow of data between a satellite positioning base station and a base station management module of a general-purpose terminal apparatus. 衛星測位基地局ユニットの初期化処理における位置座標設定のタイムチャートの一例を示す説明図である。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, embodiments of a satellite positioning system for an autonomous driving vehicle according to the present invention will be described with reference to the drawings. In this embodiment, two tractors equipped with a tilling device at the rear of the traveling vehicle body use a satellite positioning system as an automatic traveling work vehicle. The two tractors work together to cultivate the field, which is the work area.

この協調耕耘作業では、図1と図2に示すように、2台のトラクタのうち、符号「A」を付与されたトラクタが先行して走行し、符号「B」を付与されたトラクタが、先行するトラクタによって耕耘された領域に対してわずかなオーバーラップ幅をもって、追従走行する。圃場での耕耘作業では、一般に、圃場の中央側に位置する中央作業地CLと、その中央作業地CLの周囲で畦に沿って規定される枕地HLとに区分けされる。各トラクタは、中央作業地CLにおいて予め設定された目標走行経路に沿って直進走行し、枕地HLに達するとUターン走行し、再び中央作業地CLでの直進走行に戻る。なお、2台のトタクタは、設定された目標走行経路に沿って自動走行可能であるが、2台のトラクタのうちのいずれか一方に運転者が乗り込んで手動走行され、他方が自動走行される作業方法と、2台のトラクタの両方が自動走行される作業方法が可能である。また、自動走行されるトラクタには、監視目的で監視者が乗り込むこともある。さらに一般的には、農道から圃場の所定位置(自動走行開始点)までは、運転者が乗り込んで、手動走行される。手動走行と自動走行とにかかわらず、各トラクタの自車位置は、衛星測位システムを用いて算出されるので、圃場における現在位置と目標走行経路や目標地点との間の偏差は、正確に求められる。 In this cooperative tillage work, as shown in FIGS. 1 and 2, of the two tractors, the tractor assigned the symbol "A" runs first, and the tractor assigned the symbol "B" is assigned. It follows the area cultivated by the preceding tractor with a slight overlap width. In the field tilling work, it is generally divided into a central work area CL located on the central side of the field and a headland HL defined along the ridge around the central work area CL. Each tractor travels straight along a preset target travel route at the central work area CL, makes a U-turn when it reaches the headland HL, and returns to straight travel at the central work area CL. The two tractors can automatically travel along the set target travel route, but the driver gets into one of the two tractors and manually travels, and the other automatically travels. A work method and a work method in which both of the two tractors are automatically driven are possible. In addition, an observer may board the automatically traveling tractor for the purpose of monitoring. More generally, the driver gets in and manually drives from the farm road to a predetermined position (automatic driving start point) of 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 in the field and the target driving route or target point can be accurately calculated. Be 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 control portion 20 at the center of a vehicle body 10 supported by front wheels 11 and rear wheels 12. The rear part of the vehicle body 10 is equipped with a rotary type tilling device 30 as a working device via a hydraulic elevating mechanism 31. The front wheels 11 function as steering wheels, and the traveling direction of the tractor is changed by changing the steering angle by the steering mechanism 13. The steering mechanism 13 includes a steering motor 14 for automatic steering. In manual driving, the front wheels 11 are steered by using the steering wheel 22 arranged in the control unit 20. In this embodiment, the control unit 20 is equipped with a general-purpose terminal device 6 configured by a tablet computer in a cradle installed in the control seat. This general-purpose terminal device 6 has a wireless data transmission function, and even if it is removed from the cradle and taken out of the tractor, data communication with the control system of the tractor is possible. 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 adopts the RTK-GPS method in the GNSS (global navigation satellite system), the satellite positioning base station unit 9B and the vehicle are mounted as basic components. It is equipped with a satellite positioning unit 9A. The satellite positioning base station unit 9B is installed near the field and transmits correction data generated based on the position coordinates, which are parameters indicating the installed position, and the radio waves from the satellite AS to the in-vehicle satellite positioning unit 9A. .. The in-vehicle satellite positioning unit 9A is mounted on the tractor, and a satellite antenna for receiving GNSS signals (including GPS signals) is attached to the ceiling area of the totactor cabin 21. In addition, in order to complement satellite navigation using a satellite positioning system, it is also possible to combine an in-vehicle satellite positioning unit 9A with an inertial navigation module incorporating a gyro acceleration sensor and a magnetic compass 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 configured to be portable and can be installed at any location on the ground. With this configuration, it is not necessary to install the satellite positioning base station unit 9B in each of the plurality of fields, and one satellite positioning base station unit 9B is transported and installed in each field by a carrier or the like. To. A plurality of in-vehicle satellite positioning units 9A can share one satellite positioning base station unit 9B. Further, when a plurality of fields to be worked on are adjacent to each other, one satellite positioning base station unit 9B is installed at a place capable of communicating with the in-vehicle satellite positioning unit 9A of the tractor traveling in each field.

このため、作業対象となる圃場の地図データに、当該圃場に対応する衛星測位基地局ユニット9Bの適正設置位置とが対応付けられたものが、圃場情報として管理されている。しかしながら、このように持ち運び可能で地面上の任意の箇所に設置することが可能な衛星測位基地局ユニット9Bであれば、作業者が前回の設置位置と異なる位置に誤って設置するおそれがある。衛星測位基地局ユニット9Bから送信される衛星測位基地局ユニット9Bの設置位置の位置座標が、圃場情報に記述されている適正設置位置と異なれば、衛星測位基地局ユニット9Bを適正な設置位置に移動させることになる。また、衛星測位基地局ユニット9Bで算定された設置位置の位置座標に誤りがあるとみなされる場合には、後述する構成を用いて、トラクタ側から、衛星測位基地局ユニット9Bの設置位置の位置座標を書き換えることも可能である。 Therefore, the map data of the field to be worked on is associated with the proper installation position of the satellite positioning base station unit 9B corresponding to the field, which is managed as the field information. However, the satellite positioning base station unit 9B, which is portable and can be installed at an arbitrary location on the ground, may be erroneously installed by an operator at a position different from the previous installation position. If the position coordinates of the installation position of the satellite positioning base station unit 9B transmitted from the satellite positioning base station unit 9B are different from the proper installation position described in the field information, the satellite positioning base station unit 9B is set to the proper installation position. It will be moved. If it is considered that the position coordinates of the installation position calculated by the satellite positioning base station unit 9B are incorrect, the position of the installation position of the satellite positioning base station unit 9B can be determined from the tractor side by 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 the satellite positioning system and the control system of the tractor. 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 capable of operating in a plurality of communication methods is connected to the control unit 5. The wireless module 4 can also wirelessly communicate with the wireless module 4 of another tractor, and is used for data exchange between tractors. Further, the control unit 5 is connected to the general-purpose terminal device 6 and the vehicle-mounted satellite positioning unit 9A, which is a vehicle-side component of the satellite positioning system, via a vehicle-mounted LAN or the like.

衛星測位システムの地上設置される構成要素である衛星測位基地局ユニット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 equipped with a base station management module 61 that externally sets and manages various parameters of the satellite positioning base station unit 9B, particularly position coordinates indicating the installation position of the satellite positioning base station unit 9B. The 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 is also provided with the wireless module 4, it is possible to directly perform data communication 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 working device device group 72, and a notification device 73 such as a liquid crystal display. The vehicle traveling device group 71 includes control devices related to vehicle traveling, such as an engine control device, a shift control device, a braking control device, and a steering control device. In this embodiment, the working device group 72 includes a power control device such as a PTO clutch that turns on and off the power transmission to the cultivating device 30, and an elevating cylinder control device of the elevating mechanism 31 that raises and lowers the cultivating device 30. ing.

入力処理部8には、走行系検出センサ群81、作業系検出センサ群82、走行モード切替器83などが接続されている。走行モード切替器83は、自動操舵で走行する自動走行モードと、手動操舵で走行する手動操舵モードとのいずれかを選択するスイッチである。
例えば、自動操舵モードで走行中に走行モード切替器83を操作することで、手動操舵での走行に切り替えられ、手動操舵での走行中に走行モード切替器83を操作することで、自動操舵での走行に切り替えられる。走行系検出センサ群81には、エンジン回転数調整具、アクセルペダル、ブレーキペダル、ステアリングホイール22などの操作具の状態を検出するセンサが含まれている。作業系検出センサ群82には、耕耘装置30の駆動状態や姿勢を検出するセンサが含まれている。
A traveling system detection sensor group 81, a working system detection sensor group 82, a traveling mode switch 83, and the like are connected to the input processing unit 8. 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 operation can be switched to the manual steering, and by operating the travel mode switch 83 while traveling in the manual steering, the automatic steering can be performed. Can be switched to running. The traveling system detection sensor group 81 includes sensors that detect the state of operating tools such as an engine speed adjuster, an accelerator pedal, a brake pedal, and a steering wheel 22. The work system detection sensor group 82 includes sensors that detect the driving 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 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 coordinates or field coordinates) of the vehicle body 10, based on the positioning data sequentially sent from the in-vehicle satellite positioning unit 9A. The notification unit 58 generates information to be notified to the driver and the monitor, and notifies the information through the 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 equipment group 71 such as the steering motor 14. This tractor can travel in both automatic driving (automatic steering) and manual driving (manual steering). Therefore, the travel control unit 51 has a manual travel control function and an automatic travel control function. When the manual driving control function is executed, the vehicle traveling device group 71 is controlled based on the operation by the driver. When the automatic travel control function is executed, the travel control unit 51 controls the vehicle travel equipment 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 the operating equipment of the engine.

走行経路生成部55は、入力された圃場情報から、圃場の外形データを読み出し、この圃場における適正な走行経路を生成する。この走行経路は、運転者によって入力される基本的な初期パラメータに基づいて生成される。別なコンピュータで生成された走行経路をダウンロードして、利用することも可能である。いずれにしても、走行経路生成部55が得た走行経路は、メモリに展開され、自動走行における目標走行経路に利用される。もちろん、この走行経路は、手動走行であっても、トラクタが当該走行経路に沿って走行するためのガイダンスのために利用できる。 The travel route generation unit 55 reads out the outline data of the field from the input field information, and generates an appropriate travel route in this field. This travel path is generated based on the basic initial parameters entered 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 the target travel route in the 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 the directional deviation and the position deviation between the travel route set as the target travel route by the travel route generation unit 55 and the vehicle position calculated by the vehicle position calculation unit 57. , An automatic steering command for eliminating the directional deviation and the positional deviation is generated and given to the traveling control unit 51.

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

次に、図4と図5とを用いて、衛星測位基地局ユニット9Bの設置位置を示す位置座標が、汎用端末装置6の基地局管理モジュール61によって設定管理される際のデータの流れを説明する。 Next, using FIGS. 4 and 5, the data flow 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. 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 is provided with a radio module 90, a correction data generation unit 91, a parameter management unit 92, and the like. The wireless module 90 performs data communication with the in-vehicle satellite positioning unit 9A and the wireless module 4 of each tractor. The satellite positioning base station unit 9B has a function of calculating the position coordinates of the installed position based on the radio waves from the satellite AS as an initialization process when the power is turned on or reset. The position coordinates obtained by the calculation are set as the initial position coordinates by the parameter management unit 92, and are transmitted to the outside if requested. If the initial position coordinates are different from the position coordinates defined in advance as the installation position of the satellite positioning base station unit 9B more than permissible, it can be regarded as an installation error.

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

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

汎用端末装置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 has a setting state transmitting unit 64 and a setting state receiving unit 65.

位置座標設定部62は、汎用端末装置6側から、つまり各トラクタ側から、新たな位置座標を含む位置座標設定コマンドを衛星測位基地局ユニット9Bに送り、衛星測位基地局ユニット9Bで設定されている位置座標を変更設定する。この位置座標設定コマンドを生成する際には、汎用端末装置6のタッチパネル60によって具現化されるマンマシンインターフェースを用いて、各種データが入力される。 The position coordinate setting unit 62 sends a position coordinate setting command including new position coordinates 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 and set the existing position coordinates. When generating this position coordinate setting command, various data are input using the 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 the setting flag indicating the setting state, the coordinate unset flag and the coordinate set flag are defined. The coordinate unset flag indicates before and during the setting of the position coordinate in the satellite positioning base station unit 9B, and the coordinate set flag indicates the completion of setting the position coordinate. Further, the coordinate unset flag includes an initialization flag indicating that the position coordinates of the satellite positioning base station unit 9B are being initialized, and the position coordinates set at that time are given by the position coordinate setting unit 62. It contains a changing flag to indicate that it is being changed by a configuration command.

任意のトラクタの位置座標設定部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 the tractors using the base station management module 61 by wireless communication using the wireless module 4. As a result, the setting state by the position coordinate setting command from the arbitrary tractor side is shared with other tractors in substantially real time.

衛星測位基地局ユニット9Bにおける設定状態が、全てのトラクタ、詳しくは全ての汎用端末装置6によって共有されることから、任意の位置座標設定部62が位置座標の設定中または変更中である場合、他の位置座標設定部62による位置座標の設定または変更を禁止することができる。これにより、外部からの位置座標設定コマンドにより衛星測位基地局ユニット9Bの位置座標が変更されたとしても、その事実が設定フラグを通じて、全トラクタに把握されるので、自車位置算出における混乱が回避される。また、複数のトタクタから位置座標設定コマンドが衛星測位基地局ユニット9Bに与えられる不都合も回避される。 Since the setting state in the satellite positioning base station unit 9B is shared by all tractors, specifically all general-purpose terminal devices 6, when an arbitrary position coordinate setting unit 62 is setting or changing the position coordinates, It is possible to prohibit the setting or change of the position coordinates by the other position coordinate setting unit 62. As a result, even if the position coordinates of the satellite positioning base station unit 9B are changed by the position coordinate setting command from the outside, the fact is grasped by all the tractors through the setting flag, so that the confusion in the own vehicle position calculation is avoided. Will be 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, a state transition, a flag transition A, and a flag transition B are shown. The state transition indicates the initial position coordinate setting state of the satellite positioning base station unit 9B. The flag transition A shows how the content of the setting flag obtained by accessing the satellite positioning base station unit 9B by the base station management module 61 belonging to one tractor changes depending on the state transition. The flag transition B indicates the content of the setting flag in which the base station management module 61 belonging to the other tractor is transferred from the base station management module 61 belonging to one 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 place and the power is turned on, the initialization process that automatically calculates the position coordinates of the installed position is performed based on the radio waves from the satellite AS. Will be. The position coordinates obtained by this are set as the initial position coordinates.
(Flag transition A) When the base station management module 61 accesses the satellite positioning base station unit 9B, the parameter management unit 92 acquires the setting flag of the content according to the state of the satellite positioning base station unit 9B. For example, a "before initialization" flag is given corresponding to the power ON, a "initializing" flag is given corresponding to the start of initialization, and a "coordinate set" flag is given corresponding to the initial position coordinate setting. The "before initialization" flag and the "initializing" flag can be regarded as the "coordinate unset" flag.
(Flag transition B) The setting flag acquired by the base station management module 61 belonging to one tractor is 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 Transferred to. As a result, the base station management modules 61 of all the tactors can share the contents of the setting flags that change 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. In this time chart as well, the meanings of the state transition, the flag transition A, and the flag transition B are the same as those in FIG.
(State transition) The position coordinate setting command from the base station management module 61 belonging to one tractor changes the position coordinate to rewrite the position coordinate, and when the coordinate change is completed, the new position coordinate is set.
(Flag transition A) When the position coordinate setting command is transmitted to the satellite positioning base station unit 9B and the position coordinate change process is started, the base station management module 61 is given the "coordinate changing" flag. This "changing coordinates" flag is given until a new position coordinate is set, and when a new position coordinate is set, a "coordinate set" flag is given. The "coordinate set" flag is valid until the "coordinate changing" flag is given, and the "coordinate not set" flag or "coordinate not set" flag is valid from the "coordinate changing" flag to the "coordinate set" flag. The "changing" flag is considered valid.
(Flag transition B) Again, since the setting flag given to 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 the state transition. Share the contents of the changing setting flags. As a result, it is possible to prohibit the other base station management module 61 from changing the position coordinates while any of the base station management modules 61 is changing the position coordinates.

上記実施形態(別実施形態を含む、以下同じ)で開示される構成は、矛盾が生じない限り、他の実施形態で開示される構成と組み合わせて適用することが可能であり、また、本明細書において開示された実施形態は例示であって、本発明の実施形態はこれに限定されず、本発明の目的を逸脱しない範囲内で適宜改変することが可能である。 The configurations disclosed in the above embodiment (including another embodiment, the same shall apply hereinafter) can be applied in combination with the configurations disclosed in other embodiments as long as there is no contradiction, and the present specification. The embodiments disclosed in the document are examples, and the embodiments of the present invention are not limited thereto, 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 above-described embodiment, the base station management module 61 is built in the general-purpose terminal device 6, but instead, the base station management module 61 may be built 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 diagram shown in FIGS. 4 and 5 is mainly divided for the purpose of explanation. In practice, 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 a tilling device 30 as a working device is taken up as an automatic traveling work vehicle, but in addition to such a tractor, for example, agricultural work such as a rice transplanter, a fertilizer applicator, and a combine The present invention can also be applied to various work vehicles such as vehicles and construction work vehicles. Further, the plurality of automatic traveling work vehicles that perform cooperative work do not have to be the same type of work vehicle. For example, one may be a combine harvester and the other may be a tractor.

本発明は、無線端末機器との間で無線通信可能な無線通信部を備えた作業車両に適用することができる。 The present invention can be applied to a work vehicle provided with 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: Coordinated 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 status management module 64: Setting status transmission unit 65: Setting status reception unit 7: Output processing unit 8: Input processing unit 9A: In-vehicle satellite positioning unit 9B: Satellite positioning base station unit 90: Radio module 91: Correction data generation unit 92: Parameter management unit AS: Satellite (GNSS satellite)

Claims (5)

自動走行作業車両のための衛星測位システムであって、
設置された位置を示すパラメータである位置座標と衛星からの電波とに基づいて生成された補正データを送信する衛星測位基地局ユニットと、
前記衛星からの電波と前記補正データとを用いて測位データを算出する車載衛星測位ユニットと、
無線通信を用いて前記衛星測位基地局ユニットの前記位置座標を外部から設定する位置座標設定部と、
設定状態送信部及び設定状態受信部を有する設定状態管理モジュールと、を備え、
前記自動走行作業車両のそれぞれに、前記車載衛星測位ユニットと前記位置座標設定部と前記設定状態管理モジュールとが搭載され、
前記設定状態送信部は前記位置座標設定部によって設定された前記衛星測位基地局ユニットにおける前記位置座標の設定状態を他の前記自動走行作業車両に送信し、前記設定状態受信部は他の前記自動走行作業車両の前記設定状態管理モジュールの前記設定状態送信部から送信されてきた前記設定状態を受信し、前記設定状態が複数台の前記自動走行作業車両によって共用される自動走行作業車両のための衛星測位システム。
A satellite positioning system for autonomous driving vehicles
A satellite positioning base station unit that transmits correction data generated based on position coordinates, which are parameters indicating the installed position, and radio waves from satellites.
An in-vehicle 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 is provided.
The in-vehicle satellite positioning unit, the position coordinate setting unit, and the setting state management module are mounted on each of the automatic traveling work vehicles.
The setting status transmission unit transmits the setting state of the position coordinates in the satellite positioning base station unit which is set by the position coordinate setting unit to the other of said automatic traveling working vehicle, wherein the setting status receiving unit other such automatic receiving the setting state transmitted from the setting status transmission unit of the setting state management module of the traveling working vehicle, wherein the setting condition for the automatic travel working vehicle that will be shared by the plurality of the automatic traveling working vehicle Satellite positioning system.
前記設定状態を示すフラグには、前記位置座標の設定前及び設定中を示す座標未設定フラグと前記位置座標の設定完了を示す座標設定済フラグとが含まれている請求項1に記載の衛星測位システム。 The satellite according to claim 1, wherein the flag indicating the setting state includes a coordinate unset flag indicating before and during the setting of the position coordinates and a coordinate set flag indicating the completion of setting the position coordinates. Positioning system. 前記座標未設定フラグには、前記衛星測位基地局ユニットにおける前記位置座標の初期化中を示す初期化中フラグと、設定されている前記位置座標の前記位置座標設定部による変更中を示す変更中フラグが含まれている請求項2に記載の衛星測位システム。 The coordinate unset flag includes an initializing flag indicating that the position coordinates of the satellite positioning base station unit are being initialized, and a changing flag indicating that the set position coordinates are being changed by the position coordinate setting unit. The satellite positioning system according to claim 2, wherein the flag is included. 前記位置座標設定部の1つが前記位置座標の設定中または変更中である場合、他の前記位置座標設定部による前記位置座標の設定または変更は禁止される請求項3に記載の衛星測位システム。 The satellite positioning system according to claim 3, wherein when one of the position coordinate setting units is setting or changing the position coordinates, the setting or change of the position coordinates by the other 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, and each of the automatic traveling work vehicles includes a control unit and a general-purpose terminal device connected to the control unit, and
Claims 1 to 4 in which the general-purpose terminal device has the position coordinate setting unit, the setting state transmitting unit, and the setting state receiving 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 JP2018200274A (en) 2018-12-20
JP6812303B2 true 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)

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
ZA952853B (en) * 1994-04-18 1995-12-21 Caterpillar Inc Method and apparatus for real time monitoring and co-ordination of multiple geography altering machines on a work site
JP3617122B2 (en) * 1995-06-06 2005-02-02 松下電器産業株式会社 DGPS positioning device
NL1020804C2 (en) * 2002-06-06 2003-12-09 Lely Entpr Ag Method and system for performing at least two agricultural operations on an agricultural plot.
JP2004144622A (en) * 2002-10-24 2004-05-20 Kokusai Kogyo Co Ltd Monitoring system for sloped face
JP4807728B2 (en) * 2005-05-17 2011-11-02 富士重工業株式会社 Vehicle travel control device
US7400294B2 (en) * 2005-10-14 2008-07-15 Hemisphere Gps Inc. Portable reference station for local differential GPS corrections
US20080047170A1 (en) * 2006-08-24 2008-02-28 Trimble Navigation Ltd. Excavator 3D integrated laser and radio positioning guidance system
JP5028287B2 (en) * 2008-01-28 2012-09-19 株式会社日立産機システム GPS data processing device
JP2011165256A (en) * 2010-02-08 2011-08-25 Clarion Co Ltd In-vehicle information terminal
JP6291916B2 (en) * 2014-03-06 2018-03-14 三菱電機株式会社 Correction data distribution server
JP6219790B2 (en) * 2014-07-29 2017-10-25 株式会社クボタ Work vehicle coordination system
JP5878664B1 (en) * 2015-06-11 2016-03-08 株式会社岩崎 Ground surveying device, ground surveying system, ground surveying program, and ground surveying method
JP6749256B2 (en) * 2017-01-20 2020-09-02 株式会社クボタ Work vehicle position measuring device

Also Published As

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

Similar Documents

Publication Publication Date Title
JP6749256B2 (en) Work vehicle position measuring device
KR102287412B1 (en) Parallel travel work system
JP6594805B2 (en) Work vehicle
JP6592367B2 (en) Agricultural work vehicle
JP6550617B2 (en) Agricultural work vehicle
WO2019111563A1 (en) Traveling route setting device
JP7069364B2 (en) Work vehicle
CN110430746A (en) The autonomous driving system of agricultural operation vehicle
JP2019096363A (en) Travel area specification device
EP3970462A1 (en) Autonomous travel system
JP6879896B2 (en) Satellite positioning system for work platforms
JP2019170197A (en) Region registration system
JP7083001B2 (en) Autonomous driving system
EP3410247A1 (en) Master work vehicle performing work in cooperation with slave work vehicle
JP6980087B2 (en) Satellite positioning system for self-driving work vehicles
WO2020158295A1 (en) Target route generation system for work vehicle
JP6812303B2 (en) Satellite positioning system for autonomous driving vehicles
JP7387809B2 (en) Automatic driving support device, work vehicle, and automatic driving method for work vehicle
JP2020194253A (en) Obstacle determination system and autonomous travelling system
JP2020099225A (en) Travelling working machine
WO2021125124A1 (en) Work machine
JP6886626B2 (en) Travel area registration system for work vehicles
JP6815971B2 (en) Work management system
US20220147046A1 (en) Autonomous Traveling System
JP6618056B2 (en) Work system

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190626

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 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