JP6971577B2 - 走行経路生成装置及び走行経路生成プログラム - Google Patents

Description

本発明は、作業地を自動走行する作業車のための走行経路を生成する走行経路生成装置及び走行経路生成プログラムに関する。

近年、作業地を自動走行しながら作業を行う作業車が提案されている。このように作業車を自動走行させるためには、走行目標となる走行経路を生成する必要がある。作業地を網羅する走行経路を生成するためには、作業地の形状を正確に把握していることが前提条件となる。圃場などの作業地は、私的な農道などによって区画されているので、一般的な地図から正確な作業地の形状を求めることは困難である。

このため、特許文献１には、手動運転されたトラクタが圃場内を走行し、その走行軌跡によって圃場の外形データを取得するティーチング走行が開示されている。そのティーチング走行の手順は、以下のとおりである。
（１）トラクタに運転者が乗り込んで、人為操縦で、圃場に入る。
（２）トラクタのティーチングプログラムを起動させる。
（３）トラクタを圃場の最寄りのコーナに移動させ、枕地耕耘の開始点にトラクタを移動し、耕耘装置を下す。作業地形状算定モジュールは、耕耘装置を下す操作を通じて、その地点を圃場外形のコーナ点とみなす。
（４）一度耕耘装置を上げて、耕耘作業をイメージしながら次のコーナまで進む。
（５）切り返し走行の後、耕耘作業走行開始点に子トラクタを移動し、耕耘装置を下す。
この作業を繰り返して、圃場外形の各コーナ点を入力する。
（６）圃場外形のコーナ点及び圃場出入り口と出入り方向を入力パラメータとして、作業地形状が算定される。
このようにして算定された作業地形状を用いて、枕地の内側に位置する中央作業地をトラクタが自動走行するための走行経路が生成される。

特開２０１６−３１６４９号公報

圃場などの作業地では、作業地が畦などの境界によって区画されており、作業車が作業地に出入りするための出入口通路が作業地毎に決まっている。この出入口通路は、傾斜通路であったり、硬く固められた通路であったりして、作業車による作業対象にはならない領域である。しかしながら、特許文献１におけるティーチング走行を通じての作業地形状の算出においては、この出入口通路の存在が無視されている。このため、算出された作業地形状に対して生成された自動走行のための走行経路は、出入口通路に重なる可能性がある。また、走行経路と出入口通路との重なりを避けるため、走行経路が出入口通路から遠く離れた位置に設定されることで、走行経路によってカバーされない作業領域が残されるという問題も生じる。

このような実情から、本発明の課題は、作業地における自動走行するための作業対象領域を、簡単かつ正確に算出することが可能な走行経路生成装置及び走行経路生成プログラムを提供することである。

本発明による走行経路生成装置は、境界によって区画された作業地を、出入口通路を通じて出入する作業車のための装置であり、前記出入口通路の前記境界側の第１端点を始点として位置登録する始点登録部と、前記作業地の形状を規定する形状特徴点を経過点として位置登録する経過点登録部と、前記出入口通路の前記境界側の、前記第１端点と対向する第２端点を終点として位置登録する終点登録部と、前記始点の位置と前記経過点の位置と前記終点の位置とを結ぶことで前記作業地の基本形状を算出する基本形状算出部と、前記始点と前記終点とを対頂点とするとともに前記基本形状の外形延長線に沿った２辺を有する四角形を前記出入口通路の形状として出入口通路情報を生成する出入口通路情報生成部と、前記作業地の前記出入口通路以外の領域を作業対象領域とし、当該作業対象領域を前記作業車が自動走行するための走行経路を生成する走行経路生成部とを備え、前記始点、前記経過点、及び前記終点の位置は、前記作業車に搭載された衛星測位モジュールからの測位データに基づく自車位置を利用して算出され、前記出入口通路情報生成部は、前記出入口通路の形状を表す四角形の前記始点及び前記終点以外の頂点を、前記作業対象領域に接する内点と前記作業対象領域から離れた外点と定義し、前記外点と前記終点とを結ぶ辺から前記始点と前記内点とを結ぶ辺に向かう方向が前記作業車の前記作業対象領域への進入方向とする。
なお、この発明において用いられている幾何形状体を示す用語、例えば、三角形、四角形、長方形、多角形などは、幾何学的に厳密な形状を特定するために用いられているのではなく、ほぼ全体としてのそのような形状であることを言い表すために用いられている。
したがって、多角形の各辺が直線とは限らず、やや曲がっている場合も、凸凹となっている場合もある。

