JP2016071438A - 自動走行車両 - Google Patents

Abstract

【課題】予め光反射手段や反射板などを設置することなく、互いに間隔をあけて並んでいる樹木や人工立設物などの間を、自動で走行可能な自動走行車両を提供する。【解決手段】目標物設定部により設定された２つの目標物Ｏである果樹Ｋを通り、走行時の基準となる基準線ＳＬから車体３までの距離である離間距離を演算する距離演算部と、目標物の位置及び離間距離に基づいて果樹Ｋの間に所定側から入り込む進入走行と、果樹Ｋの間を基準線ＳＬに沿って走行する直線走行と、果樹Ｋの間から所定側に抜け出す抜け出し走行と、果樹Ｋの所定側の側方を通過する側方通過走行とを実行する走行制御部と、走行制御部からの操舵指令に基づいて自動操舵機構に操舵制御信号を出力する操舵制御部とが備えられている。【選択図】図１

Description

本発明は、自動で走行する自動走行車両に関する。

従来、車両の位置を検出する際に、ＧＰＳ（Global Positioning System）が用いられてきた。ＧＰＳを利用するには上空のＧＰＳ衛星からの電波を受信する必要があり、電波状況が悪い場所では受信が途切れてしまう。このため、例えば、ＧＰＳを用いて自動で車両を走行させる場合には、ＧＰＳを補完する方位センサなどが必要になる。ＧＰＳでは自車位置を検知することができるが、障害物や走行目標となる物体の位置を検知することができない。

特許文献１には、ＧＰＳではない移動体の位置計測装置が搭載された自走走行車両が記載されている。この位置計測装置は、所定の座標軸上における移動体の位置及び走行方向を推定演算する推定演算手段と、移動体の予定走行路に沿って間欠的に配設された基準点に対する移動体の相対位置を検出する相対位置検出手段とを備えている。

また、特許文献２に記載の移動体の位置計測装置は、移動経路の周囲に配置された設置位置が既知の２個以上の反射手段を備え、移動体から反射手段に対して光等を投射して、その反射光等により移動体の進行方向と反射光等の入射角度との間の相対角度を計測する。また、移動体には当該移動体の進行方向に沿った走行距離を計測する計測手段と、移動体の進行方向を向きとして計測する計測手段とが備えられ、反射手段の設置位置、移動体から見た反射手段に対する現在及びそれより一定時間前の相対角度、一定時間前から現在に至るまでの移動体の位置の変位量と向きの変位量から、移動体の絶対位置及び向きを演算する。

特開平７−１５９１８７号公報 特開平１１−２７１０４３号公報

特許文献１に記載の技術では、予定走行路に沿って、予め光反射手段を設置しておく必要がある。また、特許文献２に記載の技術では、複数の反射板を予め設置しておき、当該設置位置を登録しておかなければならない。このため、特許文献１及び２に記載の技術では、移動体は予め光反射手段や反射板が設置されている場所でしか自動で走行することができない。

本発明の目的は、上記問題に鑑み、予め光反射手段や反射板などを設置することなく、互いに間隔をあけて並んでいる樹木や人工立設物などの間を、自動で走行可能な自動走行車両を提供することにある。

本発明による自動走行車両は、自動操舵機構を有する走行車体と、２つの物体を目標物として設定する目標物設定部と、前記目標物設定部により設定された２つの目標物を通り、走行時の基準となる基準線を設定する基準線設定部と、前記基準線から前記走行車体までの距離である離間距離を演算する距離演算部と、前記目標物の位置及び前記離間距離に基づいて前記２つの目標物の間に所定側から入り込む進入走行と、前記２つの目標物の間を前記基準線に沿って走行する直線走行と、前記２つの目標物の間から前記所定側に抜け出す抜け出し走行と、前記目標物の前記所定側の側方を通過する側方通過走行とを実行する走行制御部と、前記走行制御部からの操舵指令に基づいて前記自動操舵機構に操舵制御信号を出力する操舵制御部とを備えている。

この構成によれば、目標物設定部によって２つの物体を目標物として設定されると、その２つの目標物を通る基準線を自動走行の基準として設定される。基本的な走行においてはこの基準線から走行車体までの離間距離（以下、特に必要のない限り、単に距離と略称する）を所定値に維持するように、操舵制御信号が出力される。２つの目標物（物体）の間を走行する際には、手前側の目標物の側方を通り抜ける側方通過走行と、手前側の目標物の側方から２つの目標物の間に入り込んで行く進入走行と、２つの目標物の間を走行する直線走行と、遠方側の目標物を回避すべく２つの目標物の間から抜け出す抜け出し走行とを行う必要があり、全体としてこれらの走行はいわゆるジグザグ走行となっている。このジグザグ走行は、実質的には基準線から走行車体までの維持すべき距離を変更することで可能である。本発明では、このジグザグ走行が、目標物の一方側（例えば進行方向右側）でのみ行われるので、つまり基準線に関して一方側を走行するようにしているので、その自動走行は簡単化される。例えば、果樹園の果樹のように、多数の物体（果樹）が間隔をあけて並んでいるような場合では、上述したジグザグ走行を繰り返すことにより、物体を一方方向で回避しながら、全ての物体の間を走行することができる。

