JP6525902B2 - 圃場作業車両 - Google Patents

Description

本発明は、圃場内を走行する走行機体と、機体位置を示す測位データを出力する測位ユニットと、走行機体を自動操舵走行させる自動操舵部とを備えた圃場作業車両に関する。

最初に、運転者の操舵による直線走行であるティーチング走行を行い、このティーチング走行によって得られた基準線に対して、平行な目標経路を生成し、この目標経路上を自動走行する田植機（圃場作業機の一種）が、特許文献１から知られている。その際、ティーチング開始時にティーチングＳＷが押下され、その押下された時の機体位置を開始点とし、またティーチング終了時にティーチングＳＷが押下され、その押下された時の機体位置を終了点とする。この開始点と終了点とを結ぶ線が基準線として生成され、この基準線と作業幅（植付幅×植付条数）に基づいて基準線に平行な目標経路が生成される。次の目標行経路への方向転換（Ｕターン）は、運転者による人為操舵で行われる。

特開２００８−６７６１７号

特許文献１で開示されているような田植機では、最初に、直線状の基準線を作成し、この基準線を平行移動させることで、自動操舵のための目標経路を作成する。このため、この田植機では、直線とＵターンとを組み合わせた作業走行に限定される。圃場の外周が四角形でなく、作業走行の途中で直線から斜めに延びるような異形形状の場合、上述したティーチングによる自動操舵は不可能であり、圃場を複数の四角形の組み合わせに置きかえて、それぞれ、別々のティーチングによる自動操舵を行わなければならない。
このような実情に鑑み、正確に四角形でない、屈曲変形したような異形の圃場に対しても、ティーチングを用いた自動操舵が可能な圃場作業車両が要望されている。

本発明による圃場作業車両は、圃場内を走行する走行機体と、前記圃場に対して作業を行う圃場作業装置と、機体位置を示す測位データを出力する測位ユニットと、前記走行機体を人為操舵走行させる人為操舵部と、前記走行機体を自動操舵走行させる自動操舵部と、所定距離での直進走行をティーチング走行と判定する判定部と、前記判定部によって判定されたティーチング走行で取得された走行方位をティーチング方位として取得するティーチング方位取得部と、前記ティーチング方位取得部で取得されたティーチング方位に基づいて自動操舵走行のための目標走行方位を算定する目標走行方位算定部とを備えている。

この構成では、所定距離の直進走行を判定部がティーチング走行と判定すれば、ティーチング方位取得部は、その直進走行での方位をティーチング方位と見なして、自動操舵走行のための目標走行方位を算定するために用いる。つまり、従来のように、圃場の一辺に匹敵する長い距離のティーチング走行によって得られたティーチング方位を基準として、往復走行毎に作業幅分だけずらせて繰り返し利用する方法ではない。これに代えて、圃場の作業走行中においても、所定距離の走行が、ティーチング走行として利用できるとみなされると、その走行をティーチング走行とみなし当該走行に基づいて求められたティーチング方位で、自動操舵走行のための目標方位が更新される。例えば、作業走行経路が、一直線ではなく、途中で屈曲点を有し、折れ曲がって延びていたとしても、運転者の人為操舵でその屈曲点を通過した後の直線走行が、新たなティーチング走行と見なされ、新たな目標走行方位が算定される。その結果、屈曲点の通過だけは人為操舵で行われても、引き続いての直線走行は新たに算定された目標走行方位に基づく自動操舵が可能となる。

判定部がティーチング走行と判定する条件は、圃場作業、圃場種別、作業車両種別等によって異なるが、所定条件の直線走行をティーチング走行と判定することできる。所定距離の直線走行という条件は、具体的には、例えば、走行距離が１ｍから数ｍ、あるいは数十ｍ以上の間で、走行機体の方位の継時的な変化が数度以内に保持されることとしてもよい。その際、走行機体の方位の継時的な変化は、衛星航法用モジュールや慣性航法用モジュールなどから出力される測位データから算定することができるが、操向角度（操向輪の切れ角）の検出値から算定してもよい。なお、田植機による苗植付け作業は、トラクタによる耕耘作業に比べて、より厳しん直進性が要求されるので、ティーチング走行と判定する条件も厳しくするほうがよい。

