段差検知装置およびこれを備えた電動車両
【課題】 簡易な構成で適切に段差を検知できる段差検知装置を提供する。
【解決手段】 電動車いす２０の周辺を撮影するカメラ１１と、電動車いす２０の走行面からカメラまでの高さのデータ１７を記憶するメモリ１５と、カメラ１１にて撮影した画像に基づいて段差を検知する制御部１２とを備える。制御部１２は、第１の時刻にカメラ１１にて撮影した画像に、高さの測定対象となる測定点を設定すると共に、測定点よりも手前に基準点を設定し、第２の時刻にカメラ１１にて撮影した画像から基準点の対応点と測定点の対応点を求め、メモリ１５に記憶されたカメラ１１の高さのデータ１７に基づいて、基準点、測定点、基準点の対応点、測定点の対応点を、走行面と同じ高さの平面に射影し、射影平面上における基準点とその対応点との距離、および、測定点とその対応点との距離を求め、各距離から、測定点の高さを算出し、測定点の高さに基づいて段差を検知する。
【解決手段】 電動車いす２０の周辺を撮影するカメラ１１と、電動車いす２０の走行面からカメラまでの高さのデータ１７を記憶するメモリ１５と、カメラ１１にて撮影した画像に基づいて段差を検知する制御部１２とを備える。制御部１２は、第１の時刻にカメラ１１にて撮影した画像に、高さの測定対象となる測定点を設定すると共に、測定点よりも手前に基準点を設定し、第２の時刻にカメラ１１にて撮影した画像から基準点の対応点と測定点の対応点を求め、メモリ１５に記憶されたカメラ１１の高さのデータ１７に基づいて、基準点、測定点、基準点の対応点、測定点の対応点を、走行面と同じ高さの平面に射影し、射影平面上における基準点とその対応点との距離、および、測定点とその対応点との距離を求め、各距離から、測定点の高さを算出し、測定点の高さに基づいて段差を検知する。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、電動車いす等の電動車両に搭載して用いられる段差検知装置に関する。
【背景技術】
【０００２】
高齢化社会の到来や低炭素社会への転換に伴って、電動車両の利用者が増加することが予想される。近年、高齢者向けに作られた三輪または四輪の一人乗り電動車両が普及してきている。このような車両は、現在は「シニアカー」として知られているが、ガソリン自動車から電気自動車へ移行することが予想される将来の社会にあっては、一人乗りの小型車両が近距離移動のためのパーソナルモビリティとして普及する可能性がある。
【０００３】
自動車に比べて車体の小さい電動車両にとって、段差は、転倒の可能性がある危険な場所である。電動車いすやシニアカーは高齢者が利用することが多いが、高齢者が転倒した場合、大けがをするおそれがある。
【０００４】
最近では、段差を乗り越えることができるように工夫された車いすも提案されている（特許文献１、特許文献２）。しかし、利用者が段差に気付いていなければ、段差に当たったときの衝撃で態勢を崩すおそれがあり、やはり危険である。
【０００５】
ところで、路上にある障害物を検知する多くの技術が知られている。例えば、レーダでスキャンすることにより三次元情報を取得する方法（非特許文献１）、ミリ波帯の電波を用いて障害物までの距離を測る方法（非特許文献２）、超音波センサから発する超音波が物体で反射して返ってくるまでの時間から障害物までの距離を測る方法、レーザープロジェクタから発したマルチスポット光の結像点を検出して距離を算出する方法（非特許文献３）、複数のカメラで撮影した画像の視差情報を利用して三次元情報を得る方法（非特許文献４）、異なる時刻に撮影した２枚の画像から俯瞰画像を生成し、俯瞰画像に高さを有する障害物を合成する方法（特許文献３）等がある。
【先行技術文献】
【特許文献】
【０００６】
【特許文献１】特開２００４−４９９１０号公報
【特許文献２】特開２００８−１５４８４０号公報
【特許文献３】特開２００８−４８０９４号公報
【非特許文献】
【０００７】
【非特許文献１】城殿清澄他「レーザレーダを用いた高信頼な歩行者検出」２００６年 電子情報通信学会総合大会、Ａ−１７−８
【非特許文献２】梶木淳子他「ミリ波式センサを用いた障害物検出アルゴリズムに関する一研究」信学技報 ＴＥＣＨＮＩＣＡＬ ＲＥＰＯＲＴ ＯＦ ＩＥＩＣＥ． ＩＴＳ９９−１１３
【非特許文献３】荒蒔勲他「小型距離画像センサを用いた移動ロボットの障害物回避手法の提案」日本機械学会 ２００１年ロボティクス・メカトロニクス講演会 講演概要集
【非特許文献４】熊野仁子他「ステレオビジョンセンサを用いた自律移動ロボットの実時間障害物回避」日本機械学会 ２０００年ロボティクス・メカトロニクス講演会 講演概要集
【発明の概要】
【発明が解決しようとする課題】
【０００８】
上記した障害物を検知する技術のうち、レーザレーダ、ミリ波センサ、超音波センサ、レーザープロジェクタを用いる方法は、電磁波や超音波等の反射を検知する方法であるため、路上等に存在する障害物の検知には適している。しかし、例えば、階段や側溝のように走行中のレベルより低くなる段差では、電磁波や超音波が適切に反射して戻ってこないこともあり、そのような場合には段差を検知することができない。また、これらの方法で用いられるセンサ等は高価であり、自動車等に比べて単価が安い車いす等の電動車両に用いるのは現実的ではない。
【０００９】
上記したステレオビジョンセンサを用いれば、低くなっている段差を検知することが可能である。しかし、視差情報から三次元情報を得るためには、それぞれのカメラがどの方向を向いて設置されているかを正確に把握する必要があり、カメラのキャリブレーションが煩雑である。また、二台のカメラを用いるので、コストが高いという問題もある。
【００１０】
特許文献３に記載された俯瞰画像を生成する方法は、カメラを一台しか用いないので、比較的安価に装置を構成することができる。しかし、特許文献３では、異なる時刻に撮影した俯瞰画像を重ね合わせるために車両の移動量のデータを用いる必要がある。
【００１１】
そこで、本発明は上記背景に鑑み、簡易な構成により、走行中のレベルから上方向に突出した段差だけでなく、低くなっている段差をも適切に検知することができる段差検知装置およびこれを備えた電動車両を提供することを目的とする。
【課題を解決するための手段】
【００１２】
本発明は、電動車両に搭載して用いられる段差検知装置であって、電動車両の周辺を撮影するカメラと、電動車両の走行面からカメラまでの高さのデータを記憶する記憶部と、前記カメラにて撮影した画像に基づいて、画像に映った領域内にある段差を検知する制御部とを備え、前記制御部は、第１の時刻に前記カメラにて撮影した画像に、高さの測定対象となる測定点を設定すると共に、測定点よりも手前に基準点を設定し、第２の時刻に前記カメラにて撮影した画像の中から前記基準点の対応点と前記測定点の対応点を求め、前記記憶部に記憶されたカメラの高さのデータに基づいて、前記基準点、前記測定点、前記基準点の対応点、前記測定点の対応点を、前記走行面と同じ高さの平面に射影し、前記射影平面上における前記基準点とその対応点との距離、および、前記測定点とその対応点との距離を求め、前記各距離から、前記測定点の高さを算出し、前記測定点の高さに基づいて段差を検知し、段差を検知したときに、段差があることを示す信号を出力する。
【発明の効果】
【００１３】
本発明は、電動車両の走行面と同じ高さの平面に射影した測定点とその対応点との距離と、同平面に射影した基準点とその対応点との距離とに基づいて、簡易に測定点の高さを算出することができ、これにより段差を検知できる。
【図面の簡単な説明】
【００１４】
【図１】第１の実施の形態の段差検知装置を備えた電動車いすの構成を示す図である。
【図２】第１の実施の形態の段差検知装置の構成を示す図である。
【図３】第１の時刻ｔに撮影した画像の例を示す図である。
【図４】第２の時刻ｔ＋Δｔに撮影した画像の例を示す図である。
【図５】高さを求めるアルゴリズムについて説明するための図である。
【図６】高さを求めるアルゴリズムについて説明するための図である。
【図７】高さを求めるアルゴリズムについて説明するための図である。
【図８】第１の実施の形態の段差検知装置の動作を示す図である。
【図９】第２の実施の形態の段差検知装置の構成を示す図である。
【図１０】第２の実施の形態の段差検知装置の動作を示す図である。
【図１１】第３の実施の形態の段差検知装置の動作を示す図である。
【発明を実施するための形態】
【００１５】
以下、本発明の実施の形態の段差検知装置および電動車両について説明する。以下では、電動車両として電動車いすを例として説明するが、本発明は、電動車いす以外の電動車両にも適用することが可能である。例えば、本発明は、シニアカーや、超小型電気自動車、台車等に適用できる。また、床清掃ロボットのような自律移動ロボットに適用することも可能である。
【００１６】
（第１の実施の形態）
図１は、第１の実施の形態の段差検知装置１０を備えた電動車いす２０の構成を示す図である。段差検知装置１０は、カメラ１１が電動車いす２０の前方を撮影するような位置に取り付けられている。カメラ１１は、少なくとも電動車いす２０の前輪２３の一部が撮影範囲に入るように、下方に向けられている。これにより、撮影される画像の下方の領域には走行面が映ることになる。なお、ここでは、少なくとも前輪２３の一部が撮影範囲に入るような方向を向けてカメラ１１を取り付けているが、必ずしも前輪２３の一部が入らなくても、撮影される画像の下方の領域に走行面が映る角度であればよい。
【００１７】
図２は、段差検知装置１０の構成を示す図である。段差検知装置１０は、カメラ１１と、制御部１２と、スピーカ１３と、入力部１４と、メモリ１５とを備えている。メモリ１５には、制御部１２に、段差を検知する処理を実行させるためのプログラム１６と、カメラ１１の高さのデータ１７が記憶されている。ここで、カメラ１１の高さとは、電動車いす２０に搭載されたカメラ１１の走行面からの高さである。カメラ１１の高さは、カメラ１１を電動車いす２０に取り付けた際に計測し、計測した高さのデータを入力部１４から入力する。
【００１８】
制御部１２は、メモリ１５から読み出したプログラム１６を実行することにより、制御部１２は、カメラ１１にて撮影した画像に基づいて、画像に映った領域内にある段差を検知する機能を有している。スピーカ１３は、制御部１２にて段差を検知したときに、警報を出力する機能を有している。
【００１９】
次に、段差を検知する制御部１２の機能について説明する。以下に説明する機能は、メモリ１５に記憶されたプログラムを実行することにより実現される。制御部１２は、第１の時刻ｔに撮影した画像と、第２の時刻ｔ＋Δｔに撮影した画像とに基づいて、画像に映った領域内にある段差を検知する。
【００２０】
図３は、第１の時刻ｔに撮影した画像の例を示す図、図４は、第２の時刻ｔ＋Δｔに撮影した画像の例を示す図である。第１の時刻ｔと第２の時刻ｔ＋Δｔの画像を比較すると、第１の時刻ｔにおける画像に映っていた縁石Ｃが、第２の時刻ｔ＋Δｔにおける画像では近づいている。
【００２１】
制御部１２は、第１の時刻ｔにおける画像に、測定点Ｂと、測定点Ｂより手前にある基準点Ａを設定する。ここで、「手前」とは、カメラ１１に近い方であり、画像においては下方である。基準点Ａを測定点Ｂより手前に設定しているのは、本実施の形態においては、処理を簡単にするために、基準点Ａがある場所を走行面であると仮定して処理を行うためである。従って、電動車いす２０の走行面が映っている可能性が高い場所、すなわち、測定点Ｂより電動車いす２０に近い場所に基準点Ａを設定する。なお、本実施の形態では、カメラ１１は、少なくとも電動車いす２０の前輪２３の一部が撮影範囲に入るように、下方に向けられているので、撮影画像の下方の前輪２３の近傍に映る領域は、走行面である可能性が極めて高い。また、車輪の接地地点が撮影範囲に入るような場所および角度でカメラ１１を設置すると、確実にカメラの撮影範囲に走行面を入れることができる。従って、例えば、前輪の接地地点から前方数ｍが撮影範囲になるように設置してもよい。
【００２２】
図３に示す例では、測定点Ｂとして縦５個×横１０個からなる５０個の点を設定している。基準点Ａとして、横に並ぶ１０個の点を設定する。測定点Ｂの間隔は、検出したい段差の大きさや、カメラ１１の解像度に基づいて定めることができる。測定点Ｂの密度を高めることにより、より詳細な情報を得ることができる。本実施の形態では、１０個の基準点を設定しているが、基準点は１個でもよい。
【００２３】
制御部１２は、時刻ｔ＋Δｔにおける画像の中から、基準点Ａに対応する対応点Ａ´、測定点Ｂに対応する対応点Ｂ´を求める。対応点とは、異なる画像において、同じ位置を示す点である。対応点は、例えば、基準点Ａまたは測定点Ｂを中心とする所定の領域と相関の高い領域を別の画像の中から求め、その領域の中心を対応点として求める。対応点の算出には、相互相関（Ｃｒｏｓｓ−ｃｏｒｒｅｌａｔｉｏｎ）（例えば、Ｂ．Ｐ．Ｌａｔｈｉ著「ラシィ 詳説 ディジタル・アナログ通信システム」ｐ５０−５１）を用いることができる。相互相関を用いる方法に限らず、別の公知の方法を用いてもよい。例えば、類似度（ＳＳＤ：Ｓｕｍ ｏｆ Ｓｑｕａｒｅ Ｄｉｆｆｅｒｅｎｃｅ）や相違度（ＳＡＤ：Ｓｕｍ ｏｆ Ａｂｓｏｌｕｔｅ Ｄｉｆｆｅｒｅｎｃｅ）を用いてもよいし、テンプレートマッチングによる局所的な相関の探索、Ｋａｎａｄｅ−Ｌｕｃａｓ−Ｔｏｍａｓｉトラッカー等などを採用することもできる。
【００２４】
図４は、図３に示した基準点Ａの対応点Ａ´、測定点Ｂの対応点Ｂ´を示す図である。図４に示す画像の方が、縁石Ｃに近づいているので、対応点Ａ´，Ｂ´は、画像の下方に移動している。また、若干ではあるが、図４に示す画像の方が、縁石Ｃが大きく映っている。図４に示す例では、全ての対応点が画像内に存在しているが、電動車いす２０の移動量が大きい場合や電動車いす２０が大きく曲がった場合等には、対応点が画像内に存在しないことも考えられる。
【００２５】
図５および図６は、制御部１２によって高さを求めるアルゴリズムについて説明するための図である。制御部１２は、基準点Ａ、測定点Ｂ（図３参照）と、基準点Ａの対応点Ａ´および測定点Ｂの対応点Ｂ´（図４参照）を走行面と同じ高さの平面（以下、「射影平面」という）に射影する。このとき制御部１２は、カメラ１１の高さＨのデータをメモリ１５から読み出し、読み出した高さＨのデータを用いる。
【００２６】
図５は、カメラ座標系において、基準点Ａがその対応点Ａ´に移動し、測定点Ｂがその対応点Ｂ´に移動した例を示す。制御部１２は、基準点Ａを射影平面に射影し点Ａ１の座標を求め、基準点Ａの対応点Ａ´を走行面に射影し点Ａ１´の座標を求める。同様に、制御部１２は、測定点Ｂを走行面に射影し点Ｂ１の座標を求め、測定点Ｂの対応点Ｂ´を射影平面に射影し点Ｂ１´の座標を求める。続いて、制御部１２は、基準点Ａ１とその対応点Ａ１´との距離Ｄ１、測定点Ｂとその対応点Ｂ１´との距離Ｄ２を求める。
【００２７】
図６は、距離Ｄ１、距離Ｄ２およびカメラ１１の高さＨを用いて、測定点Ｂの高さを求める例を示す図である。制御部１２は、基準点Ａ１がその対応点Ａ１´まで移動した移動距離Ｄ１と等しくなるような測定点Ｂの高さｈを求める。具体的には、下記の式（１）によって高さｈを計算する。なお、ここで求められる高さｈは、測定点Ｂを含む領域を代表する高さである。
ｈ＝Ｈ×（１−Ｄ１／Ｄ２）・・・（１）
【００２８】
制御部１２は、すべての測定点に対して上記の計算を行うことにより、すべての測定点の高さを求める。本実施の形態において、「高さ」は、走行面を基準とした高さである。走行面より上に突出している場合には高さはプラスの値で表され、例えば、窪みなどのように、走行面より下に低くなっている場合には、高さはマイナスの値で表わされる。上記式（１）による計算により、図７に示すように、走行面より低くなっている段差も適切に検出できる。
【００２９】
本実施の形態では、制御部１２は、基準点の移動距離Ｄ１として、１０個ある基準点の移動距離の平均を用いる。これにより、対応点の算出誤差や、走行面でないところに基準点を設定したこと等に起因する誤差を低減し、安定した測定結果を得ることができる。
【００３０】
制御部１２は、算出した測定点の高さのデータに基づいて、段差を検知する。制御部１２は、例えば、算出したすべての測定点の高さの絶対値と所定の閾値とを比較し、一つでも閾値以上の測定点がある場合に、段差があると判定することができる。所定の閾値には、電動車いす２０の利用者にとって危険な高さを設定することができる。例えば、１０ｃｍの段差が危険である場合には、閾値として１０ｃｍを用いる。この値は、製造時に段差検知装置１０に設定しておいてもよいし、ユーザが設定することとしてもよい。なお、本実施の形態では、走行面より高くなっている場合にも低くなっている場合にも、同じ閾値を用いて段差を検出しているが、走行面より高いか低いかによって段差を判定する閾値を変えてもよい。
【００３１】
制御部１２は、段差があることを検知したときには、段差があることを示す信号をスピーカ１３に対して出力する。スピーカ１３は、制御部１２からこの信号を受信したときに、警報音を出力する。警報音は、所定時間（例えば、２秒）、継続して出力することとしてもよい。
【００３２】
図８は、本実施の形態の段差検知装置１０の動作を示す図である。段差検知装置１０は、図８に示す動作を繰り返し行うことにより、電動車いす２０の前方周辺に段差がある場合に、段差を検知する。
【００３３】
段差検知装置１０は、第１の時刻ｔに画像を取得し、その画像に基準点と測定点を設定する（Ｓ１０）。続いて、段差検知装置１０は、Δｔ秒後の第２の時刻ｔ＋Δｔに画像を取得し、先に設定した基準点、測定点に対応する対応点を求める（Ｓ１２）。
【００３４】
次に、段差検知装置１０は、第１の時刻ｔに取得した画像中の基準点および測定点と、第２の時刻ｔ＋Δｔに取得した画像中の基準点の対応点および測定点の対応点を、走行面と同じ高さの射影平面に射影し、その座標を求める（Ｓ１４）。続いて、段差検知装置１０は、射影平面上における基準点とその対応点との距離、測定点とその対応点との距離を求める（Ｓ１６）。ここで求めた距離は、時刻ｔから時刻ｔ＋Δｔの間に、基準点および測定点が射影平面上で移動した距離である。段差検知装置１０は、複数の基準点について求めた距離の平均値を求める（Ｓ１８）。
【００３５】
次に、段差検知装置１０は、基準点の平均移動距離と、測定点の移動距離と、カメラ１１の高さのデータ１７を用いて、それぞれの測定点の高さを求める（Ｓ２０）。段差検知装置１０は、求めた測定点の高さに基づいて、段差があるか否かを判定し、段差を検知した場合には（Ｓ２２でＹＥＳ）、段差があることを知らせる警報音をスピーカ１３から出力する（Ｓ２４）。段差がないと判定した場合には（Ｓ２２でＮＯ）、時刻ｔおよび時刻ｔ＋Δｔに取得した画像を使った処理を終了する。
【００３６】
本実施の形態の段差検知装置１０は、測定点の移動距離と基準点の移動距離とを用いて段差を検知するので、走行面より高くなっている段差のみならず、走行面より低くなっている段差をも検知することができる。
【００３７】
また、本実施の形態の段差検知装置１０は、一台のカメラ１１で撮影した画像を用いて段差を検知することができるので、キャリブレーションが容易であるとともに、装置の製造コストを抑制できる。
【００３８】
また、本実施の形態では、画像処理のみで段差を検知しており、電動車いす２０の移動量のデータを用いていないので、簡易な構成で装置を実現できるとともに、移動量を検知する機能を有していない電動車いす２０にも、取り付けるたけですぐに利用できる。
【００３９】
（第２の実施の形態）
次に、第２の実施の形態の段差検知装置１０ａを備えた電動車いす２０について説明する。第２の実施の形態の電動車いす２０の基本的な構成は、第１の実施の形態と同じである（図１参照）。第２の実施の形態の段差検知装置１０ａは、電動車いす２０の車輪の駆動制御部２２と連動しており、段差を検知したときに電動車いす２０を自動停止する。
【００４０】
図９は、第２の実施の形態の段差検知装置１０ａおよび電動車いす２０の構成を示す図である。ここでは、第１の実施の形態の段差検知装置１０と相違する構成を中心に説明する。第２の実施の形態の段差検知装置１０ａは、通信インターフェース１８を備えており、電動車いす２０の通信インターフェース２１と接続されている。
【００４１】
段差検知装置１０ａの制御部１２は、第１の実施の形態と同様に、第１の時刻と第２の時刻の画像から段差を検知する処理を行う。制御部１２は、段差を検知すると、段差があることを示す信号をスピーカ１３に送信すると共に、通信インターフェース１８を通じて電動車いす２０に送信する。電動車いす２０は、段差検知装置１０ａから段差があることを示す信号を受信すると、駆動制御部２２にて、車輪の駆動を停止する。
【００４２】
図１０は、第２の実施の形態の段差検知装置１０ａを備えた電動車いす２０の動作を示す図である。第２の実施の形態の段差検知装置１０ａによって段差を検知する動作は、第１の実施の形態と同じである（Ｓ１０〜Ｓ２２）。第２の実施の形態の段差検知装置１０ａは、段差を検知したときに（Ｓ２２でＹＥＳ）、スピーカ１３から警報音を出力すると共に、電動車いす２０を自動停止する（Ｓ２６）。
【００４３】
第２の実施の形態の段差検知装置１０ａを備えた電動車いす２０は、段差を検知したときに自動的に停止するので、安全性を高めることができる。また、第２の実施の形態の段差検知装置１０ａは、第１の実施の形態と同様に、走行面より低くなっている段差をも検知することができる、キャリブレーションが容易であるとともに、簡易な構成で装置を実現できる等の効果を有する。
【００４４】
本実施の形態では、段差を検知したときに電動車いす２０を自動停止する例について説明したが、電動車いす２０は、段差を回避するように制御してもよい。具体的には、段差検知装置１０ａが段差を検知したときに段差がない方向も検知し、電動車いす２０に、段差があることを示す信号と共に段差のない方向を示す信号を送信する。電動車いす２０の駆動制御部２２は、段差検知装置１０ａから通知された方向へ進行方向を変えるようにステアリング機能を有する車輪に指示信号を出す。なお、段差を検知したときに、電動車いす２０を自動停止するか方向変換するかのモードを選択できるようにしてもよい。他の車両や歩行者がいる公道において意図せぬ方向へ移動すると危険な場合もあるが、モードを選択できるようにすることにより、例えば、公道では自動停止し、庭や屋内では自動で方向変換するというように使い分けることができる。
【００４５】
（第３の実施の形態）
次に、第３の実施の形態の段差検知装置を備えた電動車いす２０について説明する。第３の実施の形態の電動車いす２０の基本的な構成は、第２の実施の形態と同じである（図１、図９参照）。第３の実施の形態の段差検知装置は、段差の高さだけではなく、段差までの距離に基づいて段差を検知する機能を有する。
【００４６】
図１１は、第３の実施の形態の段差検知装置を備えた電動車いす２０の動作を示す図である。第３の実施の形態の段差検知装置によって、測定点の高さを求めるまでの動作は、第１の実施の形態および第２の実施の形態と同じである（Ｓ１０〜Ｓ２０）。第３の実施の形態の段差検知装置は、測定点の高さを求めた後、高さの絶対値が所定の閾値より大きい測定点（以下、「段差候補」という）があるか否かを判定する（Ｓ２８）。段差候補がない場合には（Ｓ２８でＮＯ）、段差検知装置は、時刻ｔおよび時刻ｔ＋Δｔに取得した画像を使った処理を終了する。
【００４７】
段差候補がある場合には（Ｓ２８でＹＥＳ）、その測定点までの距離を求める（Ｓ３０）。具体的には、距離を求めるべき測定点を、その測定点の高さｈと同じ高さの平面に射影し、射影された測定点までの距離を求める（図６も参照）。次に、段差検知装置は、走行の障害になる可能性のある段差があるか否かを判定する（Ｓ３２）。具体的には、段差検知装置は、段差候補までの距離と所定の閾値とを比較し、段差候補までの距離が所定の閾値以下の場合には、段差があると判定する。
【００４８】
段差検知装置は、段差がないと判定した場合には（Ｓ３２でＮＯ）、時刻ｔおよび時刻ｔ＋Δｔに取得した画像を使った処理を終了する。段差検知装置は、段差を検知した場合には（Ｓ３２でＹＥＳ）、スピーカ１３から警報音を出力すると共に、電動車いす２０を自動停止する（Ｓ３４）。
【００４９】
第３の実施の形態の段差検知装置は、段差候補までの距離が所定の閾値以下となった場合に段差があると判定し、段差候補が所定の閾値より離れている場合には段差を検知しない。すなわち、電動車いす２０から遠くに離れていて、走行の障害にならない段差については、警報を出力したり、自動停止を行なわない。これにより、段差があっても危険でない場合には、電動車いす２０の円滑な走行の妨げにならないようにすることができる。
【００５０】
また、第３の実施の形態の段差検知装置は、上記した実施の形態と同様に、走行面より低くなっている段差をも検知することができる、キャリブレーションが容易であるとともに、簡易な構成で実現できる等の効果を有する。
【００５１】
以上、本発明の段差検知装置およびこれを備えた電動車両について、実施の形態を挙げて詳細に説明したが、本発明は上記した実施の形態に限定されるものではない。
【００５２】
上記した実施の形態では、電動車いす２０の前方周辺を撮影するような位置にカメラ１１を取り付ける例について説明したが、後方にも進行することが多い電動車両の場合には、電動車両の後方にカメラ１１を取り付けてもよい。これにより、前方に取り付けた場合と全く同様に、段差を検知することが可能である。
【００５３】
上記した第３の実施の形態では、段差候補までの距離が所定の閾値以上の場合に段差があることを検知したが、この判定に用いる所定の閾値は、設定により、あるいは、電動車いす２０の走行速度により可変としてもよい。例えば、電動車いす２０の走行速度が大きい場合には、電動車いす２０の走行速度が小さい場合より、所定の閾値を大きくしてもよい。これにより、速度に応じて、走行の障害になり得る段差を適切に検知することができる。
【００５４】
また、段差候補までの距離に加えて、その段差候補の方向のデータを用いて、段差を検知してもよい。具体的には、段差候補が、電動車いす２０の進行方向に対して、所定の角度以上外れている場合には、たとえ距離が短くとも段差として検知しないこととしてもよい。これにより、走行の障害になり得る段差を適切に検知することができる。
【００５５】
以下に、上記に説明した実施の形態の構成について、総括する。
（１）実施の形態の段差検知装置は、電動車両に搭載して用いられる段差検知装置であって、電動車両の周辺を撮影するカメラと、電動車両の走行面からカメラまでの高さのデータを記憶する記憶部と、前記カメラにて撮影した画像に基づいて、画像に映った領域内にある段差を検知する制御部とを備え、前記制御部は、第１の時刻に前記カメラにて撮影した画像に、高さの測定対象となる測定点を設定すると共に、測定点よりも手前に基準点を設定し、第２の時刻に前記カメラにて撮影した画像の中から前記基準点の対応点と前記測定点の対応点を求め、前記記憶部に記憶されたカメラの高さのデータに基づいて、前記基準点、前記測定点、前記基準点の対応点、前記測定点の対応点を、前記走行面と同じ高さの平面に射影し、前記射影平面上における前記基準点とその対応点との距離、および、前記測定点とその対応点との距離を求め、前記各距離から、前記測定点の高さを算出し、前記測定点の高さに基づいて段差を検知し、段差を検知したときに、段差があることを示す信号を出力する。
【００５６】
実施の形態の段差検知装置は、走行面と同じ高さの平面上に射影した測定点の移動距離と基準点の移動距離とを用いて段差を検知するので、走行面より高くなっている段差のみならず、走行面より低くなっている段差をも検知することができる。また、一台のカメラで撮影した画像を用いて段差を検知することができるので、キャリブレーションが容易であるとともに、簡易な構成の装置とすることができる。
【００５７】
（２）前記制御部は、前記カメラの高さをＨ、前記基準点とその対応点との距離をＤ１、測定点とその対応点の距離をＤ２として、測定点の高さｈを、ｈ＝Ｈ×（１−Ｄ１／Ｄ２）によって求めてもよい。この式により、測定点の高さｈを容易に求めることができる。
【００５８】
（３）前記制御部は、複数の基準点を設定し、複数の基準点と当該複数の基準点に対応する各対応点との距離の平均値を用いて前記測定点の高さを算出してもよい。複数の基準点の平均値を用いることにより、基準点に対応する対応点の算出誤差や、設定した基準点が走行面上にないことに起因する誤差等の影響を低減し、測定点の高さを精度良く求めることができる。
【００５９】
（４）前記制御部は、高さの絶対値が所定の閾値以上である測定点があったときに段差があると検知してもよい。これにより、測定点の高さのデータから段差を検知することができる。
【００６０】
（５）前記制御部は、画像上の測定点をその測定点の高さの平面に射影することにより、高さの絶対値が前記所定の閾値以上の測定点までの距離を求め、前記測定点までの距離が所定の閾値以下になったときに段差があると検知し、前記測定点までの距離が所定の閾値以下でないときには段差を検知しないこととしてもよい。これにより、電動車両から遠くに離れていて、走行の障害にならない場所については段差を検知せず、円滑な走行の妨げにならないようにできる。
【００６１】
（６）前記制御部から出力された段差があることを示す信号を受けたときに、段差があることを音声出力する音声出力部を備えてもよい。これにより、段差があることをユーザに知らせることができる。
【００６２】
（７）実施の形態にかかる電動車いすなどの電動車両は、上記に記載した段差検知装置を備える。上記の段差検知装置を備えることにより、適切に段差を検知できるので、電動車両の安全性を高めることができる。
【００６３】
（８）上記電動車両において、前記カメラが、前記電動車両の進行方向を撮影すると共に、電動車両の車輪の少なくとも一部を撮影する角度で取り付けられていてもよい。このような角度でカメラを取り付けることにより、撮影画像の下方の領域には走行面が入るので、撮影画像の下方に基準点を設定するだけで、走行面が映る部分に基準点を設定することができる。
【００６４】
（９）上記電動車両において、前記カメラが、前記電動車両の車輪が接地する位置を撮影範囲に含むような角度で取り付けられていてもよい。電動車両の車輪が接地する位置は走行面なので、この角度でカメラを取り付けることにより、確実に撮影範囲内に走行面を含めることができる。
【００６５】
（１０）上記電動車両において、前記制御部の出力は、車輪を駆動する駆動制御部に入力され、前記駆動制御部は、段差があることを示す信号が入力されたときに、前記車輪の駆動を停止する、あるいは、前記段差を回避するように駆動してもよい。この構成により、段差があるときに電動車両を停止し、または、段差を回避することにより転倒等の危険を未然に防止できる。
【００６６】
（１１）実施の形態のプログラムは、段差を検知するためのプログラムであって、周辺を撮影するカメラを有する電動車両に搭載して用いられるコンピュータに、電動車両の周辺の第１の時刻における画像を入力するステップと、電動車両の周辺の第２の時刻における画像を入力するステップと、前記第１の時刻における画像に、高さの測定対象となる測定点を設定すると共に、測定点よりも手前に基準点を設定するステップと、前記第２の時刻における画像の中から前記基準点の対応点と前記測定点の対応点を求めるステップと、記憶部から電動車両の走行面からカメラまでの高さのデータを読み出すステップと、前記カメラの高さのデータに基づいて、前記基準点、前記測定点、前記基準点の対応点、前記測定点の対応点を走行面と同じ高さの平面に射影するステップと、射影平面上における前記基準点とその対応点との距離、および、前記測定点とその対応点との距離を求めるステップと、前記各距離から、前記測定点の高さを算出するステップと、前記測定点の高さに基づいて段差を検知するステップと、段差を検知したときに、段差があることを示す信号を出力するステップとを実行させる。
【００６７】
この構成により、上記した段差検知装置と同様に、簡易な構成によって、適切に段差を検知することができると共に、キャリブレーションが容易である。
【００６８】
（１２）実施の形態の段差検知方法は、電動車両に搭載して用いられる段差検知装置によって、段差を検知する方法であって、前記段差検知装置が、電動車両の周辺を撮影するカメラにて第１の時刻に撮影した画像を入力するステップと、前記段差検知装置が、前記カメラにて第２の時刻に撮影した画像を入力するステップと、前記段差検知装置が、前記第１の時刻における画像に、高さの測定対象となる測定点を設定すると共に、測定点よりも手前に基準点を設定するステップと、前記段差検知装置が、前記第２の時刻における画像の中から前記基準点の対応点と前記測定点の対応点を求めるステップと、前記段差検知装置が、記憶部から電動車両の走行面からカメラまでの高さのデータを読み出すステップと、前記段差検知装置が、前記カメラの高さのデータに基づいて、前記基準点、前記測定点、前記基準点の対応点、前記測定点の対応点を走行面と同じ高さの平面に射影するステップと、前記段差検知装置が、射影平面上における前記基準点とその対応点との距離、および、前記測定点とその対応点との距離を求めるステップと、前記段差検知装置が、前記各距離から、前記測定点の高さを算出するステップと、前記段差検知装置が、前記測定点の高さに基づいて段差を検知するステップと、前記段差検知装置が、段差を検知したときに、段差があることを示す信号を出力するステップとを備える。
【００６９】
この構成により、上記した段差検知装置と同様に、簡易な構成によって、適切に段差を検知することができると共に、キャリブレーションが容易である。
【産業上の利用可能性】
【００７０】
以上説明したように、本発明は、簡易な構成によって適切に段差を検知できるという効果を有し、例えば、電動車いすやシニアカー等の電動車両に有用である。
【符号の説明】
【００７１】
１０ 段差検知装置
１１ カメラ
１２ 制御部
１３ スピーカ
１４ 入力部
１５ メモリ
１６ プログラム
１７ カメラの高さデータ
１８ 通信インターフェース
２０ 電動車いす
２１ 通信インターフェース
２２ 駆動制御部
【技術分野】
【０００１】
本発明は、電動車いす等の電動車両に搭載して用いられる段差検知装置に関する。
【背景技術】
【０００２】
高齢化社会の到来や低炭素社会への転換に伴って、電動車両の利用者が増加することが予想される。近年、高齢者向けに作られた三輪または四輪の一人乗り電動車両が普及してきている。このような車両は、現在は「シニアカー」として知られているが、ガソリン自動車から電気自動車へ移行することが予想される将来の社会にあっては、一人乗りの小型車両が近距離移動のためのパーソナルモビリティとして普及する可能性がある。
【０００３】
自動車に比べて車体の小さい電動車両にとって、段差は、転倒の可能性がある危険な場所である。電動車いすやシニアカーは高齢者が利用することが多いが、高齢者が転倒した場合、大けがをするおそれがある。
【０００４】
最近では、段差を乗り越えることができるように工夫された車いすも提案されている（特許文献１、特許文献２）。しかし、利用者が段差に気付いていなければ、段差に当たったときの衝撃で態勢を崩すおそれがあり、やはり危険である。
【０００５】
ところで、路上にある障害物を検知する多くの技術が知られている。例えば、レーダでスキャンすることにより三次元情報を取得する方法（非特許文献１）、ミリ波帯の電波を用いて障害物までの距離を測る方法（非特許文献２）、超音波センサから発する超音波が物体で反射して返ってくるまでの時間から障害物までの距離を測る方法、レーザープロジェクタから発したマルチスポット光の結像点を検出して距離を算出する方法（非特許文献３）、複数のカメラで撮影した画像の視差情報を利用して三次元情報を得る方法（非特許文献４）、異なる時刻に撮影した２枚の画像から俯瞰画像を生成し、俯瞰画像に高さを有する障害物を合成する方法（特許文献３）等がある。
【先行技術文献】
【特許文献】
【０００６】
【特許文献１】特開２００４−４９９１０号公報
【特許文献２】特開２００８−１５４８４０号公報
【特許文献３】特開２００８−４８０９４号公報
【非特許文献】
【０００７】
【非特許文献１】城殿清澄他「レーザレーダを用いた高信頼な歩行者検出」２００６年 電子情報通信学会総合大会、Ａ−１７−８
【非特許文献２】梶木淳子他「ミリ波式センサを用いた障害物検出アルゴリズムに関する一研究」信学技報 ＴＥＣＨＮＩＣＡＬ ＲＥＰＯＲＴ ＯＦ ＩＥＩＣＥ． ＩＴＳ９９−１１３
【非特許文献３】荒蒔勲他「小型距離画像センサを用いた移動ロボットの障害物回避手法の提案」日本機械学会 ２００１年ロボティクス・メカトロニクス講演会 講演概要集
【非特許文献４】熊野仁子他「ステレオビジョンセンサを用いた自律移動ロボットの実時間障害物回避」日本機械学会 ２０００年ロボティクス・メカトロニクス講演会 講演概要集
【発明の概要】
【発明が解決しようとする課題】
【０００８】
上記した障害物を検知する技術のうち、レーザレーダ、ミリ波センサ、超音波センサ、レーザープロジェクタを用いる方法は、電磁波や超音波等の反射を検知する方法であるため、路上等に存在する障害物の検知には適している。しかし、例えば、階段や側溝のように走行中のレベルより低くなる段差では、電磁波や超音波が適切に反射して戻ってこないこともあり、そのような場合には段差を検知することができない。また、これらの方法で用いられるセンサ等は高価であり、自動車等に比べて単価が安い車いす等の電動車両に用いるのは現実的ではない。
【０００９】
上記したステレオビジョンセンサを用いれば、低くなっている段差を検知することが可能である。しかし、視差情報から三次元情報を得るためには、それぞれのカメラがどの方向を向いて設置されているかを正確に把握する必要があり、カメラのキャリブレーションが煩雑である。また、二台のカメラを用いるので、コストが高いという問題もある。
【００１０】
特許文献３に記載された俯瞰画像を生成する方法は、カメラを一台しか用いないので、比較的安価に装置を構成することができる。しかし、特許文献３では、異なる時刻に撮影した俯瞰画像を重ね合わせるために車両の移動量のデータを用いる必要がある。
【００１１】
そこで、本発明は上記背景に鑑み、簡易な構成により、走行中のレベルから上方向に突出した段差だけでなく、低くなっている段差をも適切に検知することができる段差検知装置およびこれを備えた電動車両を提供することを目的とする。
【課題を解決するための手段】
【００１２】
本発明は、電動車両に搭載して用いられる段差検知装置であって、電動車両の周辺を撮影するカメラと、電動車両の走行面からカメラまでの高さのデータを記憶する記憶部と、前記カメラにて撮影した画像に基づいて、画像に映った領域内にある段差を検知する制御部とを備え、前記制御部は、第１の時刻に前記カメラにて撮影した画像に、高さの測定対象となる測定点を設定すると共に、測定点よりも手前に基準点を設定し、第２の時刻に前記カメラにて撮影した画像の中から前記基準点の対応点と前記測定点の対応点を求め、前記記憶部に記憶されたカメラの高さのデータに基づいて、前記基準点、前記測定点、前記基準点の対応点、前記測定点の対応点を、前記走行面と同じ高さの平面に射影し、前記射影平面上における前記基準点とその対応点との距離、および、前記測定点とその対応点との距離を求め、前記各距離から、前記測定点の高さを算出し、前記測定点の高さに基づいて段差を検知し、段差を検知したときに、段差があることを示す信号を出力する。
【発明の効果】
【００１３】
本発明は、電動車両の走行面と同じ高さの平面に射影した測定点とその対応点との距離と、同平面に射影した基準点とその対応点との距離とに基づいて、簡易に測定点の高さを算出することができ、これにより段差を検知できる。
【図面の簡単な説明】
【００１４】
【図１】第１の実施の形態の段差検知装置を備えた電動車いすの構成を示す図である。
【図２】第１の実施の形態の段差検知装置の構成を示す図である。
【図３】第１の時刻ｔに撮影した画像の例を示す図である。
【図４】第２の時刻ｔ＋Δｔに撮影した画像の例を示す図である。
【図５】高さを求めるアルゴリズムについて説明するための図である。
【図６】高さを求めるアルゴリズムについて説明するための図である。
【図７】高さを求めるアルゴリズムについて説明するための図である。
【図８】第１の実施の形態の段差検知装置の動作を示す図である。
【図９】第２の実施の形態の段差検知装置の構成を示す図である。
【図１０】第２の実施の形態の段差検知装置の動作を示す図である。
【図１１】第３の実施の形態の段差検知装置の動作を示す図である。
【発明を実施するための形態】
【００１５】
以下、本発明の実施の形態の段差検知装置および電動車両について説明する。以下では、電動車両として電動車いすを例として説明するが、本発明は、電動車いす以外の電動車両にも適用することが可能である。例えば、本発明は、シニアカーや、超小型電気自動車、台車等に適用できる。また、床清掃ロボットのような自律移動ロボットに適用することも可能である。
【００１６】
（第１の実施の形態）
図１は、第１の実施の形態の段差検知装置１０を備えた電動車いす２０の構成を示す図である。段差検知装置１０は、カメラ１１が電動車いす２０の前方を撮影するような位置に取り付けられている。カメラ１１は、少なくとも電動車いす２０の前輪２３の一部が撮影範囲に入るように、下方に向けられている。これにより、撮影される画像の下方の領域には走行面が映ることになる。なお、ここでは、少なくとも前輪２３の一部が撮影範囲に入るような方向を向けてカメラ１１を取り付けているが、必ずしも前輪２３の一部が入らなくても、撮影される画像の下方の領域に走行面が映る角度であればよい。
【００１７】
図２は、段差検知装置１０の構成を示す図である。段差検知装置１０は、カメラ１１と、制御部１２と、スピーカ１３と、入力部１４と、メモリ１５とを備えている。メモリ１５には、制御部１２に、段差を検知する処理を実行させるためのプログラム１６と、カメラ１１の高さのデータ１７が記憶されている。ここで、カメラ１１の高さとは、電動車いす２０に搭載されたカメラ１１の走行面からの高さである。カメラ１１の高さは、カメラ１１を電動車いす２０に取り付けた際に計測し、計測した高さのデータを入力部１４から入力する。
【００１８】
制御部１２は、メモリ１５から読み出したプログラム１６を実行することにより、制御部１２は、カメラ１１にて撮影した画像に基づいて、画像に映った領域内にある段差を検知する機能を有している。スピーカ１３は、制御部１２にて段差を検知したときに、警報を出力する機能を有している。
【００１９】
次に、段差を検知する制御部１２の機能について説明する。以下に説明する機能は、メモリ１５に記憶されたプログラムを実行することにより実現される。制御部１２は、第１の時刻ｔに撮影した画像と、第２の時刻ｔ＋Δｔに撮影した画像とに基づいて、画像に映った領域内にある段差を検知する。
【００２０】
図３は、第１の時刻ｔに撮影した画像の例を示す図、図４は、第２の時刻ｔ＋Δｔに撮影した画像の例を示す図である。第１の時刻ｔと第２の時刻ｔ＋Δｔの画像を比較すると、第１の時刻ｔにおける画像に映っていた縁石Ｃが、第２の時刻ｔ＋Δｔにおける画像では近づいている。
【００２１】
制御部１２は、第１の時刻ｔにおける画像に、測定点Ｂと、測定点Ｂより手前にある基準点Ａを設定する。ここで、「手前」とは、カメラ１１に近い方であり、画像においては下方である。基準点Ａを測定点Ｂより手前に設定しているのは、本実施の形態においては、処理を簡単にするために、基準点Ａがある場所を走行面であると仮定して処理を行うためである。従って、電動車いす２０の走行面が映っている可能性が高い場所、すなわち、測定点Ｂより電動車いす２０に近い場所に基準点Ａを設定する。なお、本実施の形態では、カメラ１１は、少なくとも電動車いす２０の前輪２３の一部が撮影範囲に入るように、下方に向けられているので、撮影画像の下方の前輪２３の近傍に映る領域は、走行面である可能性が極めて高い。また、車輪の接地地点が撮影範囲に入るような場所および角度でカメラ１１を設置すると、確実にカメラの撮影範囲に走行面を入れることができる。従って、例えば、前輪の接地地点から前方数ｍが撮影範囲になるように設置してもよい。
【００２２】
図３に示す例では、測定点Ｂとして縦５個×横１０個からなる５０個の点を設定している。基準点Ａとして、横に並ぶ１０個の点を設定する。測定点Ｂの間隔は、検出したい段差の大きさや、カメラ１１の解像度に基づいて定めることができる。測定点Ｂの密度を高めることにより、より詳細な情報を得ることができる。本実施の形態では、１０個の基準点を設定しているが、基準点は１個でもよい。
【００２３】
制御部１２は、時刻ｔ＋Δｔにおける画像の中から、基準点Ａに対応する対応点Ａ´、測定点Ｂに対応する対応点Ｂ´を求める。対応点とは、異なる画像において、同じ位置を示す点である。対応点は、例えば、基準点Ａまたは測定点Ｂを中心とする所定の領域と相関の高い領域を別の画像の中から求め、その領域の中心を対応点として求める。対応点の算出には、相互相関（Ｃｒｏｓｓ−ｃｏｒｒｅｌａｔｉｏｎ）（例えば、Ｂ．Ｐ．Ｌａｔｈｉ著「ラシィ 詳説 ディジタル・アナログ通信システム」ｐ５０−５１）を用いることができる。相互相関を用いる方法に限らず、別の公知の方法を用いてもよい。例えば、類似度（ＳＳＤ：Ｓｕｍ ｏｆ Ｓｑｕａｒｅ Ｄｉｆｆｅｒｅｎｃｅ）や相違度（ＳＡＤ：Ｓｕｍ ｏｆ Ａｂｓｏｌｕｔｅ Ｄｉｆｆｅｒｅｎｃｅ）を用いてもよいし、テンプレートマッチングによる局所的な相関の探索、Ｋａｎａｄｅ−Ｌｕｃａｓ−Ｔｏｍａｓｉトラッカー等などを採用することもできる。
【００２４】
図４は、図３に示した基準点Ａの対応点Ａ´、測定点Ｂの対応点Ｂ´を示す図である。図４に示す画像の方が、縁石Ｃに近づいているので、対応点Ａ´，Ｂ´は、画像の下方に移動している。また、若干ではあるが、図４に示す画像の方が、縁石Ｃが大きく映っている。図４に示す例では、全ての対応点が画像内に存在しているが、電動車いす２０の移動量が大きい場合や電動車いす２０が大きく曲がった場合等には、対応点が画像内に存在しないことも考えられる。
【００２５】
図５および図６は、制御部１２によって高さを求めるアルゴリズムについて説明するための図である。制御部１２は、基準点Ａ、測定点Ｂ（図３参照）と、基準点Ａの対応点Ａ´および測定点Ｂの対応点Ｂ´（図４参照）を走行面と同じ高さの平面（以下、「射影平面」という）に射影する。このとき制御部１２は、カメラ１１の高さＨのデータをメモリ１５から読み出し、読み出した高さＨのデータを用いる。
【００２６】
図５は、カメラ座標系において、基準点Ａがその対応点Ａ´に移動し、測定点Ｂがその対応点Ｂ´に移動した例を示す。制御部１２は、基準点Ａを射影平面に射影し点Ａ１の座標を求め、基準点Ａの対応点Ａ´を走行面に射影し点Ａ１´の座標を求める。同様に、制御部１２は、測定点Ｂを走行面に射影し点Ｂ１の座標を求め、測定点Ｂの対応点Ｂ´を射影平面に射影し点Ｂ１´の座標を求める。続いて、制御部１２は、基準点Ａ１とその対応点Ａ１´との距離Ｄ１、測定点Ｂとその対応点Ｂ１´との距離Ｄ２を求める。
【００２７】
図６は、距離Ｄ１、距離Ｄ２およびカメラ１１の高さＨを用いて、測定点Ｂの高さを求める例を示す図である。制御部１２は、基準点Ａ１がその対応点Ａ１´まで移動した移動距離Ｄ１と等しくなるような測定点Ｂの高さｈを求める。具体的には、下記の式（１）によって高さｈを計算する。なお、ここで求められる高さｈは、測定点Ｂを含む領域を代表する高さである。
ｈ＝Ｈ×（１−Ｄ１／Ｄ２）・・・（１）
【００２８】
制御部１２は、すべての測定点に対して上記の計算を行うことにより、すべての測定点の高さを求める。本実施の形態において、「高さ」は、走行面を基準とした高さである。走行面より上に突出している場合には高さはプラスの値で表され、例えば、窪みなどのように、走行面より下に低くなっている場合には、高さはマイナスの値で表わされる。上記式（１）による計算により、図７に示すように、走行面より低くなっている段差も適切に検出できる。
【００２９】
本実施の形態では、制御部１２は、基準点の移動距離Ｄ１として、１０個ある基準点の移動距離の平均を用いる。これにより、対応点の算出誤差や、走行面でないところに基準点を設定したこと等に起因する誤差を低減し、安定した測定結果を得ることができる。
【００３０】
制御部１２は、算出した測定点の高さのデータに基づいて、段差を検知する。制御部１２は、例えば、算出したすべての測定点の高さの絶対値と所定の閾値とを比較し、一つでも閾値以上の測定点がある場合に、段差があると判定することができる。所定の閾値には、電動車いす２０の利用者にとって危険な高さを設定することができる。例えば、１０ｃｍの段差が危険である場合には、閾値として１０ｃｍを用いる。この値は、製造時に段差検知装置１０に設定しておいてもよいし、ユーザが設定することとしてもよい。なお、本実施の形態では、走行面より高くなっている場合にも低くなっている場合にも、同じ閾値を用いて段差を検出しているが、走行面より高いか低いかによって段差を判定する閾値を変えてもよい。
【００３１】
制御部１２は、段差があることを検知したときには、段差があることを示す信号をスピーカ１３に対して出力する。スピーカ１３は、制御部１２からこの信号を受信したときに、警報音を出力する。警報音は、所定時間（例えば、２秒）、継続して出力することとしてもよい。
【００３２】
図８は、本実施の形態の段差検知装置１０の動作を示す図である。段差検知装置１０は、図８に示す動作を繰り返し行うことにより、電動車いす２０の前方周辺に段差がある場合に、段差を検知する。
【００３３】
段差検知装置１０は、第１の時刻ｔに画像を取得し、その画像に基準点と測定点を設定する（Ｓ１０）。続いて、段差検知装置１０は、Δｔ秒後の第２の時刻ｔ＋Δｔに画像を取得し、先に設定した基準点、測定点に対応する対応点を求める（Ｓ１２）。
【００３４】
次に、段差検知装置１０は、第１の時刻ｔに取得した画像中の基準点および測定点と、第２の時刻ｔ＋Δｔに取得した画像中の基準点の対応点および測定点の対応点を、走行面と同じ高さの射影平面に射影し、その座標を求める（Ｓ１４）。続いて、段差検知装置１０は、射影平面上における基準点とその対応点との距離、測定点とその対応点との距離を求める（Ｓ１６）。ここで求めた距離は、時刻ｔから時刻ｔ＋Δｔの間に、基準点および測定点が射影平面上で移動した距離である。段差検知装置１０は、複数の基準点について求めた距離の平均値を求める（Ｓ１８）。
【００３５】
次に、段差検知装置１０は、基準点の平均移動距離と、測定点の移動距離と、カメラ１１の高さのデータ１７を用いて、それぞれの測定点の高さを求める（Ｓ２０）。段差検知装置１０は、求めた測定点の高さに基づいて、段差があるか否かを判定し、段差を検知した場合には（Ｓ２２でＹＥＳ）、段差があることを知らせる警報音をスピーカ１３から出力する（Ｓ２４）。段差がないと判定した場合には（Ｓ２２でＮＯ）、時刻ｔおよび時刻ｔ＋Δｔに取得した画像を使った処理を終了する。
【００３６】
本実施の形態の段差検知装置１０は、測定点の移動距離と基準点の移動距離とを用いて段差を検知するので、走行面より高くなっている段差のみならず、走行面より低くなっている段差をも検知することができる。
【００３７】
また、本実施の形態の段差検知装置１０は、一台のカメラ１１で撮影した画像を用いて段差を検知することができるので、キャリブレーションが容易であるとともに、装置の製造コストを抑制できる。
【００３８】
また、本実施の形態では、画像処理のみで段差を検知しており、電動車いす２０の移動量のデータを用いていないので、簡易な構成で装置を実現できるとともに、移動量を検知する機能を有していない電動車いす２０にも、取り付けるたけですぐに利用できる。
【００３９】
（第２の実施の形態）
次に、第２の実施の形態の段差検知装置１０ａを備えた電動車いす２０について説明する。第２の実施の形態の電動車いす２０の基本的な構成は、第１の実施の形態と同じである（図１参照）。第２の実施の形態の段差検知装置１０ａは、電動車いす２０の車輪の駆動制御部２２と連動しており、段差を検知したときに電動車いす２０を自動停止する。
【００４０】
図９は、第２の実施の形態の段差検知装置１０ａおよび電動車いす２０の構成を示す図である。ここでは、第１の実施の形態の段差検知装置１０と相違する構成を中心に説明する。第２の実施の形態の段差検知装置１０ａは、通信インターフェース１８を備えており、電動車いす２０の通信インターフェース２１と接続されている。
【００４１】
段差検知装置１０ａの制御部１２は、第１の実施の形態と同様に、第１の時刻と第２の時刻の画像から段差を検知する処理を行う。制御部１２は、段差を検知すると、段差があることを示す信号をスピーカ１３に送信すると共に、通信インターフェース１８を通じて電動車いす２０に送信する。電動車いす２０は、段差検知装置１０ａから段差があることを示す信号を受信すると、駆動制御部２２にて、車輪の駆動を停止する。
【００４２】
図１０は、第２の実施の形態の段差検知装置１０ａを備えた電動車いす２０の動作を示す図である。第２の実施の形態の段差検知装置１０ａによって段差を検知する動作は、第１の実施の形態と同じである（Ｓ１０〜Ｓ２２）。第２の実施の形態の段差検知装置１０ａは、段差を検知したときに（Ｓ２２でＹＥＳ）、スピーカ１３から警報音を出力すると共に、電動車いす２０を自動停止する（Ｓ２６）。
【００４３】
第２の実施の形態の段差検知装置１０ａを備えた電動車いす２０は、段差を検知したときに自動的に停止するので、安全性を高めることができる。また、第２の実施の形態の段差検知装置１０ａは、第１の実施の形態と同様に、走行面より低くなっている段差をも検知することができる、キャリブレーションが容易であるとともに、簡易な構成で装置を実現できる等の効果を有する。
【００４４】
本実施の形態では、段差を検知したときに電動車いす２０を自動停止する例について説明したが、電動車いす２０は、段差を回避するように制御してもよい。具体的には、段差検知装置１０ａが段差を検知したときに段差がない方向も検知し、電動車いす２０に、段差があることを示す信号と共に段差のない方向を示す信号を送信する。電動車いす２０の駆動制御部２２は、段差検知装置１０ａから通知された方向へ進行方向を変えるようにステアリング機能を有する車輪に指示信号を出す。なお、段差を検知したときに、電動車いす２０を自動停止するか方向変換するかのモードを選択できるようにしてもよい。他の車両や歩行者がいる公道において意図せぬ方向へ移動すると危険な場合もあるが、モードを選択できるようにすることにより、例えば、公道では自動停止し、庭や屋内では自動で方向変換するというように使い分けることができる。
【００４５】
（第３の実施の形態）
次に、第３の実施の形態の段差検知装置を備えた電動車いす２０について説明する。第３の実施の形態の電動車いす２０の基本的な構成は、第２の実施の形態と同じである（図１、図９参照）。第３の実施の形態の段差検知装置は、段差の高さだけではなく、段差までの距離に基づいて段差を検知する機能を有する。
【００４６】
図１１は、第３の実施の形態の段差検知装置を備えた電動車いす２０の動作を示す図である。第３の実施の形態の段差検知装置によって、測定点の高さを求めるまでの動作は、第１の実施の形態および第２の実施の形態と同じである（Ｓ１０〜Ｓ２０）。第３の実施の形態の段差検知装置は、測定点の高さを求めた後、高さの絶対値が所定の閾値より大きい測定点（以下、「段差候補」という）があるか否かを判定する（Ｓ２８）。段差候補がない場合には（Ｓ２８でＮＯ）、段差検知装置は、時刻ｔおよび時刻ｔ＋Δｔに取得した画像を使った処理を終了する。
【００４７】
段差候補がある場合には（Ｓ２８でＹＥＳ）、その測定点までの距離を求める（Ｓ３０）。具体的には、距離を求めるべき測定点を、その測定点の高さｈと同じ高さの平面に射影し、射影された測定点までの距離を求める（図６も参照）。次に、段差検知装置は、走行の障害になる可能性のある段差があるか否かを判定する（Ｓ３２）。具体的には、段差検知装置は、段差候補までの距離と所定の閾値とを比較し、段差候補までの距離が所定の閾値以下の場合には、段差があると判定する。
【００４８】
段差検知装置は、段差がないと判定した場合には（Ｓ３２でＮＯ）、時刻ｔおよび時刻ｔ＋Δｔに取得した画像を使った処理を終了する。段差検知装置は、段差を検知した場合には（Ｓ３２でＹＥＳ）、スピーカ１３から警報音を出力すると共に、電動車いす２０を自動停止する（Ｓ３４）。
【００４９】
第３の実施の形態の段差検知装置は、段差候補までの距離が所定の閾値以下となった場合に段差があると判定し、段差候補が所定の閾値より離れている場合には段差を検知しない。すなわち、電動車いす２０から遠くに離れていて、走行の障害にならない段差については、警報を出力したり、自動停止を行なわない。これにより、段差があっても危険でない場合には、電動車いす２０の円滑な走行の妨げにならないようにすることができる。
【００５０】
また、第３の実施の形態の段差検知装置は、上記した実施の形態と同様に、走行面より低くなっている段差をも検知することができる、キャリブレーションが容易であるとともに、簡易な構成で実現できる等の効果を有する。
【００５１】
以上、本発明の段差検知装置およびこれを備えた電動車両について、実施の形態を挙げて詳細に説明したが、本発明は上記した実施の形態に限定されるものではない。
【００５２】
上記した実施の形態では、電動車いす２０の前方周辺を撮影するような位置にカメラ１１を取り付ける例について説明したが、後方にも進行することが多い電動車両の場合には、電動車両の後方にカメラ１１を取り付けてもよい。これにより、前方に取り付けた場合と全く同様に、段差を検知することが可能である。
【００５３】
上記した第３の実施の形態では、段差候補までの距離が所定の閾値以上の場合に段差があることを検知したが、この判定に用いる所定の閾値は、設定により、あるいは、電動車いす２０の走行速度により可変としてもよい。例えば、電動車いす２０の走行速度が大きい場合には、電動車いす２０の走行速度が小さい場合より、所定の閾値を大きくしてもよい。これにより、速度に応じて、走行の障害になり得る段差を適切に検知することができる。
【００５４】
また、段差候補までの距離に加えて、その段差候補の方向のデータを用いて、段差を検知してもよい。具体的には、段差候補が、電動車いす２０の進行方向に対して、所定の角度以上外れている場合には、たとえ距離が短くとも段差として検知しないこととしてもよい。これにより、走行の障害になり得る段差を適切に検知することができる。
【００５５】
以下に、上記に説明した実施の形態の構成について、総括する。
（１）実施の形態の段差検知装置は、電動車両に搭載して用いられる段差検知装置であって、電動車両の周辺を撮影するカメラと、電動車両の走行面からカメラまでの高さのデータを記憶する記憶部と、前記カメラにて撮影した画像に基づいて、画像に映った領域内にある段差を検知する制御部とを備え、前記制御部は、第１の時刻に前記カメラにて撮影した画像に、高さの測定対象となる測定点を設定すると共に、測定点よりも手前に基準点を設定し、第２の時刻に前記カメラにて撮影した画像の中から前記基準点の対応点と前記測定点の対応点を求め、前記記憶部に記憶されたカメラの高さのデータに基づいて、前記基準点、前記測定点、前記基準点の対応点、前記測定点の対応点を、前記走行面と同じ高さの平面に射影し、前記射影平面上における前記基準点とその対応点との距離、および、前記測定点とその対応点との距離を求め、前記各距離から、前記測定点の高さを算出し、前記測定点の高さに基づいて段差を検知し、段差を検知したときに、段差があることを示す信号を出力する。
【００５６】
実施の形態の段差検知装置は、走行面と同じ高さの平面上に射影した測定点の移動距離と基準点の移動距離とを用いて段差を検知するので、走行面より高くなっている段差のみならず、走行面より低くなっている段差をも検知することができる。また、一台のカメラで撮影した画像を用いて段差を検知することができるので、キャリブレーションが容易であるとともに、簡易な構成の装置とすることができる。
【００５７】
（２）前記制御部は、前記カメラの高さをＨ、前記基準点とその対応点との距離をＤ１、測定点とその対応点の距離をＤ２として、測定点の高さｈを、ｈ＝Ｈ×（１−Ｄ１／Ｄ２）によって求めてもよい。この式により、測定点の高さｈを容易に求めることができる。
【００５８】
（３）前記制御部は、複数の基準点を設定し、複数の基準点と当該複数の基準点に対応する各対応点との距離の平均値を用いて前記測定点の高さを算出してもよい。複数の基準点の平均値を用いることにより、基準点に対応する対応点の算出誤差や、設定した基準点が走行面上にないことに起因する誤差等の影響を低減し、測定点の高さを精度良く求めることができる。
【００５９】
（４）前記制御部は、高さの絶対値が所定の閾値以上である測定点があったときに段差があると検知してもよい。これにより、測定点の高さのデータから段差を検知することができる。
【００６０】
（５）前記制御部は、画像上の測定点をその測定点の高さの平面に射影することにより、高さの絶対値が前記所定の閾値以上の測定点までの距離を求め、前記測定点までの距離が所定の閾値以下になったときに段差があると検知し、前記測定点までの距離が所定の閾値以下でないときには段差を検知しないこととしてもよい。これにより、電動車両から遠くに離れていて、走行の障害にならない場所については段差を検知せず、円滑な走行の妨げにならないようにできる。
【００６１】
（６）前記制御部から出力された段差があることを示す信号を受けたときに、段差があることを音声出力する音声出力部を備えてもよい。これにより、段差があることをユーザに知らせることができる。
【００６２】
（７）実施の形態にかかる電動車いすなどの電動車両は、上記に記載した段差検知装置を備える。上記の段差検知装置を備えることにより、適切に段差を検知できるので、電動車両の安全性を高めることができる。
【００６３】
（８）上記電動車両において、前記カメラが、前記電動車両の進行方向を撮影すると共に、電動車両の車輪の少なくとも一部を撮影する角度で取り付けられていてもよい。このような角度でカメラを取り付けることにより、撮影画像の下方の領域には走行面が入るので、撮影画像の下方に基準点を設定するだけで、走行面が映る部分に基準点を設定することができる。
【００６４】
（９）上記電動車両において、前記カメラが、前記電動車両の車輪が接地する位置を撮影範囲に含むような角度で取り付けられていてもよい。電動車両の車輪が接地する位置は走行面なので、この角度でカメラを取り付けることにより、確実に撮影範囲内に走行面を含めることができる。
【００６５】
（１０）上記電動車両において、前記制御部の出力は、車輪を駆動する駆動制御部に入力され、前記駆動制御部は、段差があることを示す信号が入力されたときに、前記車輪の駆動を停止する、あるいは、前記段差を回避するように駆動してもよい。この構成により、段差があるときに電動車両を停止し、または、段差を回避することにより転倒等の危険を未然に防止できる。
【００６６】
（１１）実施の形態のプログラムは、段差を検知するためのプログラムであって、周辺を撮影するカメラを有する電動車両に搭載して用いられるコンピュータに、電動車両の周辺の第１の時刻における画像を入力するステップと、電動車両の周辺の第２の時刻における画像を入力するステップと、前記第１の時刻における画像に、高さの測定対象となる測定点を設定すると共に、測定点よりも手前に基準点を設定するステップと、前記第２の時刻における画像の中から前記基準点の対応点と前記測定点の対応点を求めるステップと、記憶部から電動車両の走行面からカメラまでの高さのデータを読み出すステップと、前記カメラの高さのデータに基づいて、前記基準点、前記測定点、前記基準点の対応点、前記測定点の対応点を走行面と同じ高さの平面に射影するステップと、射影平面上における前記基準点とその対応点との距離、および、前記測定点とその対応点との距離を求めるステップと、前記各距離から、前記測定点の高さを算出するステップと、前記測定点の高さに基づいて段差を検知するステップと、段差を検知したときに、段差があることを示す信号を出力するステップとを実行させる。
【００６７】
この構成により、上記した段差検知装置と同様に、簡易な構成によって、適切に段差を検知することができると共に、キャリブレーションが容易である。
【００６８】
（１２）実施の形態の段差検知方法は、電動車両に搭載して用いられる段差検知装置によって、段差を検知する方法であって、前記段差検知装置が、電動車両の周辺を撮影するカメラにて第１の時刻に撮影した画像を入力するステップと、前記段差検知装置が、前記カメラにて第２の時刻に撮影した画像を入力するステップと、前記段差検知装置が、前記第１の時刻における画像に、高さの測定対象となる測定点を設定すると共に、測定点よりも手前に基準点を設定するステップと、前記段差検知装置が、前記第２の時刻における画像の中から前記基準点の対応点と前記測定点の対応点を求めるステップと、前記段差検知装置が、記憶部から電動車両の走行面からカメラまでの高さのデータを読み出すステップと、前記段差検知装置が、前記カメラの高さのデータに基づいて、前記基準点、前記測定点、前記基準点の対応点、前記測定点の対応点を走行面と同じ高さの平面に射影するステップと、前記段差検知装置が、射影平面上における前記基準点とその対応点との距離、および、前記測定点とその対応点との距離を求めるステップと、前記段差検知装置が、前記各距離から、前記測定点の高さを算出するステップと、前記段差検知装置が、前記測定点の高さに基づいて段差を検知するステップと、前記段差検知装置が、段差を検知したときに、段差があることを示す信号を出力するステップとを備える。
【００６９】
この構成により、上記した段差検知装置と同様に、簡易な構成によって、適切に段差を検知することができると共に、キャリブレーションが容易である。
【産業上の利用可能性】
【００７０】
以上説明したように、本発明は、簡易な構成によって適切に段差を検知できるという効果を有し、例えば、電動車いすやシニアカー等の電動車両に有用である。
【符号の説明】
【００７１】
１０ 段差検知装置
１１ カメラ
１２ 制御部
１３ スピーカ
１４ 入力部
１５ メモリ
１６ プログラム
１７ カメラの高さデータ
１８ 通信インターフェース
２０ 電動車いす
２１ 通信インターフェース
２２ 駆動制御部
【特許請求の範囲】
【請求項１】
電動車両に搭載して用いられる段差検知装置であって、
電動車両の周辺を撮影するカメラと、
電動車両の走行面からカメラまでの高さのデータを記憶する記憶部と、
前記カメラにて撮影した画像に基づいて、画像に映った領域内にある段差を検知する制御部と、
を備え、
前記制御部は、
第１の時刻に前記カメラにて撮影した画像に、高さの測定対象となる測定点を設定すると共に、測定点よりも手前に基準点を設定し、
第２の時刻に前記カメラにて撮影した画像の中から前記基準点の対応点と前記測定点の対応点を求め、
前記記憶部に記憶されたカメラの高さのデータに基づいて、前記基準点、前記測定点、前記基準点の対応点、前記測定点の対応点を、前記走行面と同じ高さの平面に射影し、
前記射影平面上における前記基準点とその対応点との距離、および、前記測定点とその対応点との距離を求め、
前記各距離から、前記測定点の高さを算出し、
前記測定点の高さに基づいて段差を検知し、
段差を検知したときに、段差があることを示す信号を出力する段差検知装置。
【請求項２】
前記制御部は、前記カメラの高さをＨ、前記基準点とその対応点との距離をＤ１、測定点とその対応点の距離をＤ２として、測定点の高さｈを、
ｈ＝Ｈ×（１−Ｄ１／Ｄ２）
によって求める請求項１に記載の段差検知装置。
【請求項３】
前記制御部は、複数の基準点を設定し、複数の基準点と当該複数の基準点に対応する各対応点との距離の平均値を用いて前記測定点の高さを算出する請求項１または２に記載の段差検知装置。
【請求項４】
前記制御部は、高さの絶対値が所定の閾値以上である測定点があったときに、段差があると検知する請求項１〜３のいずれかに記載の段差検知装置。
【請求項５】
前記制御部は、画像上の測定点をその測定点の高さの平面に射影することにより、高さの絶対値が前記所定の閾値以上の測定点までの距離を求め、
前記測定点までの距離が所定の閾値以下になったときに段差があると検知し、前記測定点までの距離が所定の閾値以下でないときには段差を検知しない請求項４に記載の段差検知装置。
【請求項６】
前記制御部から出力された段差があることを示す信号を受けたときに、段差があることを音声出力する音声出力部を備える請求項１〜５のいずれかに記載の段差検知装置。
【請求項７】
請求項１〜６のいずれかに記載の段差検知装置を備える電動車両。
【請求項８】
前記カメラが、前記電動車両の進行方向を撮影すると共に、電動車両の車輪の少なくとも一部を撮影する角度で取り付けられている請求項７に記載の電動車両。
【請求項９】
前記カメラが、前記電動車両の車輪が接地する位置を撮影範囲に含むような角度で取り付けられている請求項７に記載の電動車両。
【請求項１０】
前記制御部の出力は、車輪を駆動する駆動制御部に入力され、
前記駆動制御部は、段差があることを示す信号が入力されたときに、前記車輪の駆動を停止する、あるいは、前記段差を回避するように駆動する請求項７〜９のいずれかに記載の電動車両。
【請求項１１】
段差を検知するためのプログラムであって、周辺を撮影するカメラを有する電動車両に搭載されて用いられるコンピュータに、
電動車両の周辺の第１の時刻における画像を入力するステップと、
電動車両の周辺の第２の時刻における画像を入力するステップと、
前記第１の時刻における画像に、高さの測定対象となる測定点を設定すると共に、測定点よりも手前に基準点を設定するステップと、
前記第２の時刻における画像の中から前記基準点の対応点と前記測定点の対応点を求めるステップと、
記憶部から電動車両の走行面からカメラまでの高さのデータを読み出すステップと、
前記カメラの高さのデータに基づいて、前記基準点、前記測定点、前記基準点の対応点、前記測定点の対応点を走行面と同じ高さの平面に射影するステップと、
射影平面上における前記基準点とその対応点との距離、および、前記測定点とその対応点との距離を求めるステップと、
前記各距離から、前記測定点の高さを算出するステップと、
前記測定点の高さに基づいて段差を検知するステップと、
段差を検知したときに、段差があることを示す信号を出力するステップと、
を実行させるプログラム。
【請求項１２】
電動車両に搭載して用いられる段差検知装置によって、段差を検知する方法であって、
前記段差検知装置が、電動車両の周辺を撮影するカメラにて第１の時刻に撮影した画像を入力するステップと、
前記段差検知装置が、前記カメラにて第２の時刻に撮影した画像を入力するステップと、
前記段差検知装置が、前記第１の時刻における画像に、高さの測定対象となる測定点を設定すると共に、測定点よりも手前に基準点を設定するステップと、
前記段差検知装置が、前記第２の時刻における画像の中から前記基準点の対応点と前記測定点の対応点を求めるステップと、
前記段差検知装置が、記憶部から電動車両の走行面からカメラまでの高さのデータを読み出すステップと、
前記段差検知装置が、前記カメラの高さのデータに基づいて、前記基準点、前記測定点、前記基準点の対応点、前記測定点の対応点を走行面と同じ高さの平面に射影するステップと、
前記段差検知装置が、射影平面上における前記基準点とその対応点との距離、および、前記測定点とその対応点との距離を求めるステップと、
前記段差検知装置が、前記各距離から、前記測定点の高さを算出するステップと、
前記段差検知装置が、前記測定点の高さに基づいて段差を検知するステップと、
前記段差検知装置が、段差を検知したときに、段差があることを示す信号を出力するステップと、
を備える段差検知方法。
【請求項１】
電動車両に搭載して用いられる段差検知装置であって、
電動車両の周辺を撮影するカメラと、
電動車両の走行面からカメラまでの高さのデータを記憶する記憶部と、
前記カメラにて撮影した画像に基づいて、画像に映った領域内にある段差を検知する制御部と、
を備え、
前記制御部は、
第１の時刻に前記カメラにて撮影した画像に、高さの測定対象となる測定点を設定すると共に、測定点よりも手前に基準点を設定し、
第２の時刻に前記カメラにて撮影した画像の中から前記基準点の対応点と前記測定点の対応点を求め、
前記記憶部に記憶されたカメラの高さのデータに基づいて、前記基準点、前記測定点、前記基準点の対応点、前記測定点の対応点を、前記走行面と同じ高さの平面に射影し、
前記射影平面上における前記基準点とその対応点との距離、および、前記測定点とその対応点との距離を求め、
前記各距離から、前記測定点の高さを算出し、
前記測定点の高さに基づいて段差を検知し、
段差を検知したときに、段差があることを示す信号を出力する段差検知装置。
【請求項２】
前記制御部は、前記カメラの高さをＨ、前記基準点とその対応点との距離をＤ１、測定点とその対応点の距離をＤ２として、測定点の高さｈを、
ｈ＝Ｈ×（１−Ｄ１／Ｄ２）
によって求める請求項１に記載の段差検知装置。
【請求項３】
前記制御部は、複数の基準点を設定し、複数の基準点と当該複数の基準点に対応する各対応点との距離の平均値を用いて前記測定点の高さを算出する請求項１または２に記載の段差検知装置。
【請求項４】
前記制御部は、高さの絶対値が所定の閾値以上である測定点があったときに、段差があると検知する請求項１〜３のいずれかに記載の段差検知装置。
【請求項５】
前記制御部は、画像上の測定点をその測定点の高さの平面に射影することにより、高さの絶対値が前記所定の閾値以上の測定点までの距離を求め、
前記測定点までの距離が所定の閾値以下になったときに段差があると検知し、前記測定点までの距離が所定の閾値以下でないときには段差を検知しない請求項４に記載の段差検知装置。
【請求項６】
前記制御部から出力された段差があることを示す信号を受けたときに、段差があることを音声出力する音声出力部を備える請求項１〜５のいずれかに記載の段差検知装置。
【請求項７】
請求項１〜６のいずれかに記載の段差検知装置を備える電動車両。
【請求項８】
前記カメラが、前記電動車両の進行方向を撮影すると共に、電動車両の車輪の少なくとも一部を撮影する角度で取り付けられている請求項７に記載の電動車両。
【請求項９】
前記カメラが、前記電動車両の車輪が接地する位置を撮影範囲に含むような角度で取り付けられている請求項７に記載の電動車両。
【請求項１０】
前記制御部の出力は、車輪を駆動する駆動制御部に入力され、
前記駆動制御部は、段差があることを示す信号が入力されたときに、前記車輪の駆動を停止する、あるいは、前記段差を回避するように駆動する請求項７〜９のいずれかに記載の電動車両。
【請求項１１】
段差を検知するためのプログラムであって、周辺を撮影するカメラを有する電動車両に搭載されて用いられるコンピュータに、
電動車両の周辺の第１の時刻における画像を入力するステップと、
電動車両の周辺の第２の時刻における画像を入力するステップと、
前記第１の時刻における画像に、高さの測定対象となる測定点を設定すると共に、測定点よりも手前に基準点を設定するステップと、
前記第２の時刻における画像の中から前記基準点の対応点と前記測定点の対応点を求めるステップと、
記憶部から電動車両の走行面からカメラまでの高さのデータを読み出すステップと、
前記カメラの高さのデータに基づいて、前記基準点、前記測定点、前記基準点の対応点、前記測定点の対応点を走行面と同じ高さの平面に射影するステップと、
射影平面上における前記基準点とその対応点との距離、および、前記測定点とその対応点との距離を求めるステップと、
前記各距離から、前記測定点の高さを算出するステップと、
前記測定点の高さに基づいて段差を検知するステップと、
段差を検知したときに、段差があることを示す信号を出力するステップと、
を実行させるプログラム。
【請求項１２】
電動車両に搭載して用いられる段差検知装置によって、段差を検知する方法であって、
前記段差検知装置が、電動車両の周辺を撮影するカメラにて第１の時刻に撮影した画像を入力するステップと、
前記段差検知装置が、前記カメラにて第２の時刻に撮影した画像を入力するステップと、
前記段差検知装置が、前記第１の時刻における画像に、高さの測定対象となる測定点を設定すると共に、測定点よりも手前に基準点を設定するステップと、
前記段差検知装置が、前記第２の時刻における画像の中から前記基準点の対応点と前記測定点の対応点を求めるステップと、
前記段差検知装置が、記憶部から電動車両の走行面からカメラまでの高さのデータを読み出すステップと、
前記段差検知装置が、前記カメラの高さのデータに基づいて、前記基準点、前記測定点、前記基準点の対応点、前記測定点の対応点を走行面と同じ高さの平面に射影するステップと、
前記段差検知装置が、射影平面上における前記基準点とその対応点との距離、および、前記測定点とその対応点との距離を求めるステップと、
前記段差検知装置が、前記各距離から、前記測定点の高さを算出するステップと、
前記段差検知装置が、前記測定点の高さに基づいて段差を検知するステップと、
前記段差検知装置が、段差を検知したときに、段差があることを示す信号を出力するステップと、
を備える段差検知方法。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図１１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図１１】
【公開番号】特開２０１１−１７７３３４（Ｐ２０１１−１７７３３４Ａ）
【公開日】平成２３年９月１５日（２０１１．９．１５）
【国際特許分類】
【出願番号】特願２０１０−４３９３９（Ｐ２０１０−４３９３９）
【出願日】平成２２年３月１日（２０１０．３．１）
【出願人】（５０４１９０５４８）国立大学法人埼玉大学 (292)
【公開日】平成２３年９月１５日（２０１１．９．１５）
【国際特許分類】
【出願日】平成２２年３月１日（２０１０．３．１）
【出願人】（５０４１９０５４８）国立大学法人埼玉大学 (292)
[ Back to top ]