本発明の好適な実施形態の１つでは、予め設定された範囲に向けて検出信号を送信し、前記検出信号に対する反射信号を取得して、前記予め設定された範囲に存在する物体を検出する物体検出部が備えられており、前記目標物設定部は、前記物体検出部により検出された２つの物体の位置に基づいて、当該２つの物体を目標物として設定する。この構成では、車両周辺に物体が存在すれば、その物体からの反射信号から、車両を起点とする物体までの距離と角度を算定することができる。さらに、目標物とすべき２つの物体からの反射信号を得ることで、走行車体を基点とする２つの目標物の位置から、本発明による自動走行車両の自動操舵の制御基準となる基準線が得られる。

本発明の好適な実施形態の１つでは、前記自動操舵機構が、走行前側の車輪と走行後側の車輪とが同方向に操舵可能な同位相四輪操舵機構として構成されており、前記進入走行及び抜け出し走行において前記同位相四輪操舵機構による前記走行車体の平行移動により進路変更が行われる。この構成により、進入走行及び抜け出し走行においては、走行車体の姿勢を変えずに、一般的にカニ走行とも呼ばれる斜め走行（極端な場合は車体前後方向に対して直角な走行も可能）を行うことができる。このため、できるため、目標物と走行車体の走行軌跡の正確な算定が簡単である。進入走行及び抜け出し走行であっても走行車体は目標物とできるだけ接近させて走行することができる。

本発明の好適な実施形態の１つでは、前記直線走行において、前記走行車体の中心が前記基準線を前記所定側から反対側に超えないように走行制御される。往復走行で基準線に対する両側の領域を走行するとすれば、この構成により、往路走行及び復路走行の両方で走行車体全体の走行軌跡が完全にオーバーラップするようなことは回避される。このことはこの自動走行車両が、草刈装置は散布装置などを搭載した作業車両である場合、作業軌跡が重なってしまうことが、抑制されるので、利点となる。さらに、前記直線走行において、前記走行車体の中心と前記走行車体の前記所定側の側端部との間に前記基準線が位置するように走行制御されるような実施形態を採用することで、自動制御が簡単になるとともに、作業軌跡の重なりも抑制される。

基準線から走行車体までの距離を制御目標とすると、進入走行において、目標物との干渉を避けながらも、当該目標物とできるだけ接近することは難しい。このため、本発明の好適な実施形態の１つでは、前記進入走行における前記直線走行への移行点を決定する前記所定側から前記基準線への進入距離は、前記２つの目標物の間の距離と前記走行車体の外形寸法をパラメータとし、前記走行車体と目標物との距離が最小となる条件で、算定される最大値である。つまり、２つの目標物の間隔が短い場合での進入走行において、通常通りに、基準線の方に進入し過ぎると、つまり直線走行への移行点が基準線に近すぎると、直線走行をほとんど実行せずに抜け出し走行に移行しても、抜け出し走行で、前方の目標物から抜け出せず、干渉してしまう可能性がある。このため、２つの目標物の間隔が短くなっている場合には、直線走行における予め設定されている基準線からの距離（離間距離）を大きくして、抜け出しやすくする必要がある。目標物との干渉なしに抜け出すことができる直線走行における離間距離は、車体の外形寸法も関係するので、２つの目標物の間の距離と走行車体の外形寸法をパラメータとし、走行車体と目標物との距離が最小となる条件（つまり安全に目標物から抜け出せる条件）で算定される最大値とすることが最適となる。

自動走行車両の走行経路の一例を示す模式図である。 自動走行車両を模式的に示した側面図である。 自動走行車両の自動走行に係る機能部を模式的に示したブロック図である。 物体検出部の検出範囲を示す図である。 抜け出し走行から側方通過走行を経て進入走行に至る自動走行車両の走行状態を示す模式図である

本発明に係る自動走行車両は、予め設定された区画内において目標物を設定し、当該目標物に基づいて自動で走行可能に構成される。以下、本実施形態の自動走行車両１について説明する。本実施形態では、自動走行車両１は、図１に示された例では、果樹園に間隔をあけて植えられている複数の果樹Ｋを走行目標物（単に目標物と略称される）Ｏとしてこの目標物Ｏの間に生えている草を刈り取りながら自動走行するよう構成されている。したがって、この自動走行車両１は、２つの目標物Ｏの間を結ぶ基準線ＳＬとの距離が近く設定されている場合には、目標物Ｏである果樹Ｋが走行の邪魔となる場合には、当該果樹Ｋを一方方向に避けながら走行する一方側に偏ったジグザグ走行を行う。基準線ＳＬとの距離が遠くて果樹である果樹Ｋが走行の邪魔とならない場合には、基準線ＳＬからの距離を一定に維持しながらノーマル直線走行を行う。したがって、自動走行車両１の走行軌跡線（以下単に走行線と称する）は、ジグザグ走行の走行軌跡であるジグザグ走行線とノーマル直線走行の走行軌跡であるノーマル走行線とからなる。