このように、連続する所定距離の走行をティーチング走行と見なして、ティーチング方位を新たに取得し、当該ティーチング方位に基づいて目標走行方位を更新していく場合、外乱等に起因する方位の変動はできるだけ平滑化されることが望ましい。このことから、本発明の好適な実施形態の１つでは、前記目標走行方位算定部は継時的に取得されるティーチング方位の移動平均演算によって前記目標走行方位を算定する。これにより、所定距離毎の走行でティーチング方位が取得されたとしても、局地的な方位変動が、算定される目標走行方位に及ぼす影響は少なくなる。

圃場作業車両が田植機の場合、枕地と呼ばれる畦際でＵターン（ほぼ１８０の度旋回）走行を行う走行が主である。Ｕターン走行が、人為操舵あるいは自動操舵で行われるとしてもＵターン走行直後では、目標走行方位の更新が間に合わない可能性がある。この問題は、Ｕターン走行が行われた直後には、これまで用いていた目標走行方位をほぼ１８０度補正（逆方向）したものを仮に使用することで解消できる。このことから、本発明の好適な実施形態の１つでは、人為操舵走行によるＵターン走行を検知するＵターン検知部が備えられ、前記Ｕターン走行直後の自動操舵走行の目標走行方位は、当該Ｕターン走行直前の目標走行方位を前記Ｕターンに相当する角度だけ補正した方位とする。

圃場作業車両がトラクタの場合、四角形の渦巻きを走行軌跡として周回走行を繰り返す走行が少なくない。ここでも、コーナ部でのＬ字旋回（ほぼ９０度の旋回）が、人為操舵あるいは自動操舵で行われるとしてもこのＬ字旋回走行直後では、目標走行方位の更新が間に合わない可能性がある。このことから、本発明の好適な実施形態の１つでは、人為操舵走行によるＬ字旋回走行を検知するＬ字旋回検知部が備えられ、前記Ｌ字旋回走行直後の自動操舵走行の目標走行方位は、当該Ｌ字旋回走行直前の目標走行方位を前記Ｌ字旋回に相当する角度だけ補正した方位とする。

圃場に、井戸や電柱などの障害物がある場合、運転者はこれを人為操舵で回避して、再び直線走行に戻る障害物回避走行を行う。このような障害物回避走行は、極めて特徴的な走行パターンを示すので、比較的容易に検知することができる。したがって、この障害物回避走行を挟んでスムーズに自動操舵走行を行うため、本発明の好適な実施形態の１つでは、直進から旋回を経て再度直進に復帰する障害物回避走行を検知する障害物回避検知部が備えられ、前記障害物回避走行直後の自動操舵走行の目標走行方位は、当該障害物回避走行直前の目標走行方位とする。

本発明による圃場作業車両に採用されている自動操舵制御の基本原理を説明する模式図である。 本発明による圃場作業車両の実施形態の１つである田植機の側面図である。 本発明による圃場作業車両の実施形態の１つである田植機の平面図である。 田植機の操舵系を示す模式図である。 田植機の走行制御に関する機能を示す機能ブロック図である。 田植機の走行制御に関する制御の一例を示すフローチャート図である。

本発明による圃場作業車両の具体的な実施形態を説明する前に、図１を用いて、その圃場作業車両に採用されている車両制御の基本原理を説明する。
図１では、圃場作業車両として、田植機、播種機、トラクタ、コンバインなどが想定されている。圃場作業装置として、田植機では植付け装置が装備され、播種機では播種装置が装備され、トラクタでは耕耘装置が装備され、コンバインでは刈取装置が装備される。これらの圃場作業装置は、それぞれの走行機体に連結されている。

図１において、圃場作業車両（以下単に車両と略称する）の作業対象となっている圃場は、四角形ではなく、途中で折れ曲がった形状（四角形＋平行四辺形）である。したがって、車両は、図１では紙面の上側となる上側畦際（上側枕地）と図１では紙面の下側となる下側畦際（枕地）で、Ｕターン走行（ほぼ１８０度の方向転換走行）を行いながら、最初の直線経路と、この直線経路から折れ曲がってやや斜めに延びている次の直線経路からなる走行経路を往復する。