この構成によれば、出入口通路の一端を出発して、出入口通路の他端に戻ってくる作業地の境界に沿った移動において取得される始点の位置と経過点の位置と終点の位置とを結ぶことで、作業地の基本形状が算出される。経過点は、作業地を多角形と見なして、その形状特徴点である多角形の頂点に対応させているので、経過点の数は作業地が三角形なら１つ、四角形なら２つ、五角形なら３つとなる。出入口通路は、実質的には長方形である四角形とみなことができ、始点と終点がその長方形の対頂点に対応していることから、出入口通路を示す長方形の形状が算出できる。このことから、作業地の基本形状は、出入口通路対応する箇所に小さな長方形（四角形）が挟み込まれた多角形である。したがって、算出された作業地の形状から出入口通路を示す長方形を取り除くことで、作業車が作業しなければならない作業対象領域が得られる。走行経路生成部がこの作業対象領域を網羅する走行経路を生成することで、走行経路と出入口通路とが重なってしまう問題や走行経路が出入口通路から遠く離れてしまう問題が生じない走行経路が得られる。さらに、この構成では、作業車自体が、位置測定器として利用されるので、作業地が広大であっても、作業地形状測定のための移動が容易である。作業車に搭載されている衛星測位モジュールを用いた位置検出システムが流用されるので、コスト的にも有利である。

圃場などの作業地では、出入口通路は傾斜しているので、出入口通路から作業対象領域へ進入していく作業車の走行は直進であること、及び作業対象領域から出入口通路に退出する直前の作業車の走行は直進であることが、重要である。このことから、走行経路の生成にあたって、出入口通路での作業車の走行方向を走行経路生成の条件の１つとすることが重要である。このため、出入口通路の形状を算出するとともに、その走行方向も求められると、好都合である。この目的のため、前記出入口通路情報生成部は、前記出入口通路の形状を表す四角形の前記始点及び前記終点以外の頂点を、前記作業対象領域に接する内点と前記作業対象領域から離れた外点と定義し、前記外点と前記終点とを結ぶ辺から前記始点と前記内点とを結ぶ辺に向かう方向が前記作業車の前記作業対象領域への進入方向とするように構成されている。

出入口通路の形状を四角形と仮定する場合には、四角形の対頂点である始点と終点の位置から内点や外点を算出することができる。内点の位置は、出入口通路と作業対象領域との境界を決定するものとなるので、できるだけ実際の位置を検出したほうがよい。このため、本発明の好適な実施形態の１つでは、前記出入口通路の形状を表す四角形の前記始点及び前記終点以外の頂点を、前記作業対象領域に接する内点と前記作業対象領域から離れた外点と定義し、前記内点を登録する内点登録部が備えられている。実際の位置として登録された内点を採用することで、出入口通路の形状がより正確に算出することができる。

始点、経過点、及び終点の位置登録に必要となる位置座標は、作業地座標系であってもいいし、緯度経度系であってもよいが、自動走行する作業車には、衛星測位モジュールが搭載されているので、これを利用するのが好都合である。このため、本発明の好適な実施形態の１つでは、前記始点、前記経過点、及び前記終点の位置登録は、前記作業車の前記境界に沿った走行を通じて行われる。

作業車自体を位置測定器として用いる場合、作業車が作業地の形状特徴点（多角形の頂点）に接近しても、通常自動走行のために設定されている自車位置と、当該形状特徴点の位置との間に距離がある。この距離による位置誤差を解消するため、本発明の好適な実施形態の１つでは、前記作業車のコーナ部には、前記始点、前記経過点、及び前記終点の位置に対応付けられる１つ以上の照準点が規定されており、前記始点、前記経過点、及び前記終点の位置は、前記自車位置から前記照準点までの距離によって前記自車位置を修正することで算出されるように構成されている。これにより、作業車の適当なコーナ部（照準点）を作業地の形状特徴点に接近させるだけで、作業車による正確な位置測定が可能となる。好ましくは、このような照準点を、作業車の右前端部、左前端部、右後端部、左後端部に設定して、そのうちのいずれかを選択されるように構成すれば、スムーズに照準点を作業地の形状特徴点に合わせることができる。