ジグザグ走行は、手前側の果樹Ｋである目標物Ｏの斜め後からスタートする図１の例では、手前側の目標物Ｏの側方を通り抜ける側方通過走行と、手前側の目標物Ｏの側方から２つの目標物Ｏの間に入り込んで行く進入走行と、２つの目標物Ｏの間を走行する直線走行と、遠方側の果樹Ｋである目標物Ｏを回避すべく２つの目標物Ｏの間から抜け出す抜け出し走行とからなる１つの走行単位の繰り返しである。図１では、側方通過走行の走行線には符号Ａｔが付与され細点線で描かれ、進入走行の走行線には符号Ａｉが付与され太実線で描かれ、直線走行の走行線には符号Ａｓが付与され細実線で描かれ、抜け出し走行の走行線には符号Ａｏが付与され太点線で描かれている。ノーマル直線走行は、維持する基準線ＳＬからの離間距離が異なるだけで実質的には直線走行と同じであり、その走行線には符号Ａｎが付与され細実線で描かれている。

自動走行車両は、ジグザグ走行とノーマル直線走行との組み合わせで果樹園全体を走破するが、単一のジグザグ走行及びノーマル直線走行において果樹園の端部に達すると、線Ｂで示されるように前後進を繰り返して、自動走行車両１の位置を側方にずらすようにスイッチバックを行う。したがって、自動走行車両１は、果樹園の一方の端部から他方の端部に向って走行する場合と、果樹園の他方の端部から一方の端部に向って走行する場合とで進行方向を向く側が異なることになる。

図２には本実施形態の自動走行車両１の側面図が示される。図２に示されるように、自動走行車両１は、車輪２と走行車体３（以下単に車体３と略称される）とを備えて構成される。車輪２は、車体３の車長方向の一端側の第１車輪２Ａ、及び車長方向の他端側の第２車輪２Ｂから構成される。車体３には、自動走行車両１の動力源であるエンジン４、エンジン４に供給する燃料が備蓄されている燃料タンク５、エンジン４により駆動される発電機６、発電機６により発電された電力を蓄電し、自動走行車両１が有する電気機器に電力供給するバッテリ７、自動走行車両１の自動走行を制御する自動走行制御装置１０、バッテリ７から供給される電力に基づき第１車輪２Ａの操向操作を行う第１車輪操向操作機構５１、バッテリ７から供給される電力に基づき第２車輪２Ｂの操向操作を行う第２車輪操向操作機構５２、エンジン４の回転力が入力され、草刈りに使用する刈り刃５４を有する草刈装置５３、第１車輪２Ａ及び第２車輪２Ｂの少なくとも一方と草刈装置５３とへのエンジン４の回転力の断接を行う動力伝達機構５５を備えている。この実施形態では、第１車輪操向操作機構５１と第２車輪操向操作機構５２とが、自動操舵機構５０を構成している。車体３の前後の端部には、衝突バッファレバー機構５６が設けられている。この衝突バッファレバー機構５６は、ばね力によって衝突の衝撃を緩和するとともに、衝突バッファレバー機構５６のレバー変位を検出するセンサ（非図示）から衝突信号を出力する。衝突信号が出力されると自動走行車両１は緊急停止する。

図３には、自動走行車両１の自動走行に係る機能部を示すブロック図が示される。自動走行車両１は、自動走行制御装置１０、第１車輪操向操作機構５１、第２車輪操向操作機構５２、動力伝達機構５５の各機能部を備えて構成される。自動走行制御装置１０は、物体検出部１１、目標物設定部１２、基準線設定部１３、距離演算部１４、走行範囲設定部１５、走行制御部１６、操舵制御部１６Ａ、物体数設定部１７、物体計数部１８、物体数判定部１９、走行モード選択部２０の各機能部を備えて構成され、各機能部は、自動走行車両１の自動走行に係る種々の処理を行うためにＣＰＵを中核部材としてハードウェアまたはソフトウェア或いはその両方で構築されている。