車両は、自車位置を示す測位データを出力する測位ユニットを装備している。さらには、走行機体を人為操作に基づいて操舵する人為操舵部だけではなく、走行機体を自動操舵する自動操舵部も装備されている。なお、測位ユニットから出力される測位データは、アンテナの位置が基準となるが、ここでは、自車位置は、アンテナの位置ではなく、車両の適切な位置、例えば、圃場作業装置の対地作用点などとなるように補正処理が施されている。

まず、上側畦際に入り込んだ車両は、地点Ｐ１から初期走行を実行する。この初期走行は、人為操舵運転でも自動操舵運転でもよいが、最初から自動操舵運転を行う場合には、最初に人為的に目標案内方位を設定する必要がある。いずれにせよ、地点Ｐ１から走行が開始されると、自車位置を示す測位データが順次生成される。この測位データに基づいて、現在の走行が、ティーチング方位を取得するに適した直進走行であるかどうかチェックされる。例えば、所定走行距離（図１では地点Ｐ１から地点Ｐ３までの走行）あたりの走行方位変動が所定角以内であれば、適切な直進であるとみなし、結果的に当該走行はティーチング走行とみなされると判定される。ティーチング走行とみなされた走行経路（地点Ｐ１から地点Ｐ３）で取得された測位データから走行方位を求め、当該走行方位（ティーチング方位）を、地点Ｐ３からの自動操舵走行のための目標走行方位とする。

図１の例では、車両走行がティーチング走行として適切であるかどうかの判定は、判定対象となる走行経路を隣接する走行経路とオーバーラップさせながら行われる。つまり、地点Ｐ１から地点Ｐ３までの走行経路、地点Ｐ３（地点Ｐ１とＰ３の中間点）からＰ４までの走行経路、地点Ｐ４から地点Ｐ５までの走行経路、といったように、ティーチング走行判定のための走行経路が設定されていく。

車両が、往復走行経路の屈曲点に接近すると、運転者による人為操舵により、次の直線経路の方向に方向転換される。この方向転換により走行機体の走行方位はかなり変化する。その結果、途中で方向転換点を含む地点Ｐ４から地点Ｐ６までの走行経路、及び地点Ｐ５から地点Ｐ７までの走行経路は、いずれもティーチング走行とはみなされないので、この走行に基づく目標走行方位は算定されない。このため、方向転換後のしばらくの走行機体の操舵は、運転者による人為操舵となる。

次の地点Ｐ６から地点Ｐ８までの走行経路では方向転換点を含まないので、走行方位変動が所定角以内であれば、ティーチング走行とみなされ、求められた走行方位から目標走行方位が算定される。したがって、地点Ｐ６からは、当該目標走行方位を用いた自動操舵走行が行われる。その後も同様に、短い区間の走行を順次ティーチング走行と見なして、その後の自動操舵走行のための目標走行方位が算定される。

畦際領域（枕地）に達すると、人為操舵または自動操舵でＵターンが行われる。自動操舵でのＵターン後の微細な位置合わせは人為操舵で行われる。このＵターンも１８０度の方向転換とみなされるので、上述した方向転換点（屈曲点）を通過する際の制御アルゴリズムの流用が可能である。

また、直進走行中に障害物が存在しており、障害物回避走行が行われた場合も、障害物回避走行は人為操舵で行われる。障害物回避走行の間は非ティーチング走行となるため、障害物回避走行が終了し、再び直進走行に復帰すると、短い区間の走行を順次ティーチング走行と見なして、次々に算定される目標走行方位を用いた自動操舵走行が再開される。

次に、図面を用いて、本発明による圃場作業車両の具体的な実施形態の１つを説明する。図２は、圃場作業車両の一例である乗用型の田植機の側面図であり、図３は平面図である。この田植機は、走行機体Ｃと、圃場に対する作業を行う圃場作業装置とを備えている。ここでの圃場作業装置は、圃場に対する苗の植え付けが可能な苗植付装置Ｗである。なお、図３に示す矢印Ｆが走行機体Ｃの「前」、矢印Ｂが走行機体Ｃの「後」、矢印Ｌが走行機体Ｃの「左」、矢印Ｒが走行機体Ｃの「右」である。

