位置判定装置およびナビゲーション装置並びに位置判定方法,プログラム
【課題】車両の地図上の位置をより適正に判定する。
【解決手段】車載カメラから撮影される風景画像と複数の参照データとが一致しているか否かを判定するマッチング処理により一致していると判定された参照データに対応する撮影位置に基づいて車両の現在位置である自車位置を判定するものにおいて、マッチング処理は、車載カメラから撮影される風景画像に対して特徴点を抽出する所定の画像処理を施して得られる判定用データと参照データとの一致率Mが判定用閾値Mref以上のときに一致していると判定し、一致率Mが判定用閾値Mref未満のときに一致していないと判定することにより行なわれ(S210)、判定用閾値Mrefは、車速Vが大きいほど小さくなるように且つハンドル操舵量Stが大きいほど小さくなるように調整されている(S130)。これにより、判定用データと参照データとが一致していると判定されやすくすることができる。
【解決手段】車載カメラから撮影される風景画像と複数の参照データとが一致しているか否かを判定するマッチング処理により一致していると判定された参照データに対応する撮影位置に基づいて車両の現在位置である自車位置を判定するものにおいて、マッチング処理は、車載カメラから撮影される風景画像に対して特徴点を抽出する所定の画像処理を施して得られる判定用データと参照データとの一致率Mが判定用閾値Mref以上のときに一致していると判定し、一致率Mが判定用閾値Mref未満のときに一致していないと判定することにより行なわれ(S210)、判定用閾値Mrefは、車速Vが大きいほど小さくなるように且つハンドル操舵量Stが大きいほど小さくなるように調整されている(S130)。これにより、判定用データと参照データとが一致していると判定されやすくすることができる。
【発明の詳細な説明】
【技術分野】
【0001】
本発明は、位置判定装置およびナビゲーション装置並びに位置判定方法,プログラムに関し、詳しくは、車載カメラから撮影された風景画像を用いて車両の地図上の位置を判定する位置判定装置およびナビゲーション装置並びに位置判定方法,プログラムに関する。
【背景技術】
【0002】
従来、この種の位置判定装置としては、道路上の白線などの道路標示を示すパターン情報と道路標示の特徴点の座標(ワールド座標)を示す位置情報とを予め対応付けて登録しておき、パターン情報を用いたパターンマッチング等により、車載カメラによる撮影画像の中に道路標示があると判定したときには、撮影画像から特徴点を抽出して、車両の暫定現在位置を基準にした自動車座標系における道路標示の特徴点の座標(自動車座標)を算出し、算出した道路標示の特徴点の自動車座標と対応する位置情報とを用いて車両の現在位置を算出するものが提案されている(例えば、特許文献1参照)。この装置では、これにより、GPS信号やジャイロ,車線センサからの信号を利用した位置測位により得られる車両の暫定現在位置よりも高精度な現在位置を算出することができるものとしている。
【先行技術文献】
【特許文献】
【0003】
【特許文献1】特開2007−108043号公報
【発明の概要】
【発明が解決しようとする課題】
【0004】
しかしながら、上述の装置により行なわれる道路標示を示すパターン情報と撮影画像とのマッチング処理や、上述の装置と同様に高精度な現在位置の算出を目的として行なわれる車両からの風景画像の特徴的部分を示すパターン情報と撮影画像とのマッチング処理は、車両が走行している最中に行なう必要があることから、車両の位置を正しく判定することができない場合があった。車両が走行している最中は、その走行環境などによっては、撮影画像における道路標示や特徴的部分の移動速度が速くなり、パターン情報と一致する撮影画像を得ることができる時間が短くなって、即ち、パターン情報と一致する撮影画像を得ることができる道路上での撮影位置の範囲が狭くなって、パターン情報と撮影画像とが一致していると判定される機会が少なくなってしまう場合があった。
【0005】
本発明の位置判定装置およびナビゲーション装置並びに位置判定方法,プログラムは、車両の地図上の位置をより適正に判定することを主目的とする。
【課題を解決するための手段】
【0006】
本発明の位置判定装置およびナビゲーション装置並びに位置判定方法,プログラムは、上述の主目的を達成するために以下の手段を採った。
【0007】
本発明の第1の位置判定装置は、
道路上で走行方向に間隔をもって車載カメラから撮影された風景画像の特徴的部分を抽出して得られる複数の参照データをそれぞれ対応する地図上の位置と関連付けて記憶しておき、車載カメラから撮影される風景画像と前記複数の参照データとが一致しているか否かを判定するマッチング処理を行ない、該マッチング処理により一致していると判定された参照データに対応する地図上の位置に基づいて車両の地図上の位置を判定する位置判定装置であって、
前記マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、前記一致の程度が前記判定用閾値未満のときに一致していないと判定することにより行なわれ、
前記判定用閾値は、車速が大きいほど小さくなる傾向に且つハンドル操舵量が大きいほど小さくなる傾向に調整されてなる、
ことを特徴とする。
【0008】
この本発明の第1の位置判定装置では、マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、一致の程度が判定用閾値未満のときに一致していないと判定することにより行なわれ、判定用閾値は、車速が大きいほど小さくなる傾向に且つハンドル操舵量が大きいほど小さくなる傾向に調整されている。車速が比較的大きい場合やハンドル操舵量が比較的大きい場合には、風景画像の中の特徴的部分(例えば、道路脇の建物や道路標識といった道路脇の地物など)の移動速度(ハンドル操舵量が比較的大きい場合には、特に車両の旋回方向と逆方向に相当する方向への移動速度)が比較的大きく、参照データと一致する特徴的部分を有する風景画像を撮影可能な時間は短い。したがって、こうした場合には、判定用閾値を小さくすることにより、マッチング処理により風景画像と参照データとが一致していると判定されやすくすることができる。この結果、車両の地図上の位置をより適正に判定することができる。ここで、所定の画像処理としては、少なくともエッジ検出処理を含むものなどを用いることができる。
【0009】
こうした本発明の第1の位置判定装置において、走行している道路の幅方向における車両位置を検出する幅方向車両位置検出手段を備え、前記判定用閾値は、前記検出された車両位置が前記走行している道路の道路脇に近いほど小さくなる傾向に調整されてなる、ものとすることもできる。これは、走行している道路の幅方向において車両位置が道路脇に近いほど、風景画像の中でその近い道路脇側(左側または右側)の特徴的部分の移動速度が大きくなる傾向があることに基づく。この場合、前記幅方向車両位置検出手段は、複数の車線を有する道路を走行しているときに走行車線を検出する手段であり、前記判定用閾値は、前記検出された走行車線が前記走行している道路の道路脇に近いほど小さくなる傾向に調整されてなる、ものとすることもできる。
【0010】
また、本発明の第1の位置判定装置において、走行している道路の幅方向における車両位置を検出する幅方向車両位置検出手段を備え、前記判定用閾値は、前記走行している道路の幅方向において前記検出された車両位置が前記参照データを得た風景画像の撮影時の車両位置から離れるほど小さくなる傾向に調整されてなる、ものとすることもできる。これは、走行している道路の幅方向において車両位置が参照データを得た風景画像の撮影時の車両位置から離れるほど、風景画像の中でその離れた方向側(左側または右側)の特徴的部分の移動速度が大きくなる傾向があることに基づく。この場合、前記幅方向車両位置検出手段は、複数の車線を有する道路を走行しているときに走行車線を検出する手段であり、前記判定用閾値は、前記検出された走行車線が前記参照データを得た風景画像の撮影時の走行車線から離れるほど小さくなる傾向に調整されてなる、ものとすることもできる。
【0011】
さらに、本発明の第1の位置判定装置において、前記判定用閾値は、走行している道路の幅員が小さいほど小さくなる傾向,走行している道路の曲率半径が小さいほど小さくなる傾向,走行している道路上で最寄りの交差点からの距離が短いほど小さくなる傾向のうち少なくともいずれかとなるように調整されてなる、ものとすることもできる。これは、走行している道路の幅員が小さいほど,走行している道路の曲率半径が小さいほど,交差点を右左折してから進入した道路上でその交差点からの距離が短いほど、風景画像の中の特徴的部分の移動速度が大きくなる傾向があることに基づく。
【0012】
あるいは、本発明の第1の位置判定装置において、前記判定用閾値は、走行している道路の車線数が少ないほど小さくなる傾向,走行している道路の車線幅が狭いほど小さくなる傾向,走行している道路の歩道幅が狭いほど小さくなる傾向のうち少なくともいずれかとなるように調整されてなる、ものとすることもできる。これは、道路の車線数が少ないほど,道路の車線幅が狭いほど,道路の歩道幅が狭いほど、道路の幅員が小さくなる傾向があると共に、走行している道路の幅員が小さいほど、風景画像の中の特徴的部分の移動速度が大きくなる傾向があることに基づく。
【0013】
車両位置が参照データを得た風景画像の撮影時の車両位置から離れるほど小さくなる傾向に判定用閾値を調整する態様の本発明の第1の位置判定装置において、前記マッチング処理は、前記判定用データを前記車両からみて左側の左側判定用データと右側の右側判定用データとに分割すると共に、前記参照データを前記車両からみて左側の左側参照データと右側の右側参照データとに分割し、前記左側判定用データと前記左側参照データとの一致の程度が左側判定用閾値以上であり、且つ、前記右側判定用データと前記右側参照データとの一致の程度が右側判定用閾値以上のときには一致していると判定し、前記左側判定用データと前記左側参照データとの一致の程度が前記左側判定用閾値未満であるか、又は、前記右側判定用データと前記右側参照データとの一致の程度が前記右側判定用閾値未満であるときには一致していないと判定することにより行なわれ、前記左側判定用閾値は、前記走行している道路の幅方向において前記検出された車両位置が前記参照データを得た風景画像の撮影時の車両位置から左側に離れるほど小さくなる傾向に調整されてなり、前記右側用判定閾値は、前記走行している道路の幅方向において前記検出された車両位置が前記参照データを得た風景画像の撮影時の車両位置から右側に離れるほど小さくなる傾向に調整されてなる、ものとすることもできる。こうすれば、より適正に判定用閾値を調整することができる。
【0014】
本発明の第2の位置判定装置は、
道路上で走行方向に間隔をもって車載カメラから撮影された風景画像の特徴的部分を抽出して得られる複数の参照データをそれぞれ対応する地図上の位置と関連付けて記憶しておき、車載カメラから撮影される風景画像と前記複数の参照データとが一致しているか否かを判定するマッチング処理を行ない、該マッチング処理により一致していると判定された参照データに対応する地図上の位置に基づいて車両の地図上の位置を判定する位置判定装置であって、
走行している道路の幅方向における車両位置を検出する幅方向車両位置検出手段
を備え、
前記マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、前記一致の程度が前記判定用閾値未満のときに一致していないと判定することにより行なわれ、
前記判定用閾値は、前記検出された車両位置が前記走行している道路の道路脇に近いほど小さくなる傾向に調整されてなる、
ことを特徴とする。
【0015】
この本発明の第2の位置判定装置では、マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、一致の程度が判定用閾値未満のときに一致していないと判定することにより行なわれ、判定用閾値は、走行している道路の幅方向における車両位置が走行している道路の道路脇に近いほど小さくなる傾向に調整されている。走行している道路の幅方向における車両位置がその道路の道路脇に比較的近い場合には、風景画像の中でその近い道路脇側(左側または右側)の特徴的部分(例えば、道路脇の建物や道路標識といった道路脇の地物など)の移動速度が比較的大きく、参照データと一致する特徴的部分を有する風景画像を撮影可能な時間は短い。したがって、こうした場合には、判定用閾値を小さくすることにより、マッチング処理により風景画像と参照データとが一致していると判定されやすくすることができる。この結果、車両の地図上の位置をより適正に判定することができる。ここで、所定の画像処理としては、少なくともエッジ検出処理を含むものなどを用いることができる。
【0016】
本発明の第3の位置判定装置は、
道路上で走行方向に間隔をもって車載カメラから撮影された風景画像の特徴的部分を抽出して得られる複数の参照データをそれぞれ対応する地図上の位置と関連付けて記憶しておき、車載カメラから撮影される風景画像と前記複数の参照データとが一致しているか否かを判定するマッチング処理を行ない、該マッチング処理により一致していると判定された参照データに対応する地図上の位置に基づいて車両の地図上の位置を判定する位置判定装置であって、
走行している道路の幅方向における車両位置を検出する幅方向車両位置検出手段
を備え、
前記マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、前記一致の程度が前記判定用閾値未満のときに一致していないと判定することにより行なわれ、
前記判定用閾値は、前記走行している道路の幅方向において前記検出された車両位置が前記参照データを得た風景画像の撮影時の車両位置から離れるほど小さくなる傾向に調整されてなる、
ことを特徴とする。
【0017】
この本発明の第3の位置判定装置では、マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、一致の程度が判定用閾値未満のときに一致していないと判定することにより行なわれ、判定用閾値は、走行している道路の幅方向において車両位置が参照データを得た風景画像の撮影時の車両位置から離れるほど小さくなる傾向に調整されている。走行している道路の幅方向において車両位置が参照データを得た風景画像の撮影時の車両位置から比較的離れている場合には、風景画像の中でその離れている方向側(左側または右側)の特徴的部分(例えば、道路脇の建物や道路標識といった道路脇の地物など)の移動速度が比較的大きく、参照データと一致する特徴的部分を有する風景画像を撮影可能な時間は短い。したがって、こうした場合には、判定用閾値を小さくすることにより、マッチング処理により風景画像と参照データとが一致していると判定されやすくすることができる。この結果、車両の地図上の位置をより適正に判定することができる。ここで、所定の画像処理としては、少なくともエッジ検出処理を含むものなどを用いることができる。
【0018】
本発明のナビゲーション装置は、上述のいずれかの態様の本発明の位置判定装置、即ち、基本的には、道路上で走行方向に間隔をもって車載カメラから撮影された風景画像の特徴的部分を抽出して得られる複数の参照データをそれぞれ対応する地図上の位置と関連付けて記憶しておき、車載カメラから撮影される風景画像と前記複数の参照データとが一致しているか否かを判定するマッチング処理を行ない、該マッチング処理により一致していると判定された参照データに対応する地図上の位置に基づいて車両の地図上の位置を判定する位置判定装置であって、前記マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、前記一致の程度が前記判定用閾値未満のときに一致していないと判定することにより行なわれ、前記判定用閾値は、車速が大きいほど小さくなる傾向に且つハンドル操舵量が大きいほど小さくなる傾向に調整されてなる、第1の位置判定装置、または、走行している道路の幅方向における車両位置を検出する幅方向車両位置検出手段を備え、前記マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、前記一致の程度が前記判定用閾値未満のときに一致していないと判定することにより行なわれ、前記判定用閾値は、前記検出された車両位置が前記走行している道路の道路脇に近いほど小さくなる傾向に調整されてなる、第2の位置判定装置、または、走行している道路の幅方向における車両位置を検出する幅方向車両位置検出手段を備え、前記マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、前記一致の程度が前記判定用閾値未満のときに一致していないと判定することにより行なわれ、前記判定用閾値は、前記走行している道路の幅方向において前記検出された車両位置が前記参照データを得た風景画像の撮影時の車両位置から離れるほど小さくなる傾向に調整されてなる、第3の位置判定装置、を備え、該位置判定装置により判定された車両の地図上の位置を用いて目的地への経路案内を行なう、ことを要旨とする。
【0019】
この本発明のナビゲーション装置では、上述のいずれかの態様の本発明の位置判定装置を備えるから、上述の位置判定装置が奏する効果、例えば、車両の地図上の位置をより適正に判定することができる効果などと同様の効果を奏することができる。
【0020】
本発明の第1の位置判定方法は、
道路上で走行方向に間隔をもって車載カメラから撮影された風景画像の特徴的部分を抽出して得られる複数の参照データをそれぞれ対応する地図上の位置と関連付けて記憶しておき、車両から撮影される風景画像と前記複数の参照データとが一致しているか否かを判定するマッチング処理を行なうステップと、該マッチング処理により一定していると判定された参照データに対応する地図上の位置に基づいて車両の地図上の位置を判定するステップと、を含む位置判定方法であって、
前記マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、前記一致の程度が前記判定用閾値未満のときに一致していないと判定することにより行なわれ、
前記判定用閾値は、車速が大きいほど小さくなる傾向に且つハンドル操舵量が大きいほど小さくなる傾向に調整されてなる、
ことを特徴とする。
【0021】
この本発明の第1の位置判定方法では、マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、一致の程度が判定用閾値未満のときに一致していないと判定することにより行なわれ、判定用閾値は、車速が大きいほど小さくなる傾向に且つハンドル操舵量が大きいほど小さくなる傾向に調整されている。車速が比較的大きい場合やハンドル操舵量が比較的大きい場合には、風景画像の中の特徴的部分(例えば、道路脇の建物や道路標識といった道路脇の地物など)の移動速度(ハンドル操舵量が比較的大きい場合には、特に車両の旋回方向と逆方向に相当する方向への移動速度)が比較的大きく、参照データと一致する特徴的部分を有する風景画像を撮影可能な時間は短い。したがって、こうした場合には、判定用閾値を小さくすることにより、マッチング処理により風景画像と参照データとが一致していると判定される機会を増やすことができる。この結果、車両の地図上の位置をより適正に判定することができる。ここで、所定の画像処理としては、少なくともエッジ検出処理を含むものなどを用いることができる。
【0022】
本発明の第2の位置判定方法は、
道路上で走行方向に間隔をもって車載カメラから撮影された風景画像の特徴的部分を抽出して得られる複数の参照データをそれぞれ対応する地図上の位置と関連付けて記憶しておき、車両から撮影される風景画像と前記複数の参照データとが一致しているか否かを判定するマッチング処理を行なうステップと、該マッチング処理により一定していると判定された参照データに対応する地図上の位置に基づいて車両の地図上の位置を判定するステップと、を含む位置判定方法であって、
前記マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、前記一致の程度が前記判定用閾値未満のときに一致していないと判定することにより行なわれ、
前記判定用閾値は、走行している道路の幅方向における車両位置が前記走行している道路の道路脇に近いほど小さくなる傾向に調整されてなる、
ことを特徴とする。
【0023】
この本発明の第2の位置判定方法では、マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、一致の程度が判定用閾値未満のときに一致していないと判定することにより行なわれ、判定用閾値は、走行している道路の幅方向における車両位置が走行している道路の道路脇に近いほど小さくなる傾向に調整されている。走行している道路の幅方向における車両位置がその道路の道路脇に比較的近い場合には、風景画像の中でその近い道路脇側(左側または右側)の特徴的部分(例えば、道路脇の建物や道路標識といった道路脇の地物など)の移動速度が比較的大きく、参照データと一致する特徴的部分を有する風景画像を撮影可能な時間は短い。したがって、こうした場合には、判定用閾値を小さくすることにより、マッチング処理により風景画像と参照データとが一致していると判定されやすくすることができる。この結果、車両の地図上の位置をより適正に判定することができる。ここで、所定の画像処理としては、少なくともエッジ検出処理を含むものなどを用いることができる。
【0024】
本発明の第3の位置判定方法は、
道路上で走行方向に間隔をもって車載カメラから撮影された風景画像の特徴的部分を抽出して得られる複数の参照データをそれぞれ対応する地図上の位置と関連付けて記憶しておき、車両から撮影される風景画像と前記複数の参照データとが一致しているか否かを判定するマッチング処理を行なうステップと、該マッチング処理により一定していると判定された参照データに対応する地図上の位置に基づいて車両の地図上の位置を判定するステップと、を含む位置判定方法であって、
前記マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、前記一致の程度が前記判定用閾値未満のときに一致していないと判定することにより行なわれ、
前記判定用閾値は、走行している道路の幅方向において車両位置が前記参照データを得た風景画像の撮影時の車両位置から離れるほど小さくなる傾向に調整されてなる、
ことを特徴とする。
【0025】
この本発明の第3の位置判定方法では、マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、一致の程度が判定用閾値未満のときに一致していないと判定することにより行なわれ、判定用閾値は、走行している道路の幅方向において車両位置が参照データを得た風景画像の撮影時の車両位置から離れるほど小さくなる傾向に調整されている。走行している道路の幅方向において車両位置が参照データを得た風景画像の撮影時の車両位置から比較的離れている場合には、風景画像の中でその離れている方向側(左側または右側)の特徴的部分(例えば、道路脇の建物や道路標識といった道路脇の地物など)の移動速度が比較的大きく、参照データと一致する特徴的部分を有する風景画像を撮影可能な時間は短い。したがって、こうした場合には、判定用閾値を小さくすることにより、マッチング処理により風景画像と参照データとが一致していると判定されやすくすることができる。この結果、車両の地図上の位置をより適正に判定することができる。ここで、所定の画像処理としては、少なくともエッジ検出処理を含むものなどを用いることができる。
【0026】
本発明のプログラムは、上述した第1〜第3の位置判定方法の各ステップを1以上のコンピュータに実現させるためのものである。このプログラムは、コンピュータが読み取り可能な記録媒体(例えばハードディスク、ROM、FD、CD、DVDなど)に記録されていてもよいし、伝送媒体(インターネットやLANなどの通信網)を介してあるコンピュータから別のコンピュータへ配信されてもよいし、その他どのような形で授受されてもよい。このプログラムを一つのコンピュータに実行させるか又は複数のコンピュータに分担して実行させれば、上述した位置判定方法の各ステップが実現されるため、その位置判定方法と同様の作用効果が得られる。
【図面の簡単な説明】
【0027】
【図1】本発明の一実施例としてのナビゲーション装置20を含むナビゲーションシステム10の構成の概略を示す構成図である。
【図2】風景画像とのマッチング処理に用いられる参照データを作成する様子の一例を説明する説明図である。
【図3】道路とその幅員Dw,歩道幅Pw,車線幅Lwとの複数の関係の一例を説明する説明図である。
【図4】電子制御ユニット30により実行される自車位置判定処理ルーチンの一例を示すフローチャートである。
【図5】道路における最寄りの交差点からの距離Dcの一例を示す説明図である。
【図6】判定用閾値Mrefをを設定するためのパラメータと係数との複数の関係の一例を説明する説明図である。
【図7】走行車線係数k3の係数設定用マップの例を示す説明図である。
【図8】走行車線差係数k4を設定する様子の例を説明する説明図である。
【図9】判定用閾値Mrefを設定するためのパラメータと係数との複数の関係の一例を説明する説明図である。
【図10】車両が交差点を左折して走行する様子の一例を説明する説明図である。
【図11】変形例の電子制御ユニット30により実行される自車位置判定処理ルーチンの一例を示すフローチャートである。
【図12】左側走行車線差係数設定用マップの一例を示す説明図である。
【図13】右側走行車線差係数設定用マップの一例を示す説明図である。
【図14】参照データを左側参照データと右側参照データとに分割する様子の一例を示す説明図である。
【発明を実施するための形態】
【0028】
次に、本発明を実施するための形態を実施例を用いて説明する。
【実施例】
【0029】
図1は、本発明の一実施例としてのナビゲーション装置20を含むナビゲーションシステム10の構成の概略を示す構成図である。実施例のナビゲーションシステム10は、図示しない車両(自動車)に搭載された各種センサを中心とする車載装置12と、図示しない車載バッテリからの電力供給を受けて作動するナビゲーション装置20とを備える。実施例のナビゲーション装置20は、図示するように、文字や画像を表示する矩形状の画面を有する例えば液晶ディスプレイや有機エレクトロルミネッセンスディスプレイなどとして構成されたディスプレイ22と、ディスプレイ22の画面に取り付けられた例えば抵抗膜方式や静電容量方式などによるタッチパネル24と、装置全体をコントロールする電子制御ユニット30と、各種アプリケーションソフトウェアや地図データなどを記憶する大容量メモリとしてのハードディスクドライブ(以下、HDDという)40とを備える。
【0030】
電子制御ユニット30は、CPU32を中心とするマイクロプロセッサとして構成されており、CPU32の他に各種処理プログラムを記憶するROM34と、データを一時的に記憶するRAM36と、記憶したデータを保持する不揮発性のフラッシュメモリ38と、図示しない入出力ポートとを備える。電子制御ユニット30には、操作者のタッチ位置を検出するタッチパネル24からの信号やHDD40から読み出したデータの他に、車載装置12からの各種信号が車内ネットワーク経由で入力ポートを介して入力されている。車載装置12からの信号としては、GPS(Global Positioning System)衛星からの信号をGPSアンテナを介して受信するGPS受信機50からの信号,車両の駆動軸や車輪が一定量回転する毎にパルス信号を出力する車速センサ52からの信号,車両の加速度を検出する加速度センサ54からの信号,車両の進行方位やその変化を検出する例えばジャイロセンサにより構成された方位センサ56からの信号,車両のハンドルの基準位置(進行方向に相当する位置)からの回転量(回転角)をハンドル操舵量として検出する操舵量センサ58からの信号,車両前方に設置されて車両前方の風景画像を動画や静止画として撮影可能なカメラ59からの信号(撮影画像)などがある。電子制御ユニット30からは、ディスプレイ22への表示信号やアンプを内蔵したスピーカ26への音声信号,HDD40に書き込むデータなどが出力ポートを介して出力されている。
【0031】
実施例のナビゲーション装置20では、電子制御ユニット30は、HDD40から必要なアプリケーションソフトウェアや地図データを読み出して各種処理を実行する。例えば、ハードウェア又はソフトウェア或いはその組み合わせにより実現される機能を表す図1の機能ブロックに示すように、電子制御ユニット30は、GPS受信機50からの信号や方位センサ56からの信号などに基づいて車両の現在位置である自車位置を判定するロケーション処理部60によるロケーション処理,地図データを用いてディスプレイ22に地図を表示する地図表示処理部62による地図表示処理,判定された自車位置から目的地への走行ルートを探索して地図表示処理部62による地図表示やスピーカ26からの音声出力によりルート案内を行なうナビゲーション処理部64によるナビゲーション処理,これらの処理に用いられる画像処理部66による各種画像処理などを実行する。なお、地図データは、HDD40の地図データ用データベース(以下、地図データDBという)42に記憶されている。
【0032】
電子制御ユニット30によるロケーション処理では、GPS受信機50からのGPS信号に基づいていわゆるGPS航法により自車位置を算出したり、GPS信号を受信できない場合などに車速センサ52からの車速パルス信号や加速度センサ54からの車両の加速度,方位センサ56からの車両の方位に基づいていわゆる自律航法により自車位置を算出したり、算出された自車位置が地図の道路上から外れた場合などに地図データを用いて自車位置を道路上の位置に補正するいわゆるマップマッチングを行なったりして、自車位置を推定する。さらに、ロケーション処理では、カメラ59により撮影される風景画像と予めHDD40に記憶された複数の参照データとが一致しているか否かを判定する画像認識処理としてのマッチング処理を行ない、マッチング処理により一致していると判定された参照データに関連付けられた地図上の位置を、GPS航法や自律航法などにより推定した自車位置に代えて、正しい自車位置と判定する。ここで、HDD40に記憶された複数の参照データは、実際に走行した車両の車載カメラから道路上で走行方向に間隔をもって撮影された風景画像の特徴点(例えば、道路脇の建物の輪郭,窓枠,看板や道路標識といった道路脇の地物,道路標示など)を抽出して得られるデータであり、風景画像を撮影したときの自車位置などの撮影情報と共に、HDD40の参照データ用データベース(以下、参照データDBという)44に記憶されている。
【0033】
ここで、カメラ59により撮影される風景画像とのマッチング処理に用いられる参照データを作成する方法を説明する。図2は、風景画像とのマッチング処理に用いられる参照データを作成する様子の一例を説明する説明図である。実施例では、図中上部に示すように、参照データ作成用の車両は、道路上で予め定められた参照データ間隔Dをもって車載カメラから車両前方の風景画像を撮影しながら走行し、風景画像の撮影時における車両の地図上の位置(緯度及び経度)と車両の方位(道路方向に沿った方位)とを各種センサからの信号などに基づいて正確な情報として取得する。参照データ間隔Dは、実施例では、ロケーション処理により実施例のナビゲーション装置20が備える電子制御ユニット30の演算量が過大にならない範囲内で、多くの道路で正確な自車位置を得ることができる道路上の間隔として、電子制御ユニット30やHDD40の性能などに基づいて予め実験や解析により定められたもの(例えば、数十mなど)を用いるものとした。続いて、図中下部左側に示すように、車載された電子制御ユニットにより、撮影された風景画像に対してエッジ検出処理などを施すことにより風景画像の特徴点を抽出して二値化した特徴点画像を作成し、作成した特徴点画像に対して風景画像認識に適した特徴点を強調したり強調した特徴点周辺の特徴点を破棄したりする強調処理や、ノイズ除去処理などを施して、参照データを作成する。また、撮影された風景画像から参照データを作成する際に、特徴点画像に対して道路上の白線や矢印などの道路標示が強調されるよう強調処理を施すことにより、風景画像の撮影時における走行車線の検出を行なう。エッジ検出処理や強調処理,ノイズ除去処理などの周知な画像処理手法については、これ以上詳細な説明は省略する。こうして作成された複数の参照データは、図中中段右側に示すように、実施例の車両に搭載されたナビゲーション装置20のHDD40の参照データDB44に、参照データ毎に撮影時の車両の位置,車両の方位,走行車線(以下、それぞれ撮影位置,撮影方位,撮影時走行車線という)と関連付けられて記憶される。
【0034】
なお、HDD40の地図データDB42には、道路情報や施設情報などが含まれ、道路情報には、例えば各道路の両端のノードが示す地図上の位置(緯度及び経度),各道路の距離,地域(市街地,郊外),種別(一般道路,高速道路),勾配,信号機の数の他に、図2中下部右側に示すように、各道路の幅員Dw,車線数Ln,車線幅Lw,歩道幅Pw,道路形状(直線またはカーブ),曲率半径R,道路種類(一方通行道路,対面通行道路,中央分離帯のある道路等),前述の参照データ間隔Dなどが含まれる。図3は、道路とその幅員Dw,歩道幅Pw,車線幅Lwとの複数の関係の一例を説明する説明図である。図中、左側の(a)は道路種類が対面通行道路で片側3車線の車線数Lnが値6の道路を示し、中央の(b)は道路種類が一方通行道路(例えば高速道路や高架道路などの場合)で車線数Lnが値3の道路を示し、右側の(c)は道路種類が一方通行道路で車線数Lnが値4の道路を示す。図3では、道路の歩道幅Pwは左右両側で等しく車線幅Lwは全て等しいものとして示したが、全ての道路について同一の基準に基づくものであれば、例えば、歩道幅Pwは左右両側の歩道幅の平均値として表したり、車線幅Lwは全車線の車線幅の平均値として表すなどとしてもよい。
【0035】
次に、こうして構成された実施例のナビゲーション装置20の動作、特に走行中に自車位置を判定する際の動作について説明する。図4は、電子制御ユニット30のロケーション処理部60により画像処理部66と連携して実行される自車位置判定処理ルーチンの一例を示すフローチャートである。このルーチンは、GPS航法や自律航法などにより推定された自車位置と方位センサ56からの信号などに基づく現在の車両の進行方位(道路方向に沿った方位)とが、それぞれ参照データDB44の参照データの1つに関連付けられた撮影位置と撮影方位とに一致する毎に繰り返し実行される。
【0036】
自車位置判定処理ルーチンが実行されると、電子制御ユニット30のCPU32は、まず、現在推定されている自車位置である推定自車位置,本ルーチンが実行されたときにカメラ59により撮影された風景画像から得られる判定用データ,推定自車位置および現在の車両の進行方位(以下、車両進行方位という)と一致する撮影位置および撮影方位の参照データ,推定自車位置および車両進行方位と一致する撮影位置および撮影方位に対応する撮影時走行車線Ls,推定自車位置における道路の車線数Lnと車線幅Lwと歩道幅Pwと曲率半径R,推定自車位置および車両進行方位に対応する道路の道路形状と道路種類,推定自車位置および車両進行方位に対応する道路における最寄りの交差点からの距離Dc,車速センサ52からの信号に基づいて算出される車速V,操舵量センサ58からの信号として得られるハンドル操舵量St,本判定処理に用いられる判定用基準閾値M0など判定に必要なデータを入力する処理を実行する(ステップS100)。
【0037】
ここで、推定自車位置は、実施例では、ロケーション処理部60によりGPS航法や自律航法などにより推定されたものを入力するものとした。判定用データは、図2を用いて説明した風景画像から参照データを作成した際の画像処理手法と同手法を、本ルーチンを実行したときにカメラ59により撮影された風景画像に対して適用することにより作成したものを入力するものとした。参照データと撮影時走行車線Lsとは、それぞれ推定自車位置および車両進行方位と一致する撮影位置および撮影方位に対応するものを参照データDB44から入力するものとした。道路の車線数Lnと車線幅Lwと歩道幅Pwと曲率半径Rとは、推定自車位置における道路の情報として記憶されたものを地図データDB42から入力するものとした。道路形状と道路種類とは、推定自車位置および車両進行方位に対応する道路の情報として記憶されたものを地図データDB42から入力するものとした。最寄りの交差点からの距離Dcは、実施例では、各道路の両端のノード間を単位距離毎に分割した複数の地点毎に定められ、他の道路との関係や各道路の位置,距離に基づいて算出されて地図データDB42に記憶されたものを入力するものとした。図5にある道路における最寄りの交差点からの距離Dcの一例を示す。また、判定用基準閾値M0は、判定用データと参照データとの一致の程度を示す一致率Mが判定用閾値Mref以上か否かを判定する本ルーチンの処理(即ち、実施例のマッチング処理)における判定用閾値Mrefの基準値であり、判定用データと参照データとが一致していると判定可能な範囲の比較的小さい値として予め実験や解析により定められたものを用いるものとした。
【0038】
こうしてデータを入力すると、図2を用いて説明した参照データを作成する際に走行車線を検出したときの画像処理手法と同手法を、カメラ59により撮影した風景画像から判定用データを作成する際に適用することにより、車両が走行している道路での走行車線Lrを検出し(ステップS110)、検出した走行車線Lrから入力した撮影時走行車線Lsを減じたものを走行車線差ΔLとして計算する(ステップS120)。ここで、走行車線Lrは、日本のように自動車が左側通行となる国や地域では、車両が走行している道路が複数車線を有する場合には、最も左側の車線を値1として左側から何番目の車線かを整数で示す値とし、車両が走行している道路が一車線のみを有する場合には、値1とした。なお、参照データDB44の撮影情報としての撮影時走行車線Lsも同様に値1以上の整数とした。
【0039】
続いて、入力した車速V,ハンドル操舵量St,検出した走行車線Lr,計算した走行車線差ΔLの各パラメータに基づいてそれぞれ判定用基準閾値M0に乗じるべき車速係数k1,操舵量係数k2,走行車線係数k3,走行車線差係数k4を設定する(ステップS130〜S150)。ここで、各係数は、実施例では、パラメータと係数との関係を予め定めて係数毎に係数設定用マップとしてROM34に記憶しておき、パラメータが与えられると記憶したマップから対応する係数を導出して設定するものとした。
【0040】
図6に判定用閾値Mrefを設定するためのパラメータと係数との複数の関係の一例を示し、図7に走行車線係数k3の係数設定用マップの例を示し、図8に走行車線車係数k4を設定する様子の例を説明する説明図を示す。図6中、右側は係数設定用マップの一例である。図6に示すように、車速Vが大きいほど車速係数k1が値1を跨いで小さくなり、ハンドル操舵量Stが大きいほど操舵量係数k2が値1から小さくなり、走行車線Lrが道路脇に近いほど走行車線係数k3が小さくなり、走行車線差ΔLの絶対値が大きいほど(走行車線Lrが撮影時走行車線Lsから離れるほど)走行車線差係数k4が値1から小さくなるように、各パラメータに基づいて各係数が設定される。なお、操舵量係数k2については、ハンドル操舵量Stが値0近傍の不感帯としての所定量以下の範囲では一律に値1が設定されるものとした。また、図7に示すように、走行車線係数k3は、入力した道路種類と車線数Ln毎に異なる係数設定用マップが選択されて、選択された係数設定用マップに走行車線Lrを適用することにより設定することができる。例えば、図中左側の(a)の道路(道路種類が対面通行道路で車線数Lnが値6の道路)では、走行車線Lrが小さいほど(即ち左側の道路脇に近いほど)値1を跨いで小さくなるように走行車線係数k3が設定され、図中中央の(b)の道路(道路種類が一方通行道路で車線数Lnが値3の道路)や図中右側の(c)の道路(道路種類が一方通行道路で車線数Lnが値4の道路)では、走行車線Lrが中央の車線から離れて左側または右側の道路脇に近いほど値1から小さくなるように走行車線係数k3が設定される。さらに、走行車線差係数k4は、走行車線差ΔLの絶対値に基づいて設定することにより、図8に示すように、走行車線Lrが撮影時走行車線Lsから道路幅方向の左側または右側に離れるほど値1から小さくなるように設定される、と言い換えることができる。このように各係数を設定する理由を次に説明する。
【0041】
まず、車速Vやハンドル操舵量Stが比較的大きい場合には、カメラ59により撮影される風景画像における特徴点の移動速度(ハンドル操舵量Stについては特に車両の旋回方向と逆方向に相当する方向への移動速度)が比較的大きく、参照データと一致する特徴点を有する風景画像を撮影可能な時間は極めて短い。言い換えると、こうした場合には、参照データDB44の参照データと一致する特徴点を有する風景画像を撮影可能な道路上の撮影位置の範囲はかなり狭い。このため、マッチング処理により風景画像と参照データとが一致していると判定される機会が少なくなり、本来は参照データと一致していると認識してもよい風景画像であるにも拘わらずそう認識することができない、いわゆる認識漏れが生じてしまう。これに対し、車速Vやハンドル操舵量Stが大きいほど車速係数k1や操舵量係数k2を小さくして、判定用基準閾値M0に各係数を乗じて得られる後述の判定用閾値Mrefを小さくすることにより、マッチング処理により判定用データと参照データとが一致していると判定されやすくすることができ(一致していると判定される機会を増やすことができ)、本来一致していると認識してもよい風景画像の認識漏れを抑制する(認識率を高める)ことができる。
【0042】
また、走行車線Lrが道路脇に近い場合は、走行している道路の幅方向において車両位置が中央より左側または右側の道路脇に近い場合であり、カメラ59により撮影される風景画像における近い道路脇側の特徴点(道路の幅方向中央より左側の道路脇に近い場合には画像左側の特徴点,道路の幅方向中央より右側の道路脇に近い場合には画像右側の特徴点)の移動速度が比較的大きく、風景画像の認識漏れが生じやすい場合である。したがって、走行車線Lrが道路脇に近いほど走行車線係数k3を小さくして判定用閾値Mrefを小さくすることにより、判定用データと参照データとが一致していると判定されやすくすることができ、風景画像の認識漏れを抑制することができる。さらに、走行車線差ΔLの絶対値が大きい場合(走行車線Lrが撮影時走行車線Lsから離れる場合)は、走行している道路の幅方向において車両位置が参照データを得た風景画像の撮影時の車両位置より離れている側の道路脇に近い場合であり、カメラ59により撮影される風景画像における特徴点(参照データを得た風景画像の撮影時の車両位置から左側に離れる場合には画像左側の特徴点,参照データを得た風景画像の撮影時の車両位置から右側に離れる場合には画像右側の特徴点)の移動速度が比較的大きく、風景画像の認識漏れが生じる要因となる。したがって、走行車線差ΔLの絶対値が小さいほど走行車線差係数k4を小さくして判定用閾値Mrefを小さくすることにより、判定用データと参照データとが一致していると判定されやすくすることができ、風景画像の認識漏れを抑制することができる。
【0043】
続いて、入力した車線数Ln,車線幅Lw,歩道幅Pwの各パラメータに基づいてそれぞれ判定用基準閾値M0に乗じるべき車線数係数k5,車線幅係数k6,歩道幅係数k7を設定し(ステップS160)、入力した道路形状がカーブ形状のときには曲率半径Rに基づいて判定用基準閾値M0に乗じるべき曲率半径係数k8を設定すると共に入力した道路形状が直線形状のときには曲率半径半径係数k8に値1を設定し(ステップS170)、入力した最寄りの交差点からの距離Dcに基づいて判定用基準閾値M0に乗じるべき交差点距離係数k9を設定する(ステップS180)。ここで、各係数は、実施例では、パラメータと係数との関係を予め定めて係数毎に係数設定用マップとしてROM34に記憶しておき、パラメータが与えられると記憶したマップから対応する係数を導出して設定するものとした。
【0044】
図9に判定用閾値Mrefを設定するためのパラメータと係数との複数の関係の一例を示す。図中、右側は係数設定用マップの一例である。図示するように、車線数Lnが少ないほど車線数係数k5が値1を跨いで小さくなり、車線幅Lwが狭いほど車線幅係数k6が値1を跨いで小さくなり、歩道幅Pwが狭いほど歩道幅係数k7が値1を跨いで小さくなり、道路形状がカーブ形状の場合に曲率半径Rが小さいほど曲率半径係数k8が値1を跨いで小さくなり、最寄りの交差点からの距離Dcが後述する所定距離D1未満の範囲で短いほど交差点距離係数k9が値1未満の範囲で小さくなるように、各パラメータに基づいて各係数が設定される。なお、歩道幅係数k7については、歩道幅Pwが値0で走行している道路に歩道がない場合には歩道幅係数k7の予め定められた値1未満の下限値が設定されるものとした。また、交差点距離係数k9については、最寄りの交差点からの距離Dcが所定距離D1以上の場合には値1が設定されるものとした。このように各係数を設定する理由を次に説明する。
【0045】
まず、走行している道路の幅員が比較的小さい場合には、カメラ59により撮影される風景画像における特徴点の移動速度が比較的大きく、風景画像の認識漏れが生じやすい。これに対し、道路の幅員が比較的が小さい場合には判定用閾値Mrefを小さくすれば、判定用データと参照データとが一致していると判定されやすくすることができる。道路の幅員が比較的小さい場合としては、道路の車線数が少ない場合,車線幅が狭い場合,歩道幅が狭い場合などを考えることができるから、実施例では、車線数Lnが少ないほど,車線幅Lwが狭いほど,歩道幅Pwが狭いほど、各係数を小さくして判定用閾値Mrefを小さくすることにより、風景画像の認識漏れを抑制することができる。
【0046】
また、走行している道路がカーブ形状で曲率半径Rが比較的小さい場合には、カメラ59により撮影される風景画像における特徴点の移動速度(特に車両の旋回方向と逆方向に相当する方向への移動速度)が比較的大きく、参照データと一致する特徴点を有する風景画像を撮影可能な道路上の撮影位置の範囲はかなり狭いため、やはり風景画像の認識漏れが生じやすい。これに対し、道路の曲率半径Rが小さいほど曲率半径係数k8を小さくして判定用閾値Mrefを小さくするから、判定用データと参照データとが一致していると判定されやすくすることができ、風景画像の認識漏れを抑制することができる。さらに、図10に示す車両が交差点を左折して走行する様子の一例から分かるように、車両が交差点を右折または左折して道路に進入するときには、車両は道路方向に対して斜めに道路に進入し、車両がある程度進んでから道路方向と略一致する方向に進むことになる。このため、実施例では、道路上で最寄りの交差点からの距離Dcが所定距離D1未満の範囲で短いほど交差点距離係数k9を小さくして判定用閾値Mrefを小さくするから、判定用データと参照データとが一致していると判定されやすくすることができ、風景画像の認識漏れを抑制することができる。したがって、所定距離D1は、交差点を右左折した車両が進入した道路で道路方向と略一致する方向に走行する状態となるまでの距離として予め実験や解析により定められた距離を用いることができる。
【0047】
こうして閾値k1〜k9を設定すると、判定用基準閾値M0に全ての閾値k1〜k9を乗じたものを判定用閾値Mrefに設定し(ステップS190)、判定用データと参照データとの一致率Mを計算し(ステップS200)、計算した一致率Mと判定用閾値Mrefとを比較する(ステップS210)。ここで、一致率Mは、判定用データと参照データとが一致する程度を表すものであり、例えば、二値化画像として両データ(総画素数と縦横比は同じとする)の対応する画素を比較し、値(値0または値1)が一致する画素数の総画素数に対する割合などとして計算することができる。
【0048】
計算した一致率Mが判定用閾値Mref未満のときには、判定用データと参照データとは一致していないと判断し、推定自車位置および車両進行方位と一致する撮影位置および撮影方位の参照データおよび道路上その前後2つの参照データの合計3つの参照データと、1つの判定用データと、の合計3回の判定処理を行なったか否かを判定する(ステップS220)。合計3回の判定処理を行なっていない場合には、ステップS100に戻り、判定用データについては代えることなく、先にステップS100で入力した推定自車位置および車両進行方位と一致する撮影位置および撮影方位の参照データに代えて、この撮影位置の道路上で車両進行方向1つ後の参照データ(1つ先の参照データ)を入力して、ステップS100〜S210の処理を繰り返す。再び、一致率Mが判定用閾値Mref未満で合計3回の判定処理を行なっていない場合には(ステップS210,S220)、ステップS100に戻り、判定用データについては代えることなく、最初にステップS100で入力した推定自車位置および車両進行方位と一致する撮影位置および撮影方位の参照データに代えて、この撮影位置の道路上で車両進行方向1つ前の参照データを入力して、ステップS100〜S210の処理を繰り返す。
【0049】
こうして一致率Mが判定用閾値Mref未満との判定結果を繰り返し3回得たときには(ステップS210,S220)、推定自車位置を自車位置と判定して(ステップS230)、自車位置判定処理ルーチンを終了する。一方、こうした処理を3回繰り返している最中に一致率Mが判定用閾値Mref以上と判定されたときには、そのときに判定用データと一致した参照データに対応する撮影位置を自車位置と判定して(ステップS240)、自車位置判定処理ルーチンを終了する。こうした処理により、ロケーション処理においてGPS航法や自律航法などにより推定された推定自車位置より正確な自車位置を特定することができる。なお、こうして自車位置が特定されると、特定された自車位置を基準としてGPS航法や自律航法などにより次の自車位置の推定が行なわれる。
【0050】
なお、本ルーチンの各ステップの処理は、基本的に電子制御ユニット30のロケーション処理部60により行なわれ、ステップS100の入力処理における判定用データの作成は電子制御ユニット30の画像処理部66により行なわれる。
【0051】
以上説明した実施例のナビゲーション装置20によれば、道路上で走行方向に間隔をもって車載されたカメラ59から撮影された風景画像の特徴点を抽出して得られる複数の参照データをそれぞれ対応する撮影位置と関連付けて参照データDB44に記憶しておき、車載されたカメラ59から撮影される風景画像と複数の参照データとが一致しているか否かを判定するマッチング処理を行ない、マッチング処理により一致していると判定された参照データに対応する撮影位置に基づいて車両の現在位置である自車位置を判定するものにおいて、マッチング処理は、カメラ59から撮影される風景画像に対して特徴点を抽出する所定の画像処理を施して得られる判定用データと参照データとの一致率Mが判定用閾値Mref以上のときに一致していると判定し、一致率Mが判定用閾値Mref未満のときに一致していないと判定することにより行なわれ、判定用閾値Mrefは、車速Vが大きいほど小さくなるように且つハンドル操舵量Stが大きいほど小さくなるように調整されているから、マッチング処理により判定用データと参照データとが一致していると判定されやすくすることができる。この結果、自車位置をより適正に判定することができる。
【0052】
また、実施例のナビゲーション装置20によれば、走行車線Lrが走行している道路の道路脇に近いほど小さくなるように、即ち、走行している道路の幅方向における車両位置が走行している道路の道路脇に近いほど小さくなるように、判定用閾値Mrefを調整するから、判定用データと参照データとが一致しているとより判定されやすくすることができ、風景画像のいわゆる認識漏れをより抑制することができる。さらに、走行車線差ΔLの絶対値が大きいほど(走行車線Lrが撮影時走行車線Lsから離れるほど)小さくなるように、即ち、走行している道路の幅方向において車両位置が参照データを得た風景画像の撮影時の車両位置から離れるほど小さくなるように、判定用閾値Mrefを調整するから、判定用データと参照データとが一致していると更に判定されやすくすることができ、風景画像の認識漏れを更に抑制することができる。
【0053】
しかも、実施例のナビゲーション装置20によれば、走行している道路の幅員が小さいほど(具体的には、車線数Lnが小さいほど,車線幅Lwが狭いほど,歩道幅Pwが狭いほど)小さくなるように、また、走行している道路がカーブ形状で曲率半径Rが小さいほど小さくなるように、さらに、走行している道路上で最寄りの交差点からの距離Dcが短いほど小さくなるように、判定用閾値Mrefを調整するから、判定用データと参照データとが一致していると判定されやすくすることができ、風景画像の認識漏れをより抑制することができる。この結果、自車位置を更に適正に判定することができる。
【0054】
実施例のナビゲーション装置20では、判定用データと参照データとの一致率Mの判定に用いる判定用閾値Mrefは、車速Vが大きいほど,ハンドル操舵量Stが大きいほど,走行車線Lrが道路脇に近いほど,走行車線差ΔLの絶対値が大きいほど,車線数Lnが少ないほど,車線幅Lwが狭いほど,歩道幅Pwが狭いほど,曲率半径Rが小さいほど,最寄りの交差点からの距離Dcが短いほど小さくなるように調整されるものとした、即ち、9個のパラメータに基づいて調整されるものとしたが、道路の車線数Lnと車線幅Lwと歩道幅Pwとに基づく調整に代えてまたは加えて、判定用閾値Mrefを、道路の幅員Dwが狭いほど短くなるように調整するものとしてもよい。また、判定用閾値Mrefを、これら9個のパラメータに道路の幅員Dwを加えた計10個のパラメータのうち任意の一部(1個以上)のパラメータのみに基づいて調整するものとしてもよいし、10個のパラメータに加えて他のパラメータにも基づいて調整するものとしてもよい。
【0055】
したがって、例えば、判定用データと参照データとの一致率Mの判定に用いる判定用閾値Mrefは、車速Vおよびハンドル操舵量St以外のパラメータに基づいて調整されることなく、車速Vが大きいほど小さくなり且つハンドル操舵量Stが大きいほど小さくなるように調整されるものとしてもよい。また、判定用閾値Mrefは、走行車線Lr以外のパラメータに基づいて調整されることなく、走行車線Lrが道路脇に近いほど小さくなるように調整されるものとしてもよい。さらに、判定用閾値Mrefは、走行車線差ΔL以外のパラメータに基づいて調整されることなく、走行車線差ΔLの絶対値が大きいほど小さくなるように調整されるものとしてもよい。
【0056】
実施例のナビゲーション装置20では、判定用データと参照データとの一致率Mの判定に用いる判定用閾値Mrefは、走行車線Lrが道路脇に近いほど小さくなるように調整されるものとしたが、走行している道路の幅方向において車両位置が道路脇に近いほど判定用閾値Mrefを小さく調整すればよいから、走行車線Lrを検出することなく、道路の幅方向における車両位置を判定用データに対する画像処理により検出してこの検出位置に基づいて判定用閾値Mrefを調整するものとしてもよい。
【0057】
実施例のナビゲーション装置20では、判定用データと参照データとの一致率Mの判定に用いる判定用閾値Mrefは、走行車線Lrが撮影時走行車線Lsから離れるほど小さくなるように調整されるものとしたが、走行している道路の幅方向において車両位置が参照データを得た風景画像の撮影時の車両位置から離れるほど判定用閾値Mrefを小さく調整すればよいから、走行車線Lrを検出することなく、道路の幅方向における車両位置を判定用データに対する画像処理により検出してこの検出位置に基づいて判定用閾値Mrefを調整するものとしてもよい。
【0058】
実施例のナビゲーション装置20では、判定用データと参照データとの一致率Mを判定用閾値Mrefと比較して自車位置を判定するものとしたが、判定用データと参照データとをそれぞれ車両からみて左側のデータと右側のデータとに分割してから、左側と右側とでそれぞれ一致率と判定用閾値とを比較して自車位置を判定するものとしてもよい。この場合、図4の自車位置判定処理ルーチンに代えて、図11の自車位置判定処理ルーチンを実行すればよい。図11のルーチンでは、図4のルーチンのステップS150の処理に代えてステップS300の処理を実行し、図4のルーチンのステップS190〜S210の処理に代えてステップS310〜S340の処理を実行する点を除いて、図4のルーチンと同一である。したがって、同一の処理については同一のステップ番号を付し、その詳細な説明は省略する。
【0059】
図11のルーチンでは、車速係数k1と操舵量係数k2と走行車線係数k3とを設定すると(ステップS130,S140)、計算した走行車線差ΔLに基づいて、風景画像内左側の判定を行なうための左側走行車線差係数k4Lと風景画像内右側の判定を行なうための右側走行車線差係数k4Rとをそれぞれ設定し(ステップS300)、他の係数k5〜k9を設定する(ステップS160〜S180)。左側走行車線差係数k4Lは、走行車線差ΔLと左側走行車線差係数k4Lとの関係を予め定めてROM34に記憶された左側走行車線差係数設定用マップを用いて設定され、右側走行車線差係数k4Rは、走行車線差ΔLと右側走行車線差係数k4Rとの関係を予め定めてROM34に記憶された右側走行車線差係数設定用マップを用いて設定される。図12に左側走行車線差係数設定用マップの一例を示し、図13に右側走行車線差係数設定用マップの一例を示す。各マップの内容については後述する。
【0060】
続いて、車速係数k1と操舵量係数k2と走行車線係数k3と左側走行車線差係数k4Lと他の係数k5〜k9とを乗じたものを左側判定用閾値MLrefに設定すると共に、車速係数k1と操舵量係数k2と走行車線係数k3と右側走行車線差係数k4Rと他の係数k5〜k9とを乗じたものを右側判定用閾値MLrefに設定し(ステップS310)、判定用データを車両からみた画像データとして左側の左側判定用データと右側の右側判定用データとに分割すると共に、参照データを車両からみた画像データとして左側の左側参照データと右側の右側参照データとに分割する(ステップS320)。図14に参照データを左側参照データと右側参照データとに分割する様子の一例を示す。図14の例では、参照データは、左側と右側とに半分ずつに分割されている。判定用データも参照データと同様に分割されるものとした。なお、参照データは予め分割したものをHDD40の参照データDB44に記憶しておくものとしてもよい。
【0061】
次に、左側判定用データと右側参照データとの一致率MLを前述の一致率Mと同様に計算すると共に、右側判定用データと右側参照データとの一致率MRを前述の一致率Mと同様に計算し(ステップS320)、計算した一致率MLを左側判定用閾値MLrefと比較すると共に一致率MRを右側判定用閾値MRrefと比較する(ステップS340)。そして、ステップS100〜S340の処理を異なる参照データを用いて3回繰り返す間に、一致率MLが左側用判定閾値MLref未満または一致率MRが右側判定用閾値MRref未満と続けて3回判定されたときには、推定自車位置を自車位置と判定する(ステップS230)。一方、ステップS100〜S340の処理を異なる参照データを用いて3回繰り返す間に、一致率MLが左側用判定閾値MLref以上且つ一致率MRが右側判定用閾値MRref以上と判定されたときには、そのときに判定用データと一致した参照データに対応する撮影位置を自車位置と判定して(ステップS240)、自車位置判定処理ルーチンを終了する。
【0062】
ここで、図12および図13に例示した左側走行車線差係数設定用マップおよび右側走行車線差係数設定用マップについて説明する。図12に示すように、左側走行車線差係数k4Lは、走行車線差ΔLが値0以上のとき、即ち、走行車線Lrが撮影時走行車線Lsと同じであるか撮影時走行車線Lsより右側の車線であるときには、値1が設定される。また、左側走行車線差係数k4Lは、走行車線差ΔLが値0未満で小さいほど小さくなるように設定される、即ち、走行車線Lrが撮影時走行車線Lsより左側に離れるほど小さくなるように設定される。これは、走行車線Lrが撮影時走行車線Lsに比して道路の幅方向において左側に離れるほど、カメラ59により撮影される風景画像における左側の特徴点の移動速度が比較的大きくなる傾向があり、この傾向が、風景画像の認識漏れが生じる要因となることに基づく。また、図13に示すように、右走行車線差係数k4Rは、走行車線差ΔLが値0以下のとき、即ち、走行車線Lrが撮影時走行車線Lsと同じであるか撮影時走行車線Lsより左側の車線であるときには、値1が設定される。また、右側走行車線差係数k4Rは、走行車線差ΔLが値0より大きいほど小さくなるように設定される、即ち、走行車線Lrが撮影時走行車線Lsより右側に離れるほど小さくなるように設定される。これは、走行車線Lrが撮影時走行車線Lsに比して道路の幅方向において右側に離れるほど、カメラ59により撮影される風景画像における右側の特徴点の移動速度が比較的大きくなる傾向があり、この傾向が、風景画像の認識漏れが生じる要因となることに基づく。こうした係数を用いて設定される左側判定用閾値Mrefと右側判定用閾値Mrefとをそれぞれ左側の一致率MLと右側の一致率MRとの比較に用いて自車位置を判定するから、風景画像の認識漏れが抑制され、より適正に自車位置を判定することができる。
【0063】
実施例では、本発明の位置判定装置をディスプレイ22やHDD40を備えるナビゲーション装置20に適用して説明したが、例えば、ディスプレイを備えるナビゲーション装置と通信可能に接続されたサーバに電子制御ユニット30のロケーション処理部60の機能とロケーション処理に必要な画像処理部66の機能の一部とを行なわせるようにして、このサーバを本発明の位置判定装置として機能させるものとしてもよい。また、ナビゲーション装置20に代えて、デジタルカメラや携帯端末,ドライブレコーダなどの機器を本発明の位置判定装置として機能させるものとしてもよい。この場合、こうした機器を車室内に設置してこの機器が備えるカメラにより撮影される風景画像を用いて自車位置を判定するようにしてもよい。
【0064】
また、実施例では、本発明の位置判定装置をナビゲーション装置20に適用して説明したが、位置判定方法の形態としてもよいし、こうした位置判定方法の各ステップを1以上のコンピュータに実現させるためのプログラムの形態としてもよい。また、こうしたプログラムを記録媒体に記憶させた形態としても構わない。
【0065】
実施例の主要な要素と課題を解決するための手段の欄に記載した発明の主要な要素との対応関係について説明する。実施例では、複数の参照データをHDD40の参照データDB42に記憶しておき車載されたカメラ59から撮影される風景画像と複数の参照データとが一致しているか否かを判定するマッチング処理を行なって一致していると判定された参照データに対応する撮影位置に基づいて自車位置を判定する図4や図11の自車位置判定処理ルーチンを実行する電子制御ユニット30のロケーション処理部60と画像処理部66の一部とが「位置判定装置」に相当する。また、判定用データを用いて走行車線Lrを検出する図4や図11の自車位置判定処理ルーチンのステップS110の処理を実行する電子制御ユニット30のロケーション処理部60が「幅方向車両位置検出手段」に相当する。
【0066】
なお、実施例の主要な要素と課題を解決するための手段の欄に記載した発明の主要な要素との対応関係は、実施例が課題を解決するための手段の欄に記載した発明を実施するための形態を具体的に説明するための一例であることから、課題を解決するための手段の欄に記載した発明の要素を限定するものではない。即ち、課題を解決するための手段の欄に記載した発明についての解釈はその欄の記載に基づいて行なわれるべきものであり、実施例は課題を解決するための手段の欄に記載した発明の具体的な一例に過ぎないものである。
【0067】
以上、本発明を実施するための形態について実施例を用いて説明したが、本発明はこうした実施例に何等限定されるものではなく、本発明の要旨を逸脱しない範囲内において、種々なる形態で実施し得ることは勿論である。
【産業上の利用可能性】
【0068】
本発明は、ナビゲーション装置や位置判定装置の製造産業などに利用可能である。
【符号の説明】
【0069】
10 ナビゲーションシステム、12 車載装置、20 ナビゲーション装置、22 ディスプレイ、24 タッチパネル、26 スピーカ、30 電子制御ユニット、32 CPU、34 ROM、36 RAM、38 フラッシュメモリ、40 ハードディスクドライブ(HDD)、42 地図データ用データベース(地図データDB)、44 参照データ用データベース(参照データDB)、50 GPS受信機、52 車速センサ、54 加速度センサ、56 方位センサ、58 操舵量センサ、59 カメラ、60 ロケーション処理部、62 地図表示処理部、64 ナビゲーション処理部、66 画像処理部。
【技術分野】
【0001】
本発明は、位置判定装置およびナビゲーション装置並びに位置判定方法,プログラムに関し、詳しくは、車載カメラから撮影された風景画像を用いて車両の地図上の位置を判定する位置判定装置およびナビゲーション装置並びに位置判定方法,プログラムに関する。
【背景技術】
【0002】
従来、この種の位置判定装置としては、道路上の白線などの道路標示を示すパターン情報と道路標示の特徴点の座標(ワールド座標)を示す位置情報とを予め対応付けて登録しておき、パターン情報を用いたパターンマッチング等により、車載カメラによる撮影画像の中に道路標示があると判定したときには、撮影画像から特徴点を抽出して、車両の暫定現在位置を基準にした自動車座標系における道路標示の特徴点の座標(自動車座標)を算出し、算出した道路標示の特徴点の自動車座標と対応する位置情報とを用いて車両の現在位置を算出するものが提案されている(例えば、特許文献1参照)。この装置では、これにより、GPS信号やジャイロ,車線センサからの信号を利用した位置測位により得られる車両の暫定現在位置よりも高精度な現在位置を算出することができるものとしている。
【先行技術文献】
【特許文献】
【0003】
【特許文献1】特開2007−108043号公報
【発明の概要】
【発明が解決しようとする課題】
【0004】
しかしながら、上述の装置により行なわれる道路標示を示すパターン情報と撮影画像とのマッチング処理や、上述の装置と同様に高精度な現在位置の算出を目的として行なわれる車両からの風景画像の特徴的部分を示すパターン情報と撮影画像とのマッチング処理は、車両が走行している最中に行なう必要があることから、車両の位置を正しく判定することができない場合があった。車両が走行している最中は、その走行環境などによっては、撮影画像における道路標示や特徴的部分の移動速度が速くなり、パターン情報と一致する撮影画像を得ることができる時間が短くなって、即ち、パターン情報と一致する撮影画像を得ることができる道路上での撮影位置の範囲が狭くなって、パターン情報と撮影画像とが一致していると判定される機会が少なくなってしまう場合があった。
【0005】
本発明の位置判定装置およびナビゲーション装置並びに位置判定方法,プログラムは、車両の地図上の位置をより適正に判定することを主目的とする。
【課題を解決するための手段】
【0006】
本発明の位置判定装置およびナビゲーション装置並びに位置判定方法,プログラムは、上述の主目的を達成するために以下の手段を採った。
【0007】
本発明の第1の位置判定装置は、
道路上で走行方向に間隔をもって車載カメラから撮影された風景画像の特徴的部分を抽出して得られる複数の参照データをそれぞれ対応する地図上の位置と関連付けて記憶しておき、車載カメラから撮影される風景画像と前記複数の参照データとが一致しているか否かを判定するマッチング処理を行ない、該マッチング処理により一致していると判定された参照データに対応する地図上の位置に基づいて車両の地図上の位置を判定する位置判定装置であって、
前記マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、前記一致の程度が前記判定用閾値未満のときに一致していないと判定することにより行なわれ、
前記判定用閾値は、車速が大きいほど小さくなる傾向に且つハンドル操舵量が大きいほど小さくなる傾向に調整されてなる、
ことを特徴とする。
【0008】
この本発明の第1の位置判定装置では、マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、一致の程度が判定用閾値未満のときに一致していないと判定することにより行なわれ、判定用閾値は、車速が大きいほど小さくなる傾向に且つハンドル操舵量が大きいほど小さくなる傾向に調整されている。車速が比較的大きい場合やハンドル操舵量が比較的大きい場合には、風景画像の中の特徴的部分(例えば、道路脇の建物や道路標識といった道路脇の地物など)の移動速度(ハンドル操舵量が比較的大きい場合には、特に車両の旋回方向と逆方向に相当する方向への移動速度)が比較的大きく、参照データと一致する特徴的部分を有する風景画像を撮影可能な時間は短い。したがって、こうした場合には、判定用閾値を小さくすることにより、マッチング処理により風景画像と参照データとが一致していると判定されやすくすることができる。この結果、車両の地図上の位置をより適正に判定することができる。ここで、所定の画像処理としては、少なくともエッジ検出処理を含むものなどを用いることができる。
【0009】
こうした本発明の第1の位置判定装置において、走行している道路の幅方向における車両位置を検出する幅方向車両位置検出手段を備え、前記判定用閾値は、前記検出された車両位置が前記走行している道路の道路脇に近いほど小さくなる傾向に調整されてなる、ものとすることもできる。これは、走行している道路の幅方向において車両位置が道路脇に近いほど、風景画像の中でその近い道路脇側(左側または右側)の特徴的部分の移動速度が大きくなる傾向があることに基づく。この場合、前記幅方向車両位置検出手段は、複数の車線を有する道路を走行しているときに走行車線を検出する手段であり、前記判定用閾値は、前記検出された走行車線が前記走行している道路の道路脇に近いほど小さくなる傾向に調整されてなる、ものとすることもできる。
【0010】
また、本発明の第1の位置判定装置において、走行している道路の幅方向における車両位置を検出する幅方向車両位置検出手段を備え、前記判定用閾値は、前記走行している道路の幅方向において前記検出された車両位置が前記参照データを得た風景画像の撮影時の車両位置から離れるほど小さくなる傾向に調整されてなる、ものとすることもできる。これは、走行している道路の幅方向において車両位置が参照データを得た風景画像の撮影時の車両位置から離れるほど、風景画像の中でその離れた方向側(左側または右側)の特徴的部分の移動速度が大きくなる傾向があることに基づく。この場合、前記幅方向車両位置検出手段は、複数の車線を有する道路を走行しているときに走行車線を検出する手段であり、前記判定用閾値は、前記検出された走行車線が前記参照データを得た風景画像の撮影時の走行車線から離れるほど小さくなる傾向に調整されてなる、ものとすることもできる。
【0011】
さらに、本発明の第1の位置判定装置において、前記判定用閾値は、走行している道路の幅員が小さいほど小さくなる傾向,走行している道路の曲率半径が小さいほど小さくなる傾向,走行している道路上で最寄りの交差点からの距離が短いほど小さくなる傾向のうち少なくともいずれかとなるように調整されてなる、ものとすることもできる。これは、走行している道路の幅員が小さいほど,走行している道路の曲率半径が小さいほど,交差点を右左折してから進入した道路上でその交差点からの距離が短いほど、風景画像の中の特徴的部分の移動速度が大きくなる傾向があることに基づく。
【0012】
あるいは、本発明の第1の位置判定装置において、前記判定用閾値は、走行している道路の車線数が少ないほど小さくなる傾向,走行している道路の車線幅が狭いほど小さくなる傾向,走行している道路の歩道幅が狭いほど小さくなる傾向のうち少なくともいずれかとなるように調整されてなる、ものとすることもできる。これは、道路の車線数が少ないほど,道路の車線幅が狭いほど,道路の歩道幅が狭いほど、道路の幅員が小さくなる傾向があると共に、走行している道路の幅員が小さいほど、風景画像の中の特徴的部分の移動速度が大きくなる傾向があることに基づく。
【0013】
車両位置が参照データを得た風景画像の撮影時の車両位置から離れるほど小さくなる傾向に判定用閾値を調整する態様の本発明の第1の位置判定装置において、前記マッチング処理は、前記判定用データを前記車両からみて左側の左側判定用データと右側の右側判定用データとに分割すると共に、前記参照データを前記車両からみて左側の左側参照データと右側の右側参照データとに分割し、前記左側判定用データと前記左側参照データとの一致の程度が左側判定用閾値以上であり、且つ、前記右側判定用データと前記右側参照データとの一致の程度が右側判定用閾値以上のときには一致していると判定し、前記左側判定用データと前記左側参照データとの一致の程度が前記左側判定用閾値未満であるか、又は、前記右側判定用データと前記右側参照データとの一致の程度が前記右側判定用閾値未満であるときには一致していないと判定することにより行なわれ、前記左側判定用閾値は、前記走行している道路の幅方向において前記検出された車両位置が前記参照データを得た風景画像の撮影時の車両位置から左側に離れるほど小さくなる傾向に調整されてなり、前記右側用判定閾値は、前記走行している道路の幅方向において前記検出された車両位置が前記参照データを得た風景画像の撮影時の車両位置から右側に離れるほど小さくなる傾向に調整されてなる、ものとすることもできる。こうすれば、より適正に判定用閾値を調整することができる。
【0014】
本発明の第2の位置判定装置は、
道路上で走行方向に間隔をもって車載カメラから撮影された風景画像の特徴的部分を抽出して得られる複数の参照データをそれぞれ対応する地図上の位置と関連付けて記憶しておき、車載カメラから撮影される風景画像と前記複数の参照データとが一致しているか否かを判定するマッチング処理を行ない、該マッチング処理により一致していると判定された参照データに対応する地図上の位置に基づいて車両の地図上の位置を判定する位置判定装置であって、
走行している道路の幅方向における車両位置を検出する幅方向車両位置検出手段
を備え、
前記マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、前記一致の程度が前記判定用閾値未満のときに一致していないと判定することにより行なわれ、
前記判定用閾値は、前記検出された車両位置が前記走行している道路の道路脇に近いほど小さくなる傾向に調整されてなる、
ことを特徴とする。
【0015】
この本発明の第2の位置判定装置では、マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、一致の程度が判定用閾値未満のときに一致していないと判定することにより行なわれ、判定用閾値は、走行している道路の幅方向における車両位置が走行している道路の道路脇に近いほど小さくなる傾向に調整されている。走行している道路の幅方向における車両位置がその道路の道路脇に比較的近い場合には、風景画像の中でその近い道路脇側(左側または右側)の特徴的部分(例えば、道路脇の建物や道路標識といった道路脇の地物など)の移動速度が比較的大きく、参照データと一致する特徴的部分を有する風景画像を撮影可能な時間は短い。したがって、こうした場合には、判定用閾値を小さくすることにより、マッチング処理により風景画像と参照データとが一致していると判定されやすくすることができる。この結果、車両の地図上の位置をより適正に判定することができる。ここで、所定の画像処理としては、少なくともエッジ検出処理を含むものなどを用いることができる。
【0016】
本発明の第3の位置判定装置は、
道路上で走行方向に間隔をもって車載カメラから撮影された風景画像の特徴的部分を抽出して得られる複数の参照データをそれぞれ対応する地図上の位置と関連付けて記憶しておき、車載カメラから撮影される風景画像と前記複数の参照データとが一致しているか否かを判定するマッチング処理を行ない、該マッチング処理により一致していると判定された参照データに対応する地図上の位置に基づいて車両の地図上の位置を判定する位置判定装置であって、
走行している道路の幅方向における車両位置を検出する幅方向車両位置検出手段
を備え、
前記マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、前記一致の程度が前記判定用閾値未満のときに一致していないと判定することにより行なわれ、
前記判定用閾値は、前記走行している道路の幅方向において前記検出された車両位置が前記参照データを得た風景画像の撮影時の車両位置から離れるほど小さくなる傾向に調整されてなる、
ことを特徴とする。
【0017】
この本発明の第3の位置判定装置では、マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、一致の程度が判定用閾値未満のときに一致していないと判定することにより行なわれ、判定用閾値は、走行している道路の幅方向において車両位置が参照データを得た風景画像の撮影時の車両位置から離れるほど小さくなる傾向に調整されている。走行している道路の幅方向において車両位置が参照データを得た風景画像の撮影時の車両位置から比較的離れている場合には、風景画像の中でその離れている方向側(左側または右側)の特徴的部分(例えば、道路脇の建物や道路標識といった道路脇の地物など)の移動速度が比較的大きく、参照データと一致する特徴的部分を有する風景画像を撮影可能な時間は短い。したがって、こうした場合には、判定用閾値を小さくすることにより、マッチング処理により風景画像と参照データとが一致していると判定されやすくすることができる。この結果、車両の地図上の位置をより適正に判定することができる。ここで、所定の画像処理としては、少なくともエッジ検出処理を含むものなどを用いることができる。
【0018】
本発明のナビゲーション装置は、上述のいずれかの態様の本発明の位置判定装置、即ち、基本的には、道路上で走行方向に間隔をもって車載カメラから撮影された風景画像の特徴的部分を抽出して得られる複数の参照データをそれぞれ対応する地図上の位置と関連付けて記憶しておき、車載カメラから撮影される風景画像と前記複数の参照データとが一致しているか否かを判定するマッチング処理を行ない、該マッチング処理により一致していると判定された参照データに対応する地図上の位置に基づいて車両の地図上の位置を判定する位置判定装置であって、前記マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、前記一致の程度が前記判定用閾値未満のときに一致していないと判定することにより行なわれ、前記判定用閾値は、車速が大きいほど小さくなる傾向に且つハンドル操舵量が大きいほど小さくなる傾向に調整されてなる、第1の位置判定装置、または、走行している道路の幅方向における車両位置を検出する幅方向車両位置検出手段を備え、前記マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、前記一致の程度が前記判定用閾値未満のときに一致していないと判定することにより行なわれ、前記判定用閾値は、前記検出された車両位置が前記走行している道路の道路脇に近いほど小さくなる傾向に調整されてなる、第2の位置判定装置、または、走行している道路の幅方向における車両位置を検出する幅方向車両位置検出手段を備え、前記マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、前記一致の程度が前記判定用閾値未満のときに一致していないと判定することにより行なわれ、前記判定用閾値は、前記走行している道路の幅方向において前記検出された車両位置が前記参照データを得た風景画像の撮影時の車両位置から離れるほど小さくなる傾向に調整されてなる、第3の位置判定装置、を備え、該位置判定装置により判定された車両の地図上の位置を用いて目的地への経路案内を行なう、ことを要旨とする。
【0019】
この本発明のナビゲーション装置では、上述のいずれかの態様の本発明の位置判定装置を備えるから、上述の位置判定装置が奏する効果、例えば、車両の地図上の位置をより適正に判定することができる効果などと同様の効果を奏することができる。
【0020】
本発明の第1の位置判定方法は、
道路上で走行方向に間隔をもって車載カメラから撮影された風景画像の特徴的部分を抽出して得られる複数の参照データをそれぞれ対応する地図上の位置と関連付けて記憶しておき、車両から撮影される風景画像と前記複数の参照データとが一致しているか否かを判定するマッチング処理を行なうステップと、該マッチング処理により一定していると判定された参照データに対応する地図上の位置に基づいて車両の地図上の位置を判定するステップと、を含む位置判定方法であって、
前記マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、前記一致の程度が前記判定用閾値未満のときに一致していないと判定することにより行なわれ、
前記判定用閾値は、車速が大きいほど小さくなる傾向に且つハンドル操舵量が大きいほど小さくなる傾向に調整されてなる、
ことを特徴とする。
【0021】
この本発明の第1の位置判定方法では、マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、一致の程度が判定用閾値未満のときに一致していないと判定することにより行なわれ、判定用閾値は、車速が大きいほど小さくなる傾向に且つハンドル操舵量が大きいほど小さくなる傾向に調整されている。車速が比較的大きい場合やハンドル操舵量が比較的大きい場合には、風景画像の中の特徴的部分(例えば、道路脇の建物や道路標識といった道路脇の地物など)の移動速度(ハンドル操舵量が比較的大きい場合には、特に車両の旋回方向と逆方向に相当する方向への移動速度)が比較的大きく、参照データと一致する特徴的部分を有する風景画像を撮影可能な時間は短い。したがって、こうした場合には、判定用閾値を小さくすることにより、マッチング処理により風景画像と参照データとが一致していると判定される機会を増やすことができる。この結果、車両の地図上の位置をより適正に判定することができる。ここで、所定の画像処理としては、少なくともエッジ検出処理を含むものなどを用いることができる。
【0022】
本発明の第2の位置判定方法は、
道路上で走行方向に間隔をもって車載カメラから撮影された風景画像の特徴的部分を抽出して得られる複数の参照データをそれぞれ対応する地図上の位置と関連付けて記憶しておき、車両から撮影される風景画像と前記複数の参照データとが一致しているか否かを判定するマッチング処理を行なうステップと、該マッチング処理により一定していると判定された参照データに対応する地図上の位置に基づいて車両の地図上の位置を判定するステップと、を含む位置判定方法であって、
前記マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、前記一致の程度が前記判定用閾値未満のときに一致していないと判定することにより行なわれ、
前記判定用閾値は、走行している道路の幅方向における車両位置が前記走行している道路の道路脇に近いほど小さくなる傾向に調整されてなる、
ことを特徴とする。
【0023】
この本発明の第2の位置判定方法では、マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、一致の程度が判定用閾値未満のときに一致していないと判定することにより行なわれ、判定用閾値は、走行している道路の幅方向における車両位置が走行している道路の道路脇に近いほど小さくなる傾向に調整されている。走行している道路の幅方向における車両位置がその道路の道路脇に比較的近い場合には、風景画像の中でその近い道路脇側(左側または右側)の特徴的部分(例えば、道路脇の建物や道路標識といった道路脇の地物など)の移動速度が比較的大きく、参照データと一致する特徴的部分を有する風景画像を撮影可能な時間は短い。したがって、こうした場合には、判定用閾値を小さくすることにより、マッチング処理により風景画像と参照データとが一致していると判定されやすくすることができる。この結果、車両の地図上の位置をより適正に判定することができる。ここで、所定の画像処理としては、少なくともエッジ検出処理を含むものなどを用いることができる。
【0024】
本発明の第3の位置判定方法は、
道路上で走行方向に間隔をもって車載カメラから撮影された風景画像の特徴的部分を抽出して得られる複数の参照データをそれぞれ対応する地図上の位置と関連付けて記憶しておき、車両から撮影される風景画像と前記複数の参照データとが一致しているか否かを判定するマッチング処理を行なうステップと、該マッチング処理により一定していると判定された参照データに対応する地図上の位置に基づいて車両の地図上の位置を判定するステップと、を含む位置判定方法であって、
前記マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、前記一致の程度が前記判定用閾値未満のときに一致していないと判定することにより行なわれ、
前記判定用閾値は、走行している道路の幅方向において車両位置が前記参照データを得た風景画像の撮影時の車両位置から離れるほど小さくなる傾向に調整されてなる、
ことを特徴とする。
【0025】
この本発明の第3の位置判定方法では、マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、一致の程度が判定用閾値未満のときに一致していないと判定することにより行なわれ、判定用閾値は、走行している道路の幅方向において車両位置が参照データを得た風景画像の撮影時の車両位置から離れるほど小さくなる傾向に調整されている。走行している道路の幅方向において車両位置が参照データを得た風景画像の撮影時の車両位置から比較的離れている場合には、風景画像の中でその離れている方向側(左側または右側)の特徴的部分(例えば、道路脇の建物や道路標識といった道路脇の地物など)の移動速度が比較的大きく、参照データと一致する特徴的部分を有する風景画像を撮影可能な時間は短い。したがって、こうした場合には、判定用閾値を小さくすることにより、マッチング処理により風景画像と参照データとが一致していると判定されやすくすることができる。この結果、車両の地図上の位置をより適正に判定することができる。ここで、所定の画像処理としては、少なくともエッジ検出処理を含むものなどを用いることができる。
【0026】
本発明のプログラムは、上述した第1〜第3の位置判定方法の各ステップを1以上のコンピュータに実現させるためのものである。このプログラムは、コンピュータが読み取り可能な記録媒体(例えばハードディスク、ROM、FD、CD、DVDなど)に記録されていてもよいし、伝送媒体(インターネットやLANなどの通信網)を介してあるコンピュータから別のコンピュータへ配信されてもよいし、その他どのような形で授受されてもよい。このプログラムを一つのコンピュータに実行させるか又は複数のコンピュータに分担して実行させれば、上述した位置判定方法の各ステップが実現されるため、その位置判定方法と同様の作用効果が得られる。
【図面の簡単な説明】
【0027】
【図1】本発明の一実施例としてのナビゲーション装置20を含むナビゲーションシステム10の構成の概略を示す構成図である。
【図2】風景画像とのマッチング処理に用いられる参照データを作成する様子の一例を説明する説明図である。
【図3】道路とその幅員Dw,歩道幅Pw,車線幅Lwとの複数の関係の一例を説明する説明図である。
【図4】電子制御ユニット30により実行される自車位置判定処理ルーチンの一例を示すフローチャートである。
【図5】道路における最寄りの交差点からの距離Dcの一例を示す説明図である。
【図6】判定用閾値Mrefをを設定するためのパラメータと係数との複数の関係の一例を説明する説明図である。
【図7】走行車線係数k3の係数設定用マップの例を示す説明図である。
【図8】走行車線差係数k4を設定する様子の例を説明する説明図である。
【図9】判定用閾値Mrefを設定するためのパラメータと係数との複数の関係の一例を説明する説明図である。
【図10】車両が交差点を左折して走行する様子の一例を説明する説明図である。
【図11】変形例の電子制御ユニット30により実行される自車位置判定処理ルーチンの一例を示すフローチャートである。
【図12】左側走行車線差係数設定用マップの一例を示す説明図である。
【図13】右側走行車線差係数設定用マップの一例を示す説明図である。
【図14】参照データを左側参照データと右側参照データとに分割する様子の一例を示す説明図である。
【発明を実施するための形態】
【0028】
次に、本発明を実施するための形態を実施例を用いて説明する。
【実施例】
【0029】
図1は、本発明の一実施例としてのナビゲーション装置20を含むナビゲーションシステム10の構成の概略を示す構成図である。実施例のナビゲーションシステム10は、図示しない車両(自動車)に搭載された各種センサを中心とする車載装置12と、図示しない車載バッテリからの電力供給を受けて作動するナビゲーション装置20とを備える。実施例のナビゲーション装置20は、図示するように、文字や画像を表示する矩形状の画面を有する例えば液晶ディスプレイや有機エレクトロルミネッセンスディスプレイなどとして構成されたディスプレイ22と、ディスプレイ22の画面に取り付けられた例えば抵抗膜方式や静電容量方式などによるタッチパネル24と、装置全体をコントロールする電子制御ユニット30と、各種アプリケーションソフトウェアや地図データなどを記憶する大容量メモリとしてのハードディスクドライブ(以下、HDDという)40とを備える。
【0030】
電子制御ユニット30は、CPU32を中心とするマイクロプロセッサとして構成されており、CPU32の他に各種処理プログラムを記憶するROM34と、データを一時的に記憶するRAM36と、記憶したデータを保持する不揮発性のフラッシュメモリ38と、図示しない入出力ポートとを備える。電子制御ユニット30には、操作者のタッチ位置を検出するタッチパネル24からの信号やHDD40から読み出したデータの他に、車載装置12からの各種信号が車内ネットワーク経由で入力ポートを介して入力されている。車載装置12からの信号としては、GPS(Global Positioning System)衛星からの信号をGPSアンテナを介して受信するGPS受信機50からの信号,車両の駆動軸や車輪が一定量回転する毎にパルス信号を出力する車速センサ52からの信号,車両の加速度を検出する加速度センサ54からの信号,車両の進行方位やその変化を検出する例えばジャイロセンサにより構成された方位センサ56からの信号,車両のハンドルの基準位置(進行方向に相当する位置)からの回転量(回転角)をハンドル操舵量として検出する操舵量センサ58からの信号,車両前方に設置されて車両前方の風景画像を動画や静止画として撮影可能なカメラ59からの信号(撮影画像)などがある。電子制御ユニット30からは、ディスプレイ22への表示信号やアンプを内蔵したスピーカ26への音声信号,HDD40に書き込むデータなどが出力ポートを介して出力されている。
【0031】
実施例のナビゲーション装置20では、電子制御ユニット30は、HDD40から必要なアプリケーションソフトウェアや地図データを読み出して各種処理を実行する。例えば、ハードウェア又はソフトウェア或いはその組み合わせにより実現される機能を表す図1の機能ブロックに示すように、電子制御ユニット30は、GPS受信機50からの信号や方位センサ56からの信号などに基づいて車両の現在位置である自車位置を判定するロケーション処理部60によるロケーション処理,地図データを用いてディスプレイ22に地図を表示する地図表示処理部62による地図表示処理,判定された自車位置から目的地への走行ルートを探索して地図表示処理部62による地図表示やスピーカ26からの音声出力によりルート案内を行なうナビゲーション処理部64によるナビゲーション処理,これらの処理に用いられる画像処理部66による各種画像処理などを実行する。なお、地図データは、HDD40の地図データ用データベース(以下、地図データDBという)42に記憶されている。
【0032】
電子制御ユニット30によるロケーション処理では、GPS受信機50からのGPS信号に基づいていわゆるGPS航法により自車位置を算出したり、GPS信号を受信できない場合などに車速センサ52からの車速パルス信号や加速度センサ54からの車両の加速度,方位センサ56からの車両の方位に基づいていわゆる自律航法により自車位置を算出したり、算出された自車位置が地図の道路上から外れた場合などに地図データを用いて自車位置を道路上の位置に補正するいわゆるマップマッチングを行なったりして、自車位置を推定する。さらに、ロケーション処理では、カメラ59により撮影される風景画像と予めHDD40に記憶された複数の参照データとが一致しているか否かを判定する画像認識処理としてのマッチング処理を行ない、マッチング処理により一致していると判定された参照データに関連付けられた地図上の位置を、GPS航法や自律航法などにより推定した自車位置に代えて、正しい自車位置と判定する。ここで、HDD40に記憶された複数の参照データは、実際に走行した車両の車載カメラから道路上で走行方向に間隔をもって撮影された風景画像の特徴点(例えば、道路脇の建物の輪郭,窓枠,看板や道路標識といった道路脇の地物,道路標示など)を抽出して得られるデータであり、風景画像を撮影したときの自車位置などの撮影情報と共に、HDD40の参照データ用データベース(以下、参照データDBという)44に記憶されている。
【0033】
ここで、カメラ59により撮影される風景画像とのマッチング処理に用いられる参照データを作成する方法を説明する。図2は、風景画像とのマッチング処理に用いられる参照データを作成する様子の一例を説明する説明図である。実施例では、図中上部に示すように、参照データ作成用の車両は、道路上で予め定められた参照データ間隔Dをもって車載カメラから車両前方の風景画像を撮影しながら走行し、風景画像の撮影時における車両の地図上の位置(緯度及び経度)と車両の方位(道路方向に沿った方位)とを各種センサからの信号などに基づいて正確な情報として取得する。参照データ間隔Dは、実施例では、ロケーション処理により実施例のナビゲーション装置20が備える電子制御ユニット30の演算量が過大にならない範囲内で、多くの道路で正確な自車位置を得ることができる道路上の間隔として、電子制御ユニット30やHDD40の性能などに基づいて予め実験や解析により定められたもの(例えば、数十mなど)を用いるものとした。続いて、図中下部左側に示すように、車載された電子制御ユニットにより、撮影された風景画像に対してエッジ検出処理などを施すことにより風景画像の特徴点を抽出して二値化した特徴点画像を作成し、作成した特徴点画像に対して風景画像認識に適した特徴点を強調したり強調した特徴点周辺の特徴点を破棄したりする強調処理や、ノイズ除去処理などを施して、参照データを作成する。また、撮影された風景画像から参照データを作成する際に、特徴点画像に対して道路上の白線や矢印などの道路標示が強調されるよう強調処理を施すことにより、風景画像の撮影時における走行車線の検出を行なう。エッジ検出処理や強調処理,ノイズ除去処理などの周知な画像処理手法については、これ以上詳細な説明は省略する。こうして作成された複数の参照データは、図中中段右側に示すように、実施例の車両に搭載されたナビゲーション装置20のHDD40の参照データDB44に、参照データ毎に撮影時の車両の位置,車両の方位,走行車線(以下、それぞれ撮影位置,撮影方位,撮影時走行車線という)と関連付けられて記憶される。
【0034】
なお、HDD40の地図データDB42には、道路情報や施設情報などが含まれ、道路情報には、例えば各道路の両端のノードが示す地図上の位置(緯度及び経度),各道路の距離,地域(市街地,郊外),種別(一般道路,高速道路),勾配,信号機の数の他に、図2中下部右側に示すように、各道路の幅員Dw,車線数Ln,車線幅Lw,歩道幅Pw,道路形状(直線またはカーブ),曲率半径R,道路種類(一方通行道路,対面通行道路,中央分離帯のある道路等),前述の参照データ間隔Dなどが含まれる。図3は、道路とその幅員Dw,歩道幅Pw,車線幅Lwとの複数の関係の一例を説明する説明図である。図中、左側の(a)は道路種類が対面通行道路で片側3車線の車線数Lnが値6の道路を示し、中央の(b)は道路種類が一方通行道路(例えば高速道路や高架道路などの場合)で車線数Lnが値3の道路を示し、右側の(c)は道路種類が一方通行道路で車線数Lnが値4の道路を示す。図3では、道路の歩道幅Pwは左右両側で等しく車線幅Lwは全て等しいものとして示したが、全ての道路について同一の基準に基づくものであれば、例えば、歩道幅Pwは左右両側の歩道幅の平均値として表したり、車線幅Lwは全車線の車線幅の平均値として表すなどとしてもよい。
【0035】
次に、こうして構成された実施例のナビゲーション装置20の動作、特に走行中に自車位置を判定する際の動作について説明する。図4は、電子制御ユニット30のロケーション処理部60により画像処理部66と連携して実行される自車位置判定処理ルーチンの一例を示すフローチャートである。このルーチンは、GPS航法や自律航法などにより推定された自車位置と方位センサ56からの信号などに基づく現在の車両の進行方位(道路方向に沿った方位)とが、それぞれ参照データDB44の参照データの1つに関連付けられた撮影位置と撮影方位とに一致する毎に繰り返し実行される。
【0036】
自車位置判定処理ルーチンが実行されると、電子制御ユニット30のCPU32は、まず、現在推定されている自車位置である推定自車位置,本ルーチンが実行されたときにカメラ59により撮影された風景画像から得られる判定用データ,推定自車位置および現在の車両の進行方位(以下、車両進行方位という)と一致する撮影位置および撮影方位の参照データ,推定自車位置および車両進行方位と一致する撮影位置および撮影方位に対応する撮影時走行車線Ls,推定自車位置における道路の車線数Lnと車線幅Lwと歩道幅Pwと曲率半径R,推定自車位置および車両進行方位に対応する道路の道路形状と道路種類,推定自車位置および車両進行方位に対応する道路における最寄りの交差点からの距離Dc,車速センサ52からの信号に基づいて算出される車速V,操舵量センサ58からの信号として得られるハンドル操舵量St,本判定処理に用いられる判定用基準閾値M0など判定に必要なデータを入力する処理を実行する(ステップS100)。
【0037】
ここで、推定自車位置は、実施例では、ロケーション処理部60によりGPS航法や自律航法などにより推定されたものを入力するものとした。判定用データは、図2を用いて説明した風景画像から参照データを作成した際の画像処理手法と同手法を、本ルーチンを実行したときにカメラ59により撮影された風景画像に対して適用することにより作成したものを入力するものとした。参照データと撮影時走行車線Lsとは、それぞれ推定自車位置および車両進行方位と一致する撮影位置および撮影方位に対応するものを参照データDB44から入力するものとした。道路の車線数Lnと車線幅Lwと歩道幅Pwと曲率半径Rとは、推定自車位置における道路の情報として記憶されたものを地図データDB42から入力するものとした。道路形状と道路種類とは、推定自車位置および車両進行方位に対応する道路の情報として記憶されたものを地図データDB42から入力するものとした。最寄りの交差点からの距離Dcは、実施例では、各道路の両端のノード間を単位距離毎に分割した複数の地点毎に定められ、他の道路との関係や各道路の位置,距離に基づいて算出されて地図データDB42に記憶されたものを入力するものとした。図5にある道路における最寄りの交差点からの距離Dcの一例を示す。また、判定用基準閾値M0は、判定用データと参照データとの一致の程度を示す一致率Mが判定用閾値Mref以上か否かを判定する本ルーチンの処理(即ち、実施例のマッチング処理)における判定用閾値Mrefの基準値であり、判定用データと参照データとが一致していると判定可能な範囲の比較的小さい値として予め実験や解析により定められたものを用いるものとした。
【0038】
こうしてデータを入力すると、図2を用いて説明した参照データを作成する際に走行車線を検出したときの画像処理手法と同手法を、カメラ59により撮影した風景画像から判定用データを作成する際に適用することにより、車両が走行している道路での走行車線Lrを検出し(ステップS110)、検出した走行車線Lrから入力した撮影時走行車線Lsを減じたものを走行車線差ΔLとして計算する(ステップS120)。ここで、走行車線Lrは、日本のように自動車が左側通行となる国や地域では、車両が走行している道路が複数車線を有する場合には、最も左側の車線を値1として左側から何番目の車線かを整数で示す値とし、車両が走行している道路が一車線のみを有する場合には、値1とした。なお、参照データDB44の撮影情報としての撮影時走行車線Lsも同様に値1以上の整数とした。
【0039】
続いて、入力した車速V,ハンドル操舵量St,検出した走行車線Lr,計算した走行車線差ΔLの各パラメータに基づいてそれぞれ判定用基準閾値M0に乗じるべき車速係数k1,操舵量係数k2,走行車線係数k3,走行車線差係数k4を設定する(ステップS130〜S150)。ここで、各係数は、実施例では、パラメータと係数との関係を予め定めて係数毎に係数設定用マップとしてROM34に記憶しておき、パラメータが与えられると記憶したマップから対応する係数を導出して設定するものとした。
【0040】
図6に判定用閾値Mrefを設定するためのパラメータと係数との複数の関係の一例を示し、図7に走行車線係数k3の係数設定用マップの例を示し、図8に走行車線車係数k4を設定する様子の例を説明する説明図を示す。図6中、右側は係数設定用マップの一例である。図6に示すように、車速Vが大きいほど車速係数k1が値1を跨いで小さくなり、ハンドル操舵量Stが大きいほど操舵量係数k2が値1から小さくなり、走行車線Lrが道路脇に近いほど走行車線係数k3が小さくなり、走行車線差ΔLの絶対値が大きいほど(走行車線Lrが撮影時走行車線Lsから離れるほど)走行車線差係数k4が値1から小さくなるように、各パラメータに基づいて各係数が設定される。なお、操舵量係数k2については、ハンドル操舵量Stが値0近傍の不感帯としての所定量以下の範囲では一律に値1が設定されるものとした。また、図7に示すように、走行車線係数k3は、入力した道路種類と車線数Ln毎に異なる係数設定用マップが選択されて、選択された係数設定用マップに走行車線Lrを適用することにより設定することができる。例えば、図中左側の(a)の道路(道路種類が対面通行道路で車線数Lnが値6の道路)では、走行車線Lrが小さいほど(即ち左側の道路脇に近いほど)値1を跨いで小さくなるように走行車線係数k3が設定され、図中中央の(b)の道路(道路種類が一方通行道路で車線数Lnが値3の道路)や図中右側の(c)の道路(道路種類が一方通行道路で車線数Lnが値4の道路)では、走行車線Lrが中央の車線から離れて左側または右側の道路脇に近いほど値1から小さくなるように走行車線係数k3が設定される。さらに、走行車線差係数k4は、走行車線差ΔLの絶対値に基づいて設定することにより、図8に示すように、走行車線Lrが撮影時走行車線Lsから道路幅方向の左側または右側に離れるほど値1から小さくなるように設定される、と言い換えることができる。このように各係数を設定する理由を次に説明する。
【0041】
まず、車速Vやハンドル操舵量Stが比較的大きい場合には、カメラ59により撮影される風景画像における特徴点の移動速度(ハンドル操舵量Stについては特に車両の旋回方向と逆方向に相当する方向への移動速度)が比較的大きく、参照データと一致する特徴点を有する風景画像を撮影可能な時間は極めて短い。言い換えると、こうした場合には、参照データDB44の参照データと一致する特徴点を有する風景画像を撮影可能な道路上の撮影位置の範囲はかなり狭い。このため、マッチング処理により風景画像と参照データとが一致していると判定される機会が少なくなり、本来は参照データと一致していると認識してもよい風景画像であるにも拘わらずそう認識することができない、いわゆる認識漏れが生じてしまう。これに対し、車速Vやハンドル操舵量Stが大きいほど車速係数k1や操舵量係数k2を小さくして、判定用基準閾値M0に各係数を乗じて得られる後述の判定用閾値Mrefを小さくすることにより、マッチング処理により判定用データと参照データとが一致していると判定されやすくすることができ(一致していると判定される機会を増やすことができ)、本来一致していると認識してもよい風景画像の認識漏れを抑制する(認識率を高める)ことができる。
【0042】
また、走行車線Lrが道路脇に近い場合は、走行している道路の幅方向において車両位置が中央より左側または右側の道路脇に近い場合であり、カメラ59により撮影される風景画像における近い道路脇側の特徴点(道路の幅方向中央より左側の道路脇に近い場合には画像左側の特徴点,道路の幅方向中央より右側の道路脇に近い場合には画像右側の特徴点)の移動速度が比較的大きく、風景画像の認識漏れが生じやすい場合である。したがって、走行車線Lrが道路脇に近いほど走行車線係数k3を小さくして判定用閾値Mrefを小さくすることにより、判定用データと参照データとが一致していると判定されやすくすることができ、風景画像の認識漏れを抑制することができる。さらに、走行車線差ΔLの絶対値が大きい場合(走行車線Lrが撮影時走行車線Lsから離れる場合)は、走行している道路の幅方向において車両位置が参照データを得た風景画像の撮影時の車両位置より離れている側の道路脇に近い場合であり、カメラ59により撮影される風景画像における特徴点(参照データを得た風景画像の撮影時の車両位置から左側に離れる場合には画像左側の特徴点,参照データを得た風景画像の撮影時の車両位置から右側に離れる場合には画像右側の特徴点)の移動速度が比較的大きく、風景画像の認識漏れが生じる要因となる。したがって、走行車線差ΔLの絶対値が小さいほど走行車線差係数k4を小さくして判定用閾値Mrefを小さくすることにより、判定用データと参照データとが一致していると判定されやすくすることができ、風景画像の認識漏れを抑制することができる。
【0043】
続いて、入力した車線数Ln,車線幅Lw,歩道幅Pwの各パラメータに基づいてそれぞれ判定用基準閾値M0に乗じるべき車線数係数k5,車線幅係数k6,歩道幅係数k7を設定し(ステップS160)、入力した道路形状がカーブ形状のときには曲率半径Rに基づいて判定用基準閾値M0に乗じるべき曲率半径係数k8を設定すると共に入力した道路形状が直線形状のときには曲率半径半径係数k8に値1を設定し(ステップS170)、入力した最寄りの交差点からの距離Dcに基づいて判定用基準閾値M0に乗じるべき交差点距離係数k9を設定する(ステップS180)。ここで、各係数は、実施例では、パラメータと係数との関係を予め定めて係数毎に係数設定用マップとしてROM34に記憶しておき、パラメータが与えられると記憶したマップから対応する係数を導出して設定するものとした。
【0044】
図9に判定用閾値Mrefを設定するためのパラメータと係数との複数の関係の一例を示す。図中、右側は係数設定用マップの一例である。図示するように、車線数Lnが少ないほど車線数係数k5が値1を跨いで小さくなり、車線幅Lwが狭いほど車線幅係数k6が値1を跨いで小さくなり、歩道幅Pwが狭いほど歩道幅係数k7が値1を跨いで小さくなり、道路形状がカーブ形状の場合に曲率半径Rが小さいほど曲率半径係数k8が値1を跨いで小さくなり、最寄りの交差点からの距離Dcが後述する所定距離D1未満の範囲で短いほど交差点距離係数k9が値1未満の範囲で小さくなるように、各パラメータに基づいて各係数が設定される。なお、歩道幅係数k7については、歩道幅Pwが値0で走行している道路に歩道がない場合には歩道幅係数k7の予め定められた値1未満の下限値が設定されるものとした。また、交差点距離係数k9については、最寄りの交差点からの距離Dcが所定距離D1以上の場合には値1が設定されるものとした。このように各係数を設定する理由を次に説明する。
【0045】
まず、走行している道路の幅員が比較的小さい場合には、カメラ59により撮影される風景画像における特徴点の移動速度が比較的大きく、風景画像の認識漏れが生じやすい。これに対し、道路の幅員が比較的が小さい場合には判定用閾値Mrefを小さくすれば、判定用データと参照データとが一致していると判定されやすくすることができる。道路の幅員が比較的小さい場合としては、道路の車線数が少ない場合,車線幅が狭い場合,歩道幅が狭い場合などを考えることができるから、実施例では、車線数Lnが少ないほど,車線幅Lwが狭いほど,歩道幅Pwが狭いほど、各係数を小さくして判定用閾値Mrefを小さくすることにより、風景画像の認識漏れを抑制することができる。
【0046】
また、走行している道路がカーブ形状で曲率半径Rが比較的小さい場合には、カメラ59により撮影される風景画像における特徴点の移動速度(特に車両の旋回方向と逆方向に相当する方向への移動速度)が比較的大きく、参照データと一致する特徴点を有する風景画像を撮影可能な道路上の撮影位置の範囲はかなり狭いため、やはり風景画像の認識漏れが生じやすい。これに対し、道路の曲率半径Rが小さいほど曲率半径係数k8を小さくして判定用閾値Mrefを小さくするから、判定用データと参照データとが一致していると判定されやすくすることができ、風景画像の認識漏れを抑制することができる。さらに、図10に示す車両が交差点を左折して走行する様子の一例から分かるように、車両が交差点を右折または左折して道路に進入するときには、車両は道路方向に対して斜めに道路に進入し、車両がある程度進んでから道路方向と略一致する方向に進むことになる。このため、実施例では、道路上で最寄りの交差点からの距離Dcが所定距離D1未満の範囲で短いほど交差点距離係数k9を小さくして判定用閾値Mrefを小さくするから、判定用データと参照データとが一致していると判定されやすくすることができ、風景画像の認識漏れを抑制することができる。したがって、所定距離D1は、交差点を右左折した車両が進入した道路で道路方向と略一致する方向に走行する状態となるまでの距離として予め実験や解析により定められた距離を用いることができる。
【0047】
こうして閾値k1〜k9を設定すると、判定用基準閾値M0に全ての閾値k1〜k9を乗じたものを判定用閾値Mrefに設定し(ステップS190)、判定用データと参照データとの一致率Mを計算し(ステップS200)、計算した一致率Mと判定用閾値Mrefとを比較する(ステップS210)。ここで、一致率Mは、判定用データと参照データとが一致する程度を表すものであり、例えば、二値化画像として両データ(総画素数と縦横比は同じとする)の対応する画素を比較し、値(値0または値1)が一致する画素数の総画素数に対する割合などとして計算することができる。
【0048】
計算した一致率Mが判定用閾値Mref未満のときには、判定用データと参照データとは一致していないと判断し、推定自車位置および車両進行方位と一致する撮影位置および撮影方位の参照データおよび道路上その前後2つの参照データの合計3つの参照データと、1つの判定用データと、の合計3回の判定処理を行なったか否かを判定する(ステップS220)。合計3回の判定処理を行なっていない場合には、ステップS100に戻り、判定用データについては代えることなく、先にステップS100で入力した推定自車位置および車両進行方位と一致する撮影位置および撮影方位の参照データに代えて、この撮影位置の道路上で車両進行方向1つ後の参照データ(1つ先の参照データ)を入力して、ステップS100〜S210の処理を繰り返す。再び、一致率Mが判定用閾値Mref未満で合計3回の判定処理を行なっていない場合には(ステップS210,S220)、ステップS100に戻り、判定用データについては代えることなく、最初にステップS100で入力した推定自車位置および車両進行方位と一致する撮影位置および撮影方位の参照データに代えて、この撮影位置の道路上で車両進行方向1つ前の参照データを入力して、ステップS100〜S210の処理を繰り返す。
【0049】
こうして一致率Mが判定用閾値Mref未満との判定結果を繰り返し3回得たときには(ステップS210,S220)、推定自車位置を自車位置と判定して(ステップS230)、自車位置判定処理ルーチンを終了する。一方、こうした処理を3回繰り返している最中に一致率Mが判定用閾値Mref以上と判定されたときには、そのときに判定用データと一致した参照データに対応する撮影位置を自車位置と判定して(ステップS240)、自車位置判定処理ルーチンを終了する。こうした処理により、ロケーション処理においてGPS航法や自律航法などにより推定された推定自車位置より正確な自車位置を特定することができる。なお、こうして自車位置が特定されると、特定された自車位置を基準としてGPS航法や自律航法などにより次の自車位置の推定が行なわれる。
【0050】
なお、本ルーチンの各ステップの処理は、基本的に電子制御ユニット30のロケーション処理部60により行なわれ、ステップS100の入力処理における判定用データの作成は電子制御ユニット30の画像処理部66により行なわれる。
【0051】
以上説明した実施例のナビゲーション装置20によれば、道路上で走行方向に間隔をもって車載されたカメラ59から撮影された風景画像の特徴点を抽出して得られる複数の参照データをそれぞれ対応する撮影位置と関連付けて参照データDB44に記憶しておき、車載されたカメラ59から撮影される風景画像と複数の参照データとが一致しているか否かを判定するマッチング処理を行ない、マッチング処理により一致していると判定された参照データに対応する撮影位置に基づいて車両の現在位置である自車位置を判定するものにおいて、マッチング処理は、カメラ59から撮影される風景画像に対して特徴点を抽出する所定の画像処理を施して得られる判定用データと参照データとの一致率Mが判定用閾値Mref以上のときに一致していると判定し、一致率Mが判定用閾値Mref未満のときに一致していないと判定することにより行なわれ、判定用閾値Mrefは、車速Vが大きいほど小さくなるように且つハンドル操舵量Stが大きいほど小さくなるように調整されているから、マッチング処理により判定用データと参照データとが一致していると判定されやすくすることができる。この結果、自車位置をより適正に判定することができる。
【0052】
また、実施例のナビゲーション装置20によれば、走行車線Lrが走行している道路の道路脇に近いほど小さくなるように、即ち、走行している道路の幅方向における車両位置が走行している道路の道路脇に近いほど小さくなるように、判定用閾値Mrefを調整するから、判定用データと参照データとが一致しているとより判定されやすくすることができ、風景画像のいわゆる認識漏れをより抑制することができる。さらに、走行車線差ΔLの絶対値が大きいほど(走行車線Lrが撮影時走行車線Lsから離れるほど)小さくなるように、即ち、走行している道路の幅方向において車両位置が参照データを得た風景画像の撮影時の車両位置から離れるほど小さくなるように、判定用閾値Mrefを調整するから、判定用データと参照データとが一致していると更に判定されやすくすることができ、風景画像の認識漏れを更に抑制することができる。
【0053】
しかも、実施例のナビゲーション装置20によれば、走行している道路の幅員が小さいほど(具体的には、車線数Lnが小さいほど,車線幅Lwが狭いほど,歩道幅Pwが狭いほど)小さくなるように、また、走行している道路がカーブ形状で曲率半径Rが小さいほど小さくなるように、さらに、走行している道路上で最寄りの交差点からの距離Dcが短いほど小さくなるように、判定用閾値Mrefを調整するから、判定用データと参照データとが一致していると判定されやすくすることができ、風景画像の認識漏れをより抑制することができる。この結果、自車位置を更に適正に判定することができる。
【0054】
実施例のナビゲーション装置20では、判定用データと参照データとの一致率Mの判定に用いる判定用閾値Mrefは、車速Vが大きいほど,ハンドル操舵量Stが大きいほど,走行車線Lrが道路脇に近いほど,走行車線差ΔLの絶対値が大きいほど,車線数Lnが少ないほど,車線幅Lwが狭いほど,歩道幅Pwが狭いほど,曲率半径Rが小さいほど,最寄りの交差点からの距離Dcが短いほど小さくなるように調整されるものとした、即ち、9個のパラメータに基づいて調整されるものとしたが、道路の車線数Lnと車線幅Lwと歩道幅Pwとに基づく調整に代えてまたは加えて、判定用閾値Mrefを、道路の幅員Dwが狭いほど短くなるように調整するものとしてもよい。また、判定用閾値Mrefを、これら9個のパラメータに道路の幅員Dwを加えた計10個のパラメータのうち任意の一部(1個以上)のパラメータのみに基づいて調整するものとしてもよいし、10個のパラメータに加えて他のパラメータにも基づいて調整するものとしてもよい。
【0055】
したがって、例えば、判定用データと参照データとの一致率Mの判定に用いる判定用閾値Mrefは、車速Vおよびハンドル操舵量St以外のパラメータに基づいて調整されることなく、車速Vが大きいほど小さくなり且つハンドル操舵量Stが大きいほど小さくなるように調整されるものとしてもよい。また、判定用閾値Mrefは、走行車線Lr以外のパラメータに基づいて調整されることなく、走行車線Lrが道路脇に近いほど小さくなるように調整されるものとしてもよい。さらに、判定用閾値Mrefは、走行車線差ΔL以外のパラメータに基づいて調整されることなく、走行車線差ΔLの絶対値が大きいほど小さくなるように調整されるものとしてもよい。
【0056】
実施例のナビゲーション装置20では、判定用データと参照データとの一致率Mの判定に用いる判定用閾値Mrefは、走行車線Lrが道路脇に近いほど小さくなるように調整されるものとしたが、走行している道路の幅方向において車両位置が道路脇に近いほど判定用閾値Mrefを小さく調整すればよいから、走行車線Lrを検出することなく、道路の幅方向における車両位置を判定用データに対する画像処理により検出してこの検出位置に基づいて判定用閾値Mrefを調整するものとしてもよい。
【0057】
実施例のナビゲーション装置20では、判定用データと参照データとの一致率Mの判定に用いる判定用閾値Mrefは、走行車線Lrが撮影時走行車線Lsから離れるほど小さくなるように調整されるものとしたが、走行している道路の幅方向において車両位置が参照データを得た風景画像の撮影時の車両位置から離れるほど判定用閾値Mrefを小さく調整すればよいから、走行車線Lrを検出することなく、道路の幅方向における車両位置を判定用データに対する画像処理により検出してこの検出位置に基づいて判定用閾値Mrefを調整するものとしてもよい。
【0058】
実施例のナビゲーション装置20では、判定用データと参照データとの一致率Mを判定用閾値Mrefと比較して自車位置を判定するものとしたが、判定用データと参照データとをそれぞれ車両からみて左側のデータと右側のデータとに分割してから、左側と右側とでそれぞれ一致率と判定用閾値とを比較して自車位置を判定するものとしてもよい。この場合、図4の自車位置判定処理ルーチンに代えて、図11の自車位置判定処理ルーチンを実行すればよい。図11のルーチンでは、図4のルーチンのステップS150の処理に代えてステップS300の処理を実行し、図4のルーチンのステップS190〜S210の処理に代えてステップS310〜S340の処理を実行する点を除いて、図4のルーチンと同一である。したがって、同一の処理については同一のステップ番号を付し、その詳細な説明は省略する。
【0059】
図11のルーチンでは、車速係数k1と操舵量係数k2と走行車線係数k3とを設定すると(ステップS130,S140)、計算した走行車線差ΔLに基づいて、風景画像内左側の判定を行なうための左側走行車線差係数k4Lと風景画像内右側の判定を行なうための右側走行車線差係数k4Rとをそれぞれ設定し(ステップS300)、他の係数k5〜k9を設定する(ステップS160〜S180)。左側走行車線差係数k4Lは、走行車線差ΔLと左側走行車線差係数k4Lとの関係を予め定めてROM34に記憶された左側走行車線差係数設定用マップを用いて設定され、右側走行車線差係数k4Rは、走行車線差ΔLと右側走行車線差係数k4Rとの関係を予め定めてROM34に記憶された右側走行車線差係数設定用マップを用いて設定される。図12に左側走行車線差係数設定用マップの一例を示し、図13に右側走行車線差係数設定用マップの一例を示す。各マップの内容については後述する。
【0060】
続いて、車速係数k1と操舵量係数k2と走行車線係数k3と左側走行車線差係数k4Lと他の係数k5〜k9とを乗じたものを左側判定用閾値MLrefに設定すると共に、車速係数k1と操舵量係数k2と走行車線係数k3と右側走行車線差係数k4Rと他の係数k5〜k9とを乗じたものを右側判定用閾値MLrefに設定し(ステップS310)、判定用データを車両からみた画像データとして左側の左側判定用データと右側の右側判定用データとに分割すると共に、参照データを車両からみた画像データとして左側の左側参照データと右側の右側参照データとに分割する(ステップS320)。図14に参照データを左側参照データと右側参照データとに分割する様子の一例を示す。図14の例では、参照データは、左側と右側とに半分ずつに分割されている。判定用データも参照データと同様に分割されるものとした。なお、参照データは予め分割したものをHDD40の参照データDB44に記憶しておくものとしてもよい。
【0061】
次に、左側判定用データと右側参照データとの一致率MLを前述の一致率Mと同様に計算すると共に、右側判定用データと右側参照データとの一致率MRを前述の一致率Mと同様に計算し(ステップS320)、計算した一致率MLを左側判定用閾値MLrefと比較すると共に一致率MRを右側判定用閾値MRrefと比較する(ステップS340)。そして、ステップS100〜S340の処理を異なる参照データを用いて3回繰り返す間に、一致率MLが左側用判定閾値MLref未満または一致率MRが右側判定用閾値MRref未満と続けて3回判定されたときには、推定自車位置を自車位置と判定する(ステップS230)。一方、ステップS100〜S340の処理を異なる参照データを用いて3回繰り返す間に、一致率MLが左側用判定閾値MLref以上且つ一致率MRが右側判定用閾値MRref以上と判定されたときには、そのときに判定用データと一致した参照データに対応する撮影位置を自車位置と判定して(ステップS240)、自車位置判定処理ルーチンを終了する。
【0062】
ここで、図12および図13に例示した左側走行車線差係数設定用マップおよび右側走行車線差係数設定用マップについて説明する。図12に示すように、左側走行車線差係数k4Lは、走行車線差ΔLが値0以上のとき、即ち、走行車線Lrが撮影時走行車線Lsと同じであるか撮影時走行車線Lsより右側の車線であるときには、値1が設定される。また、左側走行車線差係数k4Lは、走行車線差ΔLが値0未満で小さいほど小さくなるように設定される、即ち、走行車線Lrが撮影時走行車線Lsより左側に離れるほど小さくなるように設定される。これは、走行車線Lrが撮影時走行車線Lsに比して道路の幅方向において左側に離れるほど、カメラ59により撮影される風景画像における左側の特徴点の移動速度が比較的大きくなる傾向があり、この傾向が、風景画像の認識漏れが生じる要因となることに基づく。また、図13に示すように、右走行車線差係数k4Rは、走行車線差ΔLが値0以下のとき、即ち、走行車線Lrが撮影時走行車線Lsと同じであるか撮影時走行車線Lsより左側の車線であるときには、値1が設定される。また、右側走行車線差係数k4Rは、走行車線差ΔLが値0より大きいほど小さくなるように設定される、即ち、走行車線Lrが撮影時走行車線Lsより右側に離れるほど小さくなるように設定される。これは、走行車線Lrが撮影時走行車線Lsに比して道路の幅方向において右側に離れるほど、カメラ59により撮影される風景画像における右側の特徴点の移動速度が比較的大きくなる傾向があり、この傾向が、風景画像の認識漏れが生じる要因となることに基づく。こうした係数を用いて設定される左側判定用閾値Mrefと右側判定用閾値Mrefとをそれぞれ左側の一致率MLと右側の一致率MRとの比較に用いて自車位置を判定するから、風景画像の認識漏れが抑制され、より適正に自車位置を判定することができる。
【0063】
実施例では、本発明の位置判定装置をディスプレイ22やHDD40を備えるナビゲーション装置20に適用して説明したが、例えば、ディスプレイを備えるナビゲーション装置と通信可能に接続されたサーバに電子制御ユニット30のロケーション処理部60の機能とロケーション処理に必要な画像処理部66の機能の一部とを行なわせるようにして、このサーバを本発明の位置判定装置として機能させるものとしてもよい。また、ナビゲーション装置20に代えて、デジタルカメラや携帯端末,ドライブレコーダなどの機器を本発明の位置判定装置として機能させるものとしてもよい。この場合、こうした機器を車室内に設置してこの機器が備えるカメラにより撮影される風景画像を用いて自車位置を判定するようにしてもよい。
【0064】
また、実施例では、本発明の位置判定装置をナビゲーション装置20に適用して説明したが、位置判定方法の形態としてもよいし、こうした位置判定方法の各ステップを1以上のコンピュータに実現させるためのプログラムの形態としてもよい。また、こうしたプログラムを記録媒体に記憶させた形態としても構わない。
【0065】
実施例の主要な要素と課題を解決するための手段の欄に記載した発明の主要な要素との対応関係について説明する。実施例では、複数の参照データをHDD40の参照データDB42に記憶しておき車載されたカメラ59から撮影される風景画像と複数の参照データとが一致しているか否かを判定するマッチング処理を行なって一致していると判定された参照データに対応する撮影位置に基づいて自車位置を判定する図4や図11の自車位置判定処理ルーチンを実行する電子制御ユニット30のロケーション処理部60と画像処理部66の一部とが「位置判定装置」に相当する。また、判定用データを用いて走行車線Lrを検出する図4や図11の自車位置判定処理ルーチンのステップS110の処理を実行する電子制御ユニット30のロケーション処理部60が「幅方向車両位置検出手段」に相当する。
【0066】
なお、実施例の主要な要素と課題を解決するための手段の欄に記載した発明の主要な要素との対応関係は、実施例が課題を解決するための手段の欄に記載した発明を実施するための形態を具体的に説明するための一例であることから、課題を解決するための手段の欄に記載した発明の要素を限定するものではない。即ち、課題を解決するための手段の欄に記載した発明についての解釈はその欄の記載に基づいて行なわれるべきものであり、実施例は課題を解決するための手段の欄に記載した発明の具体的な一例に過ぎないものである。
【0067】
以上、本発明を実施するための形態について実施例を用いて説明したが、本発明はこうした実施例に何等限定されるものではなく、本発明の要旨を逸脱しない範囲内において、種々なる形態で実施し得ることは勿論である。
【産業上の利用可能性】
【0068】
本発明は、ナビゲーション装置や位置判定装置の製造産業などに利用可能である。
【符号の説明】
【0069】
10 ナビゲーションシステム、12 車載装置、20 ナビゲーション装置、22 ディスプレイ、24 タッチパネル、26 スピーカ、30 電子制御ユニット、32 CPU、34 ROM、36 RAM、38 フラッシュメモリ、40 ハードディスクドライブ(HDD)、42 地図データ用データベース(地図データDB)、44 参照データ用データベース(参照データDB)、50 GPS受信機、52 車速センサ、54 加速度センサ、56 方位センサ、58 操舵量センサ、59 カメラ、60 ロケーション処理部、62 地図表示処理部、64 ナビゲーション処理部、66 画像処理部。
【特許請求の範囲】
【請求項1】
道路上で走行方向に間隔をもって車載カメラから撮影された風景画像の特徴的部分を抽出して得られる複数の参照データをそれぞれ対応する地図上の位置と関連付けて記憶しておき、車載カメラから撮影される風景画像と前記複数の参照データとが一致しているか否かを判定するマッチング処理を行ない、該マッチング処理により一致していると判定された参照データに対応する地図上の位置に基づいて車両の地図上の位置を判定する位置判定装置であって、
前記マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、前記一致の程度が前記判定用閾値未満のときに一致していないと判定することにより行なわれ、
前記判定用閾値は、車速が大きいほど小さくなる傾向に且つハンドル操舵量が大きいほど小さくなる傾向に調整されてなる、
位置判定装置。
【請求項2】
請求項1記載の位置判定装置であって、
走行している道路の幅方向における車両位置を検出する幅方向車両位置検出手段
を備え、
前記判定用閾値は、前記検出された車両位置が前記走行している道路の道路脇に近いほど小さくなる傾向に調整されてなる、
位置判定装置。
【請求項3】
請求項2記載の位置判定装置であって、
前記幅方向車両位置検出手段は、複数の車線を有する道路を走行しているときに走行車線を検出する手段であり、
前記判定用閾値は、前記検出された走行車線が前記走行している道路の道路脇に近いほど小さくなる傾向に調整されてなる、
位置判定装置。
【請求項4】
請求項1記載の位置判定装置であって、
走行している道路の幅方向における車両位置を検出する幅方向車両位置検出手段
を備え、
前記判定用閾値は、前記走行している道路の幅方向において前記検出された車両位置が前記参照データを得た風景画像の撮影時の車両位置から離れるほど小さくなる傾向に調整されてなる、
位置判定装置。
【請求項5】
請求項4記載の位置判定装置であって、
前記幅方向車両位置検出手段は、複数の車線を有する道路を走行しているときに走行車線を検出する手段であり、
前記判定用閾値は、前記検出された走行車線が前記参照データを得た風景画像の撮影時の走行車線から離れるほど小さくなる傾向に調整されてなる、
位置判定装置。
【請求項6】
請求項1ないし5のいずれか1つの請求項に記載の位置判定装置であって、
前記判定用閾値は、走行している道路の幅員が小さいほど小さくなる傾向,走行している道路の曲率半径が小さいほど小さくなる傾向,走行している道路上で最寄りの交差点からの距離が短いほど小さくなる傾向のうち少なくともいずれかとなるように調整されてなる、
位置判定装置。
【請求項7】
請求項1ないし6のいずれか1つの請求項に記載の位置判定装置であって、
前記判定用閾値は、走行している道路の車線数が少ないほど小さくなる傾向,走行している道路の車線幅が狭いほど小さくなる傾向,走行している道路の歩道幅が狭いほど小さくなる傾向のうち少なくともいずれかとなるように調整されてなる、
位置判定装置。
【請求項8】
請求項4または5記載の位置判定装置であって、
前記マッチング処理は、
前記判定用データを前記車両からみて左側の左側判定用データと右側の右側判定用データとに分割すると共に、前記参照データを前記車両からみて左側の左側参照データと右側の右側参照データとに分割し、
前記左側判定用データと前記左側参照データとの一致の程度が左側判定用閾値以上であり、且つ、前記右側判定用データと前記右側参照データとの一致の程度が右側判定用閾値以上のときには一致していると判定し、前記左側判定用データと前記左側参照データとの一致の程度が前記左側判定用閾値未満であるか、又は、前記右側判定用データと前記右側参照データとの一致の程度が前記右側判定用閾値未満であるときには一致していないと判定することにより行なわれ、
前記左側判定用閾値は、前記走行している道路の幅方向において前記検出された車両位置が前記参照データを得た風景画像の撮影時の車両位置から左側に離れるほど小さくなる傾向に調整されてなり、
前記右側用判定閾値は、前記走行している道路の幅方向において前記検出された車両位置が前記参照データを得た風景画像の撮影時の車両位置から右側に離れるほど小さくなる傾向に調整されてなる、
位置判定装置。
【請求項9】
請求項1ないし8のいずれか1つの請求項に記載の位置判定装置を備え、該位置判定装置により判定された車両の地図上の位置を用いて目的地への経路案内を行なうナビゲーション装置。
【請求項10】
道路上で走行方向に間隔をもって車載カメラから撮影された風景画像の特徴的部分を抽出して得られる複数の参照データをそれぞれ対応する地図上の位置と関連付けて記憶しておき、車両から撮影される風景画像と前記複数の参照データとが一致しているか否かを判定するマッチング処理を行なうステップと、該マッチング処理により一定していると判定された参照データに対応する地図上の位置に基づいて車両の地図上の位置を判定するステップと、を含む位置判定方法であって、
前記マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、前記一致の程度が前記判定用閾値未満のときに一致していないと判定することにより行なわれ、
前記判定用閾値は、車速が大きいほど小さくなる傾向に且つハンドル操舵量が大きいほど小さくなる傾向に調整されてなる、
位置判定方法。
【請求項11】
請求項10記載の位置判定方法の各ステップを1以上のコンピュータに実現させるためのプログラム。
【請求項1】
道路上で走行方向に間隔をもって車載カメラから撮影された風景画像の特徴的部分を抽出して得られる複数の参照データをそれぞれ対応する地図上の位置と関連付けて記憶しておき、車載カメラから撮影される風景画像と前記複数の参照データとが一致しているか否かを判定するマッチング処理を行ない、該マッチング処理により一致していると判定された参照データに対応する地図上の位置に基づいて車両の地図上の位置を判定する位置判定装置であって、
前記マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、前記一致の程度が前記判定用閾値未満のときに一致していないと判定することにより行なわれ、
前記判定用閾値は、車速が大きいほど小さくなる傾向に且つハンドル操舵量が大きいほど小さくなる傾向に調整されてなる、
位置判定装置。
【請求項2】
請求項1記載の位置判定装置であって、
走行している道路の幅方向における車両位置を検出する幅方向車両位置検出手段
を備え、
前記判定用閾値は、前記検出された車両位置が前記走行している道路の道路脇に近いほど小さくなる傾向に調整されてなる、
位置判定装置。
【請求項3】
請求項2記載の位置判定装置であって、
前記幅方向車両位置検出手段は、複数の車線を有する道路を走行しているときに走行車線を検出する手段であり、
前記判定用閾値は、前記検出された走行車線が前記走行している道路の道路脇に近いほど小さくなる傾向に調整されてなる、
位置判定装置。
【請求項4】
請求項1記載の位置判定装置であって、
走行している道路の幅方向における車両位置を検出する幅方向車両位置検出手段
を備え、
前記判定用閾値は、前記走行している道路の幅方向において前記検出された車両位置が前記参照データを得た風景画像の撮影時の車両位置から離れるほど小さくなる傾向に調整されてなる、
位置判定装置。
【請求項5】
請求項4記載の位置判定装置であって、
前記幅方向車両位置検出手段は、複数の車線を有する道路を走行しているときに走行車線を検出する手段であり、
前記判定用閾値は、前記検出された走行車線が前記参照データを得た風景画像の撮影時の走行車線から離れるほど小さくなる傾向に調整されてなる、
位置判定装置。
【請求項6】
請求項1ないし5のいずれか1つの請求項に記載の位置判定装置であって、
前記判定用閾値は、走行している道路の幅員が小さいほど小さくなる傾向,走行している道路の曲率半径が小さいほど小さくなる傾向,走行している道路上で最寄りの交差点からの距離が短いほど小さくなる傾向のうち少なくともいずれかとなるように調整されてなる、
位置判定装置。
【請求項7】
請求項1ないし6のいずれか1つの請求項に記載の位置判定装置であって、
前記判定用閾値は、走行している道路の車線数が少ないほど小さくなる傾向,走行している道路の車線幅が狭いほど小さくなる傾向,走行している道路の歩道幅が狭いほど小さくなる傾向のうち少なくともいずれかとなるように調整されてなる、
位置判定装置。
【請求項8】
請求項4または5記載の位置判定装置であって、
前記マッチング処理は、
前記判定用データを前記車両からみて左側の左側判定用データと右側の右側判定用データとに分割すると共に、前記参照データを前記車両からみて左側の左側参照データと右側の右側参照データとに分割し、
前記左側判定用データと前記左側参照データとの一致の程度が左側判定用閾値以上であり、且つ、前記右側判定用データと前記右側参照データとの一致の程度が右側判定用閾値以上のときには一致していると判定し、前記左側判定用データと前記左側参照データとの一致の程度が前記左側判定用閾値未満であるか、又は、前記右側判定用データと前記右側参照データとの一致の程度が前記右側判定用閾値未満であるときには一致していないと判定することにより行なわれ、
前記左側判定用閾値は、前記走行している道路の幅方向において前記検出された車両位置が前記参照データを得た風景画像の撮影時の車両位置から左側に離れるほど小さくなる傾向に調整されてなり、
前記右側用判定閾値は、前記走行している道路の幅方向において前記検出された車両位置が前記参照データを得た風景画像の撮影時の車両位置から右側に離れるほど小さくなる傾向に調整されてなる、
位置判定装置。
【請求項9】
請求項1ないし8のいずれか1つの請求項に記載の位置判定装置を備え、該位置判定装置により判定された車両の地図上の位置を用いて目的地への経路案内を行なうナビゲーション装置。
【請求項10】
道路上で走行方向に間隔をもって車載カメラから撮影された風景画像の特徴的部分を抽出して得られる複数の参照データをそれぞれ対応する地図上の位置と関連付けて記憶しておき、車両から撮影される風景画像と前記複数の参照データとが一致しているか否かを判定するマッチング処理を行なうステップと、該マッチング処理により一定していると判定された参照データに対応する地図上の位置に基づいて車両の地図上の位置を判定するステップと、を含む位置判定方法であって、
前記マッチング処理は、車両から撮影される風景画像に対して特徴的部分を抽出する所定の画像処理を施して得られる判定用データと前記参照データとの一致の程度が判定用閾値以上のときに一致していると判定し、前記一致の程度が前記判定用閾値未満のときに一致していないと判定することにより行なわれ、
前記判定用閾値は、車速が大きいほど小さくなる傾向に且つハンドル操舵量が大きいほど小さくなる傾向に調整されてなる、
位置判定方法。
【請求項11】
請求項10記載の位置判定方法の各ステップを1以上のコンピュータに実現させるためのプログラム。
【図1】
【図2】
【図3】
【図4】
【図5】
【図6】
【図7】
【図8】
【図9】
【図10】
【図11】
【図12】
【図13】
【図14】
【図2】
【図3】
【図4】
【図5】
【図6】
【図7】
【図8】
【図9】
【図10】
【図11】
【図12】
【図13】
【図14】
【公開番号】特開2013−32954(P2013−32954A)
【公開日】平成25年2月14日(2013.2.14)
【国際特許分類】
【出願番号】特願2011−168806(P2011−168806)
【出願日】平成23年8月1日(2011.8.1)
【出願人】(000100768)アイシン・エィ・ダブリュ株式会社 (3,717)
【Fターム(参考)】
【公開日】平成25年2月14日(2013.2.14)
【国際特許分類】
【出願日】平成23年8月1日(2011.8.1)
【出願人】(000100768)アイシン・エィ・ダブリュ株式会社 (3,717)
【Fターム(参考)】
[ Back to top ]