物体検出部１１は、予め設定されたスキャニング範囲に向けて検出信号を送信し、当該検出信号に対する反射信号を取得して、車体３の車長方向に沿って延長した車長延長線よりも車体３の両側方のうちの一方の側に存在する物体を検出する。予め設定されたスキャニング範囲とは物体検出部１１の検出可能な範囲であり、本実施形態では図４に示されるような自動走行車両１を中心とする約２７０度の範囲Ｒである。検出信号とはレーザーや光や超音波等のように空中伝搬する信号である。このような検出信号は回転ミラーを通じてスキャニング送信され、物体に衝突すると反射される。物体検出部１１は、検出信号を予め設定されたスキャニング範囲で送信し、衝突によって生じる反射信号を取得する。物体検出部１１は、検出信号の送信方向（送信時のスキャン角度：回転ミラーの角度に対応する）に基づいて物体検出部１１を基準とした物体が存在する方向（送信角度：θ１、θ２）を示す情報と、検出信号を送信してから反射信号を取得するまでの時間に基づいて演算した物体検出部１１から物体までの距離を示す情報とを取得する。本実施形態では、物体検出部１１は水平方向に、且つ、上述した範囲Ｒに対して例えば０．５度のスキャンピッチで検出信号を送信する。

車体３の車長方向とは、自動走行車両１の車体３の長さ方向である。したがって、車長延長線とは、自動走行車両１の長さ方向一端側の車幅方向中央部と、長さ方向他端側の車幅方向中央部とを結ぶ延長線にあたる。もちろん、自動走行車両１の長さ方向一端側の左端及び右端の一方と、長さ方向他端側の左端及び右端の一方とを結ぶ延長線であっても良い。車体３の両側方とは、車体３の進行方向前側を見て右側と左側である。したがって、一方の側とは、当該右側または左側が相当する。本実施形態では、図４に示されるように、物体検出部１１が検出する範囲Ｒは自動走行車両１を中心とした全周囲のうち約２７０度の範囲である。このため、一方の側とは、全領域に亘って検出可能な側を意味し、具体的には図４に示されるように、自動走行車両１が紙面上側の方向に向って走行する場合には進行方向を見て左側が相当し、自動走行車両１が紙面下側の方向に向って走行する場合には進行方向を見て右側が相当する。このように物体検出部１１は、自動走行車両１の片側に存在する物体を検出する。

目標物設定部１２は、物体検出部１１により検出された物体のうち、少なくとも２つの物体の位置に基づいて、当該少なくとも２つの物体を目標物Ｏとして設定する。物体検出部１１は、図４に示されるように所定の範囲（図４ではＲで示されている２７０度のスキャニング範囲）内に検出信号を送信する。このため、この範囲Ｒ内に存在する物体を検出する。ここで、本実施形態では自動走行車両１は果樹Ｋが植えられている果樹園を自動走行する。このため、果樹園内の果樹Ｋや果樹Ｋを支持する支柱の中から目標物Ｏが設定される。また、本実施形態では、自動走行車両１は少なくとも２つの物体を検出できれば目標物Ｏを設定することができる。このため、本実施形態では、目標物設定部１２は範囲Ｒ内において物体検出部１１により検出された物体から２つの物体を用いて目標物Ｏとして設定するとして説明する。

２つの目標物Ｏのうちの一方は、自動走行車両１から左側方を見て最も近い位置にある物体が選択される。図４の例では、符号Ｏ１を付したものが相当する。２つの目標物Ｏのうちの他方は、物体検出部１１により検出された物体のうち、進行方向に沿って並んだ物体を用いて設定される。進行方向に並んだ物体とは、先に設定された目標物Ｏ１から見て自動走行車両１の進行方向奥側に位置する物体である。ここで、進行方向奥側には、図１に示されるように複数並んでおり、物体検出部１１により複数検出されることもある。そこで、目標物設定部１２は、現在、設定されている目標物Ｏから車長方向に沿って予め設定された距離内において新たな目標物Ｏを設定する。これにより、現在、設定されている目標物Ｏに近い位置にある物体を目標物Ｏとして設定することができるので、物体が配置されている形態に応じて自動走行車両１を走行させることが可能となる。また、予め設定された範囲内をフィルタリングして目標物Ｏを設定するので、目標物Ｏの設定に係る演算処理を軽減できる。このようなフィルタリングする範囲として、例えば基準線ＳＬを中心とした幅１８０ｃｍであって、進行方向奥側の目標物Ｏ２の前方１５０ｃｍ以上先とすると良い。更には、果樹園においては予め設定された距離毎に果樹Ｋを植えているので、所定距離毎に目標物Ｏが設定されない場合には、物体検出部１１が異常であるか否かを判定することもできる。上述した予め設定された距離とは、例えば目標物設定部１２が検出可能であり、死角とならない範囲とすることも可能である。

本実施形態では、目標物設定部１２により、先に設定された目標物Ｏ１から見て自動走行車両１の進行方向において最も近い物体が選択される。図４の例では、符号Ｏ２を付したものが相当する。自動走行車両１に関する目標物Ｏ１及び目標物Ｏ２の座標位置は、目標物Ｏ１に係る物体検出部１１の検出結果から算定される自動走行車両１と目標物Ｏ１との間の距離及び自動走行車両１を中心とする目標物Ｏ１の角度：θ１と、目標物Ｏ２に係る物体検出部１１の検出結果から算定される自動走行車両１と目標物Ｏ２との間の距離及び自動走行車両１を中心とする目標物Ｏ２の角度：θ２とに基づき、三角関数の公式を用いて演算することができる。目標物Ｏ１及び目標物Ｏ２の座標位置から目標物Ｏ１と目標物Ｏ２との間の距離は算定される。