図２と図３とに示されるように、走行装置としては、左右一対の前車輪１０と左右一対の後車輪１１とが備えられている。走行機体Ｃには、走行装置における左右の前車輪１０を操向可能な操舵ユニットＵが備えられている。

走行機体Ｃの前部には、開閉式のボンネット１２が備えられている。ボンネット１２内には、エンジン１３が備えられている。走行機体Ｃには、前後方向に沿って延びる枠状の機体フレーム１５が備えられている。機体フレーム１５の前部には、支持支柱フレーム１６が立設されている。

図２に示されるように、苗植付装置Ｗは、油圧シリンダで構成される昇降シリンダ２０の伸縮作動により昇降作動するリンク機構２１を介して、走行機体Ｃの後端に昇降自在に連結されている。苗植付装置Ｗには、４個の伝動ケース２２、各伝動ケース２２の後部の左側部及び右側部に回転自在に支持された回転ケース２３、各回転ケース２３の両端部に備えられた一対のロータリ式の植付アーム２４、圃場の田面を整地する複数のフロート２５、植え付け用のマット状苗が載置される苗載せ台２６等が備えられている。つまり、苗植付装置Ｗは、８条植え型式に構成されている。

走行機体Ｃにおけるボンネット１２の左右側部には、苗植付装置Ｗに補給するための予備苗を載置可能な複数（例えば４つ）の通常予備苗台２８、苗植付装置Ｗに補給するための予備苗を載置可能な１つのレール式予備苗台２９が備えられている。また、走行機体Ｃにおけるボンネット１２の左右側部には、各通常予備苗台２８とレール式予備苗台２９とを支持する左右一対の予備苗フレーム３０と、左右の予備苗フレーム３０の上部に亘って連結される連結フレーム３１と、が備えられている。連結フレーム３１は、前面視で、Ｕ字状の形状となっている。連結フレーム３１の左右端部は、それぞれ、連結ブラケット３２を介して、左右の予備苗フレーム３０の上部に連結されている。

走行機体Ｃの中央部には、各種の運転操作が行われる運転部４０が備えられている。運転部４０には、運転者が着座可能な運転座席４１、操縦塔４２、前車輪１０の手動の操向操作用のステアリングホイールにより構成される操向ハンドル４３、前後進の切り換え操作や走行速度を変更操作が可能な主変速レバー４４、操作レバー４５等が備えられている。運転座席４１は、走行機体Ｃの中央部に備えられている。操縦塔４２に、操向ハンドル４３、主変速レバー４４が操作自在に備えられている。運転部４０の足元部位には、搭乗ステップ４６が設けられている。

操向ハンドル４３の下側の右横側に操作レバー４５が備えられている。操作レバー４５を上昇位置に操作すると、作業クラッチの一種である植付クラッチ（図示なし）が遮断状態に操作されて、苗植付装置Ｗが上昇する。操作レバー４５を下降位置に操作すると、植付クラッチ（図示なし）が遮断状態に操作され、苗植付装置Ｗが下降する。中央のフロート２５が圃場の田面に接地すると、苗植付装置Ｗが圃場の田面に接地して停止した状態となる。

図４に示されるように、操舵ユニットＵには、上述の操向ハンドル４３、操向ハンドル４３に連動連結されるステアリング操作軸５４、ステアリング操作軸５４の回動に伴って揺動するピットマンアーム５５、ピットマンアーム５５に連動連結される左右の連繋機構５６、ステアリングモータ５８、ステアリング操作軸５４にステアリングモータ５８を連動連結するギヤ機構５７等が備えられている。

操舵ユニットＵは、自動操舵モード及び人為操舵モードで動作可能である。人為操舵モードでは、運転者が操向ハンドル４３を操作する操作力に、ステアリングモータ５８による操向ハンドル４３の操作に応じた補助力を付与してステアリング操作軸５４を回動操作し、前車輪１０の操向角度を変更する。一方、自動操舵モードでは、ステアリングモータ５８を自動制御し、ステアリングモータ５８の駆動力によりステアリング操作軸５４を回動操作し、前車輪１０の操向角度を変更する。この実施形態では、操向ハンドル４３とステアリングモータ５８とが、走行機体Ｃを人為操舵する人為操舵部の構成要素として機能する。また、走行機体Ｃを自動操舵する自動操舵の制御機能は、後で説明する制御装置８（図５参照）に構築され、制御装置８からの制御指令に基づいてステアリングモータ５８が駆動される。なお、操向ハンドル４３の操作変位が直接ステアリング操作軸５４に伝達されるのではなく、操向ハンドル４３の操作変位がセンサによって検出され、その検出値に基づいてステアリングモータ５８が駆動される場合、いわゆるバイワイヤ方式が採用されている場合、人為操舵の制御機能も、制御装置８に構築される。

