走行制御装置
【課題】車両が目標ランプに向かって自動的に走行するように制御する走行制御装置を提供する。
【解決手段】走行制御装置において、カメラは、車両走行の目標となる方向に位置する目標ランプを撮像する。画像処理部３２は、カメラにより撮像した撮像画像を処理する。走行制御部３６は、撮像画像に含まれる目標部画像の位置と車両の初期位置との関係で定まる目標走行ラインを走行するように車両の走行を制御する。ヨー角検出部４２は、撮像画像から目標部に対する車両のヨー角を検出する。横偏差算出部５０は、撮像画像から目標走行ラインからの横偏差を算出する。走行制御部３６は、ヨー角および横偏差にもとづいて車両の走行を制御する。
【解決手段】走行制御装置において、カメラは、車両走行の目標となる方向に位置する目標ランプを撮像する。画像処理部３２は、カメラにより撮像した撮像画像を処理する。走行制御部３６は、撮像画像に含まれる目標部画像の位置と車両の初期位置との関係で定まる目標走行ラインを走行するように車両の走行を制御する。ヨー角検出部４２は、撮像画像から目標部に対する車両のヨー角を検出する。横偏差算出部５０は、撮像画像から目標走行ラインからの横偏差を算出する。走行制御部３６は、ヨー角および横偏差にもとづいて車両の走行を制御する。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、目標に向かうように車両の走行を制御する走行制御装置に関する。
【背景技術】
【０００２】
農用車両による播種、移植、畝立て、畦塗りおよび資材散布などの作業では、その作業の精度や能率向上のためや、それ以降の管理や収穫などの作業のために、各行程を直進かつ平行に行うことが重要である。特に、最初の行程は次の行程以降の基準となることから、できるだけ、真っ直ぐな行程であることが望ましい。これらの作業は長時間にわたることが多く、やり直すことができない作業もあるため、作業者への肉体的、精神的な負担が大きく、熟練を必要とする。そのため、農用車両を自動的に直進する技術へのニーズが多い。
【０００３】
車両の自動走行を制御する技術として、以下に示すような技術がある。たとえば、特許文献１には、農用車両の直進制御法が提案されている。この農用車両の直進制御法は、最初に設定された方位を目標方位とし、地磁気方位センサから得られた農用車両の走行方位と、目標方位とにもとづき自動走行する。
【０００４】
また、特許文献２には、車両のヨー方向の角速度にもとづいて車両の回転方向とは逆のヨーモーメントが生じるように、左右の制御ブレーキを制動して車両の姿勢を制御する車両姿勢制御装置が開示されている。
【０００５】
また、特許文献３には、位置調整、旋回調整が可能なレーザ発光機を車両に備え、目標地点に置かれたプリズムによって、反射されたレーザ光をもとに作業車を誘導する装置が開示されている。
【０００６】
また、特許文献４には、点灯する発光体を備えた田植機と、発光体の位置判別装置を備えた本体側車両において、田植機と本体側車両とを遠近方向に相対移動操作する移動制御装置が開示されている。
【０００７】
また、特許文献５には、点滅信号を発信する誘導灯が作業機の前後に複数配置され、誘導灯により作業機の往復作業およびレーン変更を誘導する自動運行装置が開示されている。
【０００８】
また、特許文献６には、目標とする走行経路に沿ってレーザ投光機から投射されるレーザ光線を、作業車の前後に設置した２組の受光センサで検出して、レーザ光線に対する作業車の方位ずれと車幅方向の位置ずれを検出し、方位ずれと位置ずれの情報にもとづいて作業車を走行経路に沿って自動走行するように制御する作業車誘導装置が開示されている。
【先行技術文献】
【特許文献】
【０００９】
【特許文献１】特開２０００−１４２０９号公報
【特許文献２】特開２００５−２６２９０８号公報
【特許文献３】特開平１−１０３０８号公報
【特許文献４】特開平１０−２４３７１０号公報
【特許文献５】特開平３−２４２８号公報
【特許文献６】特開平６−１６８０２４号公報
【発明の概要】
【発明が解決しようとする課題】
【００１０】
ところで、特許文献６に記載されたような作業車誘導装置を用いて、車両を自動的に走行させる場合、複数のレーザ投光機の設置や、作業車に設けられた受光センサの位置調整が煩瑣である。
【００１１】
本発明はこうした状況に鑑みてなされたものであり、その目的は、車両が目標に向かうように走行させる制御を簡易にすることができる走行制御装置を提供することにある。
【課題を解決するための手段】
【００１２】
上記課題を解決するために、本発明のある態様の走行制御装置は、車両走行の目標となる方向に位置する目標部を撮像する撮像部と、撮像部により撮像した撮像画像を処理する画像処理部と、撮像画像に含まれる目標部画像の位置と車両の初期位置との関係で定まる目標走行ラインを走行するように車両の走行を制御する走行制御部と、を備える。画像処理部は、撮像画像から目標部に対する車両のヨー角を検出するヨー角検出部と、撮像画像から目標走行ラインからの横偏差を算出する横偏差算出部と、を備える。走行制御部は、ヨー角および横偏差にもとづいて車両の走行を制御する。
【００１３】
この態様によると、画像処理によってヨー角および横偏差を算出することができ、ヨー角と横偏差とにもとづいて走行制御を行うことで、車両を精度良く目標走行ラインに沿って走行させることができる。
【発明の効果】
【００１４】
本発明によれば、車両が目標に向かうように走行させる制御を簡易にすることができる。
【図面の簡単な説明】
【００１５】
【図１】実施形態に係る走行制御装置の側面図である。
【図２】本発明の実施の形態に係る走行制御装置の上面図である。
【図３】実施形態に係るＥＣＵの機能構成を示す図である。
【図４】実施形態に係る横滑り走行を実行している車両を示す図である。
【図５】実施形態に係る画像処理部の機能構成を示す図である。
【図６】目標部画像の大きさと実距離との関係を示す図である。
【図７】にじみ幅と実距離との関係を示す図である。
【図８】撮像画像上の位置座標とにじみの関係性を示す図である。
【図９】発光部の指向性を示す模式図である。
【図１０】にじみ幅の算出結果を示す図である。
【図１１】にじみ補正をしていない実距離の算出結果を示す図である。
【図１２】実施形態に係る距離算出部がにじみ補正をした実距離の算出結果を示す図である。
【図１３】仮想２次元空間における目標部画像とウィンドウと消失点の初期状態の位置を示す図である。
【図１４】車両が実空間で右に変位した場合の仮想２次元空間における目標部画像とウィンドウと消失点の位置を示す図である。
【図１５】平面での走行制御の実験結果を示す図である。
【図１６】斜面での走行制御の実験結果を示す図である。
【図１７】実施形態に係る走行制御のフローチャートを示す図である。
【発明を実施するための形態】
【００１６】
作業車両は、通常の一般車両と比べて、牽引力および旋回力に優れる一方、直進性能が低い場合がある。また、運転者は、作業車両の後部に備えられる作業機の作業状態を確認するため、後方に振り返りつつ、直進運転をすることを強いられる。農場によっては５００ｍ以上の長さがあり、この距離を直進させるのは運転者の負担が大きい。そこで、実施形態の走行制御装置は、目標地点に設置された目標ランプをカメラで撮像し、目標ランプに向かって車両を自動的に走行させることで、運転者の負担を軽減させる。
【００１７】
一般道路には車線が描かれているが、農場には基準とする走行ラインが描かれていない。実施形態の走行制御装置は、目標ランプと車両の初期位置を結ぶ直線を走行ラインとして定める。そして、走行制御装置は、目標ランプに対するヨー角と、目標とする走行ラインに対する横偏差とにもとづいて目標ラインを走行するように車両の走行を制御する。これにより、走行制御における直進性能が高まる。
【００１８】
以下、図面を参照しながら実施形態について説明する。なお、明細書中の「左」または「右」の記載は、車両後部から車両進行方向を向いた場合の方向を意味する。図面の説明において同一の要素には同一の符号を付し、重複する説明を適宜省略する。
【００１９】
図１は、実施形態に係る走行制御装置２０の側面図である。図２は、実施形態に係る走行制御装置２０の上面図である。車両１は、車両客室３、左前輪８ａと右前輪８ｂ（以下、総称する場合は「前輪８」という）、および、左後輪１０ａと右後輪１０ｂ（以下、総称する場合は「後輪１０」という）を有し、走行制御装置２０は、車両１に搭載され、左ブレーキ機構６ａと右ブレーキ機構（不図示）（以下、総称する場合は「ブレーキ機構６」という）、カメラ１１、ＥＣＵ（Electronic control unit）１２、操舵駆動機構１４およびステアリング機構１５を備える。
【００２０】
車両１は、農用トラクタや土木用作業車両などの作業車両であってよく、車両１の後方には作業機１６が取り付けられる。作業機１６は、たとえば、圃場４において播種や畝立てなどの作業をする。
【００２１】
ステアリング機構１５は、ステアリングホイール（不図示）、ステアリングシャフト（不図示）、およびステアリングシャフトの動きを前輪の動きに変換するギヤ装置（不図示）と、を有する。ステアリング機構１５は、ハンドルとしてのステアリングホイールの回動を前輪８の転舵運動に変換する。ステアリングホイールは、車両客室３内に設けられ、運転者によって回動操作される。ステアリングシャフトは、ステアリングホイールとともに回転するように一端がステアリングホイールに連結されており、ステアリングホイールの回転をギヤ装置に伝達する回転軸として機能する。
【００２２】
操舵駆動機構１４は、舵角センサ（不図示）およびモータ（不図示）を備える。操舵駆動機構１４は、モータを駆動し、ステアリング機構１５に転舵力を与える。舵角センサは、ステアリングシャフトに設けられ、ステアリングホイールの操舵角および操舵方向を検出する。操舵駆動機構１４はＥＣＵ１２に接続されている。舵角センサの検出値は、ＥＣＵ１２に出力される。なお、操舵駆動機構１４は、液圧式であってよく、液圧ポンプを駆動して、ステアリング機構１５に転舵力を与えてよい。
【００２３】
ブレーキ機構６は、運転者のブレーキペダル（不図示）の操作量に応じて後輪１０に制動力を与える。ブレーキペダルは、左後輪用ブレーキペダルと右後輪用ブレーキペダルを有する。運転者が各ブレーキペダルを操作することで、左後輪１０ａと右後輪１０ｂに対して個別に制動力を与えることができる。たとえば、車両１を右方向に旋回するとき、運転者が、右後輪用ブレーキペダルを踏み込んで右後輪１０ｂに制動力を与えることで、右後輪１０ｂを軸として車両１を小回りさせることができる。ブレーキ機構６は、ＥＣＵ１２に接続され、ＥＣＵ１２により後輪１０に与える制動力を制御される。なお、車両１の前輪８に、ブレーキ機構は無くてよい。
【００２４】
目標ランプ２は、発光部２１および筐体２４を備える。発光部２１は、発光ダイオード（ＬＥＤ）であってよく、所定の大きさを有し、目標部として機能する。発光部２１は、所定の制御周期で点滅してよい。なお、目標部は、ＥＣＵ１２が既知の大きさで、カメラ１１によって認識可能な部材であってよい。
【００２５】
車両客室３の上部には、カメラ１１が配置される。カメラ１１は、撮像部として機能し、目標ランプ２を撮像する。カメラ１１は、点灯している発光部２１と、消灯している発光部２１を交互に撮像してよい。カメラ１１は、撮像した画像をＥＣＵ１２に出力する。
【００２６】
図２に示す目標走行ライン２６は、撮像画像に含まれる目標ランプ２の位置と車両１の初期位置との関係で定まる。図２では目標ランプ２が車両走行の目標とする方向の位置に配置されている。車両１の初期位置とは、運転者がＥＣＵ１２に接続された自動走行開始スイッチ（不図示）をオンしたときの車両１の位置をいい、走行制御装置２０による走行制御を開始する位置をいう。
【００２７】
運転者が自動走行開始スイッチをオンすると、ＥＣＵ１２は、カメラ１１から出力された目標ランプ２が撮像された画像から目標ランプ２の位置を算出し、車両１の初期位置と目標ランプ２の位置とを結ぶラインを目標走行ライン２６として定める。なお、運転者による自動走行開始スイッチのオン／オフにより、走行制御装置２０による走行制御が実行／停止される。
【００２８】
ＥＣＵ１２は、撮像された撮像画像を処理する画像処理手段として機能し、車両１の走行を制御する走行制御手段として機能する。ＥＣＵ１２は、各種演算処理を実行するＣＰＵ、各種制御プログラムを格納するＲＯＭ、データ格納やプログラム実行のためのワークエリアとして利用されるＲＡＭ、エンジン停止時にも記憶内容を保持できるバックアップＲＡＭ等の不揮発性メモリ、入出力インターフェース、各種センサ等から入力されたアナログ信号をデジタル信号に変換して取り込むためのＡ／Ｄコンバータ、計時用のタイマ等を備えるものである。なお、画像処理手段と走行制御手段は、それぞれ画像処理装置と走行制御装置とする、別のユニットであってよい。
【００２９】
図３は、実施形態に係るＥＣＵ１２の機能構成を示す。ＥＣＵ１２は、画像取得部３０、画像処理部３２、記憶部３４および走行制御部３６を備える。画像取得部３０は、カメラ１１が目標ランプ２を所定の撮像周期で撮像した撮像画像を取得する。
【００３０】
画像処理部３２は、画像取得部３０から受け取った撮像画像を処理する。画像処理部３２は、撮像画像からヨー角および横偏差を検出し、走行制御部３６に供給する。記憶部３４には、横偏差および撮像画像の情報が記憶される。
【００３１】
走行制御部３６は、操舵駆動機構１４を介して操舵を制御する操舵制御部と、ブレーキ機構６を介して制動力を制御するブレーキ制御部とを備える。ブレーキ制御部は、左右の後輪１０に設けられたブレーキ機構６の制動力を独立に制御する。操舵制御部は、操舵駆動機構１４を駆動し、前輪８の操舵を制御する。
【００３２】
走行制御部３６は、画像処理部３２から受け取ったヨー角と横偏差に応じて目標走行ライン２６を走行するように車両１の走行を制御する。たとえば、走行制御部３６は、ヨー角がゼロであり車両１の進行方向が目標ランプ２に真っ直ぐ向いている場合であっても、横偏差にもとづいて横偏差を小さくするように前輪８を操舵する。これにより、走行制御部３６は、車両１が目標走行ライン２６に近づくように走行を制御することができる。
【００３３】
なお、車両１の左右への横偏差がそれぞれプラスとマイナスで算出される場合に、横偏差がゼロである位置が目標走行ライン２６上の位置となる。
【００３４】
走行制御部３６は、ブレーキ制御部により左右の後輪１０のうち目標走行ライン２６に近い後輪１０に制動力を与え、操舵制御部により目標走行ライン２６に向かう方向と逆向きに前輪を操舵させて、横滑り走行を制御する。ここで、横滑り走行について具体的に図４を参照して説明する。
【００３５】
図４は、実施形態に係る横滑り走行を実行している車両１を示す。図４に示す車両１の位置は、目標走行ライン２６から右にずれている。このとき、ブレーキ制御部は進行中の車両１の左後輪１０ａに制動力を与え、操舵制御部は前輪８を進行方向とは逆向きに操舵する。これにより、車両１に横滑りが発生し、車両１が横滑りしながら進行する。横滑り走行において、車両１がヨー角の変化を最小限にとどめつつ走行するため、作業機１６のぶれを小さくすることができる。
【００３６】
図５は、実施形態に係る画像処理部３２の機能構成を示す。画像処理部３２は、目標ランプ検出部４０、ヨー角検出部４２、距離算出部４４、特徴設定部４６、特徴追跡処理部４８、および横偏差算出部５０を備える。
【００３７】
目標ランプ検出部４０は、画像取得部３０から受け取った撮像画像から画像上の発光部２１（以下、「目標部画像」という）を検出する。具体的には、目標ランプ検出部４０は、所定の輝度閾値以上の輝度を示す画素の集合を目標部画像として検出する。また、目標ランプ検出部４０は、点滅する発光部２１を撮像した撮像画像を受け取り、点灯した発光部２１の撮像画像と消灯した発光部２１の撮像画像の輝度を比較し、所定の輝度差以上の画素の集合を目標部画像として検出してよい。さらに、目標ランプ検出部４０は、所定の輝度差以上の画素の集合が所定の面積および所定のアスペクト比を満たせば、目標部画像であると判定してよい。また、目標ランプ検出部４０は、点滅する発光部２１の撮像画像を受け取り、検出した目標部画像が、発光部２１の点滅の周期に応じた輝度の時間的変化を満たすかどうか判定し、目標部画像の検出が妥当であるかどうか判定してよい。
【００３８】
目標ランプ検出部４０は、撮像画像と、検出した目標部画像の位置情報および大きさを記憶部３４に記憶させる。目標ランプ検出部４０は、目標部画像の大きさを距離算出部４４に供給し、目標部画像の位置情報をヨー角検出部４２および横偏差算出部５０に供給する。なお、位置情報は、撮像画像の画素を単位とする仮想２次元空間の座標であってよく、撮像画像上の所定の位置を基準とした座標であってよい。
【００３９】
ヨー角検出部４２は、目標ランプ検出部４０から目標部画像の位置情報を受け取り、車両１の向きと目標部画像の位置から目標ランプ２に対する車両１のヨー角を算出する。ヨー角は、車両１の向きと、目標ランプ２と車両１の位置とを結ぶラインと、にもとづく鋭角である。たとえば、車両１が目標ランプ２に対して真っ直ぐ向いていれば、ヨー角をゼロとしてよい。
【００４０】
車両１の向きは、あらかじめ設定されたカメラ１１の撮像方向であってよく、たとえば撮像画像の中心位置を通る縦方向のベクトルであってよい。なお、カメラ１１は、車両１のエンジンフードに設置される所定のマーカーを撮像し、ヨー角検出部４２は、撮像画像の所定の位置がマーカーからずれていれば、マーカーを基準に撮像方向の位置ずれを補正してよい。これにより、カメラ１１の撮像方向がずれた場合でも、あらかじめ設定されたカメラ１１の撮像方向と同じように、車両１の向きを検出することができる。
【００４１】
距離算出部４４は、目標部画像の大きさＬｉと、実空間上の発光部２１の大きさＬｇとにもとづいて目標ランプ２と車両１との実空間上の実距離Ｚｇを算出する。以下に実距離Ｚｇを算出する計算式（１）を示す。
Ｚｇ＝Ｌｇ／（Ｌｉ×ＰＷＶ） ・・・ （１）
ＰＷＶ：カメラ１１の１画素当たりの縦方向の視野角
なお、ＬｇおよびＰＷＶは、あらかじめ記憶された既知の値である。
【００４２】
距離算出部４４は、目標部画像に生じた輝度のにじみを補正して、目標部画像の大きさを算出してよい。これは、露光時間や量子化誤差などにより撮像された発光部２１が画像上でにじみ、目標部画像の大きさが実際より大きく算出されることを抑え、より正確な目標部画像の大きさを算出するためである。
【００４３】
図６は、目標部画像の大きさＬｉと実距離Ｚｇとの関係を示す。図６の縦軸は、目標部画像の大きさＬｉ［画素］（Image length[pix]）を示し、横軸は、実距離Ｚｇ［メートル］（Measured distance[m]）を示す。なお、図６に示す６種類の点は、カメラ１１の露光時間を示し、図７、１０〜１２も同様である。カメラ１１のレンズの絞りは固定している。図６に示す曲線は、計算上の正確な目標部画像の大きさＬｉｃである。そして、目標部画像の大きさＬｉから正確な目標部画像の大きさＬｉｃを減算したにじみ幅Ｎｊを図７に示す。
【００４４】
図７は、にじみ幅Ｎｊと実距離Ｚｇとの関係を示す。図７の縦軸は、にじみ幅Ｎｊ［画素］（Spreading width[pix]）を示し、横軸は、実距離Ｚｇ［メートル］（Measured distance[m]）を示す。図７では、カメラ１１の露光時間の増加に応じて、にじみ幅Ｎｊが大きくなっている。また、実距離Ｚｇが３０ｍに増加するまで、にじみ幅Ｎｊが増加し、実距離Ｚｇが３０ｍより増加すると、にじみ幅Ｎｊが減少している。
【００４５】
図８は、撮像画像上の位置座標と輝度との関係を示す。図８の縦軸は、輝度を示し、横軸は、撮像画像上の位置座標を示す。まず、輝度Ｂｇｒは、発光部２１の背景画像の輝度である。この輝度Ｂｇｒに発光部２１の輝度Ａｐｒが加算されている。すなわち、図８のハッチング箇所が正確な目標部画像であり、大きさはＬｉｃである。にじみとなる箇所は、正確な目標部画像の周囲に発生し、にじみの輝度は、正確な目標部画像から離れるに従って、小さくなっている。たとえば、目標ランプ検出部４０によって輝度が輝度閾値Ｔｒｌ以上であれば目標部画像として検出される場合、撮像画像から輝度閾値Ｔｒｌ以上の画素の領域の大きさＬｉが目標部画像の大きさとして算出される。
【００４６】
にじみ幅Ｎｊは、発光部２１の輝度Ａｐｒと輝度閾値Ｔｒｌとの輝度差Ｄｐｒによって算出される。その計算式を以下に示す。
Ｎｊ＝ｋ１×（Ａｐｒ−Ｔｒｌ）＋ｋ２ ・・・ （２）
Ａｐｒ＝ｋ３×（Ａｐｅ＋Ｂｐｅ）０．５ ・・・ （３）
Ｂｐｅ＝（Ｂｇｒ／ｋ３）２ ・・・ （４）
Ａｐｅ＝ｋ４×Ｐｌ×Ｔｃ／Ｚｇｉ ・・・ （５）
ｋ１，ｋ２，ｋ３，ｋ４：定数
Ａｐｅ：発光部２１から入射する光量
Ｂｐｅ：背景から入射する光量
Ｐｌ：発光部２１から投射される光の強さ
Ｔｃ：カメラ１１の露光時間
Ｚｇｉ：仮の実距離
なお、ｋ１〜ｋ４の定数は、カメラ１１や発光部２１などの性能に依存する。輝度閾値Ｔｒｌは、目標ランプ検出部４０から取得される。
【００４７】
にじみ幅Ｎｊを算出する式（２）で用いる輝度Ａｐｒは、式（３）〜（５）によって算出される。式（３）により、発光部２１からカメラ１１に入射する光量Ａｐｅと、発光部２１の背景から入射する光量Ｂｐｅとにもとづいて、輝度Ａｐｒが算出される。式（３）では、光量の０．５乗が、輝度と比例する関係性をもつように設定した。これにより、測定したデータから輝度Ａｐｒを精度良く算出することができる。
【００４８】
式（４）は、発光部２１の背景から入射する光量Ｂｐｅを算出する式であり、式（３）における光量Ａｐｅがゼロのときの逆算式である。式（４）では式（３）の関係を用いて、背景画像の輝度Ｂｇｒから、発光部２１の背景から入射する光量Ｂｐｅを算出する。背景画像の輝度Ｂｇｒは、発光部２１が消灯した時の撮像画像における目標部画像とその周りの領域の輝度の平均値であってよい。
【００４９】
式（５）は、発光部２１からカメラ１１に入射する光量Ａｐｅを算出する式である。まず、光量Ａｐｅは、発光部２１からカメラ１１の方向に投射される光の強さＰｌに比例する。ここで、図９を参照して、発光部２１から投射される光の強さＰｌの算出方法を説明する。
【００５０】
図９は、発光部２１の指向性を示す模式図である。図９の斜線領域は、ＬＥＤの指向特性（Directivity of the LED）を示す。発光部２１は、図９の斜線領域に示すように、前方に集中した光の強さを投射する指向性を有する。発光部２１に対するカメラ１１の位置によって角度Ａｇが変化し、光の強さＰｌが変化する。図７において、実距離Ｚｇが３０ｍより小さくなると、にじみ幅Ｎｊが減少したという結果は、実距離Ｚｇに応じた角度Ａｇの変化により光の強さＰｌが減少したためである。光の強さＰｌは、カメラ１１の発光部２１に対する高さｄＨと実距離Ｚｇまたは仮の実距離Ｚｇｉに応じた角度Ａｇにもとづいて算出される。
【００５１】
次に、式（５）の光量Ａｐｅは仮の実距離Ｚｇｉに反比例する。仮の実距離Ｚｇｉは、繰り返し算出される実距離Ｚｇを外挿法により算出してよい。また、仮の実距離Ｚｇｉの初期の値は、式（１）により算出された値であってよい。ここで、カメラ１１に入射する光量Ａｐｅと実距離Ｚｇとの関係を説明する。一般理論では、発光部２１が点光源であれば、光量Ａｐｅは、実距離Ｚｇの２乗に反比例し、発光部２１が無限の面積を持つ光源であれば、光量Ａｐｅは、実距離Ｚｇによらず一定となる。実施形態の発光部２１は、たとえば横０．１ｍ×縦０．３ｍの有限の面積に点光源を等間隔で配置した構造であるため、一般理論の中間をとって、距離が光量に反比例すると定めた。これにより、発光部２１から入射する光量を精度良く算出することができる。
【００５２】
次に、式（５）の光量Ａｐｅは、カメラ１１の露光時間Ｔｃに比例する。露光時間Ｔｃは、カメラ１１から受け取ってもよく、あらかじめ記憶されていてよい。
【００５３】
以上の式（２）〜（５）により、距離算出部４４は、にじみ幅Ｎｊを算出する。距離算出部４４は、以下の式（６）を用いて、目標ランプ検出部４０により検出された目標部画像の大きさＬｉに、にじみ補正をして実距離Ｚｇを算出する。
Ｚｇ＝Ｌｇ／（（Ｌｉ−Ｎｊ）×ＰＷＶ） ・・・ （６）
【００５４】
図１０は、にじみ幅Ｎｊの算出結果を示す。図１０の縦軸は、にじみ幅Ｎｊの算出結果［画素］（Calculated spreading width[pix]）を示し、横軸は、測定したにじみ幅［画素］（Measured spreading width[pix]）を示す。カメラ１１のレンズの絞りは固定している。
【００５５】
図１１は、距離算出部４４がにじみ補正をしていない実距離Ｚｇの算出結果を示す。また、図１２は、実施形態に係る距離算出部４４がにじみ補正をした実距離Ｚｇの算出結果を示す。図１１および図１２の縦軸は実距離Ｚｇの算出結果［メートル］（Calculated distance[m]）を示し、横軸は測定した実距離［メートル］（Measured distance[m]）を示す。カメラ１１のレンズの絞りは固定している。
【００５６】
図１１は、式（１）を用いた実距離Ｚｇの算出結果であり、図１２は、式（６）を用いた実距離Ｚｇの算出結果である。図１１のにじみ補正をしていない算出結果は、距離が長くなるにつれて、算出した距離と正確な距離との誤差が大きくなっている。一方、図１２の目標部画像の大きさに、にじみ補正をした算出結果は、図１１に示す結果と比較して、距離が長くなっても、算出した実距離と正確な実距離との誤差が小さく収まっている。すなわち、距離算出部４４は、にじみ補正をすることで、カメラ１１の画像から目標ランプ２と車両１の距離を精度良く算出することができる。
【００５７】
図５に戻る。特徴設定部４６および特徴追跡処理部４８は、特徴画像を検出する特徴検出手段として機能する。特徴設定部４６は、撮像画像から特徴的な部分画像を検出し、それを特徴画像として設定する。特徴画像とは、所定の傾き以上の輝度勾配がある領域、または、所定の傾き以上の輝度勾配が分布している領域であってよく、大きさが定められたウィンドウ内の撮像画像であってよい。
【００５８】
また、特徴設定部４６は、特徴追跡処理部４８が設定された特徴画像を追跡できなくなった場合に、新たに特徴画像を設定する。特徴画像として検出した領域は、車両１が進行すれば、大きくなり、変形する。とくに特徴画像が地面であれば、車両１が進行するとともに特徴画像の縦方向の大きさが大きく変形する。そこで、特徴画像の形状は縦方向に短い長方形に定められてよい。特徴設定部４６は、設定した特徴画像をテンプレートとして、画素値情報および位置情報を記憶部３４に記憶させる。なお、特徴画像のテンプレートは複数設定されてよい。
【００５９】
特徴追跡処理部４８は、新たな撮像画像が撮像される度に、設定された特徴画像のテンプレートと同じような輝度勾配等をもつ領域があるかどうか追跡する。特徴追跡処理部４８は、テンプレートの位置座標の周囲の位置座標の領域を探索する。特徴追跡処理部４８は、テンプレートと新たな撮像画像上のウィンドウで取り出した領域との画素値が所定レベル以上に一致していれば、新たな撮像画像上のウィンドウがテンプレートと実空間上の同じ領域であると判定する。たとえば、特徴追跡処理部４８は、正規化相関法などの手法を用いて、新たな撮像画像上のウィンドウがテンプレートと実空間上の同じ領域であるかどうか判定する。
【００６０】
特徴追跡処理部４８は、テンプレートと実空間上の同じ領域であると判定すれば、その新たな撮像画像上のウィンドウの位置情報を横偏差算出部５０に供給する。特徴追跡処理部４８は、テンプレートと実空間上で同じ領域である新たな撮像画像上の領域がなければ、特徴設定部４６に新たな特徴画像を設定するよう指令信号を供給する。
【００６１】
特徴画像のテンプレートは、同じ領域であると判定されるたびに、撮像画像毎のテンプレートの変位量に応じて補間されて記憶部３４に記憶される。これは、車両１が進行するにつれて、新たな撮像画像上のテンプレートと同じ領域が拡大していくからである。ここで、振動が多い作業車両に搭載されたカメラ１１の撮像画像であれば、演算周期ごとにテンプレートの画像を新たな撮像画像から抽出して更新する処理を行うと、テンプレートの画像の抽出時の誤差が蓄積されるおそれがある。そこで、特徴追跡処理部４８は、特徴設定部４６により設定されたときのテンプレートの初期の位置座標に対する、テンプレートと同じ領域であると判定された新たな撮像画像上のウィンドウの位置座標にもとづいてテンプレートを補間して、記憶部３４に記憶させてよい。
【００６２】
横偏差算出部５０は、撮像画像から目標走行ライン２６からの横偏差を算出する。横偏差は、初期値ゼロから横偏差算出部５０により横偏差が算出される毎に、加算されて蓄積されてよい。横偏差算出部５０は、カメラ１１により新たに撮像された現撮像画像から検出された目標部画像および特徴画像に対する、仮想２次元空間上の新たな消失点の位置を定め、新たな消失点と目標部画像と特徴画像との位置関係から横偏差を算出する。
【００６３】
横偏差算出部５０は、実空間上の距離に応じて、仮想２次元空間における新たな消失点の縦方向の位置を定める。また、横偏差算出部５０は、過去に検出された目標部画像および特徴画像に対して定められた過去の消失点の縦方向の位置を定める第１基準ラインから所与の間隔離れた第２基準ラインと、過去の消失点および目標部画像を結ぶ第１直線の第１交点と、第２基準ラインと、過去の消失点および特徴画像を結ぶ第２直線の第２交点との間隔にもとづいて、仮想２次元空間における目標部画像に対する新たな消失点の横方向の位置を定める。
【００６４】
ここで、図１３を参照する。図１３は、仮想２次元空間における目標部画像とウィンドウと消失点の初期状態の位置を示す。この仮想２次元空間では、縦方向をｊとして、横方向をｉとしている。仮想２次元空間での長さの単位は、撮像画像の画素であってよい。初期状態とは、車両１が初期位置にあるときをいう。
【００６５】
図１３に示す特徴画像のウィンドウＷ０の位置は、その下端の中央とし、目標部画像の位置Ｌ０は、目標部画像の下端の中央とする。横偏差算出部５０は、下記の計算式（７）により実距離Ｚｇに応じた間隔ｄｊｖｌを算出し、目標部画像の位置Ｌ０から縦方向ｊの上方の間隔ｄｊｖｌの位置に消失点があると推定する。
ｄｊｖｌ＝ＣＡＨ／（Ｚｇ×ＰＷＶ） ・・・ （７）
ＣＡＨ：地面からカメラ１１までの高さ
なお、カメラ１１の高さＣＡＨと、視野角ＰＷＶはあらかじめ記憶された値である。
【００６６】
図１３に示すように、目標部画像が初期状態であれば、消失点Ｖ０は、目標部画像の真上に位置する。仮想２次元空間に第１基準ラインＳｌ１と第２基準ラインＳｌ２を定める。第１基準ラインＳｌ１および第２基準ラインＳｌ２は平行であり、両基準ラインの仮想２次元空間の所与の間隔をｄｊｕとする。
【００６７】
車両１が目標ランプ２に向かって横移動せず真っ直ぐ進行すれば、目標部画像およびウィンドウはカメラ１１に近づくため、目標部画像の位置Ｌ０およびウィンドウの位置Ｗ０は、位置Ｌ１および位置Ｗ１に変化する。Ｌ０およびＷ０を進行前の過去の位置とし、Ｌ１およびＷ１を進行後の現在の位置とする。位置Ｗ０と位置Ｗ１のウィンドウは、同じ領域であると判定されたウィンドウである。
【００６８】
車両１が目標ランプ２に向かって直進したため、Ｌ１は、Ｌ０からＶ０とＬ０を結ぶ第１直線Ｖ０Ｌ０上の下方に変位している。ウィンドウの位置Ｗ１は、Ｖ０とＷ０を結ぶ第２直線Ｖ０Ｗ０上を変位する。第１直線Ｖ０Ｌ０と第２基準ラインＳｌ２との第１交点をＡ０とし、第２直線Ｖ０Ｗ０と第２基準ラインＳｌ２との第２交点をＢ０とする。Ａ０とＢ０の仮想２次元空間上の間隔をｄｘとする。
【００６９】
進行前と進行後において、車両１が直進していれば、消失点Ｖ０は変位しない。このとき、進行前後において両基準ラインの所与の間隔ｄｊｕが同一であれば、第１交点Ａ０と第２交点Ｂ０の間隔ｄｘは一定である。なお、実空間上では、第１直線Ｖ０Ｌ０と第２直線Ｖ０Ｗ０とは平行である。第１直線Ｖ０Ｌ０と第２直線Ｖ０Ｗ０との実空間上の平行距離をＤＸとする。
【００７０】
図１４は、車両１が実空間で右に変位した場合の仮想２次元空間における目標部画像とウィンドウと消失点の位置を示す。この仮想２次元空間では、縦方向をｊとして、横方向をｉとしている。目標部画像の位置をＬ２とし、ウィンドウの位置をＷ２とし、消失点の位置をＶ２とする。図１４に示すＬ２とＷ２は、図１３に示すＬ１とＷ１と時間は同じで、図１３の状態から、車両１が実空間上で右方向に平行に変位した状態である。したがって、Ｌ２およびＷ２は、図１３のＬ１およびＷ１のそれぞれの位置から左方向に平行に変位している。
【００７１】
第１基準ラインＳｌ１に対して垂直で消失点Ｖ２を通る第３直線と、第２基準ラインＳｌ２との第３交点をＣ２とする。第１交点Ａ２と第３交点Ｃ２の実空間上の距離が横偏差として算出される。なお、ここで算出された横偏差が、いままで蓄積されてきた横偏差に加算されて、新たな横偏差として算出されてよい。横偏差算出部５０は、実距離Ｚｇにもとずいて、目標部画像に対する消失点の縦方向ｊの間隔ｄｊｖｌを算出し、第１基準ラインＳｌ１上に消失点Ｖ２があることを定める。これにより、目標部画像に対する消失点の縦方向の位置を簡易に定めることができる。
【００７２】
そして、横偏差算出部５０は、第１基準ラインＳｌ１から第２基準ラインＳｌ２を導く。具体的には、横偏差算出部５０は、第１基準ラインＳｌ１から所与の間隔ｄｊｕ離れて、平行な線を第２基準ラインＳｌ２とする。この第１基準ラインＳｌ１と第２基準ラインＳｌ２の所与の間隔ｄｊｕは、同じ領域であるウィンドウにおいて過去の横偏差の算出で用いられた所与の間隔と同じ値である。
【００７３】
Ｖ２とＬ２を結ぶ第１直線Ｖ２Ｌ２と第２基準ラインＳｌ２との第１交点をＡ２とし、Ｖ２とＷ２を結ぶ第２直線Ｖ２Ｗ２と第２基準ラインＳｌ２との第２交点をＢ２とする。ここで、Ｖ２が消失点であるため、Ａ２とＢ２の仮想２次元空間上の間隔は、Ａ０とＢ０の仮想２次元空間上の間隔と等しく、ｄｘである。車両１が横方向に変位したとしても、仮想２次元空間上の消失点から所与の間隔ｄｊｕに離れた第２基準ラインＳｌ２上の第１交点Ａ２と第２交点Ｂ２の間隔ｄｘは一定である。つまり、実距離に応じて新たに算出された間隔ｄｊｖｌにより消失点Ｖ２の縦方向ｊの位置が定まり、同じ領域であるウィンドウにおいて過去の横偏差の算出で用いられた所与の間隔ｄｊｕと第１交点Ａ２と第２交点Ｂ２の間隔ｄｘにより、消失点Ｖ２の横方向ｉの位置が定まっている。これにより、簡易な方法で、撮像画像から消失点を定めることができる。
【００７４】
実空間上では、車両１が横方向に変位したとしても、直線Ｖ２Ｌ２と直線Ｖ２Ｗ２の位置関係は変化せず、実空間上の第１直線Ｖ２Ｌ２と、実空間上の第２直線Ｖ２Ｗ２とは平行であるため、第１交点Ａ２と第２交点Ｂ２の間隔ｄｘの実空間上の平行距離は、図１３の平行距離と同じくＤＸである。
【００７５】
横偏差算出部５０は、下記の計算式（８）により実空間上の平行距離ＤＸを算出する。
ＤＸ＝ＣＡＨ×（ｄｉｌｗ×ＰＷＨ）／（（ｄｊｖｌ＋ｄｊｌｗ）×ＰＷＶ）・・・（８）
ｄｉｌｗ：目標部画像の位置とウィンドウの位置との横方向ｉの間隔
ＰＷＨ：カメラ１１の１画素当たりの横方向の視野角
ｄｊｌｗ：目標部画像の位置とウィンドウの位置との縦方向ｊの間隔
ＰＷＨはあらかじめ記憶された値であり、間隔ｄｉｌｗおよび間隔ｄｊｌｗは画像の位置座標から算出される。平行距離ＤＸは、目標部画像とウィンドウの相対的な位置関係（間隔ｄｉｌｗおよび間隔ｄｊｌｗ）と、計算式（７）により算出した、目標部画像と消失点の縦方向ｊの位置関係にもとづいて算出される。
【００７６】
次に、横偏差算出部５０は、下記の計算式（９）により実空間上の距離Ｂ２Ｃ２を算出し、距離Ｂ２Ｃ２から平行距離ＤＸを減算することで、横偏差ＤＲを算出する。ここで、Ｌ２の横軸ｉに平行な直線と第２直線Ｖ２Ｗ２の第４交点をＥとする。
ｄｉｅｗ＝ｄｉｌｗ−（ｄｘ×ｄｊｖｌ／ｄｊｕ） ・・・（９）
Ｂ２Ｃ２＝ＣＡＨ×（ｄｉｅｗ×ＰＷＨ）／（ｄｊｌｗ×ＰＷＶ）・・・（１０）
ｄｉｅｗ：第４交点Ｅの位置とウィンドウの位置との横方向ｉの間隔
式（９）において、（ｄｘ×ｄｊｖｌ／ｄｊｕ）は、第４交点Ｅの位置と目標部画像の位置との横方向ｉの間隔である。
【００７７】
以上のように、横偏差算出部５０は、新たに撮像された現撮像画像の目標部画像およびウィンドウに対する消失点を、実距離に応じた間隔ｄｊｖｌ、同じ領域であるウィンドウにおいて過去の横偏差の算出で用いられた基準ラインの所与の間隔ｄｊｕおよび第１交点Ａ２と第２交点Ｂ２の間隔ｄｘを用いて定める。そして、横偏差算出部５０は、間隔ｄｉｌｗおよび間隔ｄｊｌｗという現撮像画像の目標部画像およびウィンドウの相対的な位置関係を用いて横偏差を算出する。目標部画像およびウィンドウの相対的な位置関係により横偏差を算出することで、ピッチングやヨーイングによる影響を抑制することができ、精度良く横偏差を算出することができる。
【００７８】
横偏差算出部５０は、複数のウィンドウにより複数の横偏差を算出し、複数の横偏差を平均化してよい。これにより、１つのウィンドウにより横偏差を算出する場合より、精度良く横偏差を算出することができる。
【００７９】
複数のウィンドウが設定されて、複数のウィンドウにより複数の横偏差が算出されている場合、横偏差算出部５０は、新たに設定されたウィンドウの最初の横偏差の算出において、他のウィンドウで定められた消失点の位置を用いてよい。
【００８０】
図１５は、平面での走行制御の実験結果を示す。本図の縦軸に走行距離［メートル］を示し、横軸に横偏差［メートル］を示す。走行結果Ａは、操舵制御をせずに、車両が走行した実験結果である。走行結果Ｂは、横偏差を用いず、ヨー角を用いて走行制御を実行し、車両が走行した実験結果である。走行結果Ｃは、実施形態に係る走行制御装置２０が、横偏差およびヨー角にもとづいて走行制御を実行し、車両１が走行した実験結果である。
【００８１】
図１５および図１６に示す下端の横偏差が０である位置が車両１の初期位置である。各実験結果の車両は、ともに作業車両である。また、各走行結果の車両の走行速度は０．５ｍ／ｓである。横偏差が０であるラインが目標走行ライン２６である。
【００８２】
走行結果Ａは、作業車両が直進性能が低いことを示す。走行結果Ｂでは横偏差が１０ｃｍ程度であるが、走行結果Ｃでは横偏差が±２ｃｍ以内に収まっている。走行制御装置２０による走行結果Ｃは、ヨー角に加えて横偏差を走行制御に用いることで、ヨー角のみで走行制御を実行した走行結果Ｂより、精度良く目標走行ラインに沿って走行していることがわかる。これは、ヨー角のみで走行制御した場合、横偏差が生じていたとしても、車両が目標ランプ２に真っ直ぐ向いていれば、修正することなく進行するためである。
【００８３】
図１６は、斜面での走行制御の実験結果を示す。本図の縦軸に走行距離［メートル］を示し、横軸に横偏差［メートル］を示す。走行結果Ｄは、横偏差を用いず、ヨー角を用いて走行制御を実行し、車両が走行した実験結果である。走行結果Ｅは、実施形態に係る走行制御装置２０が、横偏差およびヨー角にもとづいて走行制御を実行し、車両１が走行した実験結果である。斜面は草地であり、斜面の角度は５度で、図１６の右方向に下り坂となる状態である。
【００８４】
走行結果Ｄでは、走行中に４０ｃｍ程度の横偏差が生じている。これは、斜面により車両に右方向の横滑りが発生したためである。ヨー角による制御では、横滑りが発生したとしても、車両が目標ランプ２を向いていれば、それ以上の修正が実行されないためである。一方、走行結果Ｅでは、横偏差が±１０ｃｍ以内に収まっている。作業車両は斜面を通る場合も多く、走行中に横滑りが生じても高い精度で直進性を維持することができる。
【００８５】
図１７は、実施形態に係る走行制御のフローチャートを示す。本図に示す走行制御は、所定の制御周期で実行されてよい。まず、ＥＣＵ１２は、走行開始スイッチがＯＮされているかどうか判定する（Ｓ１０）。ＥＣＵ１２は、走行開始スイッチがＯＮされていなければ（Ｓ１０のＮ）、走行制御を終了する。
【００８６】
走行開始スイッチがＯＮされていれば（Ｓ１０のＹ）、目標ランプ検出部４０は、撮像画像から目標部画像を検出する（Ｓ１２）。次に、ヨー角検出部４２は、目標ランプ検出部４０により検出された目標部画像の位置情報にもとづいて、撮像画像から目標ランプ２に対する車両１のヨー角を検出する（Ｓ１４）。
【００８７】
距離算出部４４は、目標部画像の大きさと、実空間上の発光部２１の大きさとにもとづいて目標ランプ２と車両との実空間上の距離を算出する（Ｓ１６）。なお、距離算出部４４は、目標部画像に生じた輝度のにじみを補正して、目標部画像の大きさを算出してよい。
【００８８】
特徴設定部４６は、撮像画像から輝度勾配および輝度勾配の分布により特徴画像を検出し、設定する。特徴追跡処理部４８は、テンプレートと実空間上で同じ領域が新たな撮像画像からなくなるまで、記憶された特徴画像のテンプレートと同じ領域を新たな撮像画像毎に追跡する（Ｓ１８）。
【００８９】
横偏差算出部５０は、撮像部により新たに撮像された現撮像画像から検出された目標部画像と特徴画像に対する、仮想２次元空間上の新たな消失点の位置を定める（Ｓ２０）。横偏差算出部５０は、現撮像画像の消失点と目標部画像と特徴画像との位置関係から横偏差を算出する（Ｓ２２）。
【００９０】
走行制御部３６は、目標走行ライン２６を走行するように、ヨー角および横偏差にもとづいて車両１の走行を制御する（Ｓ２４）。
【００９１】
以上、本発明を実施例をもとに説明した。この実施例は例示であり、それらの各構成要素の組合せにいろいろな変形例が可能なこと、またそうした変形例も本発明の範囲にあることは当業者に理解されるところである。
【００９２】
たとえば、目標ランプ２は、車両の後方に位置し、走行制御部３６は、その目標ランプ２に向かうよう車両の後方への走行を制御してよい。このとき、車両の後方にマーカーが取り付けられ、カメラ１１の撮像方向を後方に変えた場合に、後方のマーカーが撮像されるようにしてもよい。これにより、後方への走行制御において、カメラ１１の撮像方向を後方に向けても、画像処理部で撮像方向の調整をすることができる。また、走行制御部３６は、カメラ１１により撮像された車両後方に位置する目標ランプ２と、車両の初期位置との関係で定めた目標走行ラインを走行するように車両の前方への走行を制御してもよい。
【００９３】
また、車両１の位置が初期位置にある場合、検出されたヨー角によって、車両１の向きが目標ランプ２に真っ直ぐ向いているかどうかを判定してよい。車両１の向きが目標ランプ２に真っ直ぐ向いてなければ、走行制御部３６は、後輪１０の一方に制動力を与え、車両１の向きが目標ランプ２に真っ直ぐ向くように車両１を旋回させてよい。
【００９４】
また、走行制御装置２０は、初期に定めた目標走行ライン２６から所定間隔離れた位置を保って車両１が走行するように制御してよい。たとえば、走行制御装置２０は、横偏差の初期値を所定間隔ずらすことで、目標走行ラインを所定間隔ずらして設定し、この目標走行ラインを走行するように車両走行を制御してもよい。
【００９５】
また、走行制御装置２０は、作業工程の２行程目以降は、１行程目でできた畝などの作業跡を撮像画像から検出し、１行程目を基準に、作業跡に対して一定間隔を保って走行制御をしてよい。これにより、２行程目以降では、目標ランプ２が不要となる。
【符号の説明】
【００９６】
１ 車両、 ２ 目標ランプ、 ３ 車両客室、 ４ 圃場、 ６ ブレーキ機構、 ８ 前輪、 １０ 後輪、 １１ カメラ、 １２ ＥＣＵ、 １４ 操舵駆動機構、 １５ ステアリング機構、 １６ 作業機、 ２０ 走行制御装置、 ２１ 発光部、 ２４ 筐体、 ２６ 目標走行ライン、 ３０ 画像取得部、 ３２ 画像処理部、 ３４ 記憶部、 ３６ 走行制御部、 ４０ 目標ランプ検出部、 ４２ ヨー角検出部、 ４４ 距離算出部、 ４６ 特徴設定部、 ４８ 特徴追跡処理部、 ５０ 横偏差算出部。
【技術分野】
【０００１】
本発明は、目標に向かうように車両の走行を制御する走行制御装置に関する。
【背景技術】
【０００２】
農用車両による播種、移植、畝立て、畦塗りおよび資材散布などの作業では、その作業の精度や能率向上のためや、それ以降の管理や収穫などの作業のために、各行程を直進かつ平行に行うことが重要である。特に、最初の行程は次の行程以降の基準となることから、できるだけ、真っ直ぐな行程であることが望ましい。これらの作業は長時間にわたることが多く、やり直すことができない作業もあるため、作業者への肉体的、精神的な負担が大きく、熟練を必要とする。そのため、農用車両を自動的に直進する技術へのニーズが多い。
【０００３】
車両の自動走行を制御する技術として、以下に示すような技術がある。たとえば、特許文献１には、農用車両の直進制御法が提案されている。この農用車両の直進制御法は、最初に設定された方位を目標方位とし、地磁気方位センサから得られた農用車両の走行方位と、目標方位とにもとづき自動走行する。
【０００４】
また、特許文献２には、車両のヨー方向の角速度にもとづいて車両の回転方向とは逆のヨーモーメントが生じるように、左右の制御ブレーキを制動して車両の姿勢を制御する車両姿勢制御装置が開示されている。
【０００５】
また、特許文献３には、位置調整、旋回調整が可能なレーザ発光機を車両に備え、目標地点に置かれたプリズムによって、反射されたレーザ光をもとに作業車を誘導する装置が開示されている。
【０００６】
また、特許文献４には、点灯する発光体を備えた田植機と、発光体の位置判別装置を備えた本体側車両において、田植機と本体側車両とを遠近方向に相対移動操作する移動制御装置が開示されている。
【０００７】
また、特許文献５には、点滅信号を発信する誘導灯が作業機の前後に複数配置され、誘導灯により作業機の往復作業およびレーン変更を誘導する自動運行装置が開示されている。
【０００８】
また、特許文献６には、目標とする走行経路に沿ってレーザ投光機から投射されるレーザ光線を、作業車の前後に設置した２組の受光センサで検出して、レーザ光線に対する作業車の方位ずれと車幅方向の位置ずれを検出し、方位ずれと位置ずれの情報にもとづいて作業車を走行経路に沿って自動走行するように制御する作業車誘導装置が開示されている。
【先行技術文献】
【特許文献】
【０００９】
【特許文献１】特開２０００−１４２０９号公報
【特許文献２】特開２００５−２６２９０８号公報
【特許文献３】特開平１−１０３０８号公報
【特許文献４】特開平１０−２４３７１０号公報
【特許文献５】特開平３−２４２８号公報
【特許文献６】特開平６−１６８０２４号公報
【発明の概要】
【発明が解決しようとする課題】
【００１０】
ところで、特許文献６に記載されたような作業車誘導装置を用いて、車両を自動的に走行させる場合、複数のレーザ投光機の設置や、作業車に設けられた受光センサの位置調整が煩瑣である。
【００１１】
本発明はこうした状況に鑑みてなされたものであり、その目的は、車両が目標に向かうように走行させる制御を簡易にすることができる走行制御装置を提供することにある。
【課題を解決するための手段】
【００１２】
上記課題を解決するために、本発明のある態様の走行制御装置は、車両走行の目標となる方向に位置する目標部を撮像する撮像部と、撮像部により撮像した撮像画像を処理する画像処理部と、撮像画像に含まれる目標部画像の位置と車両の初期位置との関係で定まる目標走行ラインを走行するように車両の走行を制御する走行制御部と、を備える。画像処理部は、撮像画像から目標部に対する車両のヨー角を検出するヨー角検出部と、撮像画像から目標走行ラインからの横偏差を算出する横偏差算出部と、を備える。走行制御部は、ヨー角および横偏差にもとづいて車両の走行を制御する。
【００１３】
この態様によると、画像処理によってヨー角および横偏差を算出することができ、ヨー角と横偏差とにもとづいて走行制御を行うことで、車両を精度良く目標走行ラインに沿って走行させることができる。
【発明の効果】
【００１４】
本発明によれば、車両が目標に向かうように走行させる制御を簡易にすることができる。
【図面の簡単な説明】
【００１５】
【図１】実施形態に係る走行制御装置の側面図である。
【図２】本発明の実施の形態に係る走行制御装置の上面図である。
【図３】実施形態に係るＥＣＵの機能構成を示す図である。
【図４】実施形態に係る横滑り走行を実行している車両を示す図である。
【図５】実施形態に係る画像処理部の機能構成を示す図である。
【図６】目標部画像の大きさと実距離との関係を示す図である。
【図７】にじみ幅と実距離との関係を示す図である。
【図８】撮像画像上の位置座標とにじみの関係性を示す図である。
【図９】発光部の指向性を示す模式図である。
【図１０】にじみ幅の算出結果を示す図である。
【図１１】にじみ補正をしていない実距離の算出結果を示す図である。
【図１２】実施形態に係る距離算出部がにじみ補正をした実距離の算出結果を示す図である。
【図１３】仮想２次元空間における目標部画像とウィンドウと消失点の初期状態の位置を示す図である。
【図１４】車両が実空間で右に変位した場合の仮想２次元空間における目標部画像とウィンドウと消失点の位置を示す図である。
【図１５】平面での走行制御の実験結果を示す図である。
【図１６】斜面での走行制御の実験結果を示す図である。
【図１７】実施形態に係る走行制御のフローチャートを示す図である。
【発明を実施するための形態】
【００１６】
作業車両は、通常の一般車両と比べて、牽引力および旋回力に優れる一方、直進性能が低い場合がある。また、運転者は、作業車両の後部に備えられる作業機の作業状態を確認するため、後方に振り返りつつ、直進運転をすることを強いられる。農場によっては５００ｍ以上の長さがあり、この距離を直進させるのは運転者の負担が大きい。そこで、実施形態の走行制御装置は、目標地点に設置された目標ランプをカメラで撮像し、目標ランプに向かって車両を自動的に走行させることで、運転者の負担を軽減させる。
【００１７】
一般道路には車線が描かれているが、農場には基準とする走行ラインが描かれていない。実施形態の走行制御装置は、目標ランプと車両の初期位置を結ぶ直線を走行ラインとして定める。そして、走行制御装置は、目標ランプに対するヨー角と、目標とする走行ラインに対する横偏差とにもとづいて目標ラインを走行するように車両の走行を制御する。これにより、走行制御における直進性能が高まる。
【００１８】
以下、図面を参照しながら実施形態について説明する。なお、明細書中の「左」または「右」の記載は、車両後部から車両進行方向を向いた場合の方向を意味する。図面の説明において同一の要素には同一の符号を付し、重複する説明を適宜省略する。
【００１９】
図１は、実施形態に係る走行制御装置２０の側面図である。図２は、実施形態に係る走行制御装置２０の上面図である。車両１は、車両客室３、左前輪８ａと右前輪８ｂ（以下、総称する場合は「前輪８」という）、および、左後輪１０ａと右後輪１０ｂ（以下、総称する場合は「後輪１０」という）を有し、走行制御装置２０は、車両１に搭載され、左ブレーキ機構６ａと右ブレーキ機構（不図示）（以下、総称する場合は「ブレーキ機構６」という）、カメラ１１、ＥＣＵ（Electronic control unit）１２、操舵駆動機構１４およびステアリング機構１５を備える。
【００２０】
車両１は、農用トラクタや土木用作業車両などの作業車両であってよく、車両１の後方には作業機１６が取り付けられる。作業機１６は、たとえば、圃場４において播種や畝立てなどの作業をする。
【００２１】
ステアリング機構１５は、ステアリングホイール（不図示）、ステアリングシャフト（不図示）、およびステアリングシャフトの動きを前輪の動きに変換するギヤ装置（不図示）と、を有する。ステアリング機構１５は、ハンドルとしてのステアリングホイールの回動を前輪８の転舵運動に変換する。ステアリングホイールは、車両客室３内に設けられ、運転者によって回動操作される。ステアリングシャフトは、ステアリングホイールとともに回転するように一端がステアリングホイールに連結されており、ステアリングホイールの回転をギヤ装置に伝達する回転軸として機能する。
【００２２】
操舵駆動機構１４は、舵角センサ（不図示）およびモータ（不図示）を備える。操舵駆動機構１４は、モータを駆動し、ステアリング機構１５に転舵力を与える。舵角センサは、ステアリングシャフトに設けられ、ステアリングホイールの操舵角および操舵方向を検出する。操舵駆動機構１４はＥＣＵ１２に接続されている。舵角センサの検出値は、ＥＣＵ１２に出力される。なお、操舵駆動機構１４は、液圧式であってよく、液圧ポンプを駆動して、ステアリング機構１５に転舵力を与えてよい。
【００２３】
ブレーキ機構６は、運転者のブレーキペダル（不図示）の操作量に応じて後輪１０に制動力を与える。ブレーキペダルは、左後輪用ブレーキペダルと右後輪用ブレーキペダルを有する。運転者が各ブレーキペダルを操作することで、左後輪１０ａと右後輪１０ｂに対して個別に制動力を与えることができる。たとえば、車両１を右方向に旋回するとき、運転者が、右後輪用ブレーキペダルを踏み込んで右後輪１０ｂに制動力を与えることで、右後輪１０ｂを軸として車両１を小回りさせることができる。ブレーキ機構６は、ＥＣＵ１２に接続され、ＥＣＵ１２により後輪１０に与える制動力を制御される。なお、車両１の前輪８に、ブレーキ機構は無くてよい。
【００２４】
目標ランプ２は、発光部２１および筐体２４を備える。発光部２１は、発光ダイオード（ＬＥＤ）であってよく、所定の大きさを有し、目標部として機能する。発光部２１は、所定の制御周期で点滅してよい。なお、目標部は、ＥＣＵ１２が既知の大きさで、カメラ１１によって認識可能な部材であってよい。
【００２５】
車両客室３の上部には、カメラ１１が配置される。カメラ１１は、撮像部として機能し、目標ランプ２を撮像する。カメラ１１は、点灯している発光部２１と、消灯している発光部２１を交互に撮像してよい。カメラ１１は、撮像した画像をＥＣＵ１２に出力する。
【００２６】
図２に示す目標走行ライン２６は、撮像画像に含まれる目標ランプ２の位置と車両１の初期位置との関係で定まる。図２では目標ランプ２が車両走行の目標とする方向の位置に配置されている。車両１の初期位置とは、運転者がＥＣＵ１２に接続された自動走行開始スイッチ（不図示）をオンしたときの車両１の位置をいい、走行制御装置２０による走行制御を開始する位置をいう。
【００２７】
運転者が自動走行開始スイッチをオンすると、ＥＣＵ１２は、カメラ１１から出力された目標ランプ２が撮像された画像から目標ランプ２の位置を算出し、車両１の初期位置と目標ランプ２の位置とを結ぶラインを目標走行ライン２６として定める。なお、運転者による自動走行開始スイッチのオン／オフにより、走行制御装置２０による走行制御が実行／停止される。
【００２８】
ＥＣＵ１２は、撮像された撮像画像を処理する画像処理手段として機能し、車両１の走行を制御する走行制御手段として機能する。ＥＣＵ１２は、各種演算処理を実行するＣＰＵ、各種制御プログラムを格納するＲＯＭ、データ格納やプログラム実行のためのワークエリアとして利用されるＲＡＭ、エンジン停止時にも記憶内容を保持できるバックアップＲＡＭ等の不揮発性メモリ、入出力インターフェース、各種センサ等から入力されたアナログ信号をデジタル信号に変換して取り込むためのＡ／Ｄコンバータ、計時用のタイマ等を備えるものである。なお、画像処理手段と走行制御手段は、それぞれ画像処理装置と走行制御装置とする、別のユニットであってよい。
【００２９】
図３は、実施形態に係るＥＣＵ１２の機能構成を示す。ＥＣＵ１２は、画像取得部３０、画像処理部３２、記憶部３４および走行制御部３６を備える。画像取得部３０は、カメラ１１が目標ランプ２を所定の撮像周期で撮像した撮像画像を取得する。
【００３０】
画像処理部３２は、画像取得部３０から受け取った撮像画像を処理する。画像処理部３２は、撮像画像からヨー角および横偏差を検出し、走行制御部３６に供給する。記憶部３４には、横偏差および撮像画像の情報が記憶される。
【００３１】
走行制御部３６は、操舵駆動機構１４を介して操舵を制御する操舵制御部と、ブレーキ機構６を介して制動力を制御するブレーキ制御部とを備える。ブレーキ制御部は、左右の後輪１０に設けられたブレーキ機構６の制動力を独立に制御する。操舵制御部は、操舵駆動機構１４を駆動し、前輪８の操舵を制御する。
【００３２】
走行制御部３６は、画像処理部３２から受け取ったヨー角と横偏差に応じて目標走行ライン２６を走行するように車両１の走行を制御する。たとえば、走行制御部３６は、ヨー角がゼロであり車両１の進行方向が目標ランプ２に真っ直ぐ向いている場合であっても、横偏差にもとづいて横偏差を小さくするように前輪８を操舵する。これにより、走行制御部３６は、車両１が目標走行ライン２６に近づくように走行を制御することができる。
【００３３】
なお、車両１の左右への横偏差がそれぞれプラスとマイナスで算出される場合に、横偏差がゼロである位置が目標走行ライン２６上の位置となる。
【００３４】
走行制御部３６は、ブレーキ制御部により左右の後輪１０のうち目標走行ライン２６に近い後輪１０に制動力を与え、操舵制御部により目標走行ライン２６に向かう方向と逆向きに前輪を操舵させて、横滑り走行を制御する。ここで、横滑り走行について具体的に図４を参照して説明する。
【００３５】
図４は、実施形態に係る横滑り走行を実行している車両１を示す。図４に示す車両１の位置は、目標走行ライン２６から右にずれている。このとき、ブレーキ制御部は進行中の車両１の左後輪１０ａに制動力を与え、操舵制御部は前輪８を進行方向とは逆向きに操舵する。これにより、車両１に横滑りが発生し、車両１が横滑りしながら進行する。横滑り走行において、車両１がヨー角の変化を最小限にとどめつつ走行するため、作業機１６のぶれを小さくすることができる。
【００３６】
図５は、実施形態に係る画像処理部３２の機能構成を示す。画像処理部３２は、目標ランプ検出部４０、ヨー角検出部４２、距離算出部４４、特徴設定部４６、特徴追跡処理部４８、および横偏差算出部５０を備える。
【００３７】
目標ランプ検出部４０は、画像取得部３０から受け取った撮像画像から画像上の発光部２１（以下、「目標部画像」という）を検出する。具体的には、目標ランプ検出部４０は、所定の輝度閾値以上の輝度を示す画素の集合を目標部画像として検出する。また、目標ランプ検出部４０は、点滅する発光部２１を撮像した撮像画像を受け取り、点灯した発光部２１の撮像画像と消灯した発光部２１の撮像画像の輝度を比較し、所定の輝度差以上の画素の集合を目標部画像として検出してよい。さらに、目標ランプ検出部４０は、所定の輝度差以上の画素の集合が所定の面積および所定のアスペクト比を満たせば、目標部画像であると判定してよい。また、目標ランプ検出部４０は、点滅する発光部２１の撮像画像を受け取り、検出した目標部画像が、発光部２１の点滅の周期に応じた輝度の時間的変化を満たすかどうか判定し、目標部画像の検出が妥当であるかどうか判定してよい。
【００３８】
目標ランプ検出部４０は、撮像画像と、検出した目標部画像の位置情報および大きさを記憶部３４に記憶させる。目標ランプ検出部４０は、目標部画像の大きさを距離算出部４４に供給し、目標部画像の位置情報をヨー角検出部４２および横偏差算出部５０に供給する。なお、位置情報は、撮像画像の画素を単位とする仮想２次元空間の座標であってよく、撮像画像上の所定の位置を基準とした座標であってよい。
【００３９】
ヨー角検出部４２は、目標ランプ検出部４０から目標部画像の位置情報を受け取り、車両１の向きと目標部画像の位置から目標ランプ２に対する車両１のヨー角を算出する。ヨー角は、車両１の向きと、目標ランプ２と車両１の位置とを結ぶラインと、にもとづく鋭角である。たとえば、車両１が目標ランプ２に対して真っ直ぐ向いていれば、ヨー角をゼロとしてよい。
【００４０】
車両１の向きは、あらかじめ設定されたカメラ１１の撮像方向であってよく、たとえば撮像画像の中心位置を通る縦方向のベクトルであってよい。なお、カメラ１１は、車両１のエンジンフードに設置される所定のマーカーを撮像し、ヨー角検出部４２は、撮像画像の所定の位置がマーカーからずれていれば、マーカーを基準に撮像方向の位置ずれを補正してよい。これにより、カメラ１１の撮像方向がずれた場合でも、あらかじめ設定されたカメラ１１の撮像方向と同じように、車両１の向きを検出することができる。
【００４１】
距離算出部４４は、目標部画像の大きさＬｉと、実空間上の発光部２１の大きさＬｇとにもとづいて目標ランプ２と車両１との実空間上の実距離Ｚｇを算出する。以下に実距離Ｚｇを算出する計算式（１）を示す。
Ｚｇ＝Ｌｇ／（Ｌｉ×ＰＷＶ） ・・・ （１）
ＰＷＶ：カメラ１１の１画素当たりの縦方向の視野角
なお、ＬｇおよびＰＷＶは、あらかじめ記憶された既知の値である。
【００４２】
距離算出部４４は、目標部画像に生じた輝度のにじみを補正して、目標部画像の大きさを算出してよい。これは、露光時間や量子化誤差などにより撮像された発光部２１が画像上でにじみ、目標部画像の大きさが実際より大きく算出されることを抑え、より正確な目標部画像の大きさを算出するためである。
【００４３】
図６は、目標部画像の大きさＬｉと実距離Ｚｇとの関係を示す。図６の縦軸は、目標部画像の大きさＬｉ［画素］（Image length[pix]）を示し、横軸は、実距離Ｚｇ［メートル］（Measured distance[m]）を示す。なお、図６に示す６種類の点は、カメラ１１の露光時間を示し、図７、１０〜１２も同様である。カメラ１１のレンズの絞りは固定している。図６に示す曲線は、計算上の正確な目標部画像の大きさＬｉｃである。そして、目標部画像の大きさＬｉから正確な目標部画像の大きさＬｉｃを減算したにじみ幅Ｎｊを図７に示す。
【００４４】
図７は、にじみ幅Ｎｊと実距離Ｚｇとの関係を示す。図７の縦軸は、にじみ幅Ｎｊ［画素］（Spreading width[pix]）を示し、横軸は、実距離Ｚｇ［メートル］（Measured distance[m]）を示す。図７では、カメラ１１の露光時間の増加に応じて、にじみ幅Ｎｊが大きくなっている。また、実距離Ｚｇが３０ｍに増加するまで、にじみ幅Ｎｊが増加し、実距離Ｚｇが３０ｍより増加すると、にじみ幅Ｎｊが減少している。
【００４５】
図８は、撮像画像上の位置座標と輝度との関係を示す。図８の縦軸は、輝度を示し、横軸は、撮像画像上の位置座標を示す。まず、輝度Ｂｇｒは、発光部２１の背景画像の輝度である。この輝度Ｂｇｒに発光部２１の輝度Ａｐｒが加算されている。すなわち、図８のハッチング箇所が正確な目標部画像であり、大きさはＬｉｃである。にじみとなる箇所は、正確な目標部画像の周囲に発生し、にじみの輝度は、正確な目標部画像から離れるに従って、小さくなっている。たとえば、目標ランプ検出部４０によって輝度が輝度閾値Ｔｒｌ以上であれば目標部画像として検出される場合、撮像画像から輝度閾値Ｔｒｌ以上の画素の領域の大きさＬｉが目標部画像の大きさとして算出される。
【００４６】
にじみ幅Ｎｊは、発光部２１の輝度Ａｐｒと輝度閾値Ｔｒｌとの輝度差Ｄｐｒによって算出される。その計算式を以下に示す。
Ｎｊ＝ｋ１×（Ａｐｒ−Ｔｒｌ）＋ｋ２ ・・・ （２）
Ａｐｒ＝ｋ３×（Ａｐｅ＋Ｂｐｅ）０．５ ・・・ （３）
Ｂｐｅ＝（Ｂｇｒ／ｋ３）２ ・・・ （４）
Ａｐｅ＝ｋ４×Ｐｌ×Ｔｃ／Ｚｇｉ ・・・ （５）
ｋ１，ｋ２，ｋ３，ｋ４：定数
Ａｐｅ：発光部２１から入射する光量
Ｂｐｅ：背景から入射する光量
Ｐｌ：発光部２１から投射される光の強さ
Ｔｃ：カメラ１１の露光時間
Ｚｇｉ：仮の実距離
なお、ｋ１〜ｋ４の定数は、カメラ１１や発光部２１などの性能に依存する。輝度閾値Ｔｒｌは、目標ランプ検出部４０から取得される。
【００４７】
にじみ幅Ｎｊを算出する式（２）で用いる輝度Ａｐｒは、式（３）〜（５）によって算出される。式（３）により、発光部２１からカメラ１１に入射する光量Ａｐｅと、発光部２１の背景から入射する光量Ｂｐｅとにもとづいて、輝度Ａｐｒが算出される。式（３）では、光量の０．５乗が、輝度と比例する関係性をもつように設定した。これにより、測定したデータから輝度Ａｐｒを精度良く算出することができる。
【００４８】
式（４）は、発光部２１の背景から入射する光量Ｂｐｅを算出する式であり、式（３）における光量Ａｐｅがゼロのときの逆算式である。式（４）では式（３）の関係を用いて、背景画像の輝度Ｂｇｒから、発光部２１の背景から入射する光量Ｂｐｅを算出する。背景画像の輝度Ｂｇｒは、発光部２１が消灯した時の撮像画像における目標部画像とその周りの領域の輝度の平均値であってよい。
【００４９】
式（５）は、発光部２１からカメラ１１に入射する光量Ａｐｅを算出する式である。まず、光量Ａｐｅは、発光部２１からカメラ１１の方向に投射される光の強さＰｌに比例する。ここで、図９を参照して、発光部２１から投射される光の強さＰｌの算出方法を説明する。
【００５０】
図９は、発光部２１の指向性を示す模式図である。図９の斜線領域は、ＬＥＤの指向特性（Directivity of the LED）を示す。発光部２１は、図９の斜線領域に示すように、前方に集中した光の強さを投射する指向性を有する。発光部２１に対するカメラ１１の位置によって角度Ａｇが変化し、光の強さＰｌが変化する。図７において、実距離Ｚｇが３０ｍより小さくなると、にじみ幅Ｎｊが減少したという結果は、実距離Ｚｇに応じた角度Ａｇの変化により光の強さＰｌが減少したためである。光の強さＰｌは、カメラ１１の発光部２１に対する高さｄＨと実距離Ｚｇまたは仮の実距離Ｚｇｉに応じた角度Ａｇにもとづいて算出される。
【００５１】
次に、式（５）の光量Ａｐｅは仮の実距離Ｚｇｉに反比例する。仮の実距離Ｚｇｉは、繰り返し算出される実距離Ｚｇを外挿法により算出してよい。また、仮の実距離Ｚｇｉの初期の値は、式（１）により算出された値であってよい。ここで、カメラ１１に入射する光量Ａｐｅと実距離Ｚｇとの関係を説明する。一般理論では、発光部２１が点光源であれば、光量Ａｐｅは、実距離Ｚｇの２乗に反比例し、発光部２１が無限の面積を持つ光源であれば、光量Ａｐｅは、実距離Ｚｇによらず一定となる。実施形態の発光部２１は、たとえば横０．１ｍ×縦０．３ｍの有限の面積に点光源を等間隔で配置した構造であるため、一般理論の中間をとって、距離が光量に反比例すると定めた。これにより、発光部２１から入射する光量を精度良く算出することができる。
【００５２】
次に、式（５）の光量Ａｐｅは、カメラ１１の露光時間Ｔｃに比例する。露光時間Ｔｃは、カメラ１１から受け取ってもよく、あらかじめ記憶されていてよい。
【００５３】
以上の式（２）〜（５）により、距離算出部４４は、にじみ幅Ｎｊを算出する。距離算出部４４は、以下の式（６）を用いて、目標ランプ検出部４０により検出された目標部画像の大きさＬｉに、にじみ補正をして実距離Ｚｇを算出する。
Ｚｇ＝Ｌｇ／（（Ｌｉ−Ｎｊ）×ＰＷＶ） ・・・ （６）
【００５４】
図１０は、にじみ幅Ｎｊの算出結果を示す。図１０の縦軸は、にじみ幅Ｎｊの算出結果［画素］（Calculated spreading width[pix]）を示し、横軸は、測定したにじみ幅［画素］（Measured spreading width[pix]）を示す。カメラ１１のレンズの絞りは固定している。
【００５５】
図１１は、距離算出部４４がにじみ補正をしていない実距離Ｚｇの算出結果を示す。また、図１２は、実施形態に係る距離算出部４４がにじみ補正をした実距離Ｚｇの算出結果を示す。図１１および図１２の縦軸は実距離Ｚｇの算出結果［メートル］（Calculated distance[m]）を示し、横軸は測定した実距離［メートル］（Measured distance[m]）を示す。カメラ１１のレンズの絞りは固定している。
【００５６】
図１１は、式（１）を用いた実距離Ｚｇの算出結果であり、図１２は、式（６）を用いた実距離Ｚｇの算出結果である。図１１のにじみ補正をしていない算出結果は、距離が長くなるにつれて、算出した距離と正確な距離との誤差が大きくなっている。一方、図１２の目標部画像の大きさに、にじみ補正をした算出結果は、図１１に示す結果と比較して、距離が長くなっても、算出した実距離と正確な実距離との誤差が小さく収まっている。すなわち、距離算出部４４は、にじみ補正をすることで、カメラ１１の画像から目標ランプ２と車両１の距離を精度良く算出することができる。
【００５７】
図５に戻る。特徴設定部４６および特徴追跡処理部４８は、特徴画像を検出する特徴検出手段として機能する。特徴設定部４６は、撮像画像から特徴的な部分画像を検出し、それを特徴画像として設定する。特徴画像とは、所定の傾き以上の輝度勾配がある領域、または、所定の傾き以上の輝度勾配が分布している領域であってよく、大きさが定められたウィンドウ内の撮像画像であってよい。
【００５８】
また、特徴設定部４６は、特徴追跡処理部４８が設定された特徴画像を追跡できなくなった場合に、新たに特徴画像を設定する。特徴画像として検出した領域は、車両１が進行すれば、大きくなり、変形する。とくに特徴画像が地面であれば、車両１が進行するとともに特徴画像の縦方向の大きさが大きく変形する。そこで、特徴画像の形状は縦方向に短い長方形に定められてよい。特徴設定部４６は、設定した特徴画像をテンプレートとして、画素値情報および位置情報を記憶部３４に記憶させる。なお、特徴画像のテンプレートは複数設定されてよい。
【００５９】
特徴追跡処理部４８は、新たな撮像画像が撮像される度に、設定された特徴画像のテンプレートと同じような輝度勾配等をもつ領域があるかどうか追跡する。特徴追跡処理部４８は、テンプレートの位置座標の周囲の位置座標の領域を探索する。特徴追跡処理部４８は、テンプレートと新たな撮像画像上のウィンドウで取り出した領域との画素値が所定レベル以上に一致していれば、新たな撮像画像上のウィンドウがテンプレートと実空間上の同じ領域であると判定する。たとえば、特徴追跡処理部４８は、正規化相関法などの手法を用いて、新たな撮像画像上のウィンドウがテンプレートと実空間上の同じ領域であるかどうか判定する。
【００６０】
特徴追跡処理部４８は、テンプレートと実空間上の同じ領域であると判定すれば、その新たな撮像画像上のウィンドウの位置情報を横偏差算出部５０に供給する。特徴追跡処理部４８は、テンプレートと実空間上で同じ領域である新たな撮像画像上の領域がなければ、特徴設定部４６に新たな特徴画像を設定するよう指令信号を供給する。
【００６１】
特徴画像のテンプレートは、同じ領域であると判定されるたびに、撮像画像毎のテンプレートの変位量に応じて補間されて記憶部３４に記憶される。これは、車両１が進行するにつれて、新たな撮像画像上のテンプレートと同じ領域が拡大していくからである。ここで、振動が多い作業車両に搭載されたカメラ１１の撮像画像であれば、演算周期ごとにテンプレートの画像を新たな撮像画像から抽出して更新する処理を行うと、テンプレートの画像の抽出時の誤差が蓄積されるおそれがある。そこで、特徴追跡処理部４８は、特徴設定部４６により設定されたときのテンプレートの初期の位置座標に対する、テンプレートと同じ領域であると判定された新たな撮像画像上のウィンドウの位置座標にもとづいてテンプレートを補間して、記憶部３４に記憶させてよい。
【００６２】
横偏差算出部５０は、撮像画像から目標走行ライン２６からの横偏差を算出する。横偏差は、初期値ゼロから横偏差算出部５０により横偏差が算出される毎に、加算されて蓄積されてよい。横偏差算出部５０は、カメラ１１により新たに撮像された現撮像画像から検出された目標部画像および特徴画像に対する、仮想２次元空間上の新たな消失点の位置を定め、新たな消失点と目標部画像と特徴画像との位置関係から横偏差を算出する。
【００６３】
横偏差算出部５０は、実空間上の距離に応じて、仮想２次元空間における新たな消失点の縦方向の位置を定める。また、横偏差算出部５０は、過去に検出された目標部画像および特徴画像に対して定められた過去の消失点の縦方向の位置を定める第１基準ラインから所与の間隔離れた第２基準ラインと、過去の消失点および目標部画像を結ぶ第１直線の第１交点と、第２基準ラインと、過去の消失点および特徴画像を結ぶ第２直線の第２交点との間隔にもとづいて、仮想２次元空間における目標部画像に対する新たな消失点の横方向の位置を定める。
【００６４】
ここで、図１３を参照する。図１３は、仮想２次元空間における目標部画像とウィンドウと消失点の初期状態の位置を示す。この仮想２次元空間では、縦方向をｊとして、横方向をｉとしている。仮想２次元空間での長さの単位は、撮像画像の画素であってよい。初期状態とは、車両１が初期位置にあるときをいう。
【００６５】
図１３に示す特徴画像のウィンドウＷ０の位置は、その下端の中央とし、目標部画像の位置Ｌ０は、目標部画像の下端の中央とする。横偏差算出部５０は、下記の計算式（７）により実距離Ｚｇに応じた間隔ｄｊｖｌを算出し、目標部画像の位置Ｌ０から縦方向ｊの上方の間隔ｄｊｖｌの位置に消失点があると推定する。
ｄｊｖｌ＝ＣＡＨ／（Ｚｇ×ＰＷＶ） ・・・ （７）
ＣＡＨ：地面からカメラ１１までの高さ
なお、カメラ１１の高さＣＡＨと、視野角ＰＷＶはあらかじめ記憶された値である。
【００６６】
図１３に示すように、目標部画像が初期状態であれば、消失点Ｖ０は、目標部画像の真上に位置する。仮想２次元空間に第１基準ラインＳｌ１と第２基準ラインＳｌ２を定める。第１基準ラインＳｌ１および第２基準ラインＳｌ２は平行であり、両基準ラインの仮想２次元空間の所与の間隔をｄｊｕとする。
【００６７】
車両１が目標ランプ２に向かって横移動せず真っ直ぐ進行すれば、目標部画像およびウィンドウはカメラ１１に近づくため、目標部画像の位置Ｌ０およびウィンドウの位置Ｗ０は、位置Ｌ１および位置Ｗ１に変化する。Ｌ０およびＷ０を進行前の過去の位置とし、Ｌ１およびＷ１を進行後の現在の位置とする。位置Ｗ０と位置Ｗ１のウィンドウは、同じ領域であると判定されたウィンドウである。
【００６８】
車両１が目標ランプ２に向かって直進したため、Ｌ１は、Ｌ０からＶ０とＬ０を結ぶ第１直線Ｖ０Ｌ０上の下方に変位している。ウィンドウの位置Ｗ１は、Ｖ０とＷ０を結ぶ第２直線Ｖ０Ｗ０上を変位する。第１直線Ｖ０Ｌ０と第２基準ラインＳｌ２との第１交点をＡ０とし、第２直線Ｖ０Ｗ０と第２基準ラインＳｌ２との第２交点をＢ０とする。Ａ０とＢ０の仮想２次元空間上の間隔をｄｘとする。
【００６９】
進行前と進行後において、車両１が直進していれば、消失点Ｖ０は変位しない。このとき、進行前後において両基準ラインの所与の間隔ｄｊｕが同一であれば、第１交点Ａ０と第２交点Ｂ０の間隔ｄｘは一定である。なお、実空間上では、第１直線Ｖ０Ｌ０と第２直線Ｖ０Ｗ０とは平行である。第１直線Ｖ０Ｌ０と第２直線Ｖ０Ｗ０との実空間上の平行距離をＤＸとする。
【００７０】
図１４は、車両１が実空間で右に変位した場合の仮想２次元空間における目標部画像とウィンドウと消失点の位置を示す。この仮想２次元空間では、縦方向をｊとして、横方向をｉとしている。目標部画像の位置をＬ２とし、ウィンドウの位置をＷ２とし、消失点の位置をＶ２とする。図１４に示すＬ２とＷ２は、図１３に示すＬ１とＷ１と時間は同じで、図１３の状態から、車両１が実空間上で右方向に平行に変位した状態である。したがって、Ｌ２およびＷ２は、図１３のＬ１およびＷ１のそれぞれの位置から左方向に平行に変位している。
【００７１】
第１基準ラインＳｌ１に対して垂直で消失点Ｖ２を通る第３直線と、第２基準ラインＳｌ２との第３交点をＣ２とする。第１交点Ａ２と第３交点Ｃ２の実空間上の距離が横偏差として算出される。なお、ここで算出された横偏差が、いままで蓄積されてきた横偏差に加算されて、新たな横偏差として算出されてよい。横偏差算出部５０は、実距離Ｚｇにもとずいて、目標部画像に対する消失点の縦方向ｊの間隔ｄｊｖｌを算出し、第１基準ラインＳｌ１上に消失点Ｖ２があることを定める。これにより、目標部画像に対する消失点の縦方向の位置を簡易に定めることができる。
【００７２】
そして、横偏差算出部５０は、第１基準ラインＳｌ１から第２基準ラインＳｌ２を導く。具体的には、横偏差算出部５０は、第１基準ラインＳｌ１から所与の間隔ｄｊｕ離れて、平行な線を第２基準ラインＳｌ２とする。この第１基準ラインＳｌ１と第２基準ラインＳｌ２の所与の間隔ｄｊｕは、同じ領域であるウィンドウにおいて過去の横偏差の算出で用いられた所与の間隔と同じ値である。
【００７３】
Ｖ２とＬ２を結ぶ第１直線Ｖ２Ｌ２と第２基準ラインＳｌ２との第１交点をＡ２とし、Ｖ２とＷ２を結ぶ第２直線Ｖ２Ｗ２と第２基準ラインＳｌ２との第２交点をＢ２とする。ここで、Ｖ２が消失点であるため、Ａ２とＢ２の仮想２次元空間上の間隔は、Ａ０とＢ０の仮想２次元空間上の間隔と等しく、ｄｘである。車両１が横方向に変位したとしても、仮想２次元空間上の消失点から所与の間隔ｄｊｕに離れた第２基準ラインＳｌ２上の第１交点Ａ２と第２交点Ｂ２の間隔ｄｘは一定である。つまり、実距離に応じて新たに算出された間隔ｄｊｖｌにより消失点Ｖ２の縦方向ｊの位置が定まり、同じ領域であるウィンドウにおいて過去の横偏差の算出で用いられた所与の間隔ｄｊｕと第１交点Ａ２と第２交点Ｂ２の間隔ｄｘにより、消失点Ｖ２の横方向ｉの位置が定まっている。これにより、簡易な方法で、撮像画像から消失点を定めることができる。
【００７４】
実空間上では、車両１が横方向に変位したとしても、直線Ｖ２Ｌ２と直線Ｖ２Ｗ２の位置関係は変化せず、実空間上の第１直線Ｖ２Ｌ２と、実空間上の第２直線Ｖ２Ｗ２とは平行であるため、第１交点Ａ２と第２交点Ｂ２の間隔ｄｘの実空間上の平行距離は、図１３の平行距離と同じくＤＸである。
【００７５】
横偏差算出部５０は、下記の計算式（８）により実空間上の平行距離ＤＸを算出する。
ＤＸ＝ＣＡＨ×（ｄｉｌｗ×ＰＷＨ）／（（ｄｊｖｌ＋ｄｊｌｗ）×ＰＷＶ）・・・（８）
ｄｉｌｗ：目標部画像の位置とウィンドウの位置との横方向ｉの間隔
ＰＷＨ：カメラ１１の１画素当たりの横方向の視野角
ｄｊｌｗ：目標部画像の位置とウィンドウの位置との縦方向ｊの間隔
ＰＷＨはあらかじめ記憶された値であり、間隔ｄｉｌｗおよび間隔ｄｊｌｗは画像の位置座標から算出される。平行距離ＤＸは、目標部画像とウィンドウの相対的な位置関係（間隔ｄｉｌｗおよび間隔ｄｊｌｗ）と、計算式（７）により算出した、目標部画像と消失点の縦方向ｊの位置関係にもとづいて算出される。
【００７６】
次に、横偏差算出部５０は、下記の計算式（９）により実空間上の距離Ｂ２Ｃ２を算出し、距離Ｂ２Ｃ２から平行距離ＤＸを減算することで、横偏差ＤＲを算出する。ここで、Ｌ２の横軸ｉに平行な直線と第２直線Ｖ２Ｗ２の第４交点をＥとする。
ｄｉｅｗ＝ｄｉｌｗ−（ｄｘ×ｄｊｖｌ／ｄｊｕ） ・・・（９）
Ｂ２Ｃ２＝ＣＡＨ×（ｄｉｅｗ×ＰＷＨ）／（ｄｊｌｗ×ＰＷＶ）・・・（１０）
ｄｉｅｗ：第４交点Ｅの位置とウィンドウの位置との横方向ｉの間隔
式（９）において、（ｄｘ×ｄｊｖｌ／ｄｊｕ）は、第４交点Ｅの位置と目標部画像の位置との横方向ｉの間隔である。
【００７７】
以上のように、横偏差算出部５０は、新たに撮像された現撮像画像の目標部画像およびウィンドウに対する消失点を、実距離に応じた間隔ｄｊｖｌ、同じ領域であるウィンドウにおいて過去の横偏差の算出で用いられた基準ラインの所与の間隔ｄｊｕおよび第１交点Ａ２と第２交点Ｂ２の間隔ｄｘを用いて定める。そして、横偏差算出部５０は、間隔ｄｉｌｗおよび間隔ｄｊｌｗという現撮像画像の目標部画像およびウィンドウの相対的な位置関係を用いて横偏差を算出する。目標部画像およびウィンドウの相対的な位置関係により横偏差を算出することで、ピッチングやヨーイングによる影響を抑制することができ、精度良く横偏差を算出することができる。
【００７８】
横偏差算出部５０は、複数のウィンドウにより複数の横偏差を算出し、複数の横偏差を平均化してよい。これにより、１つのウィンドウにより横偏差を算出する場合より、精度良く横偏差を算出することができる。
【００７９】
複数のウィンドウが設定されて、複数のウィンドウにより複数の横偏差が算出されている場合、横偏差算出部５０は、新たに設定されたウィンドウの最初の横偏差の算出において、他のウィンドウで定められた消失点の位置を用いてよい。
【００８０】
図１５は、平面での走行制御の実験結果を示す。本図の縦軸に走行距離［メートル］を示し、横軸に横偏差［メートル］を示す。走行結果Ａは、操舵制御をせずに、車両が走行した実験結果である。走行結果Ｂは、横偏差を用いず、ヨー角を用いて走行制御を実行し、車両が走行した実験結果である。走行結果Ｃは、実施形態に係る走行制御装置２０が、横偏差およびヨー角にもとづいて走行制御を実行し、車両１が走行した実験結果である。
【００８１】
図１５および図１６に示す下端の横偏差が０である位置が車両１の初期位置である。各実験結果の車両は、ともに作業車両である。また、各走行結果の車両の走行速度は０．５ｍ／ｓである。横偏差が０であるラインが目標走行ライン２６である。
【００８２】
走行結果Ａは、作業車両が直進性能が低いことを示す。走行結果Ｂでは横偏差が１０ｃｍ程度であるが、走行結果Ｃでは横偏差が±２ｃｍ以内に収まっている。走行制御装置２０による走行結果Ｃは、ヨー角に加えて横偏差を走行制御に用いることで、ヨー角のみで走行制御を実行した走行結果Ｂより、精度良く目標走行ラインに沿って走行していることがわかる。これは、ヨー角のみで走行制御した場合、横偏差が生じていたとしても、車両が目標ランプ２に真っ直ぐ向いていれば、修正することなく進行するためである。
【００８３】
図１６は、斜面での走行制御の実験結果を示す。本図の縦軸に走行距離［メートル］を示し、横軸に横偏差［メートル］を示す。走行結果Ｄは、横偏差を用いず、ヨー角を用いて走行制御を実行し、車両が走行した実験結果である。走行結果Ｅは、実施形態に係る走行制御装置２０が、横偏差およびヨー角にもとづいて走行制御を実行し、車両１が走行した実験結果である。斜面は草地であり、斜面の角度は５度で、図１６の右方向に下り坂となる状態である。
【００８４】
走行結果Ｄでは、走行中に４０ｃｍ程度の横偏差が生じている。これは、斜面により車両に右方向の横滑りが発生したためである。ヨー角による制御では、横滑りが発生したとしても、車両が目標ランプ２を向いていれば、それ以上の修正が実行されないためである。一方、走行結果Ｅでは、横偏差が±１０ｃｍ以内に収まっている。作業車両は斜面を通る場合も多く、走行中に横滑りが生じても高い精度で直進性を維持することができる。
【００８５】
図１７は、実施形態に係る走行制御のフローチャートを示す。本図に示す走行制御は、所定の制御周期で実行されてよい。まず、ＥＣＵ１２は、走行開始スイッチがＯＮされているかどうか判定する（Ｓ１０）。ＥＣＵ１２は、走行開始スイッチがＯＮされていなければ（Ｓ１０のＮ）、走行制御を終了する。
【００８６】
走行開始スイッチがＯＮされていれば（Ｓ１０のＹ）、目標ランプ検出部４０は、撮像画像から目標部画像を検出する（Ｓ１２）。次に、ヨー角検出部４２は、目標ランプ検出部４０により検出された目標部画像の位置情報にもとづいて、撮像画像から目標ランプ２に対する車両１のヨー角を検出する（Ｓ１４）。
【００８７】
距離算出部４４は、目標部画像の大きさと、実空間上の発光部２１の大きさとにもとづいて目標ランプ２と車両との実空間上の距離を算出する（Ｓ１６）。なお、距離算出部４４は、目標部画像に生じた輝度のにじみを補正して、目標部画像の大きさを算出してよい。
【００８８】
特徴設定部４６は、撮像画像から輝度勾配および輝度勾配の分布により特徴画像を検出し、設定する。特徴追跡処理部４８は、テンプレートと実空間上で同じ領域が新たな撮像画像からなくなるまで、記憶された特徴画像のテンプレートと同じ領域を新たな撮像画像毎に追跡する（Ｓ１８）。
【００８９】
横偏差算出部５０は、撮像部により新たに撮像された現撮像画像から検出された目標部画像と特徴画像に対する、仮想２次元空間上の新たな消失点の位置を定める（Ｓ２０）。横偏差算出部５０は、現撮像画像の消失点と目標部画像と特徴画像との位置関係から横偏差を算出する（Ｓ２２）。
【００９０】
走行制御部３６は、目標走行ライン２６を走行するように、ヨー角および横偏差にもとづいて車両１の走行を制御する（Ｓ２４）。
【００９１】
以上、本発明を実施例をもとに説明した。この実施例は例示であり、それらの各構成要素の組合せにいろいろな変形例が可能なこと、またそうした変形例も本発明の範囲にあることは当業者に理解されるところである。
【００９２】
たとえば、目標ランプ２は、車両の後方に位置し、走行制御部３６は、その目標ランプ２に向かうよう車両の後方への走行を制御してよい。このとき、車両の後方にマーカーが取り付けられ、カメラ１１の撮像方向を後方に変えた場合に、後方のマーカーが撮像されるようにしてもよい。これにより、後方への走行制御において、カメラ１１の撮像方向を後方に向けても、画像処理部で撮像方向の調整をすることができる。また、走行制御部３６は、カメラ１１により撮像された車両後方に位置する目標ランプ２と、車両の初期位置との関係で定めた目標走行ラインを走行するように車両の前方への走行を制御してもよい。
【００９３】
また、車両１の位置が初期位置にある場合、検出されたヨー角によって、車両１の向きが目標ランプ２に真っ直ぐ向いているかどうかを判定してよい。車両１の向きが目標ランプ２に真っ直ぐ向いてなければ、走行制御部３６は、後輪１０の一方に制動力を与え、車両１の向きが目標ランプ２に真っ直ぐ向くように車両１を旋回させてよい。
【００９４】
また、走行制御装置２０は、初期に定めた目標走行ライン２６から所定間隔離れた位置を保って車両１が走行するように制御してよい。たとえば、走行制御装置２０は、横偏差の初期値を所定間隔ずらすことで、目標走行ラインを所定間隔ずらして設定し、この目標走行ラインを走行するように車両走行を制御してもよい。
【００９５】
また、走行制御装置２０は、作業工程の２行程目以降は、１行程目でできた畝などの作業跡を撮像画像から検出し、１行程目を基準に、作業跡に対して一定間隔を保って走行制御をしてよい。これにより、２行程目以降では、目標ランプ２が不要となる。
【符号の説明】
【００９６】
１ 車両、 ２ 目標ランプ、 ３ 車両客室、 ４ 圃場、 ６ ブレーキ機構、 ８ 前輪、 １０ 後輪、 １１ カメラ、 １２ ＥＣＵ、 １４ 操舵駆動機構、 １５ ステアリング機構、 １６ 作業機、 ２０ 走行制御装置、 ２１ 発光部、 ２４ 筐体、 ２６ 目標走行ライン、 ３０ 画像取得部、 ３２ 画像処理部、 ３４ 記憶部、 ３６ 走行制御部、 ４０ 目標ランプ検出部、 ４２ ヨー角検出部、 ４４ 距離算出部、 ４６ 特徴設定部、 ４８ 特徴追跡処理部、 ５０ 横偏差算出部。
【特許請求の範囲】
【請求項１】
車両走行の目標となる方向に位置する目標部を撮像する撮像部と、
前記撮像部により撮像した撮像画像を処理する画像処理部と、
前記撮像画像に含まれる目標部画像の位置と車両の初期位置との関係で定まる目標走行ラインを走行するように車両の走行を制御する走行制御部と、を備え、
前記画像処理部は、
前記撮像画像から前記目標部に対する車両のヨー角を検出するヨー角検出部と、
前記撮像画像から目標走行ラインからの横偏差を算出する横偏差算出部と、を備え、
前記走行制御部は、前記ヨー角および前記横偏差にもとづいて車両の走行を制御することを特徴とする走行制御装置。
【請求項２】
前記画像処理部は、
前記撮像画像から前記目標部画像を検出する目標検出部と、
前記撮像画像から特徴画像を検出する特徴検出部と、をさらに備え、
前記横偏差算出部は、前記撮像部により撮像された現撮像画像から検出された前記目標部画像と前記特徴画像に対する、仮想２次元空間上の消失点の位置を定め、前記消失点と前記目標部画像と前記特徴画像との位置関係から前記横偏差を算出することを特徴とする請求項１に記載の走行制御装置。
【請求項３】
前記目標部画像の大きさと、実空間上の前記目標部の大きさとにもとづいて前記目標部と前記車両との実空間上の距離を算出する距離算出部をさらに備え、
前記横偏差算出部は、前記実空間上の距離に応じて、前記仮想２次元空間における前記目標部画像に対する前記消失点の縦方向の位置を定めることを特徴とする請求項２に記載の走行制御装置。
【請求項４】
前記横偏差算出部は、過去に検出された前記目標部画像および前記特徴画像に対して定められた過去の消失点の縦方向の位置を定める第１基準ラインから所与の間隔離れた第２基準ラインと、前記過去の消失点および前記目標部画像を結ぶ第１直線の第１交点と、前記第２基準ラインと、前記過去の消失点および前記特徴画像を結ぶ第２直線の第２交点との間隔にもとづいて、前記現撮像画像から検出された前記目標部画像と前記特徴画像に対する、前記仮想２次元空間上の前記消失点の横方向の位置を定めることを特徴とする請求項３に記載の走行制御装置。
【請求項５】
前記距離算出部は、前記目標部画像に生じた輝度のにじみを補正して、前記目標部画像の大きさを算出することを特徴とする請求項３または４に記載の走行制御装置。
【請求項６】
前記目標部は、発光部材を含み、
前記距離算出部は、前記目標部画像に生じた輝度のにじみを、前記撮像部が前記撮像画像を撮像した露光時間と、前記目標部から発光される光の強さと、前記目標部の背景の輝度とにもとづいて補正することを特徴とする請求項５に記載の走行制御装置。
【請求項７】
前記走行制御部は、
左右の後輪に設けられたブレーキ機構の制動力を独立に制御するブレーキ制御部と、
前輪用駆動機構を駆動し、前輪の操舵を制御する操舵制御部と、を備え、
前記ブレーキ制御部によって左右のうち前記目標走行ラインに近い側の後輪に制動力を与え、前記操舵制御部によって前記後輪の制動力が与えられていない側の向きに前輪を操舵することを特徴とする請求項１〜６のいずれかに記載の走行制御装置。
【請求項１】
車両走行の目標となる方向に位置する目標部を撮像する撮像部と、
前記撮像部により撮像した撮像画像を処理する画像処理部と、
前記撮像画像に含まれる目標部画像の位置と車両の初期位置との関係で定まる目標走行ラインを走行するように車両の走行を制御する走行制御部と、を備え、
前記画像処理部は、
前記撮像画像から前記目標部に対する車両のヨー角を検出するヨー角検出部と、
前記撮像画像から目標走行ラインからの横偏差を算出する横偏差算出部と、を備え、
前記走行制御部は、前記ヨー角および前記横偏差にもとづいて車両の走行を制御することを特徴とする走行制御装置。
【請求項２】
前記画像処理部は、
前記撮像画像から前記目標部画像を検出する目標検出部と、
前記撮像画像から特徴画像を検出する特徴検出部と、をさらに備え、
前記横偏差算出部は、前記撮像部により撮像された現撮像画像から検出された前記目標部画像と前記特徴画像に対する、仮想２次元空間上の消失点の位置を定め、前記消失点と前記目標部画像と前記特徴画像との位置関係から前記横偏差を算出することを特徴とする請求項１に記載の走行制御装置。
【請求項３】
前記目標部画像の大きさと、実空間上の前記目標部の大きさとにもとづいて前記目標部と前記車両との実空間上の距離を算出する距離算出部をさらに備え、
前記横偏差算出部は、前記実空間上の距離に応じて、前記仮想２次元空間における前記目標部画像に対する前記消失点の縦方向の位置を定めることを特徴とする請求項２に記載の走行制御装置。
【請求項４】
前記横偏差算出部は、過去に検出された前記目標部画像および前記特徴画像に対して定められた過去の消失点の縦方向の位置を定める第１基準ラインから所与の間隔離れた第２基準ラインと、前記過去の消失点および前記目標部画像を結ぶ第１直線の第１交点と、前記第２基準ラインと、前記過去の消失点および前記特徴画像を結ぶ第２直線の第２交点との間隔にもとづいて、前記現撮像画像から検出された前記目標部画像と前記特徴画像に対する、前記仮想２次元空間上の前記消失点の横方向の位置を定めることを特徴とする請求項３に記載の走行制御装置。
【請求項５】
前記距離算出部は、前記目標部画像に生じた輝度のにじみを補正して、前記目標部画像の大きさを算出することを特徴とする請求項３または４に記載の走行制御装置。
【請求項６】
前記目標部は、発光部材を含み、
前記距離算出部は、前記目標部画像に生じた輝度のにじみを、前記撮像部が前記撮像画像を撮像した露光時間と、前記目標部から発光される光の強さと、前記目標部の背景の輝度とにもとづいて補正することを特徴とする請求項５に記載の走行制御装置。
【請求項７】
前記走行制御部は、
左右の後輪に設けられたブレーキ機構の制動力を独立に制御するブレーキ制御部と、
前輪用駆動機構を駆動し、前輪の操舵を制御する操舵制御部と、を備え、
前記ブレーキ制御部によって左右のうち前記目標走行ラインに近い側の後輪に制動力を与え、前記操舵制御部によって前記後輪の制動力が与えられていない側の向きに前輪を操舵することを特徴とする請求項１〜６のいずれかに記載の走行制御装置。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図１１】
【図１２】
【図１３】
【図１４】
【図１５】
【図１６】
【図１７】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図１１】
【図１２】
【図１３】
【図１４】
【図１５】
【図１６】
【図１７】
【公開番号】特開２０１０−２００６７４（Ｐ２０１０−２００６７４Ａ）
【公開日】平成２２年９月１６日（２０１０．９．１６）
【国際特許分類】
【出願番号】特願２００９−４９８４４（Ｐ２００９−４９８４４）
【出願日】平成２１年３月３日（２００９．３．３）
【出願人】（５０１２０３３４４）独立行政法人農業・食品産業技術総合研究機構 (827)
【出願人】（００００００１２５）井関農機株式会社 (3,813)
【Ｆターム（参考）】
【公開日】平成２２年９月１６日（２０１０．９．１６）
【国際特許分類】
【出願日】平成２１年３月３日（２００９．３．３）
【出願人】（５０１２０３３４４）独立行政法人農業・食品産業技術総合研究機構 (827)
【出願人】（００００００１２５）井関農機株式会社 (3,813)
【Ｆターム（参考）】
[ Back to top ]