本発明は、出入口とは無関係に、作業地における任意の領域の形状を作業対象領域として算出し、走行経路を生成する走行経路生成装置にも適用される。そのような作業車のための走行経路生成装置では、作業走行するための作業対象領域の第１端点を始点として位置登録する始点登録部と、前記作業対象領域の形状を規定する形状特徴点を経過点として位置登録する経過点登録部と、前記第１端点または前記第１端点に隣接する第２端点を終点として位置登録する終点登録部と、前記始点の位置と前記経過点の位置と前記終点の位置とを結ぶことで前記作業対象領域の基本形状を算出する基本形状算出部と、前記作業対象領域を前記作業車が自動走行するための走行経路を生成する走行経路生成部とが備えられ、前記作業車または前記作業対象領域を走行可能な車両のコーナ部には、前記始点、前記経過点、及び前記終点の位置に対応付けられる１つ以上の照準点が規定されており、前記始点、前記経過点、及び前記終点の位置は、前記作業車に搭載された衛星測位モジュールからの測位データに基づいて算出される自車位置から前記照準点までの距離によって前記自車位置を修正することで算出される。この走行経路生成装置は作業車あるは前記作業対象領域を走行可能な車両を位置測定器として用いるので、広大な作業対象領域であってもスムーズに形状算出を行うことができる。

上述した走行経路生成装置の機能は、実質的には、コンピュータにインストールされたコンピュータプログラムの実行によって実現することができる。このため、本発明は、そのようなコンピュータプログラムも権利対象としている。本発明による走行経路生成プログラムは、境界によって区画された作業地を、出入口通路を通じて出入する作業車のためのプログラムであり、前記出入口通路の前記境界側の第１端点を始点として位置登録する始点登録機能と、前記作業地の形状を規定する形状特徴点を経過点として位置登録する経過点登録機能と、前記出入口通路の前記境界側の、前記第１端点と対向する第２端点を終点として位置登録する終点登録機能と、前記始点の位置と前記経過点の位置と前記終点の位置とを結ぶことで前記作業地の基本形状を算出する基本形状算出機能と、前記始点と前記終点とを対頂点とするとともに前記基本形状の外形延長線に沿った２辺を有する四角形を前記出入口通路の形状として出入口通路情報を生成する出入口通路情報生成機能と、前記作業地の前記出入口通路以外の領域を作業対象領域とし、当該作業対象領域を前記作業車が自動走行するための走行経路を生成する走行経路生成機能と、前記始点、前記経過点、及び前記終点の位置を、前記作業車に搭載された衛星測位モジュールからの測位データに基づく自車位置を利用して算出する機能と、前記出入口通路の形状を表す四角形の前記始点及び前記終点以外の頂点を、前記作業対象領域に接する内点と前記作業対象領域から離れた外点と定義し、前記外点と前記終点とを結ぶ辺から前記始点と前記内点とを結ぶ辺に向かう方向が前記作業車の前記作業対象領域への進入方向とする機能と、をコンピュータに実現させる。この走行経路生成プログラムの作用効果は、上述した走行経路生成装置の作用効果と同じである。また、上述した走行経路生成装置の好適な実施形態も、この走行経路生成プログラムに適用可能である。

同様に、本発明は、出入口とは無関係に、作業地における任意の領域の形状を作業対象領域として算出し、走行経路を生成する走行経路生成プログラムにも適用される。この作業車のための走行経路生成プログラムは、作業走行するための作業対象領域の第１端点を始点として位置登録する始点登録機能と、前記作業対象領域の形状を規定する形状特徴点を経過点として位置登録する経過点登録機能と、前記第１端点または前記第１端点に隣接する第２端点を終点として位置登録する終点登録機能と、前記始点の位置と前記経過点の位置と前記終点の位置とを結ぶことで前記作業対象領域の基本形状を算出する基本形状算出機能と、前記作業対象領域を前記作業車が自動走行するための走行経路を生成する走行経路生成機能と、前記始点、前記経過点、及び前記終点の位置に対応付けられる１つ以上の、前記作業車または前記作業対象領域を走行可能な車両のコーナ部に規定される照準点と、前記作業車に搭載された衛星測位モジュールからの測位データに基づいて算出される自車位置との間の距離によって前記自車位置を修正することで、前記始点、前記経過点、及び前記終点の位置を算出する機能とをコンピュータに実現させる。この走行経路生成プログラムの作用効果も、上述した走行経路生成装置の作用効果と同じである。また、上述した走行経路生成装置の好適な実施形態も、この走行経路生成プログラムに適用可能である。