走行機体Ｃには、測位ユニット６１が備えられ、走行機体Ｃの機体位置は、測位ユニット６１からの測位データから求められる。さらに、走行中の経時的な機体位置から走行方位が求められる。測位ユニット６１には、ＧＰＳモジュールまたはＧＮＳＳモジュールとして構成されている衛星航法用モジュールと、ジャイロ加速度センサと磁気方位センサを組み込んだモジュールとして構成されている慣性航法用モジュールとが含まれている。衛星航法用モジュールには、ＧＰＳ信号やＧＮＳＳ信号を受信するための衛星用アンテナが接続されている。少なくともこの衛星用アンテナは、電波受信感度が良好となる箇所、この実施形態では連結フレーム３１に取り付けられている。衛星航法用モジュールと慣性航法用モジュールとは別の場所に設けてもよい。

図５には、この田植機に装備されている制御装置８が示されている。なお、図５では、制御装置８に構築されている機能部の内、主に自動操舵制御に関する機能部が示されている。この制御装置８は、図１を用いて説明されたティーチング走行制御に関する基本原理を採用している。制御装置８は、入力信号処理部８ａを介して、測位ユニット６１、車両状態検出センサ群９、操舵モード切替操作器６５と接続している。また、制御装置８は、出力信号処理部８ｂを介して、報知デバイス７、車両走行機器群７１、作業装置機器群７２と接続している。

車両状態検出センサ群９は、走行機体Ｃの動作や姿勢を、圃場作業装置としての苗植付装置Ｗの動作や姿勢を検出するために設けられた各種センサやスイッチからなる。操舵モード切替操作器６５は、自動操舵で走行する自動操舵モードと人為操舵で走行する人為操舵モードとのいずれかを選択するスイッチである。例えば、自動操舵で走行中に操舵モード切替操作器６５が操作されることで、人為操舵での走行に切り替えられ、人為操舵で走行中に操舵モード切替操作器６５が操作されることで、自動操舵での走行に切り替えられる。また、自動操舵で走行中に、人為操舵に関係する操作、例えば、操向ハンドル４３が操作されると、人為操舵での走行に切り替えられる。

報知デバイス７には、ランプやブザーが含まれており、畦際領域への接近や自動操舵走行での目標走行方位からの許容範囲を超えた方位ずれなど、運転者に報知したい種々の情報を，制御装置８からの指令に基づいて視覚的または聴覚的に出力する。報知デバイス７にフラットパネルディスプレイなどが含まれておれば、文字情報を提供することも可能である。

車両走行機器群７１には、走行機体Ｃに搭載されている走行するための種々の動作機器や制御機器が含まれており、例えば、操舵ユニットＵを構成するステアリングモータ５８などの動作機器、エンジン回転数を調整する制御機器、クラッチやシフタなどのトランスミッション用動作機器、ブレーキ動作機器などである。この実施形態の作業走行機器群には、圃場作業装置として搭載されている苗植付装置Ｗを昇降する昇降シリンダ２０や苗植付装置Ｗの作業クラッチとして機能する植付クラッチなどの動作機器が含まれている。

制御装置８には、走行方位算定部８１、判定部８２、ティーチング方位取得部８３、目標走行方位算定部８４、自動操舵部８５、操舵モード管理部８６、走行距離算定部８７などが、実質的にはコンピュータプログラムで構築されている。

