IP Force 特許公報掲載プロジェクト 2022.1.31 β版

知財求人 - 知財ポータルサイト「IP Force」

▶ ヤンマー株式会社の特許一覧

<>
  • 特許-走行領域形状登録システム 図1
  • 特許-走行領域形状登録システム 図2
  • 特許-走行領域形状登録システム 図3
  • 特許-走行領域形状登録システム 図4
  • 特許-走行領域形状登録システム 図5
  • 特許-走行領域形状登録システム 図6
  • 特許-走行領域形状登録システム 図7
  • 特許-走行領域形状登録システム 図8
  • 特許-走行領域形状登録システム 図9
  • 特許-走行領域形状登録システム 図10
  • 特許-走行領域形状登録システム 図11
< >
(19)【発行国】日本国特許庁(JP)
(12)【公報種別】特許公報(B2)
(11)【特許番号】
(24)【登録日】2022-09-15
(45)【発行日】2022-09-27
(54)【発明の名称】走行領域形状登録システム
(51)【国際特許分類】
   G05D 1/02 20200101AFI20220916BHJP
   A01B 69/00 20060101ALI20220916BHJP
   G08G 1/16 20060101ALI20220916BHJP
   G09B 29/00 20060101ALN20220916BHJP
【FI】
G05D1/02 H
G05D1/02 N
A01B69/00 301
A01B69/00 303M
G08G1/16 C
G09B29/00 A
【請求項の数】 4
(21)【出願番号】P 2019070206
(22)【出願日】2019-04-01
(62)【分割の表示】P 2016043415の分割
【原出願日】2016-03-07
(65)【公開番号】P2019133701
(43)【公開日】2019-08-08
【審査請求日】2019-04-01
【審判番号】
【審判請求日】2021-03-18
(73)【特許権者】
【識別番号】000006781
【氏名又は名称】ヤンマーパワーテクノロジー株式会社
(74)【代理人】
【識別番号】110002217
【氏名又は名称】弁理士法人矢野内外国特許事務所
(72)【発明者】
【氏名】平松 敏史
【合議体】
【審判長】刈間 宏信
【審判官】河端 賢
【審判官】見目 省二
(56)【参考文献】
【文献】特表2002-522673(JP,A)
【文献】特開平7-72924(JP,A)
【文献】特開2000-222035(JP,A)
【文献】特開2014-103932(JP,A)
【文献】国際公開第2013/065312(WO,A1)
【文献】特開平7-222504(JP,A)
【文献】特開2015-146748(JP,A)
【文献】特開平10-66406(JP,A)
【文献】特開2015-167562(JP,A)
(58)【調査した分野】(Int.Cl.,DB名)
G05D 1/00- 1/12
A01B 69/00-69/08
(57)【特許請求の範囲】
【請求項1】
作業車両が走行する走行領域の形状を登録する走行領域形状登録システムであって、
衛星測位システムにより前記作業車両の位置情報を取得する位置情報取得手段と、
前記衛星測位システムによって取得される前記作業車両の位置情報に基づいて特定され、走行領域の形状を登録するための軌跡である、前記作業車両の走行軌跡を示す走行軌跡情報を取得する走行軌跡情報取得手段と、
前記作業車両の周辺の画像を取得する外部環境情報取得手段と、
前記外部環境情報取得手段によって取得された前記画像に基づいて前記走行領域と当該領域の外部との境界特徴部特定される境界特徴部特定手段と、
表示画面に表示される前記画像上に前記境界特徴部特定手段によって特定された前記境界特徴部と前記走行軌跡情報取得手段により取得された前記走行軌跡情報を重畳表示する表示手段と、を備える走行領域形状登録システム。
【請求項2】
前記境界特徴部に基づいて前記走行軌跡情報の一部を補正する補正手段を備える請求項1に記載の走行領域形状登録システム。
【請求項3】
前記表示手段は、前記境界特徴部と色相、彩度、明度の少なくともいずれか一つと同一又は類似する特徴を有する関連特徴部を特定可能に表示する請求項1または2に記載の走行領域形状登録システム。
【請求項4】
前記補正手段は、前記関連特徴部に基づいて前記走行軌跡情報の一部を補正する請求項3に記載の走行領域形状登録システム。
【発明の詳細な説明】
【技術分野】
【0001】
本発明は、作業車両が走行する走行領域の形状を登録する走行領域形状登録システムに関する。
【背景技術】
【0002】
特許文献1には、位置検出手段と方位検出手段によって作業車両の圃場内における位置や走行方位を検出し、これら検出値に基づいて作業車両を無人走行させる技術が記載されている。また、圃場周辺部をマニュアル運転(ティーチング走行)することによって得られる学習走行データにより得られる圃場区画や基準走行方位の情報に基づいて作業経路を設定する技術が記載されている。
【先行技術文献】
【特許文献】
【0003】
【文献】特開平10-66405号公報
【発明の概要】
【発明が解決しようとする課題】
【0004】
実際の圃場における端、つまり、圃場と畔、道路の境界は、土地の特徴等によって必ずしも直線ではなく、ティーチング走行において忠実にその境界に沿って走行することは困難である。また、ティーチング走行によって得られた測位データには、局所的に圃場内側に飛び出した電柱、取水弁、壁等の障害物についての情報がないため、枕地作業やサイドマージンの仕上げ作業を自律走行作業車両に自律的に行わせることはできなかった。
【0005】
以上のことを鑑み、本発明は、作業車両の走行領域の形状を登録するための軌跡である走行軌跡情報を表示画面上において、作業車両が走行する走行領域の形状をより適切な形状に設定されているかどうかを確認することができる走行領域形状登録システムを提供することを課題とする。
【課題を解決するための手段】
【0006】
本発明は、作業車両が走行する走行領域の形状を登録する走行領域形状登録システムであって、衛星測位システムにより前記作業車両の位置情報を取得する位置情報取得手段と、前記衛星測位システムによって取得される前記作業車両の位置情報に基づいて特定され、走行領域の形状を登録するための軌跡である、前記作業車両の走行軌跡を示す走行軌跡情報を取得する走行軌跡情報取得手段と、前記作業車両の周辺の画像を取得する外部環境情報取得手段と、前記外部環境情報取得手段によって取得された前記画像に基づいて前記走行領域と当該領域の外部との境界特徴部特定される境界特徴部特定手段と、表示画面に表示される前記画像上に前記境界特徴部特定手段によって特定された前記境界特徴部と前記走行軌跡情報取得手段により取得された前記走行軌跡情報を重畳表示する表示手段と、を備えるものである。
前記境界特徴部に基づいて前記走行軌跡情報の一部を補正する補正手段を備えるものである。
前記表示手段は、前記境界特徴部と色相、彩度、明度の少なくともいずれか一つと同一又は類似する特徴を有する関連特徴部を特定可能に表示するものである。
また、前記補正手段は、前記関連特徴部に基づいて前記走行軌跡情報の一部を補正するものである。
【発明の効果】
【0007】
本発明によれば、オペレータによる表示手段の表示画面上において、走行軌跡情報を表示することによって、作業車両が走行する走行領域の形状が適切であるか確認することができる。
【図面の簡単な説明】
【0008】
図1】自律走行作業車両と走行作業車両の概略側面図。
図2】制御ブロック図。
図3】初期画面を示す図。
図4】圃場設定を示す図。
図5】圃場の領域を示す図。
図6】圃場の形状を示す図。
図7】圃場端の形状を認識する様子を示す図。
図8】圃場形状の補正を示す図。
図9】周辺情報を取得する環境認識手段の位置及び向きを示す図。
図10】表示装置上で境界特徴点を選択する様子を示す図。
図11】周辺情報を取得する距離センサで圃場端を認識する様子を示す図。
【発明を実施するための形態】
【0009】
無人で自律走行可能な自律走行作業車両(以下、無人車両と称することがある)1、及び、この自律走行作業車両1に協調して作業者(ユーザ)が操向操作する有人の走行作業車両(以下、有人車両と称することがある)100をトラクタとし、自律走行作業車両1及び走行作業車両100には作業機としてロータリ耕耘装置がそれぞれ装着されている実施例について説明する。但し、作業車両はトラクタに限定するものではなく、コンバイン等でもよく、また、作業機はロータリ耕耘装置に限定するものではなく、畝立て機や草刈機やレーキや播種機や施肥機等であってもよい。
【0010】
本明細書において「自律走行」とは、トラクタが備える制御部(ECU)によりトラクタが備える走行に関する構成が制御されて予め定められた経路に沿ってトラクタが走行することを意味する。単一の圃場における農作業を、無人車両及び有人車両で実行することを、農作業の協調作業、追従作業、随伴作業などと称することがある。なお、農作業の協調作業としては、「単一圃場における農作業を、無人車両及び有人車両で実行すること」に加え、「隣接する圃場等の異なる圃場における農作業を同時期に無人車両及び有人車両で実行すること」が含まれてもよい。
【0011】
図1は、自律走行作業車両及び走行作業車両の概略構成を示す側面図であり、図2は、それらの制御構成を示す制御ブロック図である。図1図2において、自律走行作業車両1となるトラクタの全体構成について説明する。トラクタの車体部は、ボンネット2内にエンジン3が内設され、該ボンネット2の後部のキャビン11内にダッシュボード14が設けられ、ダッシュボード14上に操向操作手段となるステアリングハンドル4が設けられている。該ステアリングハンドル4の回動により操舵装置を介して前輪9・9の向きが回動される。操舵装置を作動させる操舵アクチュエータ40は制御部30を構成するステアリングコントローラ301と接続される。自律走行作業車両1の操舵方向は操向センサ20により検知される。操向センサ20はロータリエンコーダ等の角度センサからなり、前輪9の回動基部に配置される。但し、操向センサ20の検知構成は限定するものではなく操舵方向が認識されるものであればよく、ステアリングハンドル4の回動を検知したり、パワーステアリングの作動量を検知してもよい。操向センサ20により得られた検出値は制御部30のステアリングコントローラ301に入力される。
【0012】
制御部30は、ステアリングコントローラ301、エンジンコントローラ302、変速制御コントローラ303、水平制御コントローラ304、作業制御コントローラ305、測位制御ユニット306、自律走行制御コントローラ307等を備え、それぞれCPU(中央演算処理装置)やRAMやROM等の記憶装置やインターフェース等を備え、記憶装置には動作させるためのプログラムやデータ等が記憶され、CAN通信によりそれぞれ情報やデータ等を送受信できるように通信可能としている。
【0013】
前記ステアリングハンドル4の後方に運転席5が配設され、運転席5下方にミッションケース6が配置される。ミッションケース6の左右両側にリアアクスルケース8・8が連設され、該リアアクスルケース8・8には車軸を介して後輪10・10が支承される。エンジン3からの動力はミッションケース6内の変速装置(主変速装置や副変速装置)により変速されて、後輪10・10を駆動可能としている。変速装置は例えば油圧式無段変速装置で構成して、可変容量型の油圧ポンプの可動斜板をモータ等の変速手段44により作動させて変速可能としている。変速手段44は制御部30の変速制御コントローラ303と接続されている。後輪10の回転数は車速センサ27により検知され、走行速度として変速制御コントローラ303に入力される。但し、車速の検知方法や車速センサ27の配置位置は限定するものではない。
【0014】
ミッションケース6内にはPTOクラッチやPTO変速装置が収納され、PTOクラッチはPTO入切手段45により入り切りされ、PTO入切手段45は表示手段49を介して制御部30の自律走行制御コントローラ307と接続され、PTO軸への動力の断接を制御可能としている。また、作業機として播種機や畦塗機等を装着した場合、作業機独自の制御ができるように作業機コントローラ308が備えられ、該作業機コントローラ308は情報通信配線(所謂、ISOBUS)を介して作業制御コントローラ305と接続される。
【0015】
前記エンジン3を支持するフロントフレーム13にはフロントアクスルケース7が支持され、該フロントアクスルケース7の両側に前輪9・9が支承され、前記ミッションケース6からの動力が前輪9・9に伝達可能に構成している。前記前輪9・9は操舵輪となっており、ステアリングハンドル4の回動操作により回動可能とするとともに、操舵装置の駆動手段となるパワステシリンダからなる操舵アクチュエータ40により前輪9・9が左右操舵回動可能となっている。操舵アクチュエータ40は制御部30のステアリングコントローラ301と接続されて制御される。
【0016】
エンジン回転制御手段となるエンジンコントローラ302にはエンジン回転数センサ61や水温センサや油圧センサ等が接続され、エンジンの状態を検知できるようにしている。エンジンコントローラ302では設定回転数と実回転数から負荷を検出し、過負荷とならないように制御するとともに、後述する遠隔操作装置112にエンジン3の状態を送信して表示装置113で表示できるようにしている。
【0017】
また、ステップ下方に配置した燃料タンク15には燃料の液面を検知するレベルセンサ29が配置されて表示手段49と接続され、表示手段49は自律走行作業車両1のダッシュボードに設けられ、燃料の残量を表示する。そして、燃料の残量は自律走行コントローラ307で作業可能時間が演算され、通信装置110を介して遠隔操作装置112に情報が送信されて、遠隔操作装置112の表示装置113に燃料残量と作業可能時間が表示可能とされる。なお、回転計、燃料計、油圧、異常を表示する表示手段と、現在位置等を表示可能な表示手段とは別構成でもよい。
【0018】
前記ダッシュボード14上にはエンジンの回転計や燃料計や油圧等や異常を示すモニタや設定値等を表示する表示手段49が配置されている。表示手段49は遠隔操作装置112と同様にタッチパネル式として、データの入力や選択やスイッチ操作やボタン操作等も可能としている。
【0019】
また、トラクタの車体部の後部に作業機装着装置23を介して作業機としてロータリ耕耘装置24が昇降可能に装設させている。前記ミッションケース6上に昇降シリンダ26が設けられ、該昇降シリンダ26を伸縮させることにより、作業機装着装置23を構成する昇降アームを回動させてロータリ耕耘装置24を昇降できるようにしている。昇降シリンダ26は昇降アクチュエータ25の作動により伸縮され、昇降アクチュエータ25は制御部30の水平制御コントローラ304と接続されている。また、前記作業機装着装置23の左右一側のリフトリンクには傾斜シリンダが設けられ、該傾斜シリンダを作動させる傾斜アクチュエータ47は水平制御コントローラ304と接続されている。
【0020】
位置検出部となる測位制御ユニット306には位置情報を検出可能とするための移動GPSアンテナ(測位アンテナ)34とデータ受信アンテナ38が接続され、移動GPSアンテナ34とデータ受信アンテナ38は前記キャビン11上に設けられる。測位制御ユニット306には、位置算出手段を備えて緯度と経度を算出し、現在位置を表示手段49や遠隔操作装置112の表示装置113で表示できるようにしている。なお、GPS(米国)に加えて準天頂衛星(日本)やグロナス衛星(ロシア)等の衛星測位システム(GNSS)を利用することで精度の高い測位ができるが、本実施形態ではGPSを用いて説明する。
【0021】
自律走行作業車両1は、車体部の姿勢変化情報を得るためにジャイロセンサ31、および進行方向を検知するために方位角検出部32を具備し制御部30と接続されている。但し、GPSの位置計測から進行方向を算出できるので、方位角検出部32を省くことができる。ジャイロセンサ31は自律走行作業車両1の車体部前後方向の傾斜(ピッチ)の角速度、車体部左右方向の傾斜(ロール)の角速度、および旋回(ヨー)の角速度、を検出するものである。該三つの角速度を積分計算することにより、自律走行作業車両1の車体部の前後方向および左右方向への傾斜角度、および旋回角度を求めることが可能である。ジャイロセンサ31の具体例としては、機械式ジャイロセンサ、光学式ジャイロセンサ、流体式ジャイロセンサ、振動式ジャイロセンサ等が挙げられる。ジャイロセンサ31は制御部30に接続され、当該三つの角速度に係る情報を制御部30に入力する。
【0022】
方位角検出部32は自律走行作業車両1の向き(進行方向)を検出するものである。方位角検出部32の具体例としては磁気方位センサ等が挙げられる。方位角検出部32はCAN通信手段を介して自律走行制御コントローラ307に情報が入力される。
【0023】
こうして自律走行制御コントローラ307は、上記ジャイロセンサ31、方位角検出部32から取得した信号を姿勢・方位演算手段により演算し、自律走行作業車両1の姿勢(向き、車体部前後方向及び車体部左右方向の傾斜、旋回方向)を求める。
【0024】
次に、自律走行作業車両1の位置情報を衛星測位システムの一つであるGPS(グローバル・ポジショニング・システム)を用いて取得する。GPSを用いた測位方法としては、単独測位、相対測位、DGPS(ディファレンシャルGPS)測位、RTK-GPS(リアルタイムキネマティック-GPS)測位など種々の方法が挙げられ、これらいずれの方法を用いることも可能であるが、本実施形態では測定精度の高いRTK-GPS測位方式を採用する。
【0025】
RTK-GPS測位は、位置が判っている基準局と、位置を求めようとする移動局とで同時にGPS観測を行い、基準局で観測したデータを無線等の方法で移動局にリアルタイムで送信し、基準局の位置成果に基づいて移動局の位置をリアルタイムに求める方法である。
【0026】
本実施形態においては、自律走行作業車両1に移動局となる測位制御ユニット306と移動GPSアンテナ34とデータ受信アンテナ38が配置され、基準局となる固定通信機35と固定GPSアンテナ36とデータ送信アンテナ39が所定位置に配設される。本実施形態のRTK-GPS測位は、基準局および移動局の両方で位相の測定(相対測位)を行い、基準局の固定通信機35で測位したデータをデータ送信アンテナ39からデータ受信アンテナ38に送信する。
【0027】
自律走行作業車両1に配置された移動GPSアンテナ34はGPS衛星37・37・・・からの信号を受信する。この信号は測位制御ユニット306に送信され測位される。そして、同時に基準局となる固定GPSアンテナ36でGPS衛星37・37・・・からの信号を受信し、固定通信機35で測位し測位制御ユニット306に送信し、観測されたデータを解析して移動局の位置を決定する。
【0028】
こうして、自律走行コントローラ307は自律走行作業車両1を自律走行させる自律走行手段として備えられる。つまり、自律走行コントローラ307と接続された各種情報取得ユニットによって、自律走行作業車両1の走行状態を各種情報として取得し、自律走行コントローラ307と接続された各種制御ユニットによって、自律走行作業車両1の自律走行を制御する。具体的には、GPS衛星37・37・・・から送信される電波を受信して測位制御ユニット306において設定時間間隔で車体部の位置情報を求め、ジャイロセンサ31及び方位角検出部32から車体部の変位情報および方位情報を求め、これら位置情報と変位情報と方位情報に基づいて車体部が予め設定した経路(走行経路と作業経路)Rに沿って走行するように、操舵アクチュエータ40、変速手段44、昇降アクチュエータ25、PTO入切手段45、エンジンコントローラ302等を制御して自律走行し自動で作業できるようにしている。
【0029】
また、自律走行作業車両1には障害物センサ41が配置されて制御部30と接続され、障害物に衝突しないようにしている。例えば、障害物センサ41はレーザセンサや超音波センサやカメラで構成して車体部の前部や側部や後部に配置して制御部30と接続し、制御部30によって車体部の前方や側方や後方に障害物があるかどうかを検出し、障害物が設定距離以内に近づくと走行を停止させるように制御する。
【0030】
また、自律走行作業車両1には前方を撮影するカメラ42Fや後方の作業機や作業後の圃場状態を撮影するカメラ42Rが搭載され制御部30と接続されている。カメラ42F・42Rは本実施形態ではキャビン11のルーフの前部上と後部上に配置しているが、配置位置は限定するものではなく、キャビン11内の前部上と後部上や一つのカメラ42を車体部中心に配置して鉛直軸を中心に回転させて周囲を撮影しても、複数のカメラ42を車体部の四隅に配置して車体部周囲を撮影する構成であってもよい。また、キャビン11やボンネット2等に自律走行作業車両1の製造社のエンブレムが取り付けられている場合、当該エンブレムの背面側にカメラ42F・42Rを配することとしてもよい。その場合、エンブレム内には貫通穴或いは所定の隙間が設定され、カメラ42F・42Rのレンズが当該貫通穴或いは隙間の位置に相当することで撮影が妨げられない。カメラ42F・42Rで撮影された映像は走行作業車両100に備えられた遠隔操作装置112の表示装置113に表示される。
【0031】
遠隔操作装置112は前記自律走行作業車両1の後述する経路Rを設定したり、自律走行作業車両1を遠隔操作したり、自律走行作業車両1の走行状態や作業機の作動状態を監視したり、作業データを記憶したりするものであり、制御装置(CPUやメモリ)や通信装置111や表示装置113等を備える。
【0032】
有人走行車両となる走行作業車両100は作業者が乗車して運転操作するとともに、走行作業車両100に遠隔操作装置112を搭載して自律走行作業車両1を操作可能としている。走行作業車両100の基本構成は自律走行作業車両1と略同じ構成であるので詳細な説明は省略する。なお、走行作業車両100(または遠隔操作装置112)にGPS用の制御ユニットを備える構成とすることも可能である。
【0033】
遠隔操作装置112は、走行作業車両100及び自律走行作業車両1のダッシュボードやキャビン11のピラー等に設けられる取付部(不図示の例えば遠隔操作装置112を取り付け固定可能なアーム部材)に着脱可能としている。遠隔操作装置112は走行作業車両100の取付部に取り付けたまま操作することも、走行作業車両100の外に持ち出して携帯して操作することも、自律走行作業車両1の取付部に取り付けたまま操作することも可能である。遠隔操作装置112は例えばノート型やタブレット型のパーソナルコンピュータ等の無線通信端末で構成することができる。本実施形態ではタブレット型のコンピュータで構成している。
【0034】
さらに、遠隔操作装置112と自律走行作業車両1は無線で相互に通信可能に構成しており、自律走行作業車両1と遠隔操作装置112には通信するための通信装置110・111がそれぞれ設けられている。通信装置111は遠隔操作装置112に一体的に構成されている。通信手段は例えばWiFi等の無線LANで相互に通信可能に構成されている。遠隔操作装置112は画面に触れることで操作可能なタッチパネル式の操作画面とした表示装置113を筐体表面に設け、筐体内に通信装置111やCPUや記憶装置やバッテリ等を収納している。
【0035】
次に、遠隔操作装置112により経路Rを設定する手順について説明する。図3は、遠隔操作装置の表示装置に表示される初期画面を示す。遠隔操作装置112の表示装置113はタッチパネル式としており、電源をオンして遠隔操作装置112を起動させると初期画面が現れるようにしている。初期画面では、図3に示すように、トラクタ設定ボタン201、圃場設定ボタン202、経路生成設定ボタン203、データ転送ボタン204、作業開始ボタン205、終了ボタン206が表示される。
【0036】
まず、トラクタ設定について説明する。トラクタ設定ボタン201をタッチすると、過去にこの遠隔操作装置112によりトラクタを用いて作業を行った場合、つまり、過去に設定したトラクタが存在する場合、そのトラクタ名(機種)が表示される。表示された複数のトラクタ名から今回使用するトラクタ名をタッチして選択すると、その後、後述する圃場設定に進み、或いは、初期画面に戻ることが可能である。新規にトラクタ設定を行う場合には、トラクタの機種を特定する。この場合、機種名を直接入力する。或いは、複数のトラクタの機種を表示装置113に一覧表示させて所望の機種を選択できるようにしている。
【0037】
トラクタの機種が設定されると、トラクタに装着される作業機のサイズ、形状、作業機の位置の設定画面が現れる。作業機の位置は例えば前部か、前輪と後輪の間か、後部か、オフセットか、を選択する。作業機の設定が終了すると、作業中の車速、作業中のエンジン回転数、旋回時の車速、旋回時のエンジン回転数の設定画面が現れる。作業中の車速は往路と復路で異なる車速とすることも可能である。車速、及び、エンジン回転数の設定が終了すると、後述する圃場設定に進み、或いは、初期画面に戻ることが可能である。
【0038】
次に、圃場設定について、説明する。図4は、圃場設定時において自律走行作業車両にユーザが搭乗して行う外周走行の様子を示す。図5は、作業領域、枕地領域等、圃場内に設定される領域を示す。圃場設定ボタン202をタッチすると、過去にこの遠隔操作装置112によりトラクタを用いて作業を行った場合、つまり、過去に設定した圃場が存在する場合、設定されている圃場の名前が表示される。表示された複数の圃場名から今回作業を行う圃場名をタッチして選択すると、その後、後述する経路生成設定に進み、或いは、初期画面に戻ることが可能である。なお、設定された圃場を編集又は新規に設定することも可能である。
【0039】
登録された圃場がない場合には、新規の圃場設定となる。新規の圃場設定を選択すると、図4に示すように、トラクタ(自律走行作業車両1)を圃場H内の四隅のうちの一つの隅Aに位置させ、「測定開始」のボタンをタッチする。その後、トラクタを圃場Hの外周に沿って走行させて圃場形状を登録する。次に、作業者は、登録された圃場形状から、角位置A・B・C・Dや変曲点を登録して圃場形状を特定する。
【0040】
圃場Hが特定されると、図5に示すように、作業開始位置Sと、作業開始方向Fと、作業終了位置Gを設定する。この圃場H内に障害物が存在する場合には、障害物の位置までトラクタを移動させ、「障害物設定」ボタンをタッチして、その周囲を走行して、障害物設定を行う。なお、表示装置113には圃場の地図画像を表示することが可能であり、当該地図画像に、上記特定された圃場形状が重畳表示される場合、表示装置113上で障害物の周囲を指定することで、障害物設定を行うことができてもよい。上記作業が終了すると、または、過去に登録した圃場を選択すると、確認画面となり、OK(確認)ボタンと「編集/追加」ボタンが表示される。過去に登録した圃場に変更がある場合には、「編集/追加」ボタンをタッチする。
【0041】
前記圃場設定においてOKボタンをタッチすると、経路生成設定となる。経路生成設定は初期画面で経路生成設定ボタン203をタッチすることによっても経路生成設定が可能となる。経路生成設定では、自律走行作業車両1に対して走行作業車両100がどの位置で走行するかの選択画面が表示される。つまり、自律走行作業車両1と走行作業車両100の位置関係を設定する。具体的には、(1)走行作業車両100が自律走行作業車両1の左後方に位置する。(2)走行作業車両100が自律走行作業車両1の右後方に位置する。(3)走行作業車両100が自律走行作業車両1の真後ろに位置する。(4)走行作業車両100は随伴しない(自律走行作業車両1のみで作業を行う)。の4種類が表示され、タッチすることにより選択できる。
【0042】
次に、走行作業車両100の作業機の幅を設定する。つまり、作業機の幅を数字で入力する。次に、スキップ数を設定する。つまり、自律走行作業車両1が圃場外周端部(枕地)に至り第一の経路から第二の経路に移動する時に、経路を何本飛ばすかを設定する。具体的には、(1)スキップしない。(2)1列スキップ。(3)2列スキップ。のいずれかを選択する。次に、オーバーラップの設定を行う。つまり、作業経路と隣接する作業経路における作業幅の重複量の設定を行う。具体的には、(1)オーバーラップしない。(2)オーバーラップする。を選択する。なお、「オーバーラップする」を選択すると、数値入力画面が表示され、数値を入力しないと次に進むことができない。
【0043】
次に、外周設定が行われる。つまり、図5に示すような、自律走行作業車両1と走行作業車両100とにより、または、自律走行作業車両1により作業を行う作業領域HAの外側の領域が設定される。言い換えれば、圃場端で非作業状態として旋回走行する枕地HBと、枕地HBと枕地HBとの間の左右両側の圃場外周に接する非作業領域とする側部余裕地HCが設定される。よって、圃場H=作業領域HA+枕地HB+枕地HB+側部余裕地HC+側部余裕地HCとなる。通常、枕地HBの幅Wbと側部余裕地HCの幅Wcは、走行作業車両100が装着した作業機の幅の二倍以下の長さとして、自律走行作業車両1と走行作業車両100とによる随伴作業が終了した後に、作業者が走行作業車両100に乗り込み、手動操作で外周を二周することで、仕上げることができるようにしている。但し、圃場外周の形状が複雑でない場合には、自律走行作業車両1で外周を作業することも可能である。なお、外周設定において、枕地HBの幅Wb及び側部余裕地HCの幅Wcは、作業機の幅に応じて自動的に所定の幅に算出されるが、算出された枕地HBの幅Wb及び側部余裕地HCの幅Wcは、任意の幅に変更可能であり、ユーザは所望の幅に変更した上で、変更後の幅Wb、幅Wcを夫々、枕地HBの幅、側部余裕地HCの幅として設定可能である。但し、任意の幅に変更可能である場合、圃場内における走行、作業並びに安全性を考慮して算出される最小設定幅以下に設定することはできない。例えば、枕地HBや側部余裕地HCにおいて自律走行作業車両1が走行や旋回した場合に、作業機が圃場外に飛び出ないことを保証する幅が最小設定幅として算出される。
【0044】
上記の各種設定の入力が終了すると、確認画面が現れ、確認をタッチすると、自動で経路Rが生成される。経路Rは作業経路Raと走行経路Rbからなり、作業経路Raは作業領域HA内で生成される経路で、作業を行いながら走行する経路であり、直線の経路となる。但し、作業領域HAが矩形でない場合には作業領域HA外の領域(枕地HBと側部余裕地(サイドマージン)HC)にはみ出すこともある。走行経路Rbは作業領域HA外の領域で生成される経路で、作業を行わずに走行する経路であり、直線と曲線を組み合わせた経路となる。主に、枕地HBでの旋回走行となる。
【0045】
前記経路Rは自律走行作業車両1と走行作業車両100の経路Rが生成される。前記作業経路生成後にその作業経路を見たい場合は、経路生成設定ボタン203をタッチすることでシミユレーション画像が表示され、確認することができる。なお、経路生成設定ボタン203をタッチしなくても経路Rは生成されている。経路生成設定の各項目を設定すると、経路生成設定が表示され、その下部に、「経路設定ボタン」「データ転送する」「ホームへ戻る」が選択可能に表示される。
【0046】
経路生成設定で生成された経路(経路R)に関する情報を転送するときは、初期画面において設けられたデータ転送ボタン204をタッチすることで転送できる。この転送は遠隔操作装置112で行われるため、これら設定した情報を自律走行作業車両1の制御装置に転送する必要がある。この転送は、(1)端子を用いて転送する方法と、(2)無線で転送する方法があり、本実施形態では、端子を用いる場合には、USBケーブルを用いて遠隔操作装置112と自律走行作業車両1の制御装置を直接つなぐ、あるいは、USBメモリに一旦記憶させてから、自律走行作業車両1のUSB端子に接続して転送する。また、無線で転送する場合は、WiFi(無線LAN)を用いて転送する。
【0047】
以下、圃場形状を登録する圃場設定についてより詳しく説明する。図6は、圃場端の境界部分に障害物が存在する等に起因して局所的に複雑な形状変化を有する圃場を示しており、本実施形態では圃場Hの辺DAに圃場内側に突出する電柱が存在する例を示している。図7は、圃場端の形状を周辺情報として認識する様子を示しており、ここでは電柱を認識する様子を示している。図8は、周辺情報に基づいて走行軌跡を補正した後に登録される圃場形状を示しており、ここでは圃場Hの内側に突起した電柱を考慮した圃場外周形状を登録する様子を示している。
【0048】
遠隔操作装置112の表示装置113上で圃場設定ボタン202をタッチして、新規に圃場設定を行う場合又は既存の圃場を編集して再度圃場設定を行う場合、「測定開始」ボタンをタッチした後に、自律走行作業車両1を走行させる。本実施形態では、自律走行作業車両1を圃場Hの四隅のうちの一つの隅Aに位置させ、「測定開始」ボタンをタッチして自律走行作業車両1を圃場Hの外周に沿って走行させた場合について説明する。このとき、測位制御ユニット306において、GPS衛星37・37・・・から送信される電波を受信して車体部の位置情報が取得されると同時に、ジャイロセンサ31及び方位角検出部32により、車体部の変位情報および方位情報が取得される。このように取得される車体部の位置情報、変位情報および方位情報に基づいた走行軌跡情報が取得される。
【0049】
自律走行作業車両1を圃場Hの外周に沿って走行させるときに、自律走行作業車両1の周辺環境を認識するために配置された障害物センサ41及び/又はカメラ42F・42Rによって、自律走行作業車両1の周辺情報(環境情報)が併せて取得される。「周辺情報」とは、例えばカメラ等の撮像手段として構成される障害物センサ41によって得られた車体部の前部及び側部の映像、カメラ42Fによって得られた映像、若しくは、レーザセンサ又は超音波センサ等の距離センサとして構成される障害物センサ41による圃場端と畔等の圃場外との境界に関する情報である。本実施形態では、前方カメラ42Fによる映像を周辺情報として取得し、表示装置113に表示している。
【0050】
そのようにして得られた周辺情報に基づいて走行軌跡情報を補正する。具体的には、周辺情報として得られる映像等に基づいて圃場Hの実際の外周端を把握し、それに合わせるように走行軌跡を外側又は内側に修正することで走行軌跡情報を補正して圃場Hの外周形状を登録する。そして、その外周形状に基づいて圃場Hの外周の走行経路を設定する。つまり、圃場Hの外周を走行するときには、障害物を適宜避けるように走行するが、障害物の性質に応じて、そのとき回避した経路よりも内側又は外側に圃場外周を登録する必要があるところ、本実施形態のように周辺情報として取得された映像等から障害物の形状、空中にせり出した大きさ等を用いて、障害物に応じた適正な回避量を設定し、経路生成設定における走行経路の設定に利用することも可能である。
【0051】
なお、本実施形態では走行軌跡情報と周辺情報(環境情報)に基づいて走行軌跡情報を補正することとしたが、走行軌跡情報を補正しないことがあってもよく、或いは、補正軌跡情報を補正するか否かを選択可能であってもよい。補正軌跡情報を補正しない場合としては、例えば、周辺情報において走行軌跡情報に影響を与える外的要因(例えば、圃場端の付近に障害物が存在する場合や圃場端が曲線形状である場合)が存在しない場合が考えられる。この場合、周辺情報に基づいて外的要因の有無を判定し、外的要因がある場合は走行軌跡情報を補正し、外的要因がない場合は走行軌跡情報を補正しない。
【0052】
また、走行軌跡情報を補正するか否かを選択可能とする場合、例えば、走行軌跡情報が取得された際に、周辺情報に基づいて補正するか否かを選択させる画像を表示し、ユーザにより補正の実行が選択された場合には補正を実行し、補正の非実行が選択された場合には補正を実行しない。或いは、不図示の設定メニュー等において周辺情報に基づく補正の要否を選択設定可能であって、補正が「要」である場合は自動的に走行軌跡情報を補正し、補正が「不要」である場合は走行軌跡情報を補正しないものであってもよい。
【0053】
以上のように、周辺情報を取得して走行軌跡情報を補正することで、圃場端を正確に把握して登録することができ、圃場Hの外周が曲線状である場合、又は圃場Hの内側に障害物が突出している場合等、圃場Hの外周形状が複雑な場合でも、圃場領域としてより正確な圃場領域を登録することができる。
【0054】
図9は、周辺情報を取得する環境認識手段の位置及び向きを示す。走行軌跡情報を補正する場合は、より正確に圃場端を認識するために、周辺情報を取得する障害物センサ41及びカメラ42F・42Rの移動GPSアンテナ34に対する配置(走行軌跡情報を取得する位置に対する相対位置)を考慮し、走行軌跡上の任意位置における走行軌跡と障害物センサ41及びカメラ42F・42R、認識された圃場端の位置関係を明確にした上で、これらの位置情報及び向きに基づいて補正が行われる。具体的には、センサ又はカメラの取り付け位置の高さ、水平位置に関する位置情報、それらと移動GPSアンテナ34との相対位置関係、及び、カメラの撮影方向又はセンサの検出方向に関する情報を用いて、カメラによって取得された画像又はセンサによって検出された検出値に対して、位置及び向きに関する情報を考慮して、走行軌跡と圃場端又は障害物との距離を算出し、圃場端の位置を正確に把握する。
【0055】
以上のように、周辺情報に走行軌跡情報との相対的位置関係を持たせることで、環境認識手段によって認識される圃場端に関する情報をより正確に利用することができるとともに、圃場端の認識処理を自動で行うことが可能となる。
【0056】
上述したように走行軌跡情報の補正は自動的に行われることとしてもよいが、ユーザの操作に応じて行われることとしてもよい。例えば、表示装置113に圃場の地図画像が表示され、当該地図画像上に走行軌跡情報に基づいて特定される圃場を示す線形状、或いは、周辺情報に基づいて補正された走行軌跡情報に基づいて特定される圃場を示す線形状が重畳表示される場合、ユーザが表示装置113をタッチすることで正確な圃場端を指定可能であって、ユーザの操作に応じて走行軌跡情報を補正することとしてもよい。その場合、環境情報取得手段(上述した環境センサ41、カメラ42F・42Rの総称)は表示装置113に圃場の地図画像を表示するために用いられるものであってよい。圃場端を指定する場合、例えば上記線形状に対してコントロールポイントを追加し、コントロールポイントを操作することで、線形状の一部について補正可能であってよい。また、線形状においてユーザが1又は複数の境界特徴点を指定し、当該境界特徴点に基づいて自動的に走行軌跡情報が補正されてよい。以下、境界特徴点について説明する。
【0057】
図10は、表示装置上で圃場端の境界特徴点を選択して、圃場形状を登録する様子を示す。本例において周辺情報に基づいた圃場の外周端の認識は、カメラとして構成される障害物センサ41又はカメラ42F・42Rによって取得された画像を遠隔操作装置112の表示装置113に表示させて、外周端として登録する位置を表示装置113上でタッチすることで行っている。つまり、表示装置113に表示される画像における圃場とその外部との境界の特徴点(即ち境界特徴点)を作業者自身で判別して、表示装置113上で指定する。この場合、遠隔操作装置112の表示装置113は、車体部の位置情報、走行軌跡情報、及び、周辺情報を表示する表示部として機能するとともに、周辺情報に対して境界特徴点を指定するために操作される操作部としても機能する。そして、走行軌跡情報はユーザによって指定された境界特徴点に基づいて補正されて、変更後の線形状が圃場形状として登録される。走行軌跡情報の補正は更に、境界特徴点と関連特徴点に基づいて行われてもよい。関連特徴点とは、境界特徴点と同一又は類似する特徴を有する特徴点であり、例えば、地図画像(画像データ)上において、指定された境界特徴点と色相、彩度、明度が同一又は類似する(各要素の差異が所定閾値内であること)特徴点を関連特徴点として特定することが可能である。
【0058】
上記では圃場登録時に走行軌跡情報を補正することとしたが、走行軌跡情報及び周辺情報を対応付けて遠隔操作装置112に記憶させた上で、圃場端の位置情報の変更操作を事後的に、例えば、圃場設定の変更として行うことも可能である。
【0059】
周辺情報に基づいた圃場の外周端の認識方法としては、上述のようにカメラによって取得された映像上で作業者による視認で行う以外に、例えばカメラによって取得された画像データ上の色彩の差異又は明度の差異等、画像データ上の変位点を自動的に境界特徴点として判別する等が考えられる。また、レーザセンサ及び超音波センサ等の距離センサを用いる場合は、圃場端と畔との境界に存在する段差を距離の変化として検出して、その段差の下端を境界特徴点とすることで、圃場の外周端を自動的に認識することもできる(図11参照)。
【0060】
本明細書で、遠隔操作装置112は、自律走行作業車両1の経路Rを設定する際に用いられることとした。そして、経路Rの設定に必要な各種設定(上記トラクタ設定、圃場設定、経路生成設定)は遠隔操作装置112の表示装置113を適宜操作することで設定されることとしたが、経路Rの設定を制御部30(例えば自律走行制御コントローラ307)が行い、経路Rの設定に必要な各種設定はユーザが表示手段49を適宜操作することで設定可能であってもよい。言い換えれば圃場の形状を登録するシステムにおいて遠隔操作装置112が含まれないこととしてもよいし、遠隔操作装置112は含まれるが経路Rの設定において遠隔操作装置112が用いられないこととしてもよい。
【0061】
また、本明細書において走行軌跡情報の補正は圃場の形状を特定・登録するために行われることとしたが、圃場の形状に加え、或いは、圃場の形状に代えて、他の領域(自律走行作業車両1が走行する所定の領域(走行領域))の形状を特定・登録するために用いられてもよい。例えば上述した、作業領域の形状を特定・登録するために用いられてもよい。更には、自律走行作業車両の走行が禁止される所定の領域(非走行領域)の形状を特定・登録するために用いられてもよく。例えば上述した、障害物の形状を特定・登録するために用いられてもよい。特定・登録の対象が走行領域であっても、非走行領域であっても、周辺情報に基づいて走行軌跡情報を補正する点に差異はないが、一般に、走行領域において走行軌跡情報を取得するための走行は走行領域の端部の内側を走行するのに対して、非走行領域において走行軌跡情報を取得するための走行は走行領域の端部の外側を走行することが多い。この場合、走行領域における走行軌跡情報の補正は、走行軌跡情報により特定される閉じた線形状の面積を拡大する方向に行われる一方、非走行領域における走行軌跡情報の補正は、上記閉じた線形状の面積を縮小する方向に行われる。
【0062】
以上に記載された本明細書に基づく発明を考慮すると、本願発明は、作業車両が走行する走行領域(本明細書では例えば圃場により実現される)の形状を登録するシステムであって、衛星測位システム(本明細書では例えばGNSSにより実現される)により作業車両の位置情報を取得する位置情報取得手段(本明細書では例えば測位制御ユニットにより実現される)と、作業車両の周辺の環境情報を取得する環境情報取得手段(本明細書では例えば環境認識センサにより実現される)と、衛星測位システムによって取得される作業車両の位置情報に基づいて特定される作業車両の走行軌跡を示す走行軌跡情報を取得する走行軌跡情報取得手段(本明細書では例えば作業車両又は作業車両と無線通信可能な無線通信端末が備える制御手段により実現される)と、走行軌跡情報取得手段によって取得された環境情報に基づいて走行軌跡情報を補正して特定される特定領域(本明細書では例えば走行領域を補正することによって得られる領域により実現される)を走行領域の形状として登録する登録手段(本明細書では例えば作業車両又は作業車両と無線通信可能な無線通信端末が備える制御手段により実現される)とを備えることを特徴とするものである。
【0063】
また、本願発明において登録手段による走行軌跡情報の補正は、環境認識手段の位置情報及び環境情報を取得する方向にも基づいて行われる。また本願発明において、登録手段により登録された走行領域の形状(即ち補正後の走行領域の形状)を表示可能な表示手段(本明細書では例えば作業車両又は作業車両と無線通信可能な無線通信端末が備える画像表示部により実現される)と、表示手段に表示された走行領域の形状を操作可能な操作手段(本明細書では例えば表示手段が備えるタッチパネルにより実現される)とを備え、登録手段は表示手段に表示された走行領域の形状が操作手段に対する操作(本明細書では例えばコントロールポイントの追加や境界特徴点の指定により実現される)に応じて変更された変更後の領域を走行領域の形状として登録する。なお、登録手段により登録される前(即ち補正前の走行領域の形状)について操作手段に対する操作に応じて変更可能であってもよいことはいうまでもない。
【符号の説明】
【0064】
1:自律走行作業車両、30:制御部、34:移動GPSアンテナ、37:GPS衛星、41:障害物センサ、42F・42R:カメラ、112:遠隔操作装置、113:表示装置、306:測位制御ユニット、H:圃場
図1
図2
図3
図4
図5
図6
図7
図8
図9
図10
図11