出入口通路を通って、畦によって区画された作業地に侵入して、作業地の形状測定する作業車の様子を示す模式図である。 作業車の一例であるトラクタの側面図である。 走行経路生成装置として機能する制御機能部を示す機能ブロック図である。 走行経路生成装置における、作業地及び出入口通路の形状を算出する過程を示す流れ図である。 トラクタに設定された照準点と、タッチパネルに表示された照準点選択ボタンとの関係を示す模式図である。

図面を用いて、本発明による走行経路生成装置を搭載した作業車の実施形態の１つを説明する。この実施形態では、作業車は、車体１に作業装置３０を装備したトラクタである。最初に、トラクタはユーザによって運転され、圃場形状を算出するためのティーチング走行を行う。このティーチング走行では、トラクタは、農道から下向きに傾斜した出入口通路を通って、圃場内に進入し、畦によって区画された圃場の境界に沿って周回走行する。その際、後で詳しく説明するが、出入口通路の畦側の第１端点が始点Ｐｓとして位置登録され、圃場の形状を規定する形状特徴点が経過点Ｐ１、Ｐ２、Ｐ３として位置登録され、出入口通路の畦側の、第１端点と対向する第２端点が終点Ｐｅとして位置登録される。始点Ｐｓと経過点Ｐ１、Ｐ２、Ｐ３と終点Ｐｅとを結ぶ線によって圃場の基本形状が算出される。この圃場の基本形状から出入口通路を除外した領域が、作業対象領域と称せられる。さらに、出入口通路の形状を四角形と見なし、始点Ｐｓと終点Ｐｅ以外の頂点内作業対象領域に接する頂点を内点Ｐａと定義し、作業対象領域から離れた頂点を外点Ｐｂと定義する。

図２に示されているように、このトラクタは、前輪１１と後輪１２とによって支持された車体１の中央部に運転室２０が設けられている。車体１の後部には油圧式の昇降機構３１を介してロータリ耕耘装置である作業装置３０が装備されている。前輪１１は操向輪として機能し、その操舵角を変更することでトラクタの走行方向が変更される。前輪１１の操舵角は操舵機構１３の動作によって変更される。操舵機構１３には自動操舵のための操舵モータ１４が含まれている。手動走行の際には、前輪１１の操舵は運転室２０に配置されているステアリングホイール２２の操作によって行われる。運転室２０には、ユーザによる指令を受け付けるとともにユーザに情報を提供する汎用端末４が装備されている。トラクタのキャビン２１には、衛星測位モジュール８０が設けられている。衛星測位モジュール８０の構成要素として、ＧＮＳＳ（global navigation satellite system）信号（ＧＰＳ信号を含む）を受信するための衛星用アンテナがキャビン２１の天井領域に取り付けられている。なお、この衛星測位モジュール８０に、衛星航法を補完するために、ジャイロ加速度センサや磁気方位センサを組み込んだ慣性航法モジュールを組み合わせることも可能である。もちろん、慣性航法モジュールは、衛星測位モジュール８０とは別の場所に設けてもよい。

図３には、このトラクタに構築されている制御系が示されている。この実施形態の制御系は、グラフィカルユーザインターフェースを備えた汎用端末４である第１制御ユニットと、トラクタの車体１や作業装置３０の制御を行う制御ユニット５と、トラクタの走行開始と走行停止とを外部から無線で制御するためのリモコン８４とを備えている。本発明による走行経路生成装置は経路生成モジュール６としてモジュール化され、汎用端末４に組み込まれている。

汎用端末４は、経路生成モジュール６以外に、通信制御部４０、タッチパネル６０、タッチパネル６０に対する入力操作やタッチパネル６０での情報表示を管理する入出力管理部６１など、一般的なコンピュータシステムの諸機能を備えている。汎用端末４は、車載ＬＡＮ、無線通信、有線通信などによって、制御ユニット５とデータ交換可能に接続されている。さらに、汎用端末４は、遠隔地の管理センタＫＳに構築された管理コンピュータ１００とも、無線回線やインターネットを通じて、データ交換可能である。また、汎用端末４をタブレットコンピュータや携帯電話などで構成し、トラクタの制御系とデータ交換可能に接続すれば、汎用端末４をトラクタの外に持ち出して、使用することも可能である。