走行方位算定部８１は、測位ユニット６１から送られてくる測位データに基づいて機体位置を求めるとともに、走行機体Ｃの経時的な機体位置から走行方位を求める。機体位置及び走行方位は、タイムスタンプとともにメモリに記録される。判定部８２は、予め設定された所定距離の走行が、自動操舵に用いる目標走行方位を導出するための走行として適切であるかどうかを判定し、適切である場合、当該走行をティーチング走行と判定する。この実施形態では、数ｍから数十ｍ以下の所定走行距離において記録されている走行方位の変化が許容角度以内であれば、適切な直進走行が行われているとみなし、当該走行をティーチング走行と判定する。もちろん、これより厳しい判定条件、あるいはこれより緩い判定条件を採用してもよい。

ティーチング方位取得部８３は、判定部８２がティーチング走行と判定した走行にともなって記録されている走行方位をティーチング方位として取得する。目標走行方位算定部８４は、ティーチング方位取得部８３で取得されたティーチング方位に基づいて自動操舵走行のための目標走行方位を算定する。

最終的に目標走行方位を算定するまでの機能を分かりやすく説明するため、この実施形態では、走行方位に関する機能部を、走行方位算定部８１、ティーチング方位取得部８３、目標走行方位算定部８４に区分けしているが、これらの機能部の全て、または部分的に統合してもよいし、あるいは、さらに細分化してもよい。この実施形態の制御装置８では、測位ユニット６１から送られてくる測位データから求めた、経時的な機体位置毎の走行方位が順次メモリに記録される。さらに、走行機体Ｃの走行がティーチング走行と判定されと、所定距離範囲に含まれる走行方位をメモリから読み出して、算術平均などの統計的演算を用いてその代表値を算定して、目標走行方位とする処理が行われる。つまり、継時的に取得されるティーチング方位の移動平均演算によって、目標走行方位が順次算定され、自動操舵のために、設定される。圃場の形状により、直進走行中に走行機体Ｃの向きを変える方向転換が行われると、その方向転換を含む走行はティーチング走行とは判定されないので、一時的に目標走行方位の算定が中断される。旋回後、新たな直進走行が再開され、ティーチング走行と判定されると、目標走行方位が順次算定され、設定される。

自動操舵部８５は、自動操舵モードが選択されていれば、目標走行方位算定部８４によって設定された目標走行方位で走行するため、目標走行方位と実際の走行方位との偏差を算定し、当該偏差を最小化する自動操舵指令を生成し、操舵ユニットＵに出力する。

操舵モード管理部８６は、人為操舵による走行である人為操舵モードと自動操舵による走行である自動操舵モードとを管理する。例えば、畦際領域（枕地）では人為操舵モードを選択し、畦際領域以外（一般には直線状の作業走行）は自動操舵モードを選択するように設定される。また、操舵モード切替操作器６５からの切替指令により、人為操舵モードと自動操舵モードとのいずれかを選択することができる。さらには、操向ハンドル４３を操作すれば、強制的に自動操舵モードから人為操舵モードに切り替わるように設定することもできる。

走行距離算定部８７は、後車輪１１の回転数または後車輪１１への伝動系の回転数を検出するセンサ（車両状態検出センサ群９の１つ）からの検出信号に基づいて走行機体Ｃの走行距離を算定する。その際、圃場の状態から推定されるスリップ率を考慮すれば、より正確に走行距離を算定することができる。衛星からの電波信号に基づいて機体位置を算定する測位ユニット６１の場合、何らかの事情で電波信号の受信感度が低下すると、測位データを出力できなくなる。そのリカバリとしてこの走行距離算定部８７が利用される。例えば、制御装置８は、測位ユニット６１からの測位データが入力されない場合には、走行距離算定部８７によって算定された走行距離に基づいて、走行機体Ｃが所定距離走行したタイミングを把握することができる。

次に、図６のフローチャートを用いて、短区間繰り返しティーチングを用いた自動操舵走行における制御の流れの一例を説明する。
まず、田植機が走行すると、走行方位演算処理がスタートして、測位ユニット６１からの測位データが取り込まれ（＃０１）、機体位置が算定される（＃０２）。継時的に得られる機体位置から走行機体Ｃの向きである走行方位が算定され（＃０３）、逐次メモリに記録される（＃０４）。記録される走行方位は、走行機体Ｃの走行距離と関連付けられており、予め設定された走行距離に達すると（＃０５Ｙｅｓ分岐）、当該走行距離において得られた走行方位がメモリから抽出され、転送準備される（＃０６）。走行方位の転送が準備されると、走行方位取込指令が出力され（＃０７）、今回の所定距離分の走行方位の転送準備がリセットされ、次の転送準備が始まる（＃０８）。