ここで、自動走行車両１は、進行方向がどの方位であるかを自ら認識することができないので、自動走行車両１に対して予めユーザが進行方向を設定しておくと好適である。もちろん、自動走行車両１の長さ方向両端のうち、最初に進行する側の端部を設定しておき、当該端部が向いている側を進行方向として設定しても良い。

基準線設定部１３は、目標物設定部１２により設定された少なくとも２つの目標物Ｏを通り、走行時の基準となる基準線ＳＬを設定する。目標物設定部１２により設定された少なくとも２つの目標物Ｏとは、本実施形態では上述した目標物Ｏ１及び目標物Ｏ２である。基準線設定部１３は、自動走行制御装置１０内で用いる座標系において、この目標物Ｏ１と目標物Ｏ２とを直線で繋いで基準線ＳＬを設定する。基準線ＳＬは後述するように自動走行車両１が自動走行する際に基準として利用される。

距離演算部１４は、基準線ＳＬから車体３までの距離（離間距離）を演算する。基準線ＳＬから車体３までの距離とは、上記座標系において基準線ＳＬと車体３とを最短で繋いだ距離である。このため、車体３を通るように引いた基準線ＳＬからの垂線上での距離にあたる。

走行範囲設定部１５は、自動走行車両１が自動走行する走行経路に対して許容される走行範囲を設定する。本実施形態では自動走行車両１は自動走行しながら草を刈り取る。このため、自動走行車両１が自動走行する走行経路は、草を刈り取る経路に相当する。詳細は省略するが、刈り刃５４は自動走行車両１の車体３の中央部の底面に車幅方向に亘って設けられる。自動走行車両１は果樹園の一方の端部から他方の端部まで自動走行する際に、先に走行した経路に対して刈り取る領域の一部（例えば２０〜３０ｃｍ）を重複させて自動走行する。上述した許容される走行範囲は、このような重複する幅の１／２〜１／３（例えば１０〜１５ｃｍ）程度に設定すると好適である。これにより、刈り取りムラの発生を防止できる。

走行制御部１６は、基準線ＳＬから車体３までの距離（離間距離）及び、目標物Ｏ１及び目標物Ｏ２から車体３までの距離に基づいて、自動走行車両１を走行させる。自動走行車両１に操舵が必要な場合には、操舵制御部１６Ａに操舵指令を与えて、第１車輪操向操作機構５１及び第２車輪操向操作機構５２を動作させ、第１車輪２Ａ及び第２車輪２Ｂの操舵角を変更する。

基準線ＳＬから車体３までの距離は、上述した距離演算部１４により演算され、順次、リアルタイムで走行制御部１６に伝達される。走行制御部１６には、直線走行制御部１６０、側方通過走行制御部１６１、進入走行制御部１６２、抜け出し走行制御部１６３が含まれている。直線走行制御部１６０は、直線走行及びノーマル直線走行のために用いられる。側方通過走行制御部１６１は、側方通過走行のために用いられている。進入走行制御部１６２と抜け出し走行制御部１６３とは、それぞれ、進入走行と抜け出し走行のために用いられている。この４つの走行制御部１６０〜１６３から実行すべき走行制御部を選択する選択指令は、走行モード選択部２０が、基準線ＳＬから車体３までの距離（離間距離）及び、目標物Ｏ１及び目標物Ｏ２から車体３までの距離に基づいて、出力する。

直線走行制御部１６０は、基準線ＳＬから車体３までの距離を予め設定された範囲内に維持しながら、基準線ＳＬに沿って自動走行車両１を走行させる。この実施形態では、直線走行においては、車体３の中心が基準線ＳＬを超えないように、より好ましくは、車体３の中心と車体３の入り込んだ側の側端部（図１で進行方向左側の端部）との間に基準線ＳＬが位置するように走行制御される。側方通過走行制御部１６１は、基本的には、基準線ＳＬから車体３までの距離を目標物Ｏ１と接触しない位置に設定して、基準線ＳＬに沿って自動走行車両１を走行させる。

抜け出し走行制御部１６３は、図５に示すように、直線走行における走行線（その走行線がＡｓで示されている）において、側方通過走行の走行線（その走行線がＡｉで示されている）の方に移動しても、車体３と目標物Ｏ１とが接触しない位置に達した段階で、直線走行から抜け出し走行に移行する。その後、自動走行車両１が側方通過走行での走行線（その走行線がＡｔで示されている）に達すると、側方通過走行に移行する。