この実施形態では、圃場の地図上の位置や圃場を取り巻く農道等の配置などを含む圃場情報が、管理コンピュータ１００の圃場情報格納部１０１に格納されており、この圃場情報は、作業すべき圃場を見つけ出すために必要となる。管理コンピュータ１００は、指定された圃場での作業内容を記述した作業計画書を管理している作業計画管理部１０２も備えている。汎用端末４は、管理コンピュータ１００にアクセスし、圃場情報格納部１０１から圃場情報を、そして作業計画管理部１０２から作業計画書をダウンロードすることができる。あるいは、汎用端末４は、ＵＳＢメモリなどの記録媒体を通じて圃場情報や作業計画書を入力することも可能である。

経路生成モジュール６は、ティーチング走行を通じて、圃場の作業有効領域である作業対象領域の形状を算出する作業地形状算出サブモジュール６２と、当該作業対象領域をトラクタが走行するための走行経路を生成する走行経路生成部６３とを備えている。作業地形状算出サブモジュール６２には、始点登録部６２１、経過点登録部６２２、終点登録部６２３、基本形状算出部６２４、出入口通路情報生成部６２５、形状編集部６２６が含まれている。さらに、オプションとして内点登録部６２７も用意されている。

次に、図４に示されている、圃場形状算出処理及び走行経路生成処理の流れ図を用いて、経路生成モジュール６の各機能部の基本的な役割を説明する。図４では、圃場の形状は台形で、上辺右端に下向き傾斜した出入口通路が設けられている。さらに、図５で示すように、トラクタの４つのコーナ部に照準点Ｔ１、Ｔ２、Ｔ３，Ｔ４が規定されており、これらの照準点Ｔ１、Ｔ２、Ｔ３，Ｔ４と、衛星測位モジュール８０からの測位データに基づく自車位置（図５では、車体中央の黒丸で示されている）との間の距離が予め設定されており、各照準点Ｔ１、Ｔ２、Ｔ３，Ｔ４の位置座標が、自車位置から算出可能である。タッチパネル６０には、照準点選択ボタンＢ１、Ｂ２、Ｂ３，Ｂ４が表示され、押された照準点選択ボタンＢ１、Ｂ２、Ｂ３，Ｂ４に対応する照準点が、以下の圃場形状算出処理で有効となる。

農道を通って、目的の圃場に到着したトラクタは、当該圃場の形状を算出するために、ティーチング走行を行う。ここでは、照準点選択ボタンＢ１が押され、照準点Ｔ１を有効となっている。

まず、運転者は、出入口通路を通り、出入口通路を下った右側の端部（第１端点）に照準点Ｔ１がくるようにトラクタを操縦し、タッチパネル６０に表示された登録ボタンＲＢ（図５参照）を押す。これにより、始点登録部６２１は、第１端点を始点（図４で黒丸とＰｓで示されている）として登録する。

次に、運転者は、圃場の形状特徴点（幾何形状体、ここでは台形の頂点）である上辺左端に照準点Ｔ１がくるようにトラクタを進め、登録ボタンＲＢを押す。これにより、経過点登録部６２２は、上辺左端を第１経過点（図４で黒丸とＰ１で示されている）として登録する。さらに、下辺左端に照準点Ｔ１がくるようにトラクタを進め、登録ボタンＲＢを押す。これにより、経過点登録部６２２は、下辺左端を第２経過点（図４で黒丸とＰ２で示されている）として登録する。さらに、下辺右端に照準点Ｔ１がくるようにトラクタを進め、登録ボタンＲＢを押す。これにより、経過点登録部６２２は、下辺右端を第３経過点（図４で黒丸とＰ３で示されている）として登録する。

次に、運転者は、第３経過点を設定した圃場の下辺右端から畦（境界）に沿ってトラクタを進め、出入口通路と境界との交点となる端点に照準点Ｔ１がくる位置でトラクタを停止させ、登録ボタンＲＢを押す。終点登録部６２３は、登録ボタンＲＢが押された位置が始点と近接しているので、この位置を終点（図４で黒丸とＰｅで示されている）とみなして登録する。あるいは、運転者が終点を示す指示操作を行った後に登録ボタンＲＢを押すことで、登録位置が終点であることを終点登録部６２３に指令してもよい。