自動操舵のための目標方位を設定するルーチンは、走行方位演算処理のステップ＃０７で出力された走行方位取込指令を受けると（＃１１Ｙｅｓ分岐）、メモリから所定距離分の走行方位を読み込む（＃１２）。読み込まれた走行方位の継時的な並びから、非直線度合、つまり方位偏差が演算され（＃１３）、その方位偏差が許容範囲を超えているかどうかチェックされる（＃１４）。方位偏差が許容範囲を超えていれば、今回取り込んだ走行方位で規定される走行は、ティーチング走行には適さないと見なして、次の所定距離分の走行方位のための走行方位取込指令を待つ（＃１４Ｎｏ分岐）。方位偏差が許容範囲内であれば（＃１４Ｙｅｓ分岐）、今回取り込んだ走行方位で規定される走行がティーチング走行に適していると判定され（＃１５）、対応する走行方位はティーチング方位として処理される（＃１６）。ティーチング方位に対して算術平均や中間値算定などの統計的演算を施して、目標走行方位を算定する（＃１７）。算定された目標走行方位は所定のメモリに記録される（＃１８）。

人為操舵モードまたは自動操舵モードで走行機体Ｃを走行させる走行制御ルーチンでは、運転開始時には、人為操舵モードが設定されている（＃２１）。人為操舵または自動操舵で圃場内を走行中において、自動操舵モードまたは手動操舵モードのいずれが設定されている状態であるかどうか、操舵モードの切替が発生したかどうかがチェックされる（＃２２）。自動操舵モードが設定された状態である場合、または人為操舵モードから自動操舵モードへの切替が発生した場合（＃２２Ｙｅｓ分岐）、自動操舵モードが設定される（＃２３）。自動操舵モードが設定されていると、目標走行方位設定ルーチンのステップ＃１８で記録されている目標走行方位を読み込む（＃２４）。さらに、最新の測位データに基づいて算定された実走行方位も読み込む（＃２５）。読み込まれた目標走行方位と実走行方位との偏差に基づいて操舵指令が算定され、出力される（＃２６）。

図５に示すように、この制御装置８には、オプション機能部として、特定走行検知部８８を構築することができる。特定走行検知部８８は、走行方位算定部８１によって算定された継時的な走行方位、入力信号処理部８ａと通じて入力された各種センサ検出信号や各種操作デバイスの操作信号、出力信号処理部８ｂを通じて車両走行機器群７１や作業装置機器群７２に出力された制御信号などに基づいて、走行機体Ｃがどのような走行パターン（直進、Ｕターン、Ｌ字ターン、数度から数十度の向き変更など）を検知する。具体的には、特定走行検知部８８には、人為操舵走行によるＵターン走行を検知するＵターン検知部８８１、人為操舵走行によるＬ字旋回走行を検知するＬ字旋回検知部８８２、直進から旋回を経て再度直進に復帰する障害物回避走行を検知する障害物回避検知部８８３が組み込み可能である。

Ｕターン検知部８８１を機能させる場合には、目標走行方位算定部８４で目標走行方位が算定された時に、当該目標走行方位の反対方向の方位（１８０度の向き変更）であるＵターン方位も設定しておく。その後、Ｕターン検知部８８１がＵターン走行を検知した後は、新たなティーチング走行による目標走行方位が算定されるまでは、このＵターン方位を目標走行方位とする。つまり、Ｕターン走行直後の自動操舵走行の目標走行方位として、当該Ｕターン走行直前に用いられていた目標走行方位をＵターンに相当する角度だけ補正した方位が一時的に用いられる。

Ｌ字旋回検知部８８２を機能させる場合には、目標走行方位算定部８４で目標走行方位が算定された時に、当該目標走行方位から所定側にほぼ９０度ずれた方位であるＬ字旋回方位も設定しておく。その後、Ｌ字旋回検知部８８２がＬ字旋回走行を検知した後は、新たなティーチング走行による目標走行方位が算定されるまでは、このＬ字旋回方位を目標走行方位とする。つまり、Ｌ字旋回走行直後の自動操舵走行の目標走行方位として、当該Ｌ字旋回走行直前に用いられていた目標走行方位をＬ字旋回に相当する角度だけ補正した方位が一時的に用いられる。