この実施形態における抜け出し走行では、図５でも示されているように、第１車輪２Ａと第２車輪２Ｂとが同位相となるように操舵される同位相操舵が行われるので、車体３の向きが変わることなしに自動走行車両１は直線走行の走行線Ａｓから側方通過走行の走行線Ａｔへ移動する。したがって、車体３の走行軌跡は簡単に算定することができる。その走行軌跡の算定をさらに簡単にするためには、同位相操舵の操舵角を一定しておくとよい。直線走行から抜け出し入走行のタイミングは、車体３の進行方向左側の先端の軌跡が目標物Ｏ１と干渉しないように決定される。

進入走行制御部１６２は、図５に示すように、側方通過走行（その走行線がＡｔで示されている）において、自動走行車両１が進行方向を変えて基準線ＳＬの方に入り込んでいっても、車体３と目標物Ｏ１とが接触しない位置に達した段階で、側方通過走行から進入走行（その走行線がＡｉで示されている）に移行する。その後、自動走行車両１が直線走行（その走行線がＡｓで示されている）における基準線ＳＬから車体３までの距離に達すると、直線走行に移行する。その際、２つの目標物Ｏ１とＯ２との間隔が短い場合、側方通過走行から基準線ＳＬへの進入位置、つまり、側方通過走行から進入走行を経て直線走行するまでの入り込み距離が大きいと、抜け出し走行を行うために必要な車体３と目標物Ｏ１との距離が取れなくなってしまう。このことから、進入走行における、進入走行における基準線ＳＬの一方側から基準線ＳＬへの進入位置は、２つの目標物Ｏ１とＯ２との間の距離及び車体３の外形寸法をパラメータとし、車体３と目標物Ｏ１またはＯ２との距離が最小となる条件で、算定される最大値が採用される。

この実施形態における進入走行でも、図５でも示されているように、抜け出し走行と同様に、第１車輪２Ａと第２車輪２Ｂとが同位相となるように操舵される同位相操舵が行われるので、車体３の向きが変わることなしに自動走行車両１は側方通過走行の走行線Ａｔから直線走行の走行線Ａｓへ移動する。したがって、側方通過走行から進入走行のタイミングは、車体３の進行方向左側の後端軌跡が目標物Ｏ１と干渉しないように決定される。

この場合でも、同位相操舵の操舵角を一定しておくと軌跡演算上は好都合である。直線走行から抜け出し入走行のタイミングは、車体３の進行方向左側の先端端の軌跡が目標物Ｏ１と干渉しないように決定される。

上述したように、自動走行車両１はエンジン４を動力源として走行する。また、第１車輪２Ａ及び第２車輪２Ｂは、夫々操向操作可能に構成され、夫々第１車輪操向操作機構５１及び第２車輪操向操作機構５２により操向操作が行われる。また、エンジン４により発生された回転力は、第１車輪２Ａ及び第２車輪２Ｂの少なくとも一方に動力伝達機構５５を介して伝達される。第１車輪２Ａ及び第２車輪２Ｂに対する動力の伝達は、双方に行って自動走行車両１を４輪駆動としても良いし、一方に行って２輪駆動としても良い。また、第１車輪２Ａ及び第２車輪２Ｂの夫々は、左右一対で構成されても良いし、少なくとも一方が１輪で構成されていても良い。走行制御部１６は、基準線ＳＬから自動走行車両１までの距離が予め設定された範囲内に収まるように、第１車輪操向操作機構５１、第２車輪操向操作機構５２、及び動力伝達機構５５を制御して、基準線ＳＬに沿って走行させる。

自動走行車両１は、基準線ＳＬに沿って走行しながら次の目標物Ｏとなる物体を検出する。現在の基準線ＳＬの設定に係る進行方向前側の目標物Ｏ２に対する側方通過走行に入ると、当該目標物Ｏ２を進行方向手前側の目標物Ｏ１とし、新たに設定した目標物Ｏを進行方向奥側の目標物Ｏ２として設定する。これらの目標物Ｏ１及び目標物Ｏ２により基準線ＳＬを設定し直して、当該基準線ＳＬに沿って果樹園の一方の端部から他方の端部まで走行する。このように自動走行車両１は、目標物設定部１２が目標物Ｏを更新しながら、果樹園の一方の端部から他方の端部まで走行する。

自動走行車両１は、果樹園の一方の端部から他方の端部まで基準線ＳＬに沿って走行し、端部においてはスイッチバックをして、そこで設定された基準線ＳＬに沿って走行する。本実施形態では、自動走行車両１は自車が果樹園の端部に達した否かを物体の数によって認識するよう構成されている。すなわち、物体数設定部１７が区画内において物体検出部１１が検出する物体の数を予め設定しておく。区画内において物体検出部１１が検出する物体の数とは、自動走行車両１は、果樹園の一方の端部から他方の端部まで走行する際に目標物Ｏとして設定する物体の数である。物体数設定部１７は、このような物体の数を予め設定し、記憶しておく。