これにより、始点と３つの経過点と終点との位置座標が得られたので、基本形状算出部６２４はこれらの点を結ぶことで、作業地の基本形状を算出する。

続いて、出入口通路情報生成部６２５は、出入口通路の形状寸法や出入口通路の走行方向などの出入口通路情報を生成する。図４に示されているように、出入口通路は、部分的な通路であるので、実質的には四角形とみなして差し支えない。この出入口通路を示す四角形の２つの対頂点は、始点と終点である（図４で黒丸とＰｓ、Ｐｅで示されている）。したがって、あと２つの頂点を求めることで出入口通路の形状寸法が得られる。そこで、この出入口通路を示す四角形が隣接する圃場の境界線の延長線（作業地基本形状の外形延長線）を２辺とする平行四辺形（長方形や正方形を含む）とみなすと、圃場内側の頂点（外点と称する）と圃場外側の頂点（内点と称する）の位置座標は、幾何学的な演算で簡単に求めることができる。図４では、内点は白丸とＰａで示され、外点は白丸とＰｂで示されている。さらに、外点と終点とを結ぶ辺から始点と内点とを結ぶ辺に向かう方向がトラクタの圃場内部への進入方向（走行方向）であると見なすことができる。

始点と３つの経過点と終点と内点とを結ぶことで得られる輪郭線によって、圃場における出入口通路以外の領域、つまり有効作業領域である作業対象領域が規定される。この輪郭線は、実質的には、トラクタの走行によって得られているので、必ずしも正確ではない。例えば、トラクタが走行できないような凹部や凸部があれば、そのような凹部や凸部は無視される。このため、始点と３つの経過点と終点と内点とを結ぶことで得られる輪郭線を修正する形状編集部６２６が備えられている。この形状編集部６２６は、タッチパネル６０に表示された輪郭線を、例えばペジェ曲線の編集のような要領でユーザが編集することを可能にする。

なお、オプションである内点登録部６２７が利用可能な場合、終点の登録後に、さらに、運転者は、トラクタを、出入口通路と作業対象領域との境界線の内側の端点に出入口通路を下った右側の端部（第１端点）に照準点Ｔ１がくるようにトラクタを操縦し、照準点Ｔ１がくる位置でトラクタを停止させ、登録ボタンＲＢを押す。これにより内点登録部６２７は、当該位置を内点（図４で白丸とＰａで示されている）として登録する。

これまでの説明で、照準点Ｔ１だけが利用されていたが、その他の照準点Ｔ２、Ｔ３，Ｔ４の方が、目的の位置に接近しやすい場合がある。特に後進で接近する場合には、照準点Ｔ３，Ｔ４が好都合である。そのような場合には、照準点選択ボタンＢ１、Ｂ２、Ｂ３，Ｂ４から所望の照準点に対応するボタンを選んで押すことで、有効となる照準点が変更される。

作業対象領域が決定されると、走行経路生成部６３が、当該作業対象領域を前記作業車が自動走行するための走行経路を生成する。生成される走行経路は、図４では、直進経路と各直進経路同士をつなぐＵターン経路とからなる内側走行経路と、圃場の外周領域を周回走行するための周回走行経路とから構成されている。もちろん、これに代えて、圃場を渦巻き状に走行する渦巻き走行経路やその他の走行経路が生成されるアルゴリズムを採用してもよい。

図３に示すように、トラクタの制御系の中核要素である制御ユニット５には、入出力インタフェースとして機能する、出力処理部７、入力処理部８、通信処理部７０が備えられている。出力処理部７は、トラクタに装備されている、車両走行機器群７１、作業装置機器群７２、報知デバイス７３などと接続している。車両走行機器群７１には、操舵モータ１４や、図示されていないが変速機構やエンジンユニットなど車両走行のために制御される機器が含まれている。作業装置機器群７２には、作業装置３０の駆動機構や、作業装置３０を昇降させる昇降機構３１などが含まれている。報知デバイス７３には、ディスプレイやランプやスピーカが含まれている。報知デバイス７３は、走行注意事項や自動操舵走行での目標走行経路からの外れなど、注意情報や警告情報を運転者や監視者に報知するために用いられる。通信処理部７０は、制御ユニット５で処理されたデータを管理コンピュータ１００に送信するとともに、管理コンピュータ１００から種々のデータを受信する機能を有する。さらに、通信処理部７０は、リモコン８４からのリモコン指令を入力する。