障害物回避検知部８８３が、障害物回避走行を検知した後は、新たなティーチング走行による目標走行方位が算定されるまでは、障害物回避走行直後の自動操舵走行の目標走行方位として、障害物回避走行直前の目標走行方位が一時的に用いられる。

本発明は、作業装置として苗植付装置を備える上述した乗用型の田植機以外にも、例えば、作業装置として播種装置を備える植播系水田作業車両である乗用型の直播機、作業装置としてプラウ等を備えるトラクタ、若しくは、作業装置として刈取部等を備えるコンバイン等の農作業車両、または、作業装置としてバケット等を備える建設作業車両等の種々の作業車両に適用できる。

１０ ：前車輪
１１ ：後車輪
１３ ：エンジン
４３ ：操向ハンドル
４４ ：主変速レバー
４５ ：操作レバー
４６ ：搭乗ステップ
５４ ：ステアリング操作軸
５５ ：ピットマンアーム
５６ ：連繋機構
５７ ：ギヤ機構
５８ ：ステアリングモータ
６１ ：測位ユニット
６５ ：操舵モード切替操作器
７ ：報知デバイス
７１ ：車両走行機器群
７２ ：作業装置機器群
８ ：制御装置
８ａ ：入力信号処理部
８ｂ ：出力信号処理部
８１ ：走行方位算定部
８２ ：判定部
８３ ：ティーチング方位取得部
８４ ：目標走行方位算定部
８５ ：自動操舵部
８６ ：操舵モード管理部
８７ ：走行距離算定部
８８ ：特定走行検知部
８８１ ：Ｕターン検知部
８８２ ：Ｌ字旋回検知部
８８３ ：障害物回避検知部
９ ：車両状態検出センサ群
Ｃ ：走行機体
Ｕ ：操舵ユニット
Ｗ ：苗植付装置

Claims (6)

1. 圃場内を走行する走行機体と、
   前記圃場に対して作業を行う圃場作業装置と、
   機体位置を示す測位データを出力する測位ユニットと、
   前記走行機体を人為操舵走行させる人為操舵部と、
   前記走行機体を自動操舵走行させる自動操舵部と、
   所定距離での直進走行をティーチング走行と判定する判定部と、
   前記判定部によって判定されたティーチング走行で取得された走行方位をティーチング方位として取得するティーチング方位取得部と、
   前記ティーチング方位取得部で取得されたティーチング方位に基づいて前記自動操舵走行のための目標走行方位を算定する目標走行方位算定部と、
   を備えた圃場作業車両。
2. 前記目標走行方位算定部は継時的に取得されるティーチング方位の移動平均演算によって前記目標走行方位を算定する請求項１に記載の圃場作業車両。
3. 前記人為操舵走行によるＵターン走行を検知するＵターン検知部が備えられ、前記Ｕターン走行直後の前記自動操舵走行の前記目標走行方位は、当該Ｕターン走行直前の前記目標走行方位を前記Ｕターンに相当する角度だけ補正した方位とする請求項１または２に記載の圃場作業車両。
4. 前記人為操舵走行によるＬ字旋回走行を検知するＬ字旋回検知部が備えられ、前記Ｌ字旋回走行直後の前記自動操舵走行の前記目標走行方位は、当該Ｌ字旋回走行直前の前記目標走行方位をＬ字旋回に相当する角度だけ補正した方位とする請求項１から３のいずれか一項に記載の圃場作業車両。
5. 直進から旋回を経て再度直進に復帰する障害物回避走行を検知する障害物回避検知部が備えられ、前記障害物回避走行直後の前記自動操舵走行の前記目標走行方位は、当該障害物回避走行直前の前記目標走行方位である請求項１から４のいずれか一項に記載の圃場作業車両。
6. 前記判定部は、所定条件の直線走行を前記ティーチング走行と判定する請求項１から５のいずれか一項に記載の圃場作業車両。

Images