この物体の数は、ユーザが自動走行車両１を自動走行させる前に、予め手動で入力して物体数設定部１７に設定しておいても良いし、区画内に存在する物体の数を示すマップを物体数設定部１７に読み込ませて自動で物体の数を設定しても良い。例えば、マップを用いて物体の数を設定する場合には、区画内に存在する物体の列数、及び夫々の列毎の物体の個数を記載しておくと良い。更には、自動走行車両１は基準線ＳＬに沿って草を刈り取りながら走行する前に例えばラジコン操作によりティーチング走行を行い、当該ティーチング走行時に物体数設定部１７が区画内の物体の数を計数し、当該計数した物体の数を基準線ＳＬに沿って走行する際に目標物Ｏとして設定される物体検出部１１が検出する物体の数として設定することも可能である。これにより、物体数設定部１７は物体検出部１１が検出する物体の数を容易に設定することが可能となる。

物体計数部１８は、区画の一方の端部から他方の端部に向って走行する際に、基準線ＳＬの設定に用いた物体の数を計数する。物体計数部１８は目標物設定部１２が目標物Ｏを新たに設定した場合には、その旨を示す情報を取得し、当該新たに設定した目標物Ｏを用いて実際に基準線ＳＬを設定に用いた物体の数を計数する。元々、進行方向奥側の目標物Ｏ２として設定していたものを、自動走行車両１の走行に応じて進行方向手前側の目標物Ｏ１として設定した場合には、双方を計数すると、同一の物体に係る目標物Ｏであることから重複して計数することになる。このような重複して計数することを避けるために、物体計数部１８は、自動走行車両１が区画の一方の端部から他方の端部に向って走行する際に、予め決定された進行方向手前側に設定された目標物Ｏ１に係る物体及び進行方向奥側に設定された目標物Ｏ２に係る物体のいずれか一方のみを計数し、当該計数結果に１を加えておくことで、区画の一方の端部から他方の端部に至るまで基準線ＳＬの設定に係る物体を計数することが可能となる。

物体数判定部１９は、物体計数部１８の係数結果が、物体数設定部１７により設定された物体の数に達した場合に、自動走行車両１が区画の他方の端部に達したと判定する。これにより、走行制御部１６はその位置で自動走行車両１を一旦、停車させ、当該停車した位置から自動走行車両１をスイッチバックさせて次に草を刈り取る分だけ位置をずらし、その位置から再度、目標物Ｏに基づき基準線ＳＬを設定して自動走行しながら草を刈り取る。このようにして自動走行車両１は、自車で自動走行する際に基準となる基準線ＳＬを設定し、自動走行することが可能となる。

〔その他の実施形態〕
（１）上記実施形態では、自動操舵機構５０は、第１車輪２Ａの操舵角を操作する第１車輪操向操作機構５１と第２車輪２Ｂの操舵角を操作する第２車輪操向操作機構５２とから構成され、同位相操舵が可能であり、必要な場合、車体３の中心を旋回中心として旋回走行する逆位相操舵可能である。このような自動操舵機構５０に代えて、第１車輪２Ａまたは第２車輪２Ｂの一方だけの操舵角を操作するように構成してもよい。

（２）上記実施形態では、物体検出部１１が果樹園の果樹Ｋや果樹Ｋを支持する支柱を検出するとして説明したが、果樹Ｋや支柱以外に、柵やフェンス等を検出するよう構成することも可能である。また、物体と、当該物体から予め設定された距離内にある他の物体とをグループ化して一つの物体として扱うように構成することも可能である。これにより、例えば果樹Ｋと当該果樹Ｋを支持する支柱とを一つの目標物Ｏとして設定することが可能となるので、目標物Ｏの設定に係る演算処理を軽減できる。

（３）上記実施形態では、物体計数部１８の係数結果が、物体数設定部１７により設定された物体の数に達した場合に自動走行車両１が区画の他方の端部に達したと物体数判定部１９が判定し、走行制御部１６は、区画の端部に達したと判定された場合に自動走行車両１を停車させるとして説明したが、走行制御部１６は例えば走行距離やリモコン操作等によって区画の端部に達したと判定し、自動走行車両１を停車させるよう構成することも可能である。

（４）上記実施形態では、目標物設定部１２が物体検出部１１により検出された物体のうち、進行方向に沿って並んだ物体を用いて目標物Ｏを設定するとして説明したが、目標物設定部１２は進行方向から外れた位置で検出された物体を用いて目標物Ｏを設定することも可能である。すなわち、例えば進行方向に沿った樹列に隣接する樹列を構成する果樹Ｋ等を補助目標物とし、当該補助目標物に基づいて基準線ＳＬを設定すること可能である。この場合、元々の基準線ＳＬの設定に用いた２つの目標物Ｏの間の距離と、２つの目標物Ｏの一方と前記補助目標物との距離と、前記２つの目標物Ｏの他方を基準とした２つの目標物Ｏの一方と前記補助目標物とのなす角とにより新たな基準線ＳＬを設定することが可能である。これにより、目標物Ｏを設定し難い場合でも適切に自動走行車両１を自動走行させることが可能となる。なお、このような構成とすべく、基準線ＳＬの設定に用いた２つの目標物Ｏの間の距離と、２つの目標物Ｏの一方と前記補助目標物との距離と、前記２つの目標物Ｏの他方を基準とした２つの目標物Ｏの一方と前記補助目標物とのなす角とを、その都度、記憶しておくと良い。

