道路勾配推定装置
【課題】片側の白線のみからでも車両前方の道路の道路勾配を推定可能な道路勾配推定装置を提供する。
【解決手段】画像処理部４で抽出した白線が破線であるとき、その白線のペイント部分と非ペイント部分の境界である端点を抽出する端点抽出部６と、視点変換処理を行い、車両前方の道路の道路勾配が、車両が走行している位置での道路勾配で一定であると仮定したときの各端点の見かけ上の位置を求める視点変換処理部７と、隣り合う端点間の見かけ上の距離と、予め求めた隣り合う端点間の実際の距離とに基づき、各端点間の勾配を求める端点間勾配取得部９と、端点間勾配取得部９が求めた各端点間の勾配に、車両が走行している位置での道路勾配を足し合わせることで、端点間の実際の道路勾配を求める道路勾配演算部１０と、を備えた。
【解決手段】画像処理部４で抽出した白線が破線であるとき、その白線のペイント部分と非ペイント部分の境界である端点を抽出する端点抽出部６と、視点変換処理を行い、車両前方の道路の道路勾配が、車両が走行している位置での道路勾配で一定であると仮定したときの各端点の見かけ上の位置を求める視点変換処理部７と、隣り合う端点間の見かけ上の距離と、予め求めた隣り合う端点間の実際の距離とに基づき、各端点間の勾配を求める端点間勾配取得部９と、端点間勾配取得部９が求めた各端点間の勾配に、車両が走行している位置での道路勾配を足し合わせることで、端点間の実際の道路勾配を求める道路勾配演算部１０と、を備えた。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、車両前方の道路の道路勾配を推定する道路勾配推定装置に関するものである。
【背景技術】
【０００２】
道路勾配の変化を予測し、早めに加減速を開始することで、燃費を向上できることが知られている。特に、大型車の場合、乗用車と比較して加速性能が低く、燃費に対する要求も高いためその効果は大きい。
【０００３】
従来より、道路勾配を推定する手法として、カメラにより自車両の前方の画像を取得し、画像処理によって白線（道路区分線）を認識し、左右の白線の開き具合などから車両の前方の道路の道路勾配、凹凸の変化を推定する方法が提案されている。
【０００４】
この方法では、例えば、自車両が平坦な道路（勾配が０の道路）を走行しているとすると、図５（ａ）のように白線Ｌが地平線Ｈ上で交われば、前方の道路は平坦であり、図５（ｂ）のように白線Ｌが地平線Ｈよりも低い位置で交われば、前方の道路は下り坂であり、図５（ｃ）のように白線Ｌが地平線Ｈよりも高い位置で交われば、前方の道路は上り坂である、と判断することができる。
【０００５】
このような道路勾配の推定は、図６に示すような道路勾配推定装置６１で実現できる。この道路勾配推定装置６１は、車両前方の道路の画像を撮像するカメラ２と、カメラ２が撮像した画像を取得する画像取得部３と、画像取得部３が取得した画像の画像処理を行い、白線を抽出する画像処理部４と、画像処理部４が抽出した白線から車両前方の道路の道路勾配を推定する勾配推定部５と、を備えている。
【０００６】
なお、この出願の発明に関連する先行技術文献情報としては、特許文献１，２がある。
【先行技術文献】
【特許文献】
【０００７】
【特許文献１】特開２００９−４１９７２号公報
【特許文献２】特開平９−３２５０２６号公報
【発明の概要】
【発明が解決しようとする課題】
【０００８】
しかしながら、上述の従来技術では、左右の白線Ｌの開き具合などから道路勾配を推定するため、左右両側の白線Ｌがそろわないと道路勾配の推定ができないという問題がある。換言すれば、上述の従来技術では、片側の白線Ｌのみから道路勾配を推定することができないという問題がある。
【０００９】
これは、図７に示すように、片側の白線Ｌのみから道路勾配を推定する場合、白線Ｌの歪曲が勾配によるものなのかカーブによるものなのか判断できないためである。
【００１０】
そこで、本発明の目的は、上記課題を解決し、片側の白線のみからでも車両前方の道路の道路勾配を推定可能な道路勾配推定装置を提供することにある。
【課題を解決するための手段】
【００１１】
本発明は上記目的を達成するために創案されたものであり、車両前方の道路の画像を撮像するカメラと、該カメラが撮像した画像を取得する画像取得部と、該画像取得部が取得した画像の画像処理を行い、白線を抽出する画像処理部と、該画像処理部が抽出した白線から前記車両前方の道路の道路勾配を推定する勾配推定部と、を備えた道路勾配推定装置において、前記画像処理部は、抽出した白線が破線であるとき、その白線のペイント部分と非ペイント部分の境界である端点を抽出する端点抽出部と、該端点抽出部が抽出した各端点の前記画像上での位置と、前記カメラの設置条件や特性とを基に、視点変換処理を行い、前記車両前方の道路の道路勾配が、前記車両が走行している位置での道路勾配で一定であると仮定したときの各端点の見かけ上の位置を求める視点変換処理部と、を備え、前記勾配推定部は、前記車両が走行している位置での道路勾配を求める基準勾配取得部と、前記各端点の見かけ上の位置から得られる隣り合う端点間の見かけ上の距離と、予め求めた隣り合う端点間の実際の距離とに基づき、各端点間の勾配を求める端点間勾配取得部と、前記端点間勾配取得部が求めた各端点間の勾配に、前記基準勾配取得部が求めた前記車両が走行している位置での道路勾配を足し合わせることで、前記端点間の実際の道路勾配を求める道路勾配演算部と、を備えた道路勾配推定装置である。
【００１２】
前記端点間勾配取得部は、前記端点抽出部が抽出した各端点の番号を前記車両に近い順に０、１、・・・とし、前記車両前方の道路の道路勾配が前記基準勾配で一定であると仮定した場合の仮想道路平面を基準とした（距離，高さ）の座標系にて、Ｎ番目の端点の見かけ上の位置を（ＬN，０）、Ｎ番目の端点の実際の位置を（ＬN’，ＨN’）としたとき、前記車両に最も近い０番目の端点の実際の位置（Ｌ0’，Ｈ0’）が、前記視点変換処理部で求めた０番目の端点の見かけ上の位置（Ｌ0，０）と等しいと仮定し、［数１］に示す式（１），式（２）
【００１３】
【数１】
【００１４】
により、各端点の実際の位置を順次求め、下式（３）
ＧN＝ｔａｎ-1｛（ＨN+1’−ＨN’）／（ＬN+1’−ＬN’）｝ ・・・（３）
より、Ｎ番目とＮ＋１番目の端点間の勾配ＧNを求めるように構成されてもよい。
【００１５】
前記勾配推定部は、前記車両の走行中に、前記画像上で、任意の端点がその端点よりも前記車両に近い端点の位置まで移動するためにかかる時間を求め、その求めた時間と、前記車両の車速とを基に、前記隣り合う端点間の実際の距離を求める端点間実距離取得部をさらに備えてもよい。
【発明の効果】
【００１６】
本発明によれば、片側の白線のみからでも車両前方の道路の道路勾配を推定可能な道路勾配推定装置を提供できる。
【図面の簡単な説明】
【００１７】
【図１】本発明の一実施の形態に係る道路勾配推定装置の概略構成図である。
【図２】本発明において、破線の白線ではペイント部と非ペイント部が一定の間隔で周期的に繰り返されていることを説明する図である。
【図３】（ａ），（ｂ）は、図１の道路勾配推定装置において、端点間の道路勾配を推定する原理を説明する図である。
【図４】図１の道路勾配推定装置の処理フローを示すフローチャートである。
【図５】（ａ）〜（ｃ）は、従来の道路勾配推定方法を説明する図である。
【図６】従来の道路勾配推定装置の概略構成図である。
【図７】従来方法では、片側の白線のみから車両前方の道路の道路勾配を推定することができないことを説明する図である。
【発明を実施するための形態】
【００１８】
以下、本発明の実施の形態を添付図面にしたがって説明する。
【００１９】
図１は、本実施の形態に係る道路勾配推定装置の概略構成図である。
【００２０】
図１に示すように、道路勾配推定装置１は、車両前方の道路の画像を撮像するカメラ２と、カメラ２が撮像した画像を取得する画像取得部３と、画像取得部３が取得した画像の画像処理を行い、白線を抽出する画像処理部４と、画像処理部４が抽出した白線から車両前方の道路の道路勾配を推定する勾配推定部５と、を備えている。
【００２１】
画像処理部４は、ソーベルフィルタ等により画像取得部３が取得した画像の垂直エッジを抽出するエッジ抽出処理を行い、垂直エッジのエッジ点を抽出した後、ハフ変換を用いて直線成分を抽出し、車線幅・白線幅等の条件で候補を絞り込み、白線を抽出する白線認識処理を行う。エッジ抽出処理や白線認識処理は公知技術であるため、ここでは説明を省略する。
【００２２】
本実施の形態に係る道路勾配推定装置１では、画像処理部４は、抽出した白線が破線であるとき、その白線のペイント部分と非ペイント部分の境界である端点を抽出する端点抽出部６を備えている。
【００２３】
白線には実線と破線があり、片側二車線以上の高速道路では少なくとも左右のうち一方は破線であることが多い。例えば、一般的な高速道路では、図２に示すように、破線の白線のペイント部２１と非ペイント部２２は一定の間隔で周期的に繰り返されている。本発明では、この間隔に着目して道路勾配を推定する。
【００２４】
上述の白線認識処理によって求まるのは直線を表す式のみであるため、本実施の形態では、端点抽出部６にて別途白線の端点を抽出するように構成している。端点抽出部６は、白線認識処理で抽出した直線上またはその近傍にあるエッジ点を列挙し、連続的に並んでいるかを調べる。端点以外でも白線の汚れなどによってエッジ点が途切れる場合があるため、その周辺で水平エッジを探索し、端点かどうかを判断する。端点抽出部６は、抽出された端点を自車両から近い順に列挙する。ここでは、抽出した各端点の番号を車両に近い順に０、１、・・・とする。
【００２５】
また、本実施の形態に係る道路勾配推定装置１では、画像処理部４は、端点抽出部６が抽出した各端点の画像上での位置と、カメラ２の設置条件や特性とを基に、視点変換処理を行い、車両前方の道路の道路勾配が、車両が走行している位置での道路勾配（以下、基準勾配という）で一定であると仮定した場合の各端点の見かけ上の位置を求める視点変換処理部７を備えている。
【００２６】
カメラ２の高さ、俯角、画角などのパラメータが既知であれば、カメラ２で取得した車両前方の画像を真上から見たように視点変換することができる。視点変換処理は公知であるため詳細な説明は省略するが、［数２］に示す式（４），式（５）のような変換式を用いて視点変換できることが一般に知られている。
【００２７】
【数２】
【００２８】
なお、視点変換処理を行う時期は特に限定されるものではなく、上述のように端点抽出後に視点変換を行うようにしてもよいし、視点変換後の座標上で端点を抽出するように構成してもよい。
【００２９】
なお、視点変換後の端点の見かけ上の位置は、車両前方の道路の道路勾配が基準勾配で一定であると仮定した場合に、真上（走行面に対して垂直方向）から見たときの位置情報であるから、高さ情報は含まれていない。以下、視点変換後のＮ番目の端点の見かけ上の位置を（ＬN，０）と記載する。ここでＬNは、道路が平坦であるという仮定で視点変換したＮ番目の端点までの見かけの距離である。以下、括弧書きで座標を示す場合、車両前方の道路の道路勾配が基準勾配で一定であると仮定した場合の仮想道路平面を基準とした（距離，高さ）を示すものとする。ＬNは、画像上でのＮ番目の端点のｙ座標の位置がｙNだとすると、上述の式（４）を用いて、［数３］に示す式（６）のように表すことができる。
【００３０】
【数３】
【００３１】
本実施の形態に係る道路勾配推定装置１では、勾配推定部５は、車両が走行している位置での道路勾配である基準勾配Ｇを求める基準勾配取得部８と、各端点の見かけ上の位置から得られる隣り合う端点間の見かけ上の距離と、予め求めた隣り合う端点間の実際の距離とに基づき、各端点間の勾配ＧNを求める端点間勾配取得部９と、端点間勾配取得部９が求めた各端点間の勾配ＧNに、基準勾配Ｇを足し合わせることで、端点間の実際の道路勾配ＧN’を求める道路勾配演算部１０と、を備えている。
【００３２】
基準勾配取得部８で基準勾配Ｇを求める方法については、数多く提案されており、特に限定するものではないが、例えば、車速の時間微分によって求めた加速度と、加速度センサから求めた実際の加速度を比較して基準勾配Ｇを推定することができる。
【００３３】
端点間勾配取得部９は、抽出した端点間の見かけ上の距離と、隣り合う端点間の実際の距離ｄとを比較して、端点間の勾配を求めるように構成される。隣り合う端点間の実際の距離ｄを求める方法については、後述する。
【００３４】
図３（ａ）に示すように、Ｎ番目の端点が実座標上で点Ａの位置にあるとすると、Ｎ＋１番目の端点は、点Ａを中心とする半径ｄの円Ｂの円周上に存在することになる。他方、カメラ２の高さをＨとすると、Ｎ＋１番目の端点は、カメラ２の位置である（０，Ｈ）とＮ＋１番目の端点の見かけ上の位置（ＬN+1，０）を結ぶ直線Ｃ上に存在することになる。したがって、円Ｂと直線Ｃの交点Ｄが、Ｎ＋１番目の端点の実際の位置になる。
【００３５】
図３（ａ）のように、Ｎ番目とＮ＋１番目の端点間の見かけ上の距離Ｅが、隣り合う端点間の実際の距離ｄよりも長い場合には、Ｎ番目の端点からＮ＋１番目の端点は上り坂であると判断することができ、図３（ｂ）のように、Ｎ番目とＮ＋１番目の端点間の見かけ上の距離Ｅが、隣り合う端点間の実際の距離ｄよりも短い場合には、Ｎ番目の端点からＮ＋１番目の端点は下り坂であると判断することができる。
【００３６】
つまり、白線認識を行い、端点として認識された点の間隔と、理論値（端点間の実際の距離ｄ）とを比較することで、大まかな勾配を推定することができる。実際にはＮ番目の端点の高さは０ではないので、あくまで大まかな判断ではあるが、傾向としては、理論値より短く映っていれば下り坂、長く映っていれば上り坂と判断できる。
【００３７】
ここで、Ｎ番目の端点の実際の位置（ＬN’，ＨN’）から、Ｎ＋１番目の端点の実際の位置（ＬN+1’，ＨN+1’）を求める方法を以下に説明する。なお、ＬN’は、道路が平坦であると仮定したときのＮ番目の端点までの距離、ＨN’は、道路が平坦であると仮定したときのＮ番目の端点の平坦面（道路面）からの高さを表している。
【００３８】
図３（ａ）における直線Ｃの長さは、［数４］に示す式（７）で表される。
【００３９】
【数４】
【００４０】
よって、直線Ｃの直線方向の単位ベクトルは、［数５］に示す式（８）で表すことができ、直線Ｃに対して垂直方向の単位ベクトルは、［数６］に示す式（９）のように表すことができる。
【００４１】
【数５】
【００４２】
【数６】
【００４３】
ここで、Ｎ番目の端点である点Ａ、つまり（ＬN’，ＨN’）の位置から直線Ｃに垂線（直線Ｃに対して垂直な線）を引いたときの垂線の足（垂線と直線Ｃの交点）を点Ｆとする。点Ａから点Ｆまでの距離をｋとすると、点Ｆの位置は、点Ａから式（９）の単位ベクトルをｋ倍した長さ移動した位置となるので、［数７］に示す式（１０）のように表すことができる。
【００４４】
【数７】
【００４５】
直線Ｃの式は、下式（１１）
ＨＬN+1’＋ＨN+1’ＬN+1＝ＨＬN+1 ・・・（１１）
または下式（１２）
（ＬN+1’／ＬN+1）＋（ＨN+1’／Ｈ）＝１ ・・・（１２）
で表すことができるので、点Ｆの位置を式（１１）または式（１２）のＬN+1’、ＨN+1’として代入して整理すると、［数８］に示す式（１３）のように、ｋを求めることができる。
【００４６】
【数８】
【００４７】
この式（１３）を上述の式（１０）に代入すると、点Ｆの位置は［数９］に示す（式１４）のようになる。
【００４８】
【数９】
【００４９】
ここで、点Ｆから点Ｄ、すなわちＮ＋１番目の端点までの距離は、［数１０］に示す式（１５）で表される。
【００５０】
【数１０】
【００５１】
点Ｄの位置（ＬN+1’，ＨN+1’）は、点Ｆから直線Ｃの直線方向に式（１５）の距離移動した位置なので、ＬN+1’，ＨN+1’は、それぞれ［数１１］に示す式（１６），式（１７）のようになり、式を整理すると、［数１２］に示す式（１），式（２）のようになる。
【００５２】
【数１１】
【００５３】
【数１２】
【００５４】
以上より求めた式（１），式（２）を用いれば、Ｎ番目の端点の実際の位置（ＬN’，ＨN’）から、Ｎ＋１番目の端点の実際の位置（ＬN+1’，ＨN+1’）を求めることが可能になる。
【００５５】
本実施の形態では、端点間勾配取得部９は、道路面に段差や屈折は無く道路勾配は連続的に変化するものとし、車両に最も近い０番目の端点の実際の位置（Ｌ0’，Ｈ0’）が、視点変換処理部７で求めた０番目の端点の見かけ上の位置（Ｌ0，０）と等しいと仮定し（換言すれば、最も近い０番目の端点は自車両が走行中の道路平面と同一平面上にあると仮定し）、上述の式（１），式（２）の漸化式を用いて各端点の実際の位置を順次求める。初期値として０番目の端点の位置を設定すれば、式（１），式（２）により各端点の実際の位置が順次求められることになる。
【００５６】
端点間勾配取得部９は、各端点の実際の位置を求めた後、下式（３）
ＧN＝ｔａｎ-1｛（ＨN+1’−ＨN’）／（ＬN+1’−ＬN’）｝ ・・・（３）
より、Ｎ番目とＮ＋１番目の端点間の勾配ＧNを順次求めるように構成される。
【００５７】
なお、ここでいう端点間の勾配ＧNとは、基準勾配Ｇを０と仮定したときの道路勾配（端点で区切られた各区間での平均勾配）である。よって、道路勾配演算部１０にて、下式（１８）
ＧN’＝Ｇ＋ＧN
＝Ｇ＋ｔａｎ-1｛（ＨN+1’−ＨN’）／（ＬN+1’−ＬN’）｝
・・・（１８）
のように、端点間勾配取得部９が求めた各端点間の勾配ＧNに、基準勾配Ｇを足し合わせることで、端点間の実際の道路勾配ＧN’を求めることができる。
【００５８】
ここで、隣り合う端点間の実際の距離ｄを求める方法について説明しておく。
【００５９】
本実施の形態では、勾配推定部５は、隣り合う端点間の実際の距離ｄを求める端点間実距離取得部１１をさらに備えている。
【００６０】
本実施の形態では、車両の走行中に、画像取得部３が取得した画像上で、任意の端点がその端点よりも車両に近い端点の位置まで移動するためにかかる時間を求め、その求めた時間と、車両の車速とを基に、隣り合う端点間の実際の距離ｄを求めるように、端点間実距離取得部１１を構成した。
【００６１】
つまり、本実施の形態では、隣り合う端点間の実際の距離ｄを車両が走行するのにかかった時間を求め、その時間に車速を掛け合わせて車両の走行距離を求めることで、隣り合う端点間の実際の距離ｄを求めるように端点間実距離取得部１１を構成した。
【００６２】
ただし、隣り合う端点間の実際の距離ｄを求める方法は、これに限定されるものではなく、例えば、白線のペイント部分と非ペイント部分の長さを道路情報データとして予め蓄積しておき、ＧＰＳにより車両がどの道路を走っているかを判定して道路情報データを参照することによって、隣り合う端点間の実際の距離ｄを求めるようにしてもよい。
【００６３】
次に、本実施の形態に係る道路勾配推定装置１の処理フローについて図４を用いて説明する。
【００６４】
図４に示すように、道路勾配推定装置１では、まず、ステップＳ１にて、画像取得部３が、カメラ２が撮像した画像を取得する。
【００６５】
ステップＳ２では、画像処理部４の視点変換処理部７が視点変換処理を行い、その後、画像処理部４が、エッジ抽出処理（ステップＳ３）、白線認識処理（ステップＳ４）を順次行う。
【００６６】
ステップＳ５では、画像処理部４の端点抽出部６が白線の端点の抽出を行い、その後、ステップＳ６にて、抽出した端点を近い順にリスト化する（各端点に番号をつける）。
【００６７】
ステップＳ７では、勾配推定部５の端点間勾配取得部９が、車両に一番近い０番目の端点に初期値を与える。すなわち、０番目の端点の実際の位置（Ｌ0’，Ｈ0’）が、視点変換処理部７で求めた０番目の端点の見かけ上の位置（Ｌ0，０）と等しいと仮定する。
【００６８】
ステップＳ８では、端点間勾配取得部９が、次の端点があるか判断し、ＹＥＳと判断された場合、ステップＳ９にて、上述の式（１），式（２）を用いて、次の端点の位置を推定し、ステップＳ８に戻る。
【００６９】
ステップＳ８にてＮＯと判断された場合、すなわち、ステップＳ５で抽出した全ての端点について実際の位置（ＬN’，ＨN’）を求めた後、ステップＳ１０にて、基準勾配取得部８が、自車両位置の道路勾配、すなわち基準勾配Ｇを求める。
【００７０】
その後、ステップＳ１１にて、端点間勾配取得部９が、上述の式（３）を用いて、各端点間の勾配ＧNを求め、道路勾配演算部１０が、求めた各端点間の勾配ＧNにステップＳ１０で求めた基準勾配Ｇを足し合わせて、上述の式（１８）より、端点間の実際の道路勾配ＧN’を求める。
【００７１】
以上説明したように、本実施の形態に係る道路勾配推定装置１では、抽出した白線が破線であるとき、その白線のペイント部分と非ペイント部分の境界である端点を抽出し、視点変換処理により、車両前方の道路の道路勾配が基準勾配Ｇで一定であると仮定したときの各端点の見かけ上の位置を求め、隣り合う端点間の見かけ上の距離と、予め求めた隣り合う端点間の実際の距離とに基づき、各端点間の勾配ＧNを求め、求めた各端点間の勾配ＧNに基準勾配Ｇを足し合わせることで、端点間の実際の道路勾配ＧN’を求めている。
【００７２】
これにより、認識した白線が破線であれば、片側の白線のみからでも道路勾配を推定できるようになり、左右両側の白線が同時に認識できない場合でも、白線が破線でさえあれば、車両前方の道路の道路勾配を推定することが可能になる。
【００７３】
なお、車両の両側の白線を認識できた場合には、両側の白線を用いて従来通りの道路勾配推定を行い、片側の白線のみしか認識できなかった場合にのみ、上述のような道路勾配推定を行うように勾配推定部５を構成してもよい。また、車両の両側の白線を認識できた場合においても、両側の白線を用いて従来通りの道路勾配推定を行うと同時に、上述のような道路勾配推定を補助的に行うように構成してもよい。これにより、道路勾配推定結果の信頼性を高めることができる。
【００７４】
本発明は上記実施の形態に限定されるものではなく、本発明の趣旨を逸脱しない範囲で種々の変更を加え得ることは勿論である。
【符号の説明】
【００７５】
１ 道路勾配推定装置
２ カメラ
３ 画像取得部
４ 画像処理部
５ 勾配推定部
６ 端点抽出部
７ 視点変換処理部
８ 基準勾配取得部
９ 端点間勾配取得部
１０ 道路勾配演算部
１１ 端点間実距離取得部
【技術分野】
【０００１】
本発明は、車両前方の道路の道路勾配を推定する道路勾配推定装置に関するものである。
【背景技術】
【０００２】
道路勾配の変化を予測し、早めに加減速を開始することで、燃費を向上できることが知られている。特に、大型車の場合、乗用車と比較して加速性能が低く、燃費に対する要求も高いためその効果は大きい。
【０００３】
従来より、道路勾配を推定する手法として、カメラにより自車両の前方の画像を取得し、画像処理によって白線（道路区分線）を認識し、左右の白線の開き具合などから車両の前方の道路の道路勾配、凹凸の変化を推定する方法が提案されている。
【０００４】
この方法では、例えば、自車両が平坦な道路（勾配が０の道路）を走行しているとすると、図５（ａ）のように白線Ｌが地平線Ｈ上で交われば、前方の道路は平坦であり、図５（ｂ）のように白線Ｌが地平線Ｈよりも低い位置で交われば、前方の道路は下り坂であり、図５（ｃ）のように白線Ｌが地平線Ｈよりも高い位置で交われば、前方の道路は上り坂である、と判断することができる。
【０００５】
このような道路勾配の推定は、図６に示すような道路勾配推定装置６１で実現できる。この道路勾配推定装置６１は、車両前方の道路の画像を撮像するカメラ２と、カメラ２が撮像した画像を取得する画像取得部３と、画像取得部３が取得した画像の画像処理を行い、白線を抽出する画像処理部４と、画像処理部４が抽出した白線から車両前方の道路の道路勾配を推定する勾配推定部５と、を備えている。
【０００６】
なお、この出願の発明に関連する先行技術文献情報としては、特許文献１，２がある。
【先行技術文献】
【特許文献】
【０００７】
【特許文献１】特開２００９−４１９７２号公報
【特許文献２】特開平９−３２５０２６号公報
【発明の概要】
【発明が解決しようとする課題】
【０００８】
しかしながら、上述の従来技術では、左右の白線Ｌの開き具合などから道路勾配を推定するため、左右両側の白線Ｌがそろわないと道路勾配の推定ができないという問題がある。換言すれば、上述の従来技術では、片側の白線Ｌのみから道路勾配を推定することができないという問題がある。
【０００９】
これは、図７に示すように、片側の白線Ｌのみから道路勾配を推定する場合、白線Ｌの歪曲が勾配によるものなのかカーブによるものなのか判断できないためである。
【００１０】
そこで、本発明の目的は、上記課題を解決し、片側の白線のみからでも車両前方の道路の道路勾配を推定可能な道路勾配推定装置を提供することにある。
【課題を解決するための手段】
【００１１】
本発明は上記目的を達成するために創案されたものであり、車両前方の道路の画像を撮像するカメラと、該カメラが撮像した画像を取得する画像取得部と、該画像取得部が取得した画像の画像処理を行い、白線を抽出する画像処理部と、該画像処理部が抽出した白線から前記車両前方の道路の道路勾配を推定する勾配推定部と、を備えた道路勾配推定装置において、前記画像処理部は、抽出した白線が破線であるとき、その白線のペイント部分と非ペイント部分の境界である端点を抽出する端点抽出部と、該端点抽出部が抽出した各端点の前記画像上での位置と、前記カメラの設置条件や特性とを基に、視点変換処理を行い、前記車両前方の道路の道路勾配が、前記車両が走行している位置での道路勾配で一定であると仮定したときの各端点の見かけ上の位置を求める視点変換処理部と、を備え、前記勾配推定部は、前記車両が走行している位置での道路勾配を求める基準勾配取得部と、前記各端点の見かけ上の位置から得られる隣り合う端点間の見かけ上の距離と、予め求めた隣り合う端点間の実際の距離とに基づき、各端点間の勾配を求める端点間勾配取得部と、前記端点間勾配取得部が求めた各端点間の勾配に、前記基準勾配取得部が求めた前記車両が走行している位置での道路勾配を足し合わせることで、前記端点間の実際の道路勾配を求める道路勾配演算部と、を備えた道路勾配推定装置である。
【００１２】
前記端点間勾配取得部は、前記端点抽出部が抽出した各端点の番号を前記車両に近い順に０、１、・・・とし、前記車両前方の道路の道路勾配が前記基準勾配で一定であると仮定した場合の仮想道路平面を基準とした（距離，高さ）の座標系にて、Ｎ番目の端点の見かけ上の位置を（ＬN，０）、Ｎ番目の端点の実際の位置を（ＬN’，ＨN’）としたとき、前記車両に最も近い０番目の端点の実際の位置（Ｌ0’，Ｈ0’）が、前記視点変換処理部で求めた０番目の端点の見かけ上の位置（Ｌ0，０）と等しいと仮定し、［数１］に示す式（１），式（２）
【００１３】
【数１】
【００１４】
により、各端点の実際の位置を順次求め、下式（３）
ＧN＝ｔａｎ-1｛（ＨN+1’−ＨN’）／（ＬN+1’−ＬN’）｝ ・・・（３）
より、Ｎ番目とＮ＋１番目の端点間の勾配ＧNを求めるように構成されてもよい。
【００１５】
前記勾配推定部は、前記車両の走行中に、前記画像上で、任意の端点がその端点よりも前記車両に近い端点の位置まで移動するためにかかる時間を求め、その求めた時間と、前記車両の車速とを基に、前記隣り合う端点間の実際の距離を求める端点間実距離取得部をさらに備えてもよい。
【発明の効果】
【００１６】
本発明によれば、片側の白線のみからでも車両前方の道路の道路勾配を推定可能な道路勾配推定装置を提供できる。
【図面の簡単な説明】
【００１７】
【図１】本発明の一実施の形態に係る道路勾配推定装置の概略構成図である。
【図２】本発明において、破線の白線ではペイント部と非ペイント部が一定の間隔で周期的に繰り返されていることを説明する図である。
【図３】（ａ），（ｂ）は、図１の道路勾配推定装置において、端点間の道路勾配を推定する原理を説明する図である。
【図４】図１の道路勾配推定装置の処理フローを示すフローチャートである。
【図５】（ａ）〜（ｃ）は、従来の道路勾配推定方法を説明する図である。
【図６】従来の道路勾配推定装置の概略構成図である。
【図７】従来方法では、片側の白線のみから車両前方の道路の道路勾配を推定することができないことを説明する図である。
【発明を実施するための形態】
【００１８】
以下、本発明の実施の形態を添付図面にしたがって説明する。
【００１９】
図１は、本実施の形態に係る道路勾配推定装置の概略構成図である。
【００２０】
図１に示すように、道路勾配推定装置１は、車両前方の道路の画像を撮像するカメラ２と、カメラ２が撮像した画像を取得する画像取得部３と、画像取得部３が取得した画像の画像処理を行い、白線を抽出する画像処理部４と、画像処理部４が抽出した白線から車両前方の道路の道路勾配を推定する勾配推定部５と、を備えている。
【００２１】
画像処理部４は、ソーベルフィルタ等により画像取得部３が取得した画像の垂直エッジを抽出するエッジ抽出処理を行い、垂直エッジのエッジ点を抽出した後、ハフ変換を用いて直線成分を抽出し、車線幅・白線幅等の条件で候補を絞り込み、白線を抽出する白線認識処理を行う。エッジ抽出処理や白線認識処理は公知技術であるため、ここでは説明を省略する。
【００２２】
本実施の形態に係る道路勾配推定装置１では、画像処理部４は、抽出した白線が破線であるとき、その白線のペイント部分と非ペイント部分の境界である端点を抽出する端点抽出部６を備えている。
【００２３】
白線には実線と破線があり、片側二車線以上の高速道路では少なくとも左右のうち一方は破線であることが多い。例えば、一般的な高速道路では、図２に示すように、破線の白線のペイント部２１と非ペイント部２２は一定の間隔で周期的に繰り返されている。本発明では、この間隔に着目して道路勾配を推定する。
【００２４】
上述の白線認識処理によって求まるのは直線を表す式のみであるため、本実施の形態では、端点抽出部６にて別途白線の端点を抽出するように構成している。端点抽出部６は、白線認識処理で抽出した直線上またはその近傍にあるエッジ点を列挙し、連続的に並んでいるかを調べる。端点以外でも白線の汚れなどによってエッジ点が途切れる場合があるため、その周辺で水平エッジを探索し、端点かどうかを判断する。端点抽出部６は、抽出された端点を自車両から近い順に列挙する。ここでは、抽出した各端点の番号を車両に近い順に０、１、・・・とする。
【００２５】
また、本実施の形態に係る道路勾配推定装置１では、画像処理部４は、端点抽出部６が抽出した各端点の画像上での位置と、カメラ２の設置条件や特性とを基に、視点変換処理を行い、車両前方の道路の道路勾配が、車両が走行している位置での道路勾配（以下、基準勾配という）で一定であると仮定した場合の各端点の見かけ上の位置を求める視点変換処理部７を備えている。
【００２６】
カメラ２の高さ、俯角、画角などのパラメータが既知であれば、カメラ２で取得した車両前方の画像を真上から見たように視点変換することができる。視点変換処理は公知であるため詳細な説明は省略するが、［数２］に示す式（４），式（５）のような変換式を用いて視点変換できることが一般に知られている。
【００２７】
【数２】
【００２８】
なお、視点変換処理を行う時期は特に限定されるものではなく、上述のように端点抽出後に視点変換を行うようにしてもよいし、視点変換後の座標上で端点を抽出するように構成してもよい。
【００２９】
なお、視点変換後の端点の見かけ上の位置は、車両前方の道路の道路勾配が基準勾配で一定であると仮定した場合に、真上（走行面に対して垂直方向）から見たときの位置情報であるから、高さ情報は含まれていない。以下、視点変換後のＮ番目の端点の見かけ上の位置を（ＬN，０）と記載する。ここでＬNは、道路が平坦であるという仮定で視点変換したＮ番目の端点までの見かけの距離である。以下、括弧書きで座標を示す場合、車両前方の道路の道路勾配が基準勾配で一定であると仮定した場合の仮想道路平面を基準とした（距離，高さ）を示すものとする。ＬNは、画像上でのＮ番目の端点のｙ座標の位置がｙNだとすると、上述の式（４）を用いて、［数３］に示す式（６）のように表すことができる。
【００３０】
【数３】
【００３１】
本実施の形態に係る道路勾配推定装置１では、勾配推定部５は、車両が走行している位置での道路勾配である基準勾配Ｇを求める基準勾配取得部８と、各端点の見かけ上の位置から得られる隣り合う端点間の見かけ上の距離と、予め求めた隣り合う端点間の実際の距離とに基づき、各端点間の勾配ＧNを求める端点間勾配取得部９と、端点間勾配取得部９が求めた各端点間の勾配ＧNに、基準勾配Ｇを足し合わせることで、端点間の実際の道路勾配ＧN’を求める道路勾配演算部１０と、を備えている。
【００３２】
基準勾配取得部８で基準勾配Ｇを求める方法については、数多く提案されており、特に限定するものではないが、例えば、車速の時間微分によって求めた加速度と、加速度センサから求めた実際の加速度を比較して基準勾配Ｇを推定することができる。
【００３３】
端点間勾配取得部９は、抽出した端点間の見かけ上の距離と、隣り合う端点間の実際の距離ｄとを比較して、端点間の勾配を求めるように構成される。隣り合う端点間の実際の距離ｄを求める方法については、後述する。
【００３４】
図３（ａ）に示すように、Ｎ番目の端点が実座標上で点Ａの位置にあるとすると、Ｎ＋１番目の端点は、点Ａを中心とする半径ｄの円Ｂの円周上に存在することになる。他方、カメラ２の高さをＨとすると、Ｎ＋１番目の端点は、カメラ２の位置である（０，Ｈ）とＮ＋１番目の端点の見かけ上の位置（ＬN+1，０）を結ぶ直線Ｃ上に存在することになる。したがって、円Ｂと直線Ｃの交点Ｄが、Ｎ＋１番目の端点の実際の位置になる。
【００３５】
図３（ａ）のように、Ｎ番目とＮ＋１番目の端点間の見かけ上の距離Ｅが、隣り合う端点間の実際の距離ｄよりも長い場合には、Ｎ番目の端点からＮ＋１番目の端点は上り坂であると判断することができ、図３（ｂ）のように、Ｎ番目とＮ＋１番目の端点間の見かけ上の距離Ｅが、隣り合う端点間の実際の距離ｄよりも短い場合には、Ｎ番目の端点からＮ＋１番目の端点は下り坂であると判断することができる。
【００３６】
つまり、白線認識を行い、端点として認識された点の間隔と、理論値（端点間の実際の距離ｄ）とを比較することで、大まかな勾配を推定することができる。実際にはＮ番目の端点の高さは０ではないので、あくまで大まかな判断ではあるが、傾向としては、理論値より短く映っていれば下り坂、長く映っていれば上り坂と判断できる。
【００３７】
ここで、Ｎ番目の端点の実際の位置（ＬN’，ＨN’）から、Ｎ＋１番目の端点の実際の位置（ＬN+1’，ＨN+1’）を求める方法を以下に説明する。なお、ＬN’は、道路が平坦であると仮定したときのＮ番目の端点までの距離、ＨN’は、道路が平坦であると仮定したときのＮ番目の端点の平坦面（道路面）からの高さを表している。
【００３８】
図３（ａ）における直線Ｃの長さは、［数４］に示す式（７）で表される。
【００３９】
【数４】
【００４０】
よって、直線Ｃの直線方向の単位ベクトルは、［数５］に示す式（８）で表すことができ、直線Ｃに対して垂直方向の単位ベクトルは、［数６］に示す式（９）のように表すことができる。
【００４１】
【数５】
【００４２】
【数６】
【００４３】
ここで、Ｎ番目の端点である点Ａ、つまり（ＬN’，ＨN’）の位置から直線Ｃに垂線（直線Ｃに対して垂直な線）を引いたときの垂線の足（垂線と直線Ｃの交点）を点Ｆとする。点Ａから点Ｆまでの距離をｋとすると、点Ｆの位置は、点Ａから式（９）の単位ベクトルをｋ倍した長さ移動した位置となるので、［数７］に示す式（１０）のように表すことができる。
【００４４】
【数７】
【００４５】
直線Ｃの式は、下式（１１）
ＨＬN+1’＋ＨN+1’ＬN+1＝ＨＬN+1 ・・・（１１）
または下式（１２）
（ＬN+1’／ＬN+1）＋（ＨN+1’／Ｈ）＝１ ・・・（１２）
で表すことができるので、点Ｆの位置を式（１１）または式（１２）のＬN+1’、ＨN+1’として代入して整理すると、［数８］に示す式（１３）のように、ｋを求めることができる。
【００４６】
【数８】
【００４７】
この式（１３）を上述の式（１０）に代入すると、点Ｆの位置は［数９］に示す（式１４）のようになる。
【００４８】
【数９】
【００４９】
ここで、点Ｆから点Ｄ、すなわちＮ＋１番目の端点までの距離は、［数１０］に示す式（１５）で表される。
【００５０】
【数１０】
【００５１】
点Ｄの位置（ＬN+1’，ＨN+1’）は、点Ｆから直線Ｃの直線方向に式（１５）の距離移動した位置なので、ＬN+1’，ＨN+1’は、それぞれ［数１１］に示す式（１６），式（１７）のようになり、式を整理すると、［数１２］に示す式（１），式（２）のようになる。
【００５２】
【数１１】
【００５３】
【数１２】
【００５４】
以上より求めた式（１），式（２）を用いれば、Ｎ番目の端点の実際の位置（ＬN’，ＨN’）から、Ｎ＋１番目の端点の実際の位置（ＬN+1’，ＨN+1’）を求めることが可能になる。
【００５５】
本実施の形態では、端点間勾配取得部９は、道路面に段差や屈折は無く道路勾配は連続的に変化するものとし、車両に最も近い０番目の端点の実際の位置（Ｌ0’，Ｈ0’）が、視点変換処理部７で求めた０番目の端点の見かけ上の位置（Ｌ0，０）と等しいと仮定し（換言すれば、最も近い０番目の端点は自車両が走行中の道路平面と同一平面上にあると仮定し）、上述の式（１），式（２）の漸化式を用いて各端点の実際の位置を順次求める。初期値として０番目の端点の位置を設定すれば、式（１），式（２）により各端点の実際の位置が順次求められることになる。
【００５６】
端点間勾配取得部９は、各端点の実際の位置を求めた後、下式（３）
ＧN＝ｔａｎ-1｛（ＨN+1’−ＨN’）／（ＬN+1’−ＬN’）｝ ・・・（３）
より、Ｎ番目とＮ＋１番目の端点間の勾配ＧNを順次求めるように構成される。
【００５７】
なお、ここでいう端点間の勾配ＧNとは、基準勾配Ｇを０と仮定したときの道路勾配（端点で区切られた各区間での平均勾配）である。よって、道路勾配演算部１０にて、下式（１８）
ＧN’＝Ｇ＋ＧN
＝Ｇ＋ｔａｎ-1｛（ＨN+1’−ＨN’）／（ＬN+1’−ＬN’）｝
・・・（１８）
のように、端点間勾配取得部９が求めた各端点間の勾配ＧNに、基準勾配Ｇを足し合わせることで、端点間の実際の道路勾配ＧN’を求めることができる。
【００５８】
ここで、隣り合う端点間の実際の距離ｄを求める方法について説明しておく。
【００５９】
本実施の形態では、勾配推定部５は、隣り合う端点間の実際の距離ｄを求める端点間実距離取得部１１をさらに備えている。
【００６０】
本実施の形態では、車両の走行中に、画像取得部３が取得した画像上で、任意の端点がその端点よりも車両に近い端点の位置まで移動するためにかかる時間を求め、その求めた時間と、車両の車速とを基に、隣り合う端点間の実際の距離ｄを求めるように、端点間実距離取得部１１を構成した。
【００６１】
つまり、本実施の形態では、隣り合う端点間の実際の距離ｄを車両が走行するのにかかった時間を求め、その時間に車速を掛け合わせて車両の走行距離を求めることで、隣り合う端点間の実際の距離ｄを求めるように端点間実距離取得部１１を構成した。
【００６２】
ただし、隣り合う端点間の実際の距離ｄを求める方法は、これに限定されるものではなく、例えば、白線のペイント部分と非ペイント部分の長さを道路情報データとして予め蓄積しておき、ＧＰＳにより車両がどの道路を走っているかを判定して道路情報データを参照することによって、隣り合う端点間の実際の距離ｄを求めるようにしてもよい。
【００６３】
次に、本実施の形態に係る道路勾配推定装置１の処理フローについて図４を用いて説明する。
【００６４】
図４に示すように、道路勾配推定装置１では、まず、ステップＳ１にて、画像取得部３が、カメラ２が撮像した画像を取得する。
【００６５】
ステップＳ２では、画像処理部４の視点変換処理部７が視点変換処理を行い、その後、画像処理部４が、エッジ抽出処理（ステップＳ３）、白線認識処理（ステップＳ４）を順次行う。
【００６６】
ステップＳ５では、画像処理部４の端点抽出部６が白線の端点の抽出を行い、その後、ステップＳ６にて、抽出した端点を近い順にリスト化する（各端点に番号をつける）。
【００６７】
ステップＳ７では、勾配推定部５の端点間勾配取得部９が、車両に一番近い０番目の端点に初期値を与える。すなわち、０番目の端点の実際の位置（Ｌ0’，Ｈ0’）が、視点変換処理部７で求めた０番目の端点の見かけ上の位置（Ｌ0，０）と等しいと仮定する。
【００６８】
ステップＳ８では、端点間勾配取得部９が、次の端点があるか判断し、ＹＥＳと判断された場合、ステップＳ９にて、上述の式（１），式（２）を用いて、次の端点の位置を推定し、ステップＳ８に戻る。
【００６９】
ステップＳ８にてＮＯと判断された場合、すなわち、ステップＳ５で抽出した全ての端点について実際の位置（ＬN’，ＨN’）を求めた後、ステップＳ１０にて、基準勾配取得部８が、自車両位置の道路勾配、すなわち基準勾配Ｇを求める。
【００７０】
その後、ステップＳ１１にて、端点間勾配取得部９が、上述の式（３）を用いて、各端点間の勾配ＧNを求め、道路勾配演算部１０が、求めた各端点間の勾配ＧNにステップＳ１０で求めた基準勾配Ｇを足し合わせて、上述の式（１８）より、端点間の実際の道路勾配ＧN’を求める。
【００７１】
以上説明したように、本実施の形態に係る道路勾配推定装置１では、抽出した白線が破線であるとき、その白線のペイント部分と非ペイント部分の境界である端点を抽出し、視点変換処理により、車両前方の道路の道路勾配が基準勾配Ｇで一定であると仮定したときの各端点の見かけ上の位置を求め、隣り合う端点間の見かけ上の距離と、予め求めた隣り合う端点間の実際の距離とに基づき、各端点間の勾配ＧNを求め、求めた各端点間の勾配ＧNに基準勾配Ｇを足し合わせることで、端点間の実際の道路勾配ＧN’を求めている。
【００７２】
これにより、認識した白線が破線であれば、片側の白線のみからでも道路勾配を推定できるようになり、左右両側の白線が同時に認識できない場合でも、白線が破線でさえあれば、車両前方の道路の道路勾配を推定することが可能になる。
【００７３】
なお、車両の両側の白線を認識できた場合には、両側の白線を用いて従来通りの道路勾配推定を行い、片側の白線のみしか認識できなかった場合にのみ、上述のような道路勾配推定を行うように勾配推定部５を構成してもよい。また、車両の両側の白線を認識できた場合においても、両側の白線を用いて従来通りの道路勾配推定を行うと同時に、上述のような道路勾配推定を補助的に行うように構成してもよい。これにより、道路勾配推定結果の信頼性を高めることができる。
【００７４】
本発明は上記実施の形態に限定されるものではなく、本発明の趣旨を逸脱しない範囲で種々の変更を加え得ることは勿論である。
【符号の説明】
【００７５】
１ 道路勾配推定装置
２ カメラ
３ 画像取得部
４ 画像処理部
５ 勾配推定部
６ 端点抽出部
７ 視点変換処理部
８ 基準勾配取得部
９ 端点間勾配取得部
１０ 道路勾配演算部
１１ 端点間実距離取得部
【特許請求の範囲】
【請求項１】
車両前方の道路の画像を撮像するカメラと、
該カメラが撮像した画像を取得する画像取得部と、
該画像取得部が取得した画像の画像処理を行い、白線を抽出する画像処理部と、
該画像処理部が抽出した白線から前記車両前方の道路の道路勾配を推定する勾配推定部と、を備えた道路勾配推定装置において、
前記画像処理部は、
抽出した白線が破線であるとき、その白線のペイント部分と非ペイント部分の境界である端点を抽出する端点抽出部と、
該端点抽出部が抽出した各端点の前記画像上での位置と、前記カメラの設置条件や特性とを基に、視点変換処理を行い、前記車両前方の道路の道路勾配が、前記車両が走行している位置での道路勾配で一定であると仮定したときの各端点の見かけ上の位置を求める視点変換処理部と、を備え、
前記勾配推定部は、
前記車両が走行している位置での道路勾配を求める基準勾配取得部と、
前記各端点の見かけ上の位置から得られる隣り合う端点間の見かけ上の距離と、予め求めた隣り合う端点間の実際の距離とに基づき、各端点間の勾配を求める端点間勾配取得部と、
前記端点間勾配取得部が求めた各端点間の勾配に、前記基準勾配取得部が求めた前記車両が走行している位置での道路勾配を足し合わせることで、前記端点間の実際の道路勾配を求める道路勾配演算部と、を備えた
ことを特徴とする道路勾配推定装置。
【請求項２】
前記端点間勾配取得部は、
前記端点抽出部が抽出した各端点の番号を前記車両に近い順に０、１、・・・とし、前記車両前方の道路の道路勾配が前記基準勾配で一定であると仮定した場合の仮想道路平面を基準とした（距離，高さ）の座標系にて、Ｎ番目の端点の見かけ上の位置を（ＬN，０）、Ｎ番目の端点の実際の位置を（ＬN’，ＨN’）としたとき、
前記車両に最も近い０番目の端点の実際の位置（Ｌ0’，Ｈ0’）が、前記視点変換処理部で求めた０番目の端点の見かけ上の位置（Ｌ0，０）と等しいと仮定し、［数１］に示す式（１），式（２）
【数１】
により、各端点の実際の位置を順次求め、下式（３）
ＧN＝ｔａｎ-1｛（ＨN+1’−ＨN’）／（ＬN+1’−ＬN’）｝ ・・・（３）
より、Ｎ番目とＮ＋１番目の端点間の勾配ＧNを求めるように構成される
請求項１記載の道路勾配推定装置。
【請求項３】
前記勾配推定部は、
前記車両の走行中に、前記画像上で、任意の端点がその端点よりも前記車両に近い端点の位置まで移動するためにかかる時間を求め、その求めた時間と、前記車両の車速とを基に、前記隣り合う端点間の実際の距離を求める端点間実距離取得部をさらに備える
請求項１または２記載の道路勾配推定装置。
【請求項１】
車両前方の道路の画像を撮像するカメラと、
該カメラが撮像した画像を取得する画像取得部と、
該画像取得部が取得した画像の画像処理を行い、白線を抽出する画像処理部と、
該画像処理部が抽出した白線から前記車両前方の道路の道路勾配を推定する勾配推定部と、を備えた道路勾配推定装置において、
前記画像処理部は、
抽出した白線が破線であるとき、その白線のペイント部分と非ペイント部分の境界である端点を抽出する端点抽出部と、
該端点抽出部が抽出した各端点の前記画像上での位置と、前記カメラの設置条件や特性とを基に、視点変換処理を行い、前記車両前方の道路の道路勾配が、前記車両が走行している位置での道路勾配で一定であると仮定したときの各端点の見かけ上の位置を求める視点変換処理部と、を備え、
前記勾配推定部は、
前記車両が走行している位置での道路勾配を求める基準勾配取得部と、
前記各端点の見かけ上の位置から得られる隣り合う端点間の見かけ上の距離と、予め求めた隣り合う端点間の実際の距離とに基づき、各端点間の勾配を求める端点間勾配取得部と、
前記端点間勾配取得部が求めた各端点間の勾配に、前記基準勾配取得部が求めた前記車両が走行している位置での道路勾配を足し合わせることで、前記端点間の実際の道路勾配を求める道路勾配演算部と、を備えた
ことを特徴とする道路勾配推定装置。
【請求項２】
前記端点間勾配取得部は、
前記端点抽出部が抽出した各端点の番号を前記車両に近い順に０、１、・・・とし、前記車両前方の道路の道路勾配が前記基準勾配で一定であると仮定した場合の仮想道路平面を基準とした（距離，高さ）の座標系にて、Ｎ番目の端点の見かけ上の位置を（ＬN，０）、Ｎ番目の端点の実際の位置を（ＬN’，ＨN’）としたとき、
前記車両に最も近い０番目の端点の実際の位置（Ｌ0’，Ｈ0’）が、前記視点変換処理部で求めた０番目の端点の見かけ上の位置（Ｌ0，０）と等しいと仮定し、［数１］に示す式（１），式（２）
【数１】
により、各端点の実際の位置を順次求め、下式（３）
ＧN＝ｔａｎ-1｛（ＨN+1’−ＨN’）／（ＬN+1’−ＬN’）｝ ・・・（３）
より、Ｎ番目とＮ＋１番目の端点間の勾配ＧNを求めるように構成される
請求項１記載の道路勾配推定装置。
【請求項３】
前記勾配推定部は、
前記車両の走行中に、前記画像上で、任意の端点がその端点よりも前記車両に近い端点の位置まで移動するためにかかる時間を求め、その求めた時間と、前記車両の車速とを基に、前記隣り合う端点間の実際の距離を求める端点間実距離取得部をさらに備える
請求項１または２記載の道路勾配推定装置。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【公開番号】特開２０１２−２５５７０３（Ｐ２０１２−２５５７０３Ａ）
【公開日】平成２４年１２月２７日（２０１２．１２．２７）
【国際特許分類】
【出願番号】特願２０１１−１２８５３９（Ｐ２０１１−１２８５３９）
【出願日】平成２３年６月８日（２０１１．６．８）
【出願人】（００００００１７０）いすゞ自動車株式会社 (1,721)
【Ｆターム（参考）】
【公開日】平成２４年１２月２７日（２０１２．１２．２７）
【国際特許分類】
【出願日】平成２３年６月８日（２０１１．６．８）
【出願人】（００００００１７０）いすゞ自動車株式会社 (1,721)
【Ｆターム（参考）】
[ Back to top ]