JPH10243708A - 作業車の走行経路作成装置及び走行制御装置 - Google Patents
作業車の走行経路作成装置及び走行制御装置Info
- Publication number
- JPH10243708A JPH10243708A JP9047631A JP4763197A JPH10243708A JP H10243708 A JPH10243708 A JP H10243708A JP 9047631 A JP9047631 A JP 9047631A JP 4763197 A JP4763197 A JP 4763197A JP H10243708 A JPH10243708 A JP H10243708A
- Authority
- JP
- Japan
- Prior art keywords
- work
- traveling
- vehicle
- vehicle body
- travel
- 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
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0219—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Guiding Agricultural Machines (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
(57)【要約】
【課題】 傾斜した作業地内において作業車が作業走行
する場合にも、例えば隣接する作業経路の境界付近に未
作業領域を生じさせない状態で適正な作業ができるよう
に予定走行経路を設定し、又、その作成した走行経路デ
ータを用いて作業車を適正な作業状態で自動走行させ
る。 【解決手段】 作業車が走行車体に備えた所定作業幅の
作業部にて作業しながら走行する作業地Ｆの３次元形状
が計測され、その作業地Ｆの３次元形状計測情報に基づ
いて、作業車を作業地Ｆ内において走行させるための予
定走行経路Ｌのデータが作成され、又、作業車がその予
定走行経路Ｌに沿って自動走行するように制御される。
する場合にも、例えば隣接する作業経路の境界付近に未
作業領域を生じさせない状態で適正な作業ができるよう
に予定走行経路を設定し、又、その作成した走行経路デ
ータを用いて作業車を適正な作業状態で自動走行させ
る。 【解決手段】 作業車が走行車体に備えた所定作業幅の
作業部にて作業しながら走行する作業地Ｆの３次元形状
が計測され、その作業地Ｆの３次元形状計測情報に基づ
いて、作業車を作業地Ｆ内において走行させるための予
定走行経路Ｌのデータが作成され、又、作業車がその予
定走行経路Ｌに沿って自動走行するように制御される。
Description
【０００１】
【発明の属する技術分野】本発明は、作業車の走行経路
作成装置、及び、その作成された予定走行経路に沿って
作業車を自動走行させるための走行制御装置に関する。
作成装置、及び、その作成された予定走行経路に沿って
作業車を自動走行させるための走行制御装置に関する。
【０００２】
【従来の技術】例えば肥料用の薬剤を散布する薬剤散布
装置を備えた作業車を圃場等の作業地内で自動走行させ
る場合には、従来は、対象作業地内において薬剤散布装
置の作業幅（薬剤散布幅）に対応する経路幅で複数の作
業経路が隣接して並ぶように予定走行経路を設定して、
例えば、作業幅の中心が経路横幅方向の中心線上を通過
するように操向操作して各作業経路に沿って走行させて
いた。
装置を備えた作業車を圃場等の作業地内で自動走行させ
る場合には、従来は、対象作業地内において薬剤散布装
置の作業幅（薬剤散布幅）に対応する経路幅で複数の作
業経路が隣接して並ぶように予定走行経路を設定して、
例えば、作業幅の中心が経路横幅方向の中心線上を通過
するように操向操作して各作業経路に沿って走行させて
いた。
【０００３】
【発明が解決しようとする課題】しかし、従来では、作
業地を平面視状態で見て経路設定を行っているので、作
業地内で高低差が無く水平状態とみなせる場合には問題
はないが、例えば、作業地が全体として傾斜しているよ
うな場合には、図１１に示すように、実際の作業地表面
に沿っての作業経路の幅ＳＨが平面視での経路幅ｈより
も長くなるので、実際に傾斜した作業経路に対して作業
するときに、作業部ＳＢの作業幅ｈが実際に作業すべき
作業経路の幅ＳＨよりも短い状態で作業することがあ
り、その結果、隣接する作業経路同士の境界部分に未作
業領域が生じるおそれがあった。
業地を平面視状態で見て経路設定を行っているので、作
業地内で高低差が無く水平状態とみなせる場合には問題
はないが、例えば、作業地が全体として傾斜しているよ
うな場合には、図１１に示すように、実際の作業地表面
に沿っての作業経路の幅ＳＨが平面視での経路幅ｈより
も長くなるので、実際に傾斜した作業経路に対して作業
するときに、作業部ＳＢの作業幅ｈが実際に作業すべき
作業経路の幅ＳＨよりも短い状態で作業することがあ
り、その結果、隣接する作業経路同士の境界部分に未作
業領域が生じるおそれがあった。
【０００４】本発明は、上記実情に鑑みてなされたもの
であって、その目的は、上記従来技術の不具合を解消さ
せるべく、傾斜した作業地内において作業車が作業走行
する場合にも、例えば隣接する作業経路の境界付近に未
作業領域を生じさせない状態で適正な作業ができるよう
に予定走行経路を設定する走行経路作成装置、及び、そ
の作成した走行経路データを用いて作業車を適正な状態
で作業走行させる走行制御装置を得ることにある。
であって、その目的は、上記従来技術の不具合を解消さ
せるべく、傾斜した作業地内において作業車が作業走行
する場合にも、例えば隣接する作業経路の境界付近に未
作業領域を生じさせない状態で適正な作業ができるよう
に予定走行経路を設定する走行経路作成装置、及び、そ
の作成した走行経路データを用いて作業車を適正な状態
で作業走行させる走行制御装置を得ることにある。
【０００５】
【課題を解決するための手段】請求項１では、作業車が
走行車体に備えた所定作業幅の作業部にて作業しながら
走行する作業地の３次元形状が計測され、その作業地の
３次元形状計測情報に基づいて、作業車を前記作業地内
において走行させるための予定走行経路のデータが作成
される。
走行車体に備えた所定作業幅の作業部にて作業しながら
走行する作業地の３次元形状が計測され、その作業地の
３次元形状計測情報に基づいて、作業車を前記作業地内
において走行させるための予定走行経路のデータが作成
される。
【０００６】従って、作業地の３次元形状計測情報に基
づいて例えば作業地全体での傾斜状態を判別し、その傾
斜した作業地表面での作業部の作業幅が平面視での幅よ
りも短くなる点を考慮して、作業車の予定走行経路を設
定することができるので、従来のように単純に平面視状
態で作業地内に作業部の作業幅に基づいて各作業経路を
設定した場合には、作業地上で作業すべき幅に対して実
際の作業幅が短くなって、隣接する作業経路の境界部分
に未作業領域が生じるというような不都合を的確に防止
して適正な作業を行うことができる走行経路作成装置が
得られる。
づいて例えば作業地全体での傾斜状態を判別し、その傾
斜した作業地表面での作業部の作業幅が平面視での幅よ
りも短くなる点を考慮して、作業車の予定走行経路を設
定することができるので、従来のように単純に平面視状
態で作業地内に作業部の作業幅に基づいて各作業経路を
設定した場合には、作業地上で作業すべき幅に対して実
際の作業幅が短くなって、隣接する作業経路の境界部分
に未作業領域が生じるというような不都合を的確に防止
して適正な作業を行うことができる走行経路作成装置が
得られる。
【０００７】請求項２によれば、請求項１において、予
定走行経路として、作業地内に平行状態で設定間隔を隔
てて隣接して並ぶ複数の作業経路が形成される。
定走行経路として、作業地内に平行状態で設定間隔を隔
てて隣接して並ぶ複数の作業経路が形成される。
【０００８】従って、例えば作業地の長手方向に沿って
平行状態で並ぶ複数の作業経路を設定することができる
ので、例えば、作業車を各作業経路に沿って往復走行さ
せることによって、作業地の全体に亘って効率よく作業
走行させることができ、もって、上記請求項１の走行経
路作成装置の好適な手段が得られる。
平行状態で並ぶ複数の作業経路を設定することができる
ので、例えば、作業車を各作業経路に沿って往復走行さ
せることによって、作業地の全体に亘って効率よく作業
走行させることができ、もって、上記請求項１の走行経
路作成装置の好適な手段が得られる。
【０００９】請求項３によれば、請求項１又は２におい
て、作業地の周縁部における複数設定箇所の３次元位置
情報に基づいて、作業地の３次元形状が計測される。
て、作業地の周縁部における複数設定箇所の３次元位置
情報に基づいて、作業地の３次元形状が計測される。
【００１０】従って、例えば、作業地表面が平面であっ
て一定の傾斜角で所定方向に傾斜しているような場合
に、作業地内部での位置情報を要することなく、測量等
によって位置が判っている作業地周縁部の複数設定箇所
での３次元位置情報に基づいて、作業地全体の３次元形
状を的確に判断することができ、もって、上記請求項１
又は２の走行経路作成装置の好適な手段が得られる。
て一定の傾斜角で所定方向に傾斜しているような場合
に、作業地内部での位置情報を要することなく、測量等
によって位置が判っている作業地周縁部の複数設定箇所
での３次元位置情報に基づいて、作業地全体の３次元形
状を的確に判断することができ、もって、上記請求項１
又は２の走行経路作成装置の好適な手段が得られる。
【００１１】請求項４によれば、請求項３において、多
角形状の作業地の各角部を、作業地の周縁部における複
数設定箇所として、その各角部での３次元位置情報に基
づいて、作業地の３次元形状が計測される。
角形状の作業地の各角部を、作業地の周縁部における複
数設定箇所として、その各角部での３次元位置情報に基
づいて、作業地の３次元形状が計測される。
【００１２】従って、通常最も多い多角形状の作業地に
対して、必要最小数の箇所での３次元位置情報に基づい
て作業地の３次元形状を的確に判断することができ、も
って、上記請求項３の走行経路作成装置の好適な手段が
得られる。
対して、必要最小数の箇所での３次元位置情報に基づい
て作業地の３次元形状を的確に判断することができ、も
って、上記請求項３の走行経路作成装置の好適な手段が
得られる。
【００１３】請求項５によれば、請求項３又は４におい
て、走行車体が作業地の周縁部における設定箇所に位置
したときの走行車体の３次元位置が検出され、その走行
車体の３次元位置情報に基づいて作業地の３次元形状が
計測される。
て、走行車体が作業地の周縁部における設定箇所に位置
したときの走行車体の３次元位置が検出され、その走行
車体の３次元位置情報に基づいて作業地の３次元形状が
計測される。
【００１４】従って、予め測量等による３次元位置情報
が得られていない作業地についても、作業走行させる前
に走行車体を作業地の周縁部の設定箇所に位置させて、
作業地の３次元形状を的確に判断することができ、もっ
て、上記請求項３又は４の走行経路作成装置の好適な手
段が得られる。
が得られていない作業地についても、作業走行させる前
に走行車体を作業地の周縁部の設定箇所に位置させて、
作業地の３次元形状を的確に判断することができ、もっ
て、上記請求項３又は４の走行経路作成装置の好適な手
段が得られる。
【００１５】請求項６によれば、請求項５において、地
上側の基準位置において、ＧＰＳ衛星からの搬送波信号
がＧＰＳ基準局で受信され、そのＧＰＳ基準局での搬送
波位相情報が基準側通信手段から車体側に向けて送信さ
れる一方、走行車体において、ＧＰＳ移動局が受信した
ＧＰＳ衛星からの搬送波信号及び上記基準側通信手段の
送信情報を受信した車体側通信手段が受信したＧＰＳ基
準局での搬送波位相情報から求めた二重位相差情報に基
づいて、走行車体の３次元位置が時系列的なＧＰＳ位置
データとして求められる。
上側の基準位置において、ＧＰＳ衛星からの搬送波信号
がＧＰＳ基準局で受信され、そのＧＰＳ基準局での搬送
波位相情報が基準側通信手段から車体側に向けて送信さ
れる一方、走行車体において、ＧＰＳ移動局が受信した
ＧＰＳ衛星からの搬送波信号及び上記基準側通信手段の
送信情報を受信した車体側通信手段が受信したＧＰＳ基
準局での搬送波位相情報から求めた二重位相差情報に基
づいて、走行車体の３次元位置が時系列的なＧＰＳ位置
データとして求められる。
【００１６】従って、ＧＰＳ衛星からの搬送波信号の二
重位相差情報に基づく正確な位置の検出によって、走行
車体の３次元位置を時系列的な位置データとして正確に
求め、このＧＰＳ位置データを用いて、作業地の３次元
形状を的確に判断することができ、もって、上記請求項
５の走行経路作成装置の好適な手段が得られる。
重位相差情報に基づく正確な位置の検出によって、走行
車体の３次元位置を時系列的な位置データとして正確に
求め、このＧＰＳ位置データを用いて、作業地の３次元
形状を的確に判断することができ、もって、上記請求項
５の走行経路作成装置の好適な手段が得られる。
【００１７】請求項７によれば、請求項１〜６のいずれ
か１項に記載の作業車の走行経路作成装置によって作成
された予定走行経路のデータに基づいて、作業車が予定
走行経路に沿って自動走行するように制御される。
か１項に記載の作業車の走行経路作成装置によって作成
された予定走行経路のデータに基づいて、作業車が予定
走行経路に沿って自動走行するように制御される。
【００１８】従って、例えば作業者が画面表示された走
行経路を見て手動操縦する場合の負担増を回避しなが
ら、傾斜等した作業地に対して適切に走行経路を設定し
て隣接する作業経路の境界部分に未作業領域が生じるよ
うな不都合を防止して適正な作業状態で自動走行させる
ことができる作業車の走行制御装置が得られる。
行経路を見て手動操縦する場合の負担増を回避しなが
ら、傾斜等した作業地に対して適切に走行経路を設定し
て隣接する作業経路の境界部分に未作業領域が生じるよ
うな不都合を防止して適正な作業状態で自動走行させる
ことができる作業車の走行制御装置が得られる。
【００１９】請求項８によれば、請求項７において、作
業地内での作業車の走行車体の３次元位置が検出され、
その走行車体の位置検出情報に基づいて作業車が予定走
行経路に沿って自動走行するように制御される。
業地内での作業車の走行車体の３次元位置が検出され、
その走行車体の位置検出情報に基づいて作業車が予定走
行経路に沿って自動走行するように制御される。
【００２０】従って、例えば、走行車体の３次元位置検
出情報から予定走行経路の経路横方向の適正操向位置に
対する偏位を判断して、その偏位を零にするように適切
な操向状態で自動走行させることができ、もって、上記
請求項７の作業車の走行制御装置の好適な手段が得られ
る。
出情報から予定走行経路の経路横方向の適正操向位置に
対する偏位を判断して、その偏位を零にするように適切
な操向状態で自動走行させることができ、もって、上記
請求項７の作業車の走行制御装置の好適な手段が得られ
る。
【００２１】
【発明の実施の形態】以下、本発明の実施形態につい
て、薬剤散布用の作業車Ｖが、矩形状の作業地（圃場
Ｆ）内を自動走行しながら肥料である薬剤の散布作業を
行う場合について図面に基づいて説明する。
て、薬剤散布用の作業車Ｖが、矩形状の作業地（圃場
Ｆ）内を自動走行しながら肥料である薬剤の散布作業を
行う場合について図面に基づいて説明する。
【００２２】図２に示すように、例えばその地点の重力
方向に対して水平方向を東西及び南北方向で表した局地
水平座標系Ｅ（東方向），Ｎ（北方向），Ｈ（地球中心
からの高さ方向）において高精度に位置（上記座標系
Ｅ，Ｎ，Ｈでの座標値）が判っている地上側の基準位置
に設置されて、少なくとも４個のＧＰＳ衛星２からのス
ペクトラム拡散変調された搬送波信号を受信するＧＰＳ
基準局Ｒ（以後、単に基準局Ｒともいう）用のアンテナ
１９ａと、そのアンテナ１９ａの受信信号を処理して搬
送波の位相情報を得るＧＰＳ受信機１９と、そのＧＰＳ
受信機１９からのＧＰＳ基準局での搬送波位相情報を送
信する送信アンテナ２０ａを備えた地上側のデータ送受
信機２０とが設けられている。
方向に対して水平方向を東西及び南北方向で表した局地
水平座標系Ｅ（東方向），Ｎ（北方向），Ｈ（地球中心
からの高さ方向）において高精度に位置（上記座標系
Ｅ，Ｎ，Ｈでの座標値）が判っている地上側の基準位置
に設置されて、少なくとも４個のＧＰＳ衛星２からのス
ペクトラム拡散変調された搬送波信号を受信するＧＰＳ
基準局Ｒ（以後、単に基準局Ｒともいう）用のアンテナ
１９ａと、そのアンテナ１９ａの受信信号を処理して搬
送波の位相情報を得るＧＰＳ受信機１９と、そのＧＰＳ
受信機１９からのＧＰＳ基準局での搬送波位相情報を送
信する送信アンテナ２０ａを備えた地上側のデータ送受
信機２０とが設けられている。
【００２３】一方、作業車Ｖには、ＧＰＳ衛星２からの
搬送波信号を受信するＧＰＳ受信アンテナ１７ａと、そ
のＧＰＳ受信アンテナ１７ａの受信信号を処理して搬送
波位相情報を得るＧＰＳ受信機１７と、地上側の送受信
機２０の送信情報（基準局Ｒでの搬送波位相情報）を受
信するデータ受信アンテナ１８ａを備えたデータ送受信
機１８とが設けられて、ＧＰＳ移動局Ｉ（以後、単に移
動局Ｉともいう）が構成されている。
搬送波信号を受信するＧＰＳ受信アンテナ１７ａと、そ
のＧＰＳ受信アンテナ１７ａの受信信号を処理して搬送
波位相情報を得るＧＰＳ受信機１７と、地上側の送受信
機２０の送信情報（基準局Ｒでの搬送波位相情報）を受
信するデータ受信アンテナ１８ａを備えたデータ送受信
機１８とが設けられて、ＧＰＳ移動局Ｉ（以後、単に移
動局Ｉともいう）が構成されている。
【００２４】前記基準局Ｒ及び移動局Ｉの各ＧＰＳ受信
機１９，１７は、図４に示すように、ほぼ同様の構成に
なるものであって、夫々のＧＰＳ受信アンテナ１９ａ，
１７ａで受信した電波信号は、先ず高周波信号処理部３
０，４０に入力して低周波数に変換される。その低周波
数変換された信号は、Ｃ／Ａコード解析部３１，４１に
て衛星番号等が解読されるとともに、搬送波位相計測部
３３，４３において、上記衛星番号に応じて作成される
Ｃ／Ａコードと相関をとって搬送波が再生され、さらに
内蔵した時計３４，４４にて設定時間間隔で搬送波の位
相が計測される。同時に、Ｃ／Ａコード解析部３１，４
１からの情報に基づいて、航路メッセージ解読部３２，
４２にて衛星位置情報等が判別される。そして、上記各
部からの情報は、夫々の制御用のコンピュータ３５，４
５に入力されて各基準局Ｒ及び移動局Ｉにおける搬送波
位相情報が求められる。
機１９，１７は、図４に示すように、ほぼ同様の構成に
なるものであって、夫々のＧＰＳ受信アンテナ１９ａ，
１７ａで受信した電波信号は、先ず高周波信号処理部３
０，４０に入力して低周波数に変換される。その低周波
数変換された信号は、Ｃ／Ａコード解析部３１，４１に
て衛星番号等が解読されるとともに、搬送波位相計測部
３３，４３において、上記衛星番号に応じて作成される
Ｃ／Ａコードと相関をとって搬送波が再生され、さらに
内蔵した時計３４，４４にて設定時間間隔で搬送波の位
相が計測される。同時に、Ｃ／Ａコード解析部３１，４
１からの情報に基づいて、航路メッセージ解読部３２，
４２にて衛星位置情報等が判別される。そして、上記各
部からの情報は、夫々の制御用のコンピュータ３５，４
５に入力されて各基準局Ｒ及び移動局Ｉにおける搬送波
位相情報が求められる。
【００２５】さらに、基準局Ｒ側コンピュータ３５から
出力された基準局Ｒでの搬送波位相情報が、地上側の送
受信機２０を経て送信アンテナ２０ａから送信されて作
業車Ｖ側のアンテナ１８ａで受信され、送受信機１８を
経て移動局Ｉ側のコンピュータ４５に入力される。そし
て、その移動局Ｉ側コンピュータ４５によって、移動局
Ｉでの搬送波位相情報及び上記受信した基準局Ｒでの搬
送波位相情報から二重位相差情報を求め、その二重位相
差情報に基づいて、基準局Ｒに対する移動局Ｉつまり作
業車Ｖの走行車体５の３次元位置を所定時間間隔の時系
列的なＧＰＳ位置データとして求めるＧＰＳ位置データ
算出手段４５が構成されている。
出力された基準局Ｒでの搬送波位相情報が、地上側の送
受信機２０を経て送信アンテナ２０ａから送信されて作
業車Ｖ側のアンテナ１８ａで受信され、送受信機１８を
経て移動局Ｉ側のコンピュータ４５に入力される。そし
て、その移動局Ｉ側コンピュータ４５によって、移動局
Ｉでの搬送波位相情報及び上記受信した基準局Ｒでの搬
送波位相情報から二重位相差情報を求め、その二重位相
差情報に基づいて、基準局Ｒに対する移動局Ｉつまり作
業車Ｖの走行車体５の３次元位置を所定時間間隔の時系
列的なＧＰＳ位置データとして求めるＧＰＳ位置データ
算出手段４５が構成されている。
【００２６】ここで、二重位相差情報について概略を説
明すると、異なる２つの衛星２からの各搬送波信号を２
つの受信局（基準局Ｒ及び移動局Ｉ）夫々で受信して、
各衛星２ごとに対応する２つの位相差を求め、さらにこ
れら２つの位相差の差分をとったものを二重位相差と呼
ぶ。これによって各衛星２での送信信号の位相乱れの影
響が除去されるとともに、各受信局の位相計測用の時計
の同期ずれの影響が除去され、最終的に、衛星側及び受
信局側での誤差の影響を少なくした精度のよい位相差情
報が得られる。尚、基準局Ｒに対する移動局Ｉの位置ベ
クトルｒ（図５参照）を求めるために、実際は、異なる
４つの衛星２からの各搬送波信号に基づいて、独立した
３つの二重位相差が求められることになる。
明すると、異なる２つの衛星２からの各搬送波信号を２
つの受信局（基準局Ｒ及び移動局Ｉ）夫々で受信して、
各衛星２ごとに対応する２つの位相差を求め、さらにこ
れら２つの位相差の差分をとったものを二重位相差と呼
ぶ。これによって各衛星２での送信信号の位相乱れの影
響が除去されるとともに、各受信局の位相計測用の時計
の同期ずれの影響が除去され、最終的に、衛星側及び受
信局側での誤差の影響を少なくした精度のよい位相差情
報が得られる。尚、基準局Ｒに対する移動局Ｉの位置ベ
クトルｒ（図５参照）を求めるために、実際は、異なる
４つの衛星２からの各搬送波信号に基づいて、独立した
３つの二重位相差が求められることになる。
【００２７】前記３つの二重位相差情報に基づく走行車
体５の位置検出について具体的に説明する。先ず最初
に、作業車Ｖを局地水平座標系Ｅ，Ｎ，Ｈにおいて高精
度に位置が判っている地点に位置させ、移動局Ｉ側及び
基準局Ｒ側の各ＧＰＳ受信機１７，１９の受信情報から
３つの二重位相差を計算し、基準局Ｒ及び作業車Ｖ間の
相対位置が判っていることから上記二重位相差情報に含
まれる搬送波波長の整数倍の不確定（整数値バイアス）
を確定させる。次に、図５に示すように、作業車Ｖを圃
場Ｆ内の未知の点に移動させたときの３つの二重位相差
情報より、基準局Ｒから作業車Ｖへの位置ベクトルｒが
求まり、この位置ベクトルｒと基準局Ｒの位置とから、
走行車体５の３次元位置（ｘ，ｙ，ｚ）（具体的には、
受信アンテナ１７ａの位置）が判別される。
体５の位置検出について具体的に説明する。先ず最初
に、作業車Ｖを局地水平座標系Ｅ，Ｎ，Ｈにおいて高精
度に位置が判っている地点に位置させ、移動局Ｉ側及び
基準局Ｒ側の各ＧＰＳ受信機１７，１９の受信情報から
３つの二重位相差を計算し、基準局Ｒ及び作業車Ｖ間の
相対位置が判っていることから上記二重位相差情報に含
まれる搬送波波長の整数倍の不確定（整数値バイアス）
を確定させる。次に、図５に示すように、作業車Ｖを圃
場Ｆ内の未知の点に移動させたときの３つの二重位相差
情報より、基準局Ｒから作業車Ｖへの位置ベクトルｒが
求まり、この位置ベクトルｒと基準局Ｒの位置とから、
走行車体５の３次元位置（ｘ，ｙ，ｚ）（具体的には、
受信アンテナ１７ａの位置）が判別される。
【００２８】以上より、走行車体５の３次元位置を検出
する位置検出手段１０２が、前記ＧＰＳ基準局Ｒと、そ
のＧＰＳ基準局Ｒでの搬送波位相情報を送信する基準側
通信手段としてのデータ送受信機２０とが、地上側の基
準位置に設置されるとともに、前記ＧＰＳ移動局Ｉと、
前記地上側のデータ送受信機２０の送信情報を受信する
車体側通信手段としてのデータ送受信機１８と、前記位
置データ算出手段４５とが、走行車体５に備えられて構
成されることになる。
する位置検出手段１０２が、前記ＧＰＳ基準局Ｒと、そ
のＧＰＳ基準局Ｒでの搬送波位相情報を送信する基準側
通信手段としてのデータ送受信機２０とが、地上側の基
準位置に設置されるとともに、前記ＧＰＳ移動局Ｉと、
前記地上側のデータ送受信機２０の送信情報を受信する
車体側通信手段としてのデータ送受信機１８と、前記位
置データ算出手段４５とが、走行車体５に備えられて構
成されることになる。
【００２９】次に、作業車Ｖの装置構成を、図１〜図３
に基づいて説明する。左右一対の前輪３及び後輪４を備
えた走行車体５の後部に、作業部としての薬剤散布装置
６と、この薬剤散布装置６に対して薬剤を加圧供給する
供給タンク２１とが設置されている。薬剤散布装置６
は、車体横幅方向において所定作業幅で圃場面に向けて
薬剤を噴射するために、細かいピッチで配列した多数の
噴射ノズル６ａを備えている。薬剤散布装置６の車体左
右両側の各端部位置は、ＧＰＳ受信アンテナ１７ａの位
置に対して、車体後方側に距離ｂ、車体横幅方向に車体
中心から左右に各距離ａに位置し、上下方向には距離ｃ
下方に位置している。これより、薬剤散布装置６の車体
横幅方向での作業幅は２ａになる。この薬剤散布装置６
の作業幅は２ａ、及び、走行車体５（受信アンテナ１７
ａの位置）に対する位置関係の情報は、後述の制御装置
１６内に記憶されている。
に基づいて説明する。左右一対の前輪３及び後輪４を備
えた走行車体５の後部に、作業部としての薬剤散布装置
６と、この薬剤散布装置６に対して薬剤を加圧供給する
供給タンク２１とが設置されている。薬剤散布装置６
は、車体横幅方向において所定作業幅で圃場面に向けて
薬剤を噴射するために、細かいピッチで配列した多数の
噴射ノズル６ａを備えている。薬剤散布装置６の車体左
右両側の各端部位置は、ＧＰＳ受信アンテナ１７ａの位
置に対して、車体後方側に距離ｂ、車体横幅方向に車体
中心から左右に各距離ａに位置し、上下方向には距離ｃ
下方に位置している。これより、薬剤散布装置６の車体
横幅方向での作業幅は２ａになる。この薬剤散布装置６
の作業幅は２ａ、及び、走行車体５（受信アンテナ１７
ａの位置）に対する位置関係の情報は、後述の制御装置
１６内に記憶されている。
【００３０】前輪３及び後輪４は、左右を一対として各
別に操向操作自在に構成され、操向用の油圧シリンダ
７，８と、これに対する電磁操作式の制御弁９，１０と
が設けられている。そして、切換スイッチ１３によっ
て、前輪３又は後輪４の一方のみを操向する２輪ステア
リング形式、前後輪３，４を逆位相で且つ同角度に操向
する４輪ステアリング形式、前後輪３，４を同位相で且
つ同角度に操向する平行ステアリング形式の３種類のス
テアリング形式を選択できる。
別に操向操作自在に構成され、操向用の油圧シリンダ
７，８と、これに対する電磁操作式の制御弁９，１０と
が設けられている。そして、切換スイッチ１３によっ
て、前輪３又は後輪４の一方のみを操向する２輪ステア
リング形式、前後輪３，４を逆位相で且つ同角度に操向
する４輪ステアリング形式、前後輪３，４を同位相で且
つ同角度に操向する平行ステアリング形式の３種類のス
テアリング形式を選択できる。
【００３１】作業車Ｖには、エンジンＥ、エンジンＥか
らの出力を変速して前後輪３，４の夫々を同時に駆動す
る油圧式無段変速装置１１、その変速操作用の電動モー
タ１２、前記供給タンク２１から各ノズル６ａへの薬剤
供給を断続する制御弁１４が設けられている。１６は作
業車Ｖの走行等を制御するマイクロコンピュータ利用の
制御装置であって、各種センサの検出情報及び予め記憶
された作業データに基づいて、変速用モータ１２、各制
御弁９，１０，１４等を作動させる。
らの出力を変速して前後輪３，４の夫々を同時に駆動す
る油圧式無段変速装置１１、その変速操作用の電動モー
タ１２、前記供給タンク２１から各ノズル６ａへの薬剤
供給を断続する制御弁１４が設けられている。１６は作
業車Ｖの走行等を制御するマイクロコンピュータ利用の
制御装置であって、各種センサの検出情報及び予め記憶
された作業データに基づいて、変速用モータ１２、各制
御弁９，１０，１４等を作動させる。
【００３２】作業車Ｖに装備されるセンサ類について説
明すれば、図１に示すように、前後輪３，４夫々の操向
角を検出するポテンショメータ利用の操向角検出センサ
Ｒ１，Ｒ２と、変速装置１１の変速状態に基づいて間接
的に前後進状態及び車速を検出するポテンショメータ利
用の車速センサＲ３と、変速装置１１の出力軸の回転数
を計数して走行距離を検出するエンコーダＳ３と、車体
方位を検出する地磁気方位センサＳ４とが設けられてい
る。
明すれば、図１に示すように、前後輪３，４夫々の操向
角を検出するポテンショメータ利用の操向角検出センサ
Ｒ１，Ｒ２と、変速装置１１の変速状態に基づいて間接
的に前後進状態及び車速を検出するポテンショメータ利
用の車速センサＲ３と、変速装置１１の出力軸の回転数
を計数して走行距離を検出するエンコーダＳ３と、車体
方位を検出する地磁気方位センサＳ４とが設けられてい
る。
【００３３】前記制御装置１６を利用して、作業車Ｖが
走行車体５に備えた薬剤散布装置６にて薬剤散布作業を
しながら走行する圃場Ｆの３次元形状を計測する作業地
形状計測手段１０１が構成されている。具体的には、図
６及び図７に示すように、圃場Ｆの周縁部における複数
設定箇所の３次元位置情報に基づいて、圃場Ｆの３次元
形状を計測する。そのために、作業車Ｖを手動操縦等に
よって矩形状の圃場Ｆの各角部に走行させ、走行車体５
が圃場Ｆの各角部（少なくとも、３つの角部Ｐ０，Ｐ
１，Ｐ２）に位置したときの前記車体位置検出手段１０
２の情報に基づいて、上記圃場Ｆの各角部の３次元位置
情報を求めて圃場Ｆの３次元形状を計測する。つまり、
図６及び図７の例では、圃場Ｆは短辺Ｆ２の方向にのみ
傾斜していて、その傾斜角は、角部Ｐ２とＰ０との高低
差（Ｈ座標の差）を、角部Ｐ２とＰ０間の水平距離で割
ることによって算出される。
走行車体５に備えた薬剤散布装置６にて薬剤散布作業を
しながら走行する圃場Ｆの３次元形状を計測する作業地
形状計測手段１０１が構成されている。具体的には、図
６及び図７に示すように、圃場Ｆの周縁部における複数
設定箇所の３次元位置情報に基づいて、圃場Ｆの３次元
形状を計測する。そのために、作業車Ｖを手動操縦等に
よって矩形状の圃場Ｆの各角部に走行させ、走行車体５
が圃場Ｆの各角部（少なくとも、３つの角部Ｐ０，Ｐ
１，Ｐ２）に位置したときの前記車体位置検出手段１０
２の情報に基づいて、上記圃場Ｆの各角部の３次元位置
情報を求めて圃場Ｆの３次元形状を計測する。つまり、
図６及び図７の例では、圃場Ｆは短辺Ｆ２の方向にのみ
傾斜していて、その傾斜角は、角部Ｐ２とＰ０との高低
差（Ｈ座標の差）を、角部Ｐ２とＰ０間の水平距離で割
ることによって算出される。
【００３４】又、前記制御装置１６を利用して、前記作
業地形状計測手段１０１の計測情報に基づいて、作業車
Ｖを圃場Ｆ内において走行させるための予定走行経路の
データを作成する走行用データ作成手段１０３が構成さ
れ、この走行用データ作成手段１０３は、前記予定走行
経路として、図５及び図６に示すように、圃場Ｆ内に平
行状態で設定間隔を隔てて隣接して並ぶ複数の作業経路
Ｌを形成するように構成されている。
業地形状計測手段１０１の計測情報に基づいて、作業車
Ｖを圃場Ｆ内において走行させるための予定走行経路の
データを作成する走行用データ作成手段１０３が構成さ
れ、この走行用データ作成手段１０３は、前記予定走行
経路として、図５及び図６に示すように、圃場Ｆ内に平
行状態で設定間隔を隔てて隣接して並ぶ複数の作業経路
Ｌを形成するように構成されている。
【００３５】つまり、圃場Ｆの内部に位置して１つの角
部寄りのスタート地点Ｓｔから圃場長手方向に沿って走
行開始して、圃場の中央部分において、長手方向に沿う
各作業経路Ｌを直進走行しながら薬剤散布し、圃場端部
に達すると１８０度旋回して前回走行した作業済領域
（図５の斜線部分）に隣接する状態で作業経路Ｌを逆方
向に走行することを繰り返し、圃場の中央部分での作業
を終えると、圃場短辺に隣接する上記旋回部分と、圃場
長辺に隣接する作業経路部分とを走行して、出入口Ｐｉ
から外に出るようにして、圃場Ｆの全体を走行する予定
走行経路が設定されている。
部寄りのスタート地点Ｓｔから圃場長手方向に沿って走
行開始して、圃場の中央部分において、長手方向に沿う
各作業経路Ｌを直進走行しながら薬剤散布し、圃場端部
に達すると１８０度旋回して前回走行した作業済領域
（図５の斜線部分）に隣接する状態で作業経路Ｌを逆方
向に走行することを繰り返し、圃場の中央部分での作業
を終えると、圃場短辺に隣接する上記旋回部分と、圃場
長辺に隣接する作業経路部分とを走行して、出入口Ｐｉ
から外に出るようにして、圃場Ｆの全体を走行する予定
走行経路が設定されている。
【００３６】図７に示すように、圃場Ｆは短辺Ｆ２の方
向に傾斜し、長辺Ｆ１の方向には傾斜してないので、短
辺Ｆ２に沿っての作業地表面での長さは、平面視での長
さより長くなり（図１１参照）、長辺Ｆ１に沿っての長
さは平面視での長さと変わらない。従って、実際の作業
地表面での短辺Ｆ２の長さに対して薬剤散布装置６の作
業幅２ａを対応させて、隣接する作業経路Ｌの間隔を設
定することになる。つまり、平面視で見ると、作業経路
Ｌの間隔は、傾斜していない作業地に対する間隔よりも
短くなっている。
向に傾斜し、長辺Ｆ１の方向には傾斜してないので、短
辺Ｆ２に沿っての作業地表面での長さは、平面視での長
さより長くなり（図１１参照）、長辺Ｆ１に沿っての長
さは平面視での長さと変わらない。従って、実際の作業
地表面での短辺Ｆ２の長さに対して薬剤散布装置６の作
業幅２ａを対応させて、隣接する作業経路Ｌの間隔を設
定することになる。つまり、平面視で見ると、作業経路
Ｌの間隔は、傾斜していない作業地に対する間隔よりも
短くなっている。
【００３７】又、前記制御装置１６を利用して、前記走
行用データ作成手段１０３の作成情報に基づいて、作業
車Ｖが前記予定走行経路（各作業経路Ｌ）に沿って自動
走行するように制御する走行制御手段１００が構成さ
れ、この走行制御手段１００は、前記車体位置検出手段
１０２の位置情報に基づいて、前記走行車体５の圃場Ｆ
内での位置を特定して前記走行制御を行うように構成さ
れている。
行用データ作成手段１０３の作成情報に基づいて、作業
車Ｖが前記予定走行経路（各作業経路Ｌ）に沿って自動
走行するように制御する走行制御手段１００が構成さ
れ、この走行制御手段１００は、前記車体位置検出手段
１０２の位置情報に基づいて、前記走行車体５の圃場Ｆ
内での位置を特定して前記走行制御を行うように構成さ
れている。
【００３８】具体的には、図７に示すように、走行車体
５の現在位置Ｐが、圃場Ｆの左下角部Ｐ０からＰに向く
ベクトルＰ−Ｐ０で表され、下式（１）及び（２）に示
すベクトルの内積演算によって、そのベクトルＰ−Ｐ０
を短辺Ｆ２に投影した長さＴ２で短辺方向に沿っての位
置（つまり、各作業経路Ｌの適正操向位置に対する位置
ずれ）が示され、ベクトルＰ−Ｐ０を長辺Ｆ１に投影し
た長さＴ１で長辺方向に沿っての位置（つまり、作業経
路Ｌに沿っての進行距離）が示され、このＴ１，Ｔ２の
情報で走行車体５の圃場Ｆ内での位置が特定される。
尚、式中、（Ｐ１−Ｐ０）はＰ０からＰ１に向くベクト
ル、（Ｐ２−Ｐ０）はＰ０からＰ２に向くベクトルを表
し、ＡＢＳ（Ｐ１−Ｐ０）、ＡＢＳ（Ｐ２−Ｐ０）は、
夫々、ベクトル（Ｐ１−Ｐ０）、ベクトル（Ｐ２−Ｐ
０）の絶対値つまり長辺Ｆ１又は短辺Ｆ２の距離を表
す。
５の現在位置Ｐが、圃場Ｆの左下角部Ｐ０からＰに向く
ベクトルＰ−Ｐ０で表され、下式（１）及び（２）に示
すベクトルの内積演算によって、そのベクトルＰ−Ｐ０
を短辺Ｆ２に投影した長さＴ２で短辺方向に沿っての位
置（つまり、各作業経路Ｌの適正操向位置に対する位置
ずれ）が示され、ベクトルＰ−Ｐ０を長辺Ｆ１に投影し
た長さＴ１で長辺方向に沿っての位置（つまり、作業経
路Ｌに沿っての進行距離）が示され、このＴ１，Ｔ２の
情報で走行車体５の圃場Ｆ内での位置が特定される。
尚、式中、（Ｐ１−Ｐ０）はＰ０からＰ１に向くベクト
ル、（Ｐ２−Ｐ０）はＰ０からＰ２に向くベクトルを表
し、ＡＢＳ（Ｐ１−Ｐ０）、ＡＢＳ（Ｐ２−Ｐ０）は、
夫々、ベクトル（Ｐ１−Ｐ０）、ベクトル（Ｐ２−Ｐ
０）の絶対値つまり長辺Ｆ１又は短辺Ｆ２の距離を表
す。
【００３９】
【数１】 Ｔ１＝（Ｐ−Ｐ０）・（Ｐ１−Ｐ０）／ＡＢＳ（Ｐ１−Ｐ０）……（１） Ｔ２＝（Ｐ−Ｐ０）・（Ｐ２−Ｐ０）／ＡＢＳ（Ｐ２−Ｐ０）……（２）
【００４０】次に、図８〜図１０に示すフローチャート
に基づいて、圃場形状の計測、走行用データの作成、及
び走行制御について説明する。メインフロー（図８）で
は、先ず、矩形状の圃場Ｆの３角部に走行車体５を位置
させて、各角部での３次元のＧＰＳ位置検出を行い、そ
のＧＰＳ位置データを記憶する。そして、３つの角部で
の位置データを記憶すると、それに基づいて圃場Ｆの３
次元形状を判別し、さらに、予め入力してある薬剤散布
幅２ａや走行ルートのパターン（図６参照）等のデータ
を参照して、予定走行経路のデータを作成する。次に、
前記スタート地点Ｓｔへ移動してから、圃場Ｆに対する
無人作業走行を実行した後、全処理を終える。
に基づいて、圃場形状の計測、走行用データの作成、及
び走行制御について説明する。メインフロー（図８）で
は、先ず、矩形状の圃場Ｆの３角部に走行車体５を位置
させて、各角部での３次元のＧＰＳ位置検出を行い、そ
のＧＰＳ位置データを記憶する。そして、３つの角部で
の位置データを記憶すると、それに基づいて圃場Ｆの３
次元形状を判別し、さらに、予め入力してある薬剤散布
幅２ａや走行ルートのパターン（図６参照）等のデータ
を参照して、予定走行経路のデータを作成する。次に、
前記スタート地点Ｓｔへ移動してから、圃場Ｆに対する
無人作業走行を実行した後、全処理を終える。
【００４１】無人作業走行処理（図９）では、スタート
地点Ｓｔから２輪ステアリングで作業経路Ｌに沿って直
進走行を開始するとともに、経路始端側の作業開始位置
に達すると薬剤散布装置６による薬剤散布作業を開始し
て、各作業経路に沿わせるための操向制御を行う。経路
終端側の作業停止位置に達すると薬剤散布作業を停止す
るが、圃場Ｆの中央部分に対する往復走行が終了してい
ない場合は、その地点から所定距離直進した後、ステア
リングを２輪から４輪に切り換えて、隣接する次の作業
経路の始端部に向けて１８０度旋回動作する。旋回後
は、ステアリングを２輪に戻して次の作業経路を反対向
きに操向制御しながら走行するとともに、上記と同様
に、薬剤散布装置６による薬剤散布作業を行う。圃場Ｆ
の中央部分に対する往復走行が終了している場合には、
圃場Ｆの短辺及び長辺に沿っての周り走行を行ってから
圃場Ｆ外に出て走行停止し、メインフローに戻る。
地点Ｓｔから２輪ステアリングで作業経路Ｌに沿って直
進走行を開始するとともに、経路始端側の作業開始位置
に達すると薬剤散布装置６による薬剤散布作業を開始し
て、各作業経路に沿わせるための操向制御を行う。経路
終端側の作業停止位置に達すると薬剤散布作業を停止す
るが、圃場Ｆの中央部分に対する往復走行が終了してい
ない場合は、その地点から所定距離直進した後、ステア
リングを２輪から４輪に切り換えて、隣接する次の作業
経路の始端部に向けて１８０度旋回動作する。旋回後
は、ステアリングを２輪に戻して次の作業経路を反対向
きに操向制御しながら走行するとともに、上記と同様
に、薬剤散布装置６による薬剤散布作業を行う。圃場Ｆ
の中央部分に対する往復走行が終了している場合には、
圃場Ｆの短辺及び長辺に沿っての周り走行を行ってから
圃場Ｆ外に出て走行停止し、メインフローに戻る。
【００４２】操向制御処理（図１０）では、ＧＰＳ位置
データを取り込んで、現時点での車体５の位置Ｐ（ｘ，
ｙ，ｚ）を算出するとともに、その位置データと、３つ
の角部Ｐ０，Ｐ１，Ｐ２での位置データとから、前述の
式（２）に基づいて車体位置と作業経路Ｌにおける適正
位置との偏位ｄを求め、又、車体方位データ（φ）を取
り込み、上記偏位ｄの情報と、車体方位φの情報と、前
輪３の操舵角θの情報（これは操向角検出センサＲ１に
て検出される）とに基づいて下式のように、前輪３に対
する目標操舵角θｆを演算する。尚、ｋ１，ｋ２，ｋ３
は所定のゲイン係数である。そして、この目標操舵角θ
ｆになるように、前輪３がステアリング操作される。
データを取り込んで、現時点での車体５の位置Ｐ（ｘ，
ｙ，ｚ）を算出するとともに、その位置データと、３つ
の角部Ｐ０，Ｐ１，Ｐ２での位置データとから、前述の
式（２）に基づいて車体位置と作業経路Ｌにおける適正
位置との偏位ｄを求め、又、車体方位データ（φ）を取
り込み、上記偏位ｄの情報と、車体方位φの情報と、前
輪３の操舵角θの情報（これは操向角検出センサＲ１に
て検出される）とに基づいて下式のように、前輪３に対
する目標操舵角θｆを演算する。尚、ｋ１，ｋ２，ｋ３
は所定のゲイン係数である。そして、この目標操舵角θ
ｆになるように、前輪３がステアリング操作される。
【００４３】
【数２】 θｆ＝ｋ１・ｄ＋ｋ２・φ＋ｋ３・θ……（３）
【００４４】〔別実施形態〕上記実施例では、矩形状の
作業地（圃場Ｆ）の傾斜方向が短辺方向に沿う場合を説
明したが、これ以外の傾斜状態であってもよい。例え
ば、図６において圃場Ｆの傾斜方向が長辺方向に沿う場
合は、各作業経路Ｌの隣接間隔は平面視のときと同じで
あり、長辺方向に沿っての進行距離が平面視のときより
も長くなる。又、図１２に示すように、圃場Ｆの傾斜方
向が長辺方向と短辺方向の中間の方向であったり、図１
３に示すように、圃場Ｆが、夫々の傾斜角度が異なる４
つの小部分Ｆａ，Ｆｂ．Ｆｃ，Ｆｄからなるものであっ
てもよい。図１３の場合は、各小部分Ｆａ，Ｆｂ．Ｆ
ｃ，Ｆｄごとの傾斜状態に対応させながら、圃場Ｆ全体
での走行経路を設定する。
作業地（圃場Ｆ）の傾斜方向が短辺方向に沿う場合を説
明したが、これ以外の傾斜状態であってもよい。例え
ば、図６において圃場Ｆの傾斜方向が長辺方向に沿う場
合は、各作業経路Ｌの隣接間隔は平面視のときと同じで
あり、長辺方向に沿っての進行距離が平面視のときより
も長くなる。又、図１２に示すように、圃場Ｆの傾斜方
向が長辺方向と短辺方向の中間の方向であったり、図１
３に示すように、圃場Ｆが、夫々の傾斜角度が異なる４
つの小部分Ｆａ，Ｆｂ．Ｆｃ，Ｆｄからなるものであっ
てもよい。図１３の場合は、各小部分Ｆａ，Ｆｂ．Ｆ
ｃ，Ｆｄごとの傾斜状態に対応させながら、圃場Ｆ全体
での走行経路を設定する。
【００４５】作業地の形状は、多角形状であるものに限
らない。又、多角形状の場合も、矩形状以外に、台形等
であってもよい。
らない。又、多角形状の場合も、矩形状以外に、台形等
であってもよい。
【００４６】上記実施例では、圃場に対して薬剤を散布
する薬剤散布装置６を作業部として備えた作業車Ｖにつ
いて説明したが、これ以外の農作業用及びその他の用途
の各種作業車に適用できる。
する薬剤散布装置６を作業部として備えた作業車Ｖにつ
いて説明したが、これ以外の農作業用及びその他の用途
の各種作業車に適用できる。
【００４７】上記実施例では、作業地の３次元形状の計
測のために、作業地周縁部における設定箇所の３次元位
置情報を求めるのに、車体位置検出手段を備えた作業車
Ｖを作業走行させる前に、上記設定箇所に位置させて位
置検出するようにしたが、これ以外に、予め上記設定箇
所での位置を計測したデータを記憶させるようにしても
よい。
測のために、作業地周縁部における設定箇所の３次元位
置情報を求めるのに、車体位置検出手段を備えた作業車
Ｖを作業走行させる前に、上記設定箇所に位置させて位
置検出するようにしたが、これ以外に、予め上記設定箇
所での位置を計測したデータを記憶させるようにしても
よい。
【００４８】上記実施例では、予定走行経路として、作
業地内に平行状態で設定間隔を隔てて隣接して並ぶ複数
の作業経路を形成するようにした（図６参照）が、これ
に限るものではなく、例えば、矩形状の作業地の外周の
４辺に沿って、９０度づつ向き変更しながら順次作業走
行する、いわゆる「周り走行」用の作業経路を形成して
もよい。
業地内に平行状態で設定間隔を隔てて隣接して並ぶ複数
の作業経路を形成するようにした（図６参照）が、これ
に限るものではなく、例えば、矩形状の作業地の外周の
４辺に沿って、９０度づつ向き変更しながら順次作業走
行する、いわゆる「周り走行」用の作業経路を形成して
もよい。
【００４９】位置検出手段１０２は、上記実施例に示し
たＧＰＳ受信データに基づくものに限らない。例えば、
地上側から光利用の追尾式３次元位置検出装置にて作業
車Ｖの位置を計測して、その位置データを作業車側に送
るようにしてもよい。
たＧＰＳ受信データに基づくものに限らない。例えば、
地上側から光利用の追尾式３次元位置検出装置にて作業
車Ｖの位置を計測して、その位置データを作業車側に送
るようにしてもよい。
【図１】作業車の制御構成を示すブロック図
【図２】作業車及びＧＰＳ基準局を示す概略側面図
【図３】作業車の平面図
【図４】ＧＰＳ受信局の構成を示すブロック図
【図５】作業経路に沿っての自動走行を説明するための
平面図
平面図
【図６】作業車の予定走行経路を示す概略平面図
【図７】傾斜した作業地に対する走行経路の設定を示す
斜視図
斜視図
【図８】制御作動のフローチャート
【図９】制御作動のフローチャート
【図１０】制御作動のフローチャート
【図１１】傾斜作業地に対する作業部位置を説明する図
【図１２】別実施例の作業地の３次元形状を示す斜視図
【図１３】別実施例の作業地の３次元形状を示す斜視図
５ 走行車体 ６ 作業部 １８ 車体側通信手段 ２０ 基準側通信手段 ４５ ＧＰＳ位置データ算出手段 １００ 走行制御手段 １０１ 作業地形状計測手段 １０２ 車体位置検出手段 １０３ 走行用データ作成手段 Ｉ ＧＰＳ移動局 Ｒ ＧＰＳ基準局 Ｖ 作業車
Claims (8)
- 【請求項１】 作業車が走行車体に備えた所定作業幅の
作業部にて作業しながら走行する作業地の３次元形状を
計測する作業地形状計測手段と、 前記作業地形状計測手段の計測情報に基づいて、前記作
業車を前記作業地内において走行させるための予定走行
経路のデータを作成する走行用データ作成手段とが設け
られている作業車の走行経路作成装置。 - 【請求項２】 前記走行用データ作成手段は、前記予定
走行経路として、前記作業地内に平行状態で設定間隔を
隔てて隣接して並ぶ複数の作業経路を形成するように構
成されている請求項１記載の作業車の走行経路作成装
置。 - 【請求項３】 前記作業地形状計測手段は、前記作業地
の周縁部における複数設定箇所の３次元位置情報に基づ
いて、前記作業地の３次元形状を計測するように構成さ
れている請求項１又は２記載の作業車の走行経路作成装
置。 - 【請求項４】 前記作業地が、多角形状であり、 前記作業地形状計測手段は、前記多角形状の作業地の各
角部を前記周縁部における設定箇所とするように構成さ
れている請求項３記載の作業車の走行経路作成装置。 - 【請求項５】 前記走行車体の３次元位置を検出する車
体位置検出手段が設けられ、 前記作業地形状計測手段は、前記走行車体が前記作業地
の周縁部における設定箇所に位置したときの前記車体位
置検出手段の情報に基づいて、前記作業地の３次元形状
を計測するように構成されている請求項３又は４記載の
作業車の走行経路作成装置。 - 【請求項６】 前記車体位置検出手段は、 ＧＰＳ衛星からの搬送波信号を受信するＧＰＳ基準局
と、そのＧＰＳ基準局での搬送波位相情報を送信する基
準側通信手段とが、地上側の基準位置に設置されるとと
もに、 前記ＧＰＳ衛星からの搬送波信号を受信するＧＰＳ移動
局と、 前記基準側通信手段の送信情報を受信する車体側通信手
段と、 前記ＧＰＳ移動局での搬送波位相情報及び前記車体側通
信手段が受信した前記ＧＰＳ基準局での搬送波位相情報
から求めた二重位相差情報に基づいて、前記走行車体の
３次元位置を時系列的なＧＰＳ位置データとして求める
ＧＰＳ位置データ算出手段とが、前記走行車体に備えら
れて構成されている請求項５記載の作業車の走行経路作
成装置。 - 【請求項７】 請求項１〜６のいずれか１項に記載の作
業車の走行経路作成装置における、前記走行用データ作
成手段の作成情報に基づいて、前記作業車が前記予定走
行経路に沿って自動走行するように制御する走行制御手
段が設けられている作業車の走行制御装置。 - 【請求項８】 前記走行制御手段は、前記車体位置検出
手段の位置情報に基づいて、前記走行車体の前記作業地
内での位置を特定して前記走行制御を行うように構成さ
れている請求項７記載の作業車の走行制御装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP04763197A JP3604249B2 (ja) | 1997-03-03 | 1997-03-03 | 作業車の走行経路作成装置及び走行制御装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP04763197A JP3604249B2 (ja) | 1997-03-03 | 1997-03-03 | 作業車の走行経路作成装置及び走行制御装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH10243708A true JPH10243708A (ja) | 1998-09-14 |
| JP3604249B2 JP3604249B2 (ja) | 2004-12-22 |
Family
ID=12780583
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP04763197A Expired - Fee Related JP3604249B2 (ja) | 1997-03-03 | 1997-03-03 | 作業車の走行経路作成装置及び走行制御装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3604249B2 (ja) |
Cited By (22)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| FR2800232A1 (fr) | 1999-10-27 | 2001-05-04 | Renault Agriculture | Procede pour le guidage automatique d'un engin et dispositif correspondant |
| JP2002186309A (ja) * | 2000-12-19 | 2002-07-02 | Yanmar Agricult Equip Co Ltd | 農業用作業車 |
| JP2004008053A (ja) * | 2002-06-05 | 2004-01-15 | Yanmar Agricult Equip Co Ltd | 農業用作業車 |
| JP2005176741A (ja) * | 2003-12-19 | 2005-07-07 | Yanmar Co Ltd | 農業用作業車 |
| WO2017159615A1 (ja) * | 2016-03-16 | 2017-09-21 | ヤンマー株式会社 | 経路生成装置 |
| JP2017167838A (ja) * | 2016-03-16 | 2017-09-21 | ヤンマー株式会社 | 経路生成装置 |
| JP2017173986A (ja) * | 2016-03-22 | 2017-09-28 | ヤンマー株式会社 | 経路生成装置 |
| JP2017174229A (ja) * | 2016-03-24 | 2017-09-28 | ヤンマー株式会社 | 経路生成装置 |
| JP2017182373A (ja) * | 2016-03-30 | 2017-10-05 | ヤンマー株式会社 | 経路生成装置 |
| WO2017216983A1 (ja) * | 2016-06-17 | 2017-12-21 | 株式会社クボタ | 圃場走行経路生成システム及び圃場作業車 |
| CN107535147A (zh) * | 2016-06-28 | 2018-01-05 | 株式会社久保田 | 作业车 |
| EP3351903A1 (en) | 2017-01-20 | 2018-07-25 | Kubota Corporation | Travel route generation device and a method for operating a travel route generation device |
| WO2018139024A1 (ja) | 2017-01-27 | 2018-08-02 | ヤンマー株式会社 | 経路生成システム、及びそれによって生成された経路に沿って作業車両を走行させる自律走行システム |
| CN109104925A (zh) * | 2017-06-26 | 2019-01-01 | 株式会社久保田 | 作业车辆 |
| JP2019503523A (ja) * | 2016-09-27 | 2019-02-07 | バイドゥ・ユーエスエイ・リミテッド・ライアビリティ・カンパニーＢａｉｄｕ ＵＳＡ ＬＬＣ | 自律走行車のための車両の位置点の配信方法 |
| US10219423B2 (en) | 2017-01-20 | 2019-03-05 | Kubota Corporation | Travel route generation device and travel route generation method |
| JP2019154393A (ja) * | 2018-03-16 | 2019-09-19 | 国立研究開発法人農業・食品産業技術総合研究機構 | 圃場作業車両の走行経路設定装置、圃場作業車両、圃場作業車両の走行経路設定方法および走行経路設定用プログラム |
| US10598505B2 (en) | 2016-12-14 | 2020-03-24 | Kubota Corporation | Travel route generation apparatus and method for generating travel route |
| WO2020158295A1 (ja) * | 2019-02-01 | 2020-08-06 | ヤンマー株式会社 | 作業車両用の目標経路生成システム |
| WO2020256034A1 (ja) * | 2019-06-20 | 2020-12-24 | ヤンマーパワーテクノロジー株式会社 | 散布作業用の自動走行システム |
| SE2050727A1 (en) * | 2020-06-17 | 2021-12-18 | Husqvarna Ab | Methods of navigating a self-propelled robotic tool, and robotic tools, and computer pograms implementing such methods |
| CN116243714A (zh) * | 2017-03-09 | 2023-06-09 | 洋马动力科技有限公司 | 路径生成系统 |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH06113607A (ja) * | 1992-10-09 | 1994-04-26 | Sakura Rubber Kk | 屋外作業自動化システム |
| JPH07184415A (ja) * | 1993-12-27 | 1995-07-25 | Fuji Heavy Ind Ltd | 自律走行作業車 |
| JPH08163905A (ja) * | 1994-12-14 | 1996-06-25 | Semiconductor Energy Lab Co Ltd | 自動芝刈機 |
| JPH0949729A (ja) * | 1995-08-07 | 1997-02-18 | Hitachi Ltd | 移動作業機械の運転方法及び作業データの作成方法 |
-
1997
- 1997-03-03 JP JP04763197A patent/JP3604249B2/ja not_active Expired - Fee Related
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH06113607A (ja) * | 1992-10-09 | 1994-04-26 | Sakura Rubber Kk | 屋外作業自動化システム |
| JPH07184415A (ja) * | 1993-12-27 | 1995-07-25 | Fuji Heavy Ind Ltd | 自律走行作業車 |
| JPH08163905A (ja) * | 1994-12-14 | 1996-06-25 | Semiconductor Energy Lab Co Ltd | 自動芝刈機 |
| JPH0949729A (ja) * | 1995-08-07 | 1997-02-18 | Hitachi Ltd | 移動作業機械の運転方法及び作業データの作成方法 |
Cited By (30)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| FR2800232A1 (fr) | 1999-10-27 | 2001-05-04 | Renault Agriculture | Procede pour le guidage automatique d'un engin et dispositif correspondant |
| JP2002186309A (ja) * | 2000-12-19 | 2002-07-02 | Yanmar Agricult Equip Co Ltd | 農業用作業車 |
| JP2004008053A (ja) * | 2002-06-05 | 2004-01-15 | Yanmar Agricult Equip Co Ltd | 農業用作業車 |
| JP2005176741A (ja) * | 2003-12-19 | 2005-07-07 | Yanmar Co Ltd | 農業用作業車 |
| WO2017159615A1 (ja) * | 2016-03-16 | 2017-09-21 | ヤンマー株式会社 | 経路生成装置 |
| JP2017167838A (ja) * | 2016-03-16 | 2017-09-21 | ヤンマー株式会社 | 経路生成装置 |
| JP2017173986A (ja) * | 2016-03-22 | 2017-09-28 | ヤンマー株式会社 | 経路生成装置 |
| JP2017174229A (ja) * | 2016-03-24 | 2017-09-28 | ヤンマー株式会社 | 経路生成装置 |
| JP2017182373A (ja) * | 2016-03-30 | 2017-10-05 | ヤンマー株式会社 | 経路生成装置 |
| WO2017216983A1 (ja) * | 2016-06-17 | 2017-12-21 | 株式会社クボタ | 圃場走行経路生成システム及び圃場作業車 |
| US10900787B2 (en) | 2016-06-17 | 2021-01-26 | Kubota Corporation | Field traveling route production system and field work vehicle |
| CN107535147A (zh) * | 2016-06-28 | 2018-01-05 | 株式会社久保田 | 作业车 |
| KR20180002021A (ko) * | 2016-06-28 | 2018-01-05 | 가부시끼 가이샤 구보다 | 작업차 |
| JP2018000039A (ja) * | 2016-06-28 | 2018-01-11 | 株式会社クボタ | 作業車 |
| JP2019503523A (ja) * | 2016-09-27 | 2019-02-07 | バイドゥ・ユーエスエイ・リミテッド・ライアビリティ・カンパニーＢａｉｄｕ ＵＳＡ ＬＬＣ | 自律走行車のための車両の位置点の配信方法 |
| US10598505B2 (en) | 2016-12-14 | 2020-03-24 | Kubota Corporation | Travel route generation apparatus and method for generating travel route |
| EP3351903A1 (en) | 2017-01-20 | 2018-07-25 | Kubota Corporation | Travel route generation device and a method for operating a travel route generation device |
| US10219423B2 (en) | 2017-01-20 | 2019-03-05 | Kubota Corporation | Travel route generation device and travel route generation method |
| WO2018139024A1 (ja) | 2017-01-27 | 2018-08-02 | ヤンマー株式会社 | 経路生成システム、及びそれによって生成された経路に沿って作業車両を走行させる自律走行システム |
| US11274931B2 (en) | 2017-01-27 | 2022-03-15 | Yanmar Power Technology Co., Ltd. | Route generation system, and autonomous travel system causing work vehicle to travel along route generated thereby |
| CN116243714A (zh) * | 2017-03-09 | 2023-06-09 | 洋马动力科技有限公司 | 路径生成系统 |
| CN109104925A (zh) * | 2017-06-26 | 2019-01-01 | 株式会社久保田 | 作业车辆 |
| JP2019154393A (ja) * | 2018-03-16 | 2019-09-19 | 国立研究開発法人農業・食品産業技術総合研究機構 | 圃場作業車両の走行経路設定装置、圃場作業車両、圃場作業車両の走行経路設定方法および走行経路設定用プログラム |
| WO2020158295A1 (ja) * | 2019-02-01 | 2020-08-06 | ヤンマー株式会社 | 作業車両用の目標経路生成システム |
| JP2020126307A (ja) * | 2019-02-01 | 2020-08-20 | ヤンマーパワーテクノロジー株式会社 | 作業車両用の目標経路生成システム |
| WO2020256034A1 (ja) * | 2019-06-20 | 2020-12-24 | ヤンマーパワーテクノロジー株式会社 | 散布作業用の自動走行システム |
| JP2021000021A (ja) * | 2019-06-20 | 2021-01-07 | ヤンマーパワーテクノロジー株式会社 | 散布作業用の自動走行システム |
| JP2021166560A (ja) * | 2019-06-20 | 2021-10-21 | ヤンマーパワーテクノロジー株式会社 | 作業方法 |
| SE2050727A1 (en) * | 2020-06-17 | 2021-12-18 | Husqvarna Ab | Methods of navigating a self-propelled robotic tool, and robotic tools, and computer pograms implementing such methods |
| WO2021256973A1 (en) * | 2020-06-17 | 2021-12-23 | Husqvarna Ab | Methods of navigating a self-propelled robotic tool, and robotic tools and computer programs implementing such methods |
Also Published As
| Publication number | Publication date |
|---|---|
| JP3604249B2 (ja) | 2004-12-22 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3604249B2 (ja) | 作業車の走行経路作成装置及び走行制御装置 | |
| JPH09178481A (ja) | 作業車の走行用データ作成装置及び誘導制御装置 | |
| JP7542770B2 (ja) | トラクタ | |
| US6463374B1 (en) | Form line following guidance system | |
| CN109310043B (zh) | 越野车辆的条带跟踪系统 | |
| JP2024164121A5 (ja) | ||
| WO2010004911A1 (ja) | 隊列走行支援装置 | |
| JPH09154315A (ja) | 作業車の制御装置 | |
| JPH09145367A (ja) | 作業車の作業管理装置 | |
| JP3238308B2 (ja) | 作業車の誘導制御装置 | |
| JPH09107717A (ja) | 作業機械の姿勢制御装置 | |
| JP2005071142A (ja) | 作業車両の走行制御装置 | |
| JPH09120313A (ja) | 作業車の誘導制御装置 | |
| JP3429151B2 (ja) | 作業車の走行制御装置 | |
| JP7045979B2 (ja) | 走行作業機 | |
| JP3236487B2 (ja) | 作業車の誘導制御装置 | |
| JP3158029B2 (ja) | 作業車の作業状態制御装置 | |
| JP3113567B2 (ja) | 作業車の作業状態制御装置 | |
| JP3238307B2 (ja) | 移動車の誘導制御装置 | |
| JPH09154308A (ja) | 作業機械の姿勢制御装置 | |
| JPH10234204A (ja) | 走行用アシスト装置 | |
| EP4278876B1 (en) | Method and system for precise planting based on planned paths | |
| JPH10234202A (ja) | 走行用アシスト装置 | |
| JPH10243707A (ja) | 走行制御装置 | |
| JP2020099227A (ja) | 走行作業機 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20040129 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20040329 |
|
| 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: 20040909 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20040928 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| LAPS | Cancellation because of no payment of annual fees |