入力処理部８は、衛星測位モジュール８０、走行系検出センサ群８１、作業系検出センサ群８２、自動／手動切替操作具８３などと接続している。走行系検出センサ群８１には、エンジン回転数や変速状態などの走行状態を検出するセンサが含まれている。作業系検出センサ群８２には、作業装置３０の位置や傾きを検出するセンサ、作業負荷などを検出するセンサなどが含まれている。自動／手動切替操作具８３は、自動操舵で走行する自動走行モードと手動操舵で走行する手動操舵モードとのいずれかを選択するスイッチである。

さらに、制御ユニット５には、走行制御部５０、作業制御部５４、自車位置算出部５３、走行経路設定部５５、報知部５６が備えられている。自車位置算出部５３は、衛星測位モジュール８０から送られてくる測位データに基づいて、自車位置を算出する。上述したティーチング走行の実行中は、算出された自車位置は、作業地形状算出サブモジュールに与えられる。車両走行機器群７１を制御する走行制御部５０には、このトラクタが自動走行（自動操舵）と手動走行（手動操舵）の両方で走行可能に構成されているため、手動走行制御部５１と自動走行制御部５２とが含まれている。手動走行制御部５１は、運転者による操作に基づいて車両走行機器群７１を制御する。自動走行制御部５２は、走行経路設定部５５で設定された走行経路と自車位置との間の方位ずれ及び位置ずれを算出し、自動操舵指令を生成する。この自動操舵指令は、出力処理部７を介して操舵モータ１４に出力される。自動走行制御部５２は、リモコン８４からの停止指令に基づいてトラクタを停止させるとともに、リモコン８４からの開始指令に基づいてトラクタの走行を開始させる。作業制御部５４は、作業装置３０の動きを制御するために、作業装置機器群７２に制御信号を与える。報知部５６は、運転者や監視者に必要な情報を報知するための報知信号（表示データや音声データ）を生成して、計器パネルに組み込まれた報知デバイス７３に与える。

走行経路設定部５５は、経路生成モジュール６によって生成された走行経路を汎用端末４の走行経路生成部６３から通信処理部７０を介して受け取り、トラクタの目標走行経路として設定する。

〔別実施の形態〕
（１）上述した実施形態では、作業地の出入口の位置形状を算出し、作業地から出入口を除外した領域である作業対象領域を算出し、当該作業対象領域を自動走行するための走行経路を生成している。この実施形態に代えて、出入口とは無関係に、作業地における任意の領域の形状を作業対象領域として算出し、走行経路を生成する実施形態を採用してもよい。そのような走行経路生成装置では、経路生成モジュール６の作業地形状算出サブモジュール６２において、出入口通路情報生成部６２５や内点登録部６２７が不要となる。
（２）上述した実施形態では、経路生成モジュール６は、実際の作業に用いられるトラクタに装備されており、照準点Ｔ１、Ｔ２、Ｔ３，Ｔ４も当該トラクタのコーナ部に規定されていた。これに代えて、トラクタ以外の別な車両、例えば、作業地（圃場）をより速い速度で走行可能で、衛星測位機能を備えた多目的車両に、経路生成モジュール６、または、作業地形状算出サブモジュール６２を装備し、作業地（圃場）の形状を算出させてもよい。
（３）図３で示された機能ブロック図における各機能部は、主に説明目的で区分けされている。実際には、各機能部は他の機能部と統合または複数の機能部に分けることができる。例えば、経路生成モジュール６を、特に走行経路生成部６３を作業車の制御ユニット５内に構築してもよい。
（４）上述した実施形態では、作業車として、ロータリ耕耘機を作業装置３０として装備したトラクタを、作業車として取り上げたが、そのようなトラクタ以外にも、例えば、田植機、施肥機、コンバインなどの農作業車にも適用可能である。

本発明による走行経路生成装置は、設定された走行経路に沿って作業地を作業する作業車のために適用可能である。