（５）上記実施形態では、目標物設定部１２は、現在、設定されている目標物Ｏから予め設定された距離内において新たな目標物Ｏを設定するとして説明したが、目標物設定部１２は、現在、設定されている目標物Ｏから予め設定された距離にかかわらず、新たな目標物Ｏを設定する構成とすることも可能である。

（６）自動走行車両１に、ＧＰＳなどの衛星航法が可能な自車位置検出機能が備えられており、目標物Ｏとなる果樹Ｋなどの物体の位置が地図情報として記録されている場合、基準線ＳＬの位置は地図情報から算定でき、基準線ＳＬからの離間距離は逐次検出される自車位置から算定できる。目標物設定部１２は、自車位置に基づいて地図情報における果樹Ｋを探し出し、目標物Ｏを設定することができる。このような実施形態でも、逐次検出される自車位置と地図情報とに基づいて、上述した直進走行、抜け出し走行、側方通過走行、進入走行、さらにはノーマル直線走行を実行することができる。

（７）上記実施形態では、自動走行車両１が草の刈り取りを行いながら自動走行するとして説明したが、自動走行車両１を例えば運搬車両として用いることも可能であるし、他の用途に用いることも当然に可能である。

本発明は、自動で走行する自動走行車両に利用することが可能である。

１ ：自動走行車両
２ ：車輪
２Ａ ：第１車輪
２Ｂ ：第２車輪
３ ：走行車体（車体）
１０ ：自動走行制御装置
１１ ：物体検出部
１２ ：目標物設定部
１３ ：基準線設定部
１４ ：距離演算部
１５ ：走行範囲設定部
１６ ：走行制御部
１６０ ：直線走行制御部
１６１ ：側方通過走行制御部
１６２ ：進入走行制御部
１６３ ：抜け出し走行制御部
１６Ａ ：操舵制御部
１７ ：物体数設定部
１８ ：物体計数部
１９ ：物体数判定部
２０ ：走行モード選択部
５０ ：自動操舵機構
５１ ：第１車輪操向操作機構
５２ ：第２車輪操向操作機構
Ａｓ ：走行線
Ａｔ ：走行線
Ｋ ：果樹
Ｏ ：目標物（果樹Ｋ）
Ｏ１ ：目標物（果樹Ｋ）
Ｏ２ ：目標物（果樹Ｋ）
ＳＬ ：基準線

Claims (6)

1. 自動操舵機構を有する走行車体と、
   ２つの物体を目標物として設定する目標物設定部と、
   前記目標物設定部により設定された２つの目標物を通り、走行時の基準となる基準線を設定する基準線設定部と、
   前記基準線から前記走行車体までの距離である離間距離を演算する距離演算部と、
   前記目標物の位置及び前記離間距離に基づいて前記２つの目標物の間に所定側から入り込む進入走行と、前記２つの目標物の間を前記基準線に沿って走行する直線走行と、前記２つの目標物の間から前記所定側に抜け出す抜け出し走行と、前記目標物の前記所定側の側方を通過する側方通過走行とを実行する走行制御部と、
   前記走行制御部からの操舵指令に基づいて前記自動操舵機構に操舵制御信号を出力する操舵制御部と、
   を備えた自動走行車両。
2. 予め設定された範囲に向けて検出信号を送信し、前記検出信号に対する反射信号を取得して、前記予め設定された範囲に存在する物体を検出する物体検出部が備えられており、
   前記目標物設定部は、前記物体検出部により検出された２つの物体の位置に基づいて、当該２つの物体を目標物として設定する請求項１に記載の自動走行車両。
3. 前記自動操舵機構が、走行前側の車輪と走行後側の車輪とが同方向に操舵可能な同位相四輪操舵機構として構成されており、前記進入走行及び抜け出し走行において前記同位相四輪操舵機構による前記走行車体の平行移動により進路変更が行われる請求項１または２に記載の自動走行車両。
4. 前記直線走行において、前記走行車体の中心が前記基準線を前記所定側から反対側に超えないように走行制御される請求項１から３のいずれか一項に記載の自動走行車両。
5. 前記直線走行において、前記走行車体の中心と前記走行車体の前記所定側の側端部との間に前記基準線が位置するように走行制御される請求項４に記載の自動走行車両。
6. 前記進入走行における前記直線走行への移行点を決定する前記所定側から前記基準線への進入距離は、前記２つの目標物の間の距離と前記走行車体の外形寸法をパラメータとし、前記走行車体と目標物との距離が最小となる条件で、算定される最大値である請求項１から５のいずれか一項に記載の自動走行車両。

Images