５ ：制御ユニット
５０ ：走行制御部
５３ ：自車位置算出部
５５ ：走行経路設定部
８０ ：衛星測位モジュール
６ ：経路生成モジュール
６０ ：タッチパネル
６１ ：入出力管理部
６２ ：作業地形状算出サブモジュール
６２１ ：始点登録部
６２２ ：経過点登録部
６２３ ：終点登録部
６２４ ：基本形状算出部
６２５ ：出入口通路情報生成部
６２６ ：形状編集部
６２７ ：内点登録部
６３ ：走行経路生成部
Ｐｓ ：始点
Ｐ１ ：経過点
Ｐ２ ：経過点
Ｐ３ ：経過点
Ｐｅ ：終点
Ｐａ ：内点
Ｐｂ ：外点

Claims (6)

1. 境界によって区画された作業地を、出入口通路を通じて出入する作業車のための走行経路生成装置であって、
   前記出入口通路の前記境界側の第１端点を始点として位置登録する始点登録部と、
   前記作業地の形状を規定する形状特徴点を経過点として位置登録する経過点登録部と、
   前記出入口通路の前記境界側の、前記第１端点と対向する第２端点を終点として位置登録する終点登録部と、
   前記始点の位置と前記経過点の位置と前記終点の位置とを結ぶことで前記作業地の基本形状を算出する基本形状算出部と、
   前記始点と前記終点とを対頂点とするとともに前記基本形状の外形延長線に沿った２辺を有する四角形を前記出入口通路の形状として出入口通路情報を生成する出入口通路情報生成部と、
   前記作業地の前記出入口通路以外の領域を作業対象領域とし、当該作業対象領域を前記作業車が自動走行するための走行経路を生成する走行経路生成部と、を備え、
   前記始点、前記経過点、及び前記終点の位置は、前記作業車に搭載された衛星測位モジュールからの測位データに基づく自車位置を利用して算出され、
   前記出入口通路情報生成部は、前記出入口通路の形状を表す四角形の前記始点及び前記終点以外の頂点を、前記作業対象領域に接する内点と前記作業対象領域から離れた外点と定義し、前記外点と前記終点とを結ぶ辺から前記始点と前記内点とを結ぶ辺に向かう方向が前記作業車の前記作業対象領域への進入方向とする走行経路生成装置。
2. 前記内点を登録する内点登録部が備えられている請求項１に記載の走行経路生成装置。
3. 前記始点、前記経過点、及び前記終点の位置登録は、前記作業車の前記境界に沿った走行を通じて行われる請求項１又は２に記載の走行経路生成装置。
4. 前記作業車のコーナ部には、前記始点、前記経過点、及び前記終点の位置に対応付けられる１つ以上の照準点が規定されており、前記始点、前記経過点、及び前記終点の位置は、前記自車位置から前記照準点までの距離によって前記自車位置を修正することで算出される請求項３に記載の走行経路生成装置。
5. 前記照準点が複数規定されており、前記複数の照準点のうちから有効な照準点が選択可
   能である請求項４に記載の走行経路生成装置。
6. 境界によって区画された作業地を、出入口通路を通じて出入する作業車のための走行経路生成プログラムであって、
   前記出入口通路の前記境界側の第１端点を始点として位置登録する始点登録機能と、
   前記作業地の形状を規定する形状特徴点を経過点として位置登録する経過点登録機能と、
   前記出入口通路の前記境界側の、前記第１端点と対向する第２端点を終点として位置登録する終点登録機能と、
   前記始点の位置と前記経過点の位置と前記終点の位置とを結ぶことで前記作業地の基本形状を算出する基本形状算出機能と、
   前記始点と前記終点とを対頂点とするとともに前記基本形状の外形延長線に沿った２辺を有する四角形を前記出入口通路の形状として出入口通路情報を生成する出入口通路情報生成機能と、
   前記作業地の前記出入口通路以外の領域を作業対象領域とし、当該作業対象領域を前記作業車が自動走行するための走行経路を生成する走行経路生成機能と、
   前記始点、前記経過点、及び前記終点の位置を、前記作業車に搭載された衛星測位モジュールからの測位データに基づく自車位置を利用して算出する機能と、
   前記出入口通路の形状を表す四角形の前記始点及び前記終点以外の頂点を、前記作業対象領域に接する内点と前記作業対象領域から離れた外点と定義し、前記外点と前記終点とを結ぶ辺から前記始点と前記内点とを結ぶ辺に向かう方向が前記作業車の前記作業対象領域への進入方向とする機能と、をコンピュータに実現させる走行経路生成プログラム。
   

Images