算出装置及び車椅子
【課題】 移動体の現時点の正確な位置及び向きを算出すること。外部システム等を必要とせずに、移動体単体において自律的に現時点の正確な位置及び向きを算出すること。
【解決手段】 制御装置１４０は、光学センサ１００ａ、１００ｂの各検出値を所定の変換係数に従って車椅子１の前後方向への移動変位量に変換し、これらに基づいて車椅子１の走行面に対する位置変位量及び向き変位量を算出する。そして、制御装置１４０は、算出した位置変位量及び向き変位量を予め定義された基準位置及び基準向きに加算していくことで、車椅子１の現時点の位置及び向きを算出する。さらに、制御装置１４０は、無線タグ読取装置１２０から入力された設置位置データに基づいて、当該時点での車椅子１の絶対位置を特定・補正するとともに、前記所定の変換係数を補正する。
【解決手段】 制御装置１４０は、光学センサ１００ａ、１００ｂの各検出値を所定の変換係数に従って車椅子１の前後方向への移動変位量に変換し、これらに基づいて車椅子１の走行面に対する位置変位量及び向き変位量を算出する。そして、制御装置１４０は、算出した位置変位量及び向き変位量を予め定義された基準位置及び基準向きに加算していくことで、車椅子１の現時点の位置及び向きを算出する。さらに、制御装置１４０は、無線タグ読取装置１２０から入力された設置位置データに基づいて、当該時点での車椅子１の絶対位置を特定・補正するとともに、前記所定の変換係数を補正する。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、移動体に設置され、該移動体の現時点の位置及び向きを算出する算出装置及び当該算出装置を具備した車椅子に関する。
【背景技術】
【０００２】
従来から、ナビゲーション装置を搭載した車椅子が知られている。このナビゲーション装置は、ＧＰＳ衛星から受信した電波をもとに当該車椅子の位置を特定するものであり、例えば車椅子利用者用の地図データをダウンロードしておくことによって、当該地図データを現在位置とともに表示する（特許文献１参照。）。
【特許文献１】特開２００１−３０４９０８号公報
【発明の開示】
【発明が解決しようとする課題】
【０００３】
ところで、前述のようなナビゲーション装置には、ＧＰＳ衛星からの電波を受信できない場合に備えて、車輪の回転数によって車椅子の移動量を算出する機能を備えたものも知られている。しかしながら、車輪の回転によって車椅子の移動量を測定した場合、測定値に利用者の体重等に起因する誤差が生じてしまい、車椅子の正確な現在位置を特定できず精度が悪いという問題があった。
【０００４】
また、車椅子の利用者を目的地まで誘導することを目的として、例えば、地磁気センサといった方位センサを車椅子に搭載することにすれば、車椅子の現在の向きを検出して利用者に対して進行方向が正しいか否かを提示することが可能となる。しかしながら、特に駅構内等の鉄道施設では、電車の架線による磁界等が外乱となって測定値に誤差が生じてしまうため、正しい誘導ができないという問題があった。
【０００５】
本発明は、上記した従来の問題に鑑みて為されたものであり、移動体の現時点の正確な位置及び向きを算出することを目的とする。また、更なる目的は、外部システム等を必要とせずに、移動体単体において自律的に現時点の正確な位置及び向きを算出することである。
【課題を解決するための手段】
【０００６】
以上の課題を解決するため、第１の発明の算出装置は、移動体に設置され、当該移動体の現時点の位置及び向きを算出する算出装置であって、
走行面に対向して設けられ、受光した前記走行面からの反射光又は前記走行面の映像に基づいて所定の検出方向の移動量を異なる位置で検出する複数の光学センサ（例えば、図１に示す左側光学センサ１００ａ、右側光学センサ１００ｂ）と、
前記各光学センサによって検出される移動量及び各光学センサの検出方向に基づいて、前記移動体の現時点の位置及び向きを算出する算出手段（例えば、図２に示す制御装置１４０）と、
を備える算出装置である。
【０００７】
この第１の発明によれば、走行面に対向して設けられた複数の光学センサによって、それぞれ移動体の走行面に対する検出方向への移動量を検出することで、当該移動体の現時点の位置及び向きを算出することができる。これにより、走行面を直接測定すること、複数の点で測定することができるので、移動体単体において自律的に現時点の正確な位置及び向きを算出することが可能である。
【０００８】
第２の発明は、第１の発明の算出装置において、
前記各光学センサの検出方向は、何れも前記移動体の前後方向であり、
前記各光学センサは、前記移動体の左右方向に離れて設置されている算出装置である。
【０００９】
この第２の発明によれば、前記複数の光学センサを、移動体の左右方向に離れるように設置し、当該各光学センサにより移動体の前後方向の移動量を検出することによって、移動体の現時点の位置及び向きを検出することができる。
【００１０】
第３の発明は、第２の発明の算出装置において、
前記移動体には、回転軸が固定された左右一対の車輪が設けられており、
前記複数の光学センサは、前記左右一対の車輪それぞれの接地位置近傍に設けられた少なくとも２つの光学センサである算出装置である。
【００１１】
この第３の発明によれば、回転軸が固定された左右一対の車輪が設けられた移動体において、当該移動体の左右一対の車輪それぞれの接地位置近傍に少なくとも２つの光学センサを設け、各車輪の回転移動方向への移動量を検出することによって、移動体の現時点の位置及び向きを検出することができる。
【００１２】
第４の発明は、第１〜第３の何れかの発明の算出装置において、
前記各光学センサは移動変位量を検出するセンサであり、
前記算出手段は、
前記各光学センサによって検出される前記移動変位量及び前記各光学センサの検出方向に基づいて、前記移動体の位置変位量及び向き変位量を求める変位量算出手段（例えば、図２に示す制御装置１４０）と、
前記変位量算出手段により算出された位置変位量及び向き変位量を、予め定義された基準位置及び基準向きに加算していくことで、前記移動体の現時点の位置及び向きを求める加算算出手段（例えば、図２に示す制御装置１４０）と、
を有する算出装置である。
【００１３】
この第４の発明によれば、各光学センサによって検出される移動変位量及び各光学センサの検出方向に基づいて移動体の位置変位量及び向き変位量を算出し、当該算出した位置変位量及び向き変位量を予め定義された基準位置及び基準向きに加算していくことで、当該移動体の現時点の位置及び向きを算出することができる。
【００１４】
第５の発明は、第４の発明の算出装置において、
前記加算算出手段は、前記基準位置及び基準向きに対する相対的な前記移動体の位置及び向きを求める手段（例えば、図２に示す制御装置１４０）であり、
前記算出手段は、移動空間中の異なる位置に予め定められた複数の通過位置を通過した際に前記加算算出手段が算出した前記移動体の位置及び向きから、前記移動体の前記移動空間に対する位置及び向きを算出する対空間算出手段（例えば、図２に示す制御装置１４０）を有する算出装置である。
【００１５】
この第５の発明によれば、異なる位置に予め定められた複数の通過位置を通過した際の、当該通過位置における移動体の基準位置及び基準向きに対する相対的な位置及び向きから、当該移動体の移動空間に対する位置及び向きを算出することができる。
【００１６】
第６の発明は、第５の発明の算出装置において、
前記通過位置には、当該移動空間に対する当該位置を示すデータを所定の近距離無線通信で発信する発信器（例えば、図１に示す無線タグ５０）が備えられており、
前記発信器と前記近距離無線通信を行う無線通信手段（例えば、図２に示す無線タグ読取装置１２０）と、
前記無線通信手段の通信によってデータが得られた時点の前記移動体の位置を、当該得られたデータに基づく通過位置と判断する通過位置判断手段（例えば、図２に示す制御装置１４０）と、
を備える算出装置である。
【００１７】
この第６の発明によれば、移動空間に備えられた発信器との近距離無線通信によってデータが得られた時点の移動体の位置を、当該得られたデータに基づく通過位置と判断することができる。
【００１８】
また、第７の発明は、第６の発明の算出装置において、
前記通過位置判断手段により判断された通過位置で、算出していた前記移動体の現時点の位置を補正する算出位置補正手段（例えば、図２に示す制御装置１４０）を備える算出装置である。
【００１９】
この第７の発明によれば、移動空間に備えられた発信器との近距離無線通信によってデータが得られた時点の移動体の位置を、当該得られたデータに基づく通過位置と判断することで、当該移動体の現時点の位置を補正することができる。
【００２０】
第８の発明は、第５〜第７の何れかの発明の算出装置において、
前記通過位置は複数有り、前記基準位置も通過位置の１つである算出装置である。
【００２１】
この第８の発明によれば、移動空間中の所定の通過位置を、移動体の基準位置とすることができる。
【００２２】
第９の発明は、第１〜第８の何れかの発明の算出装置において、
前記移動体の地上高を測定する地上高測定手段（例えば、距離センサ）と、
前記各光学センサによって検出される移動量に基づく前記算出手段の算出値が、前記移動体の地上高の変化により生じる誤差を、前記地上高測定手段によって測定される地上高に基づいて補正する算出誤差補正手段（例えば、図２に示す制御装置１４０）と、
を備える算出装置である。
【００２３】
この第９の発明によれば、各光学センサによって検出される移動量に基づいて移動体の現時点の位置及び向きを算出する際の、当該移動体の地上高の変化によって生じる誤差を補正することができる。
【００２４】
第１０の発明は、第１〜第９の何れかの発明の算出装置を具備した前記移動体である車椅子である。
【００２５】
この第１０の発明によれば、第１〜第９の何れかの発明と同等の効果を奏する算出装置を具備した車椅子を実現できる。
【発明の効果】
【００２６】
本発明によれば、走行面に対向して設けられた複数の光学センサによって、それぞれ移動体の走行面に対する検出方向への移動量を検出することで、当該移動体の現時点の位置及び向きを算出することができる。これにより、走行面を直接測定すること、複数の点で測定することができるので、移動体単体において自律的に現時点の正確な位置及び向きを算出することが可能である。
【発明を実施するための最良の形態】
【００２７】
以下、図面を参照し、本発明を適用した算出装置について、移動体を車椅子とし、移動空間（絶対座標系）を駅構内として、算出装置が、駅構内を移動する車椅子の現時点の位置及び向きを算出する場合を例にとって説明する。尚、以下では、説明を簡明にするため、車椅子１が移動空間のＸＹ平面上を移動することとして説明する。
【００２８】
図１は、車椅子１の背面図である。本実施形態では、車椅子１本体の左右側部に設けられ、回転軸が固定された左右一対の車輪５ａ、５ｂの接地位置近傍において、それぞれ光学センサ１００ａ、１００ｂが設けられている。この光学センサ１００ａ、１００ｂは、それぞれ車椅子１の走行面（地面）と対向して設けられ、受光した走行面からの反射光又は前記走行面の映像に基づいて車椅子１の移動を光学的に検出する。
【００２９】
具体的には、各光学センサ１００ａ、１００ｂは、例えばイメージセンサ、走行面の画像をイメージセンサに投影するレンズ、走行面の画像の移動量を判断する画像処理回路、画像メモリ等により構成され、イメージセンサが走行面の画像を連続して取り込み、画像処理回路が取り込まれた画像を画像処理して前回取り込まれた画像と比較することで、画像の移動量を検出する。詳細は後述するが、このように各光学センサ１００ａ、１００ｂによって検出された走行面の画像の移動量（例えば、撮影画像中の移動ドット数）が、それぞれ予め設定された所定の変換係数に従って車椅子１の前後方向への移動変位量（例えば、２ｃｍといった実際に車椅子１が移動した距離）に変換され、これらに基づいて車椅子１の現時点の位置及び向きが算出されることとなる。尚、以下では、左側部の車輪５ａの接地位置近傍に設けられた光学センサ１００ａのことを適宜「左側光学センサ１００ａ」、右側部の車輪５ｂの接地位置近傍に設けられた光学センサ１００ｂのことを適宜「右側光学センサ１００ｂ」という。
【００３０】
また、車椅子１は、無線タグ読取装置１２０を備えている。この無線タグ読取装置１２０は、アンテナや制御回路等により構成されるものであり、駅構内の所定位置に設置される発信器としての無線タグ５０との間で電磁誘導による近距離無線通信を行って、無線タグ５０から当該無線タグ５０の設置位置のデータ（設置位置データ）を受信する。この設置位置データは、駅構内における当該無線タグの位置を示す絶対座標値で表される。詳細は後述するが、この無線タグ読取装置１２０が読み取った無線タグ５０の設置位置データによって、駅構内における車椅子１の絶対位置が特定・補正されるとともに、前記所定の変換係数が補正されることとなる。
【００３１】
［機能構成］
図２は、車椅子に設けられた算出装置１０の主要機能ブロックの構成例を示す図である。図２において、算出装置１０は、左側光学センサ１００ａと、右側光学センサ１００ｂと、無線タグ読取装置１２０と、制御装置１４０と、記憶装置１６０と、図示しない入力装置及び表示装置とを備えて構成されている。
【００３２】
また、図２において、駅構内の所定位置に設置される無線タグの例として、Ａ駅の南口券売機前、南口旅行案内所前、南口改札の各位置にそれぞれ設置された無線タグ５０−１〜５０−３を示している。各無線タグは、無線タグ読取装置１２０との間で近距離無線通信を行うものであり、メモリやアンテナ、電源回路、制御回路等で構成され、メモリに記憶された設置位置データを無線タグ読取装置１２０に送信する。
【００３３】
左側光学センサ１００ａ及び右側光学センサ１００ｂは、図１に示して説明したように、回転軸が固定された左右一対の車輪５ａ、５ｂそれぞれの接地位置近傍において走行面に対向するように設けられ、走行面の画像の移動量を検出して検出値を制御装置１４０に出力する。この左側光学センサ１００ａ及び右側光学センサ１００ｂによる画像の移動量の検出処理は、例えば数ミリ秒毎といった所定の時間間隔で実行される。尚、この左側光学センサ１００ａ及び右側光学センサ１００ｂによる移動量の検出処理は、走行面の画像が変化した際に実行されるものであってもよい。また、左側光学センサ１００ａ及び右側光学センサ１００ｂは、走行面の移動変位量を直接検出するものであってもよい。
【００３４】
無線タグ読取装置１２０は、駅構内に設置された無線タグとの間で近距離無線通信を行って、当該無線タグから送信された設置位置データを制御装置１４０に出力する。例えば、車椅子１がＡ駅の南口改札を通過した場合には、無線タグ読取装置１２０と南口改札に設置された無線タグ５０−３との間で近距離無線通信が行われ、無線タグ読取装置１２０は、受信した無線タグ５０−３の設置位置データを制御装置１４０に出力する。
【００３５】
制御装置１４０は、ＣＰＵ等で構成され、算出装置１０を構成する各機能部への指示やデータの転送等を行って算出装置１０を統括的に制御する。具体的には、左側光学センサ１００ａ及び右側光学センサ１００ｂから入力される検出値や、無線タグ読取装置１２０から入力される設置位置データ、或いは図示しない入力装置から入力される操作信号等に応じた処理プログラムを記憶装置１６０から読み出して実行し、処理結果を記憶装置１６０に保存する。
【００３６】
記憶装置１６０は、更新記憶可能なフラッシュメモリ等のＲＯＭやＲＡＭといった各種ＩＣメモリ、或いはハードディスクドライブ等で構成され、算出装置１０の動作に係る各種処理プログラムや当該処理プログラムによる処理結果等のデータを記憶する。特に、本実施形態を実現するため、現在位置・向き検出プログラム１６２が格納され、制御装置１４０は、この現在位置・向き検出プログラム１６２に従って現在位置・向き検出処理を実行する。
【００３７】
具体的には、制御装置１４０は、左側光学センサ１００ａ及び右側光学センサ１００ｂの各検出値を前記所定の変換係数に従って車椅子１の前後方向への移動変位量に変換し、これらに基づいて車椅子１の走行面に対する位置変位量及び向き変位量を算出する処理を行う。詳細には、制御装置１４０は、左側光学センサ１００ａ及び右側光学センサ１００ｂの検出値から得られた車椅子１の移動変位量の平均値をもとに車椅子１の位置変位量を算出するとともに、差分をもとに車椅子１の向き変位量を算出する。
【００３８】
そして、制御装置１４０は、算出した位置変位量及び向き変位量を予め定義された基準位置及び基準向きに加算していくことで、車椅子１の現時点の位置及び向きを自律的に算出する。
【００３９】
さらに、制御装置１４０は、無線タグ読取装置１２０から設置位置データが入力された場合には、当該設置位置データによって表される無線タグの設置位置を車椅子１の通過位置と判断し、入力された設置位置データに基づいて、当該時点での車椅子１の駅構内における絶対位置を特定・補正するとともに、前記所定の変換係数を補正する処理を行う。
【００４０】
ここで、現在位置・向き検出処理について図３を参照して説明する。制御装置１４０は、無線タグ読取装置１２０から入力される設置位置データをもとに算出するが、車椅子１の現時点の位置及び向きを、車椅子１の駅構内における絶対位置が特定されるまでの間は予め定義された基準位置及び基準向きに対する車椅子１の相対位置及び相対向きとして算出する。
【００４１】
図３（ａ）は、算出された相対位置及び相対向きに基づく、当該車椅子１の移動軌跡の一例を示す図である。本実施形態では、車椅子１の相対位置は、移動開始位置を原点とした座標系（相対座標系：ＸR−ＹR）の座標値として算出されるものであって、相対位置及び相対向きは、例えば、相対座標系ＸR−ＹRの原点を前記予め定義された基準位置、ＸR軸方向を基準向き（０°）とし、この基準位置及び基準向きに前述のように算出された位置変位量及び向き変位量を加算していくことで算出される。
【００４２】
また、図３（ａ）では、地点Ａの無線タグから設置位置データを受信した時点での車椅子１の相対位置Ｐ１０と、地点Ｂの無線タグから設置位置データを受信した時点での車椅子１の相対位置Ｐ２０とを示している。制御装置１４０は、このように近距離無線通信を行った無線タグの設置位置（地点Ａ、Ｂ）を車椅子１の通過位置と判断する。そして、制御装置１４０は、無線タグ読取装置１２０が２つ目の無線タグと近距離無線通信を行った時点で、駅構内における車椅子１の現時点の絶対位置及び絶対向きを算出する。
【００４３】
例えば、図３（ｂ）は、地点Ａ及び地点Ｂの各無線タグと近距離無線通信を行った時点での車椅子１の相対向きをもとに、図３（ａ）に示す相対座標系ＸR−ＹRにおける移動軌跡を車椅子１が移動する駅構内に対応する絶対座標系ＸA−ＹAに座標変換した図である。このように、制御装置１４０は、無線タグ読取装置１２０が２つ目の無線タグと近距離無線通信を行った時点で、当該２つ目の無線タグの設置位置（地点Ｂ）に従って駅構内における車椅子１の絶対位置（地点Ｂ）を特定するとともに、２つの無線タグの設置位置の位置関係（地点Ａ及び地点Ｂの位置関係）と、各無線タグと近距離無線通信を行った時点での車椅子１の相対向きとに基づいて、特定した絶対位置（地点Ｂ）における車椅子１の絶対向きを算出する。
【００４４】
そして、前述のように、車椅子１の駅構内における絶対位置が特定されて絶対向きが算出されたならば、当該特定された絶対位置を基準位置、算出された絶対向きを基準向きとし、この基準位置及び基準向きに前述のように算出された位置変位量及び向き変位量を加算していくことで、車椅子１の現時点の位置及び向きを得る。
【００４５】
尚、無線タグ読取装置１２０が新たに無線タグと近距離無線通信を行った際には、当該無線タグの設置位置に基づいて、車椅子１の絶対位置が適宜補正されることとなる。
【００４６】
図３（ｃ）は、無線タグ読取装置１２０が地点Ｃの無線タグと近距離無線通信を行うまでの駅構内に対応する絶対座標系ＸA−ＹAにおける車椅子１の移動を示す図である。図３（ｃ）によれば、無線タグ読取装置１２０が地点Ｃの無線タグと近距離無線通信を行った時点での車椅子１の絶対位置Ｐ３０及び絶対向きと、実際の無線タグの設置位置（地点Ｃ）との位置及び車椅子の向きに誤差が生じているが、このような場合には、制御装置１４０は、車椅子１の絶対位置を、無線タグの設置位置（地点Ｃ）に補正するとともに絶対向きを再度算出する。そして、制御装置１４０は、当該補正された絶対位置を基準位置、再度算出された絶対向きを基準向きとし、この基準位置及び基準向きに前述のように算出された位置変位量及び向き変位量を加算していくことで、車椅子１の現時点の位置及び向きを得る。
【００４７】
さらにこの際、制御装置１４０は、前回近距離無線通信を行った無線タグの設置位置（地点Ｂ）と、無線タグ読取装置１２０が地点Ｃの無線タグと近距離無線通信を行った時点での車椅子１の絶対位置Ｐ３０との位置関係、及び実際の無線タグの設置位置（地点Ｃ）との位置関係に従って、前記所定の変換係数を補正する。したがって、例えば車椅子１の利用者の体重や重心位置等に起因する各光学センサ１００ａ、１００ｂの走行面からの地上高の変化によって生じる、該光学センサ１００ａ、１００ｂの検出値（例えば、画像中の１０ドット）から実際の移動変位量（例えば、５ｃｍ）を求める際の変換誤差を、補正することが可能となる。
【００４８】
図２に戻り、記憶装置１６０には、データとして、相対位置情報１６４と、通過無線タグ位置情報１６６と、車椅子移動情報１６８とが格納される。
【００４９】
相対位置情報１６４は、移動開始位置から車椅子１の絶対位置が特定されるまでの間の車椅子１の相対位置及び相対向きを蓄積記憶する。図４は、相対位置情報１６４のデータ構成例を示す図である。図４に示すように、相対位置情報１６４には、移動開始時を基準とした経過時間（ｔ）と対応付けて、相対座標系ＸR−ＹRにおける車椅子１の相対位置の座標値と、相対向きと、無線タグ読取フラグとが設定される。制御装置１４０は、駅構内における車椅子１の絶対位置が特定されるまでの間は、左側光学センサ１００ａ及び右側光学センサ１００ｂからの検出値をもとに車椅子１の相対位置及び相対向きを算出し、移動開始からの経過時間（ｔ）と対応付けて相対位置情報１６４に追加して書き込む。
【００５０】
また、無線タグ読取フラグは、該当する相対位置で無線タグを読み取ったか否かを表すフラグ情報であり、制御装置１４０は、無線タグ読取装置１２０から設置位置データが入力された場合には、当該時点での相対位置に対応する無線タグ読取フラグに“ＯＮ”を設定する。
【００５１】
通過無線タグ位置情報１６６は、無線タグ読取装置１２０から入力された無線タグの設置位置データを蓄積記憶する。図５は、通過無線タグ位置情報１６６のデータ構成例を示す図である。前述のように、無線タグ読取装置１２０から入力される設置位置データは、車椅子１が移動する駅構内における当該無線タグの位置を示す絶対座標値で表される。この通過無線タグ位置情報１６６には、制御装置１４０により通過位置と判断された無線タグの設置位置が移動開始からの経過時間（ｔ）と対応付けて蓄積記憶される。
【００５２】
車椅子移動情報１６８は、絶対位置が特定されてからの車椅子１の絶対位置及び絶対向きを蓄積記憶する。図６は、車椅子移動情報１６８のデータ構成例を示す図である。図６に示すように、車椅子移動情報１６８には、移動開始時を基準とした経過時間（ｔ）と対応付けて、絶対座標系ＸA−ＹAにおける車椅子１の絶対位置の座標値と、絶対向きとが設定される。制御装置１４０は、駅構内における車椅子１の絶対位置が特定された以降は、左側光学センサ１００ａ及び右側光学センサ１００ｂの検出値をもとに車椅子１の絶対位置及び絶対向きを算出し、移動開始からの経過時間（ｔ）と対応付けて車椅子移動情報１６８に追加して書き込む。
【００５３】
［処理の流れ］
次に、本実施形態において制御装置１４０が実行する現在位置・向き検出処理の流れについて説明する。図７は、現在位置・向き検出処理の流れの一例を示すフローチャートである。尚、ここで説明する処理は、制御装置１４０が現在位置・向き検出プログラム１６２を読み出して実行することにより実現される。
【００５４】
現在位置・向き検出処理において、制御装置１４０は、先ず、左側光学センサ１００ａ及び右側光学センサ１００ｂの各検出値を前記所定の変換係数に従って車椅子１の前後方向への移動変位量に変換し、これらに基づいて車椅子１の走行面に対する位置変位量及び向き変位量を算出する（ステップＳ１０）。
【００５５】
続いて、制御装置１４０は、相対座標系ＸR−ＹRの原点を前記予め定義された基準位置、ＸR軸方向を基準向きとし、この基準位置及び基準向きにステップＳ１０で算出された位置変位量及び向き変位量を加算していくことで、車椅子１の相対位置及び相対向きを算出する（ステップＳ２０）。またこの際、制御装置１４０は、移動開始からの経過時間と対応付けて、算出した相対位置及び相対向きを相対位置情報１６４に追加して書き込む。
【００５６】
そして、制御装置１４０は、無線タグを検知した場合、すなわち、無線タグ読取装置１２０から無線タグの設置位置データが入力された場合には（ステップＳ３０：ＹＥＳ）、ステップＳ２０で算出した相対位置及び相対向きに対応する無線タグ読取フラグを“ＯＮ”に設定して、相対位置情報１６４を更新する（ステップＳ４０）。
【００５７】
続いて、制御装置１４０は、相対位置情報１６４の無線タグ読取フラグを参照して検知した無線タグは２つ目の無線タグか否かを判定し、２つ目ではない場合、すなわち検知した無線タグが１つ目の無線タグの場合には（ステップＳ５０：ＮＯ）、ステップＳ１０に戻って上記した処理を繰り返す。
【００５８】
一方、制御装置１４０は、２つ目の無線タグと判定した場合には（ステップＳ５０：ＹＥＳ）、入力された設置位置データに基づいて車椅子１の現時点の絶対位置を特定する（ステップＳ６０）。そして、制御装置１４０は、相対位置情報１６４及び通過無線タグ位置情報１６６を参照し、２つの無線タグの設置位置の位置関係と、各無線タグと近距離無線通信を行った時点での車椅子１の相対向きとに基づいて、車椅子１の現時点の絶対向きを算出する（ステップＳ７０）。
【００５９】
次に、制御装置１４０は、ステップＳ６０で特定した絶対位置及びステップＳ７０で算出した絶対向きを移動開始からの経過時間と対応付けて車椅子移動情報１６８に設定する（ステップＳ８０）。
【００６０】
続いて、制御装置１４０は、ループＡの処理を当該現在位置・向き検出処理を終了するまで繰り返す（ステップＳ９０〜ステップＳ１５０）。
【００６１】
ループＡでは、制御装置１４０は、先ず、左側光学センサ１００ａ及び右側光学センサ１００ｂの各検出値を前記所定の変換係数に従って車椅子１の前後方向への移動変位量に変換し、これらに基づいて車椅子１の走行面に対する位置変位量及び向き変位量を算出する処理を行う（ステップＳ１００）。
【００６２】
続いて、制御装置１４０は、車椅子移動情報１６８に設定される最新の絶対位置及び絶対向きに、ステップＳ１００で算出された位置変位量及び向き変位量を加算していくことで、車椅子１の現時点の絶対位置及び絶対向きを算出する（ステップＳ１１０）。またこの際、制御装置１４０は、移動開始からの経過時間と対応付けて、算出した絶対位置及び絶対向きを車椅子移動情報１６８に追加して書き込む。
【００６３】
そして、無線タグを検知した場合には（ステップＳ１２０：ＹＥＳ）、制御装置１４０は、当該検知した無線タグの設置位置を車椅子１が通過したと判断し、先ず、通過無線タグ位置情報１６６及び車椅子移動情報１６８を参照して、前回検出した無線タグの設置位置と今回検出した無線タグの設置位置との位置関係、及び前回検出した無線タグの設置位置と車椅子１の現時点の絶対位置との位置関係に従って、前記所定の変換係数を補正する（ステップＳ１３０）。
【００６４】
続いて、制御装置１４０は、入力された設置位置データに基づいて車椅子１の現時点の絶対位置及び絶対向きを補正する（ステップＳ１４０）。すなわち、制御装置１４０は、車椅子移動情報１６８に設定される最新の絶対位置を入力された設置位置データに置き換える処理を行う。この結果、新たに検知した無線タグの設置位置が基準位置となり、このときの絶対向きが基準向きとなる。
【００６５】
そして、現在位置・向き検出処理を終了するならばループＡを終了し、本処理を終了する。
【００６６】
以上説明したように、本実施形態によれば、回転軸が固定された左右一対の車輪それぞれの接地位置近傍に設けられた、当該車椅子１の前後方向を検出方向とした左側光学センサ１００ａ及び右側光学センサ１００ｂの各検出値によって、車椅子１の走行面に対する位置変位量及び向き変位量を算出し、算出した位置変位量及び向き変位量を予め定義された基準位置及び基準向きに加算していくことで、車椅子１単体において自律的に現時点の位置及び向きを算出することができる。
【００６７】
また、無線タグ読取装置１２０が駅構内に設置された無線タグと近距離無線通信を行ってその設置位置のデータを受信することで、当該時点での車椅子１の駅構内における絶対位置を特定・補正するとともに、前記所定の変換係数を補正することが可能となる。
【００６８】
したがって、駅構内における車椅子１の現時点の絶対位置及び向きを正確に検知することができる。さらに、外部システム等を必要とせずに、移動体単体において自律的に現時点の正確な位置及び向きを算出することができる。
【００６９】
［変形例］
以上、本発明についての好適な実施形態について説明したが、本発明は、上記したものに限らず、発明の趣旨を逸脱しない限りにおいて適宜変更可能である。
【００７０】
例えば、上記した実施形態では、算出装置１０の備える無線タグ読取装置１２０が駅構内に設置された無線タグと近距離無線通信を行うことにより、車椅子１の駅構内における絶対位置及び絶対向きを特定・補正する場合を例にとって説明したが、絶対位置及び絶対向きを特定・補正する方法はこれに限られない。
【００７１】
具体的には、以下のようにしてもよい。すなわち、算出装置１０を、例えばＧＰＳ衛星からの電波を受信するＧＰＳ受信装置をさらに備えた構成とし、当該ＧＰＳ受信装置で受信した電波から車椅子１の現在位置情報を抽出することにより、駅構内における車椅子１の初期の絶対位置を特定するとともに、適宜のタイミングで車椅子１の絶対位置を補正することとしてもよい。
また、絶対向きについては、算出装置１０を、例えば地磁気センサといった方位センサを備えた構成とし、当該方位センサの検出値に基づいて駅構内における車椅子１の初期の絶対向きを特定することとしてもよい。また、電車の架線による磁界等の外乱の影響が少ない場所においては、この方位センサの検出値に基づいて車椅子１の絶対向きを補正することとしてもよい。
【００７２】
また、光学センサ１００ａ、１００ｂとして、自動焦点機能を備えた光学センサ１００ａ、１００ｂを用いることとしてもよい。或いは、算出装置１０を、赤外線やレーザ或いは超音波などを照射してその反射を検知するまでの時間差から距離を求める距離センサを備えた構成とし、この距離センサの検出値をもとに前記所定の変換係数を補正してもよい。
これによれば、車椅子１の走行面の凹凸の変化や、光学センサ１００ａ、１００ｂから車椅子１の走行面までの距離の変動等による、各光学センサ１００ａ、１００ｂの検出値の誤差を補正することができる。
【００７３】
また、上記した実施形態では、車椅子１が無線タグ読取装置１２０を具備し、駅構内の所定位置に設置された無線タグと近距離無線通信を行うことで、当該車椅子１の駅構内における絶対位置を特定・補正することとしたが、これに限定されるものではなく、算出装置１０を、赤外線通信やＢｌｕｅｔｏｏｔｈ（登録商標）等の近距離無線通信装置を備えた構成とし、駅構内の所定位置に設置された近距離無線通信装置からその設置位置のデータを受信することにより、車椅子１の駅構内における絶対位置を特定・補正することとしても構わない。
【００７４】
また、上記した実施形態では、無線タグ読取装置１２０が２つの無線タグと近距離無線通信を行った場合に車椅子１の絶対位置を特定することとしたが、例えば、移動空間を建物とした場合であって、建物の入り口が１つしかなく、また、この入り口から建物内に入る車椅子１の向きが必ず一定方向になるような場合には、当該建物の入り口に設置された一の無線タグと近距離無線通信を行うだけで車椅子１の絶対位置を特定することができる。
【００７５】
また、上記した実施形態で説明した、相対位置情報１６４（図４参照）、通過無線タグ位置情報１６６（図５参照）、及び車椅子移動情報１６８（図６参照）のデータ構成は一例であって、これに限られない。
【００７６】
例えば、上記した実施形態では、相対位置情報１６４として、移動開始位置から車椅子１の絶対位置が特定されるまでの間の車椅子１の相対位置及び相対向きを蓄積記憶することとしたが、無線タグを読み取った時点、すなわち無線タグ読取装置１２０から設置位置データが入力された時点での相対位置及び相対向き、及び現時点での相対位置及び相対向きのみを記憶しておくこととしてもよい。
また、通過無線タグ位置情報１６６として、無線タグ読取装置１２０から入力された無線タグの設置位置データを蓄積記憶することとしたが、無線タグ読取装置１２０から入力された最新の無線タグの設置位置データのみを記憶しておくこととしてもよい。
また、車椅子移動情報１６８として、絶対位置が特定されてからの車椅子１の絶対位置及び絶対向きを蓄積記憶することとしたが、無線タグを最後に読み取った時点、すなわち無線タグ読取装置１２０から設置位置データが最後に入力された時点での絶対位置及び絶対向き、及び現時点での絶対位置及び絶対向きのみを記憶しておくこととしてもよい。
或いは、無線タグ読取装置１２０から設置位置データが最後に入力された時点での絶対位置及び絶対向きと、当該時点からの現時点における相対位置及び相対向きのみを記憶することとしてもよい。
【００７７】
また、上記した実施形態では、無線タグが、当該無線タグの位置を示す絶対座標値で表される設置位置データを記憶し、算出装置１０が、無線タグの位置を示す絶対座標値そのものを読み取ることで車椅子１の絶対位置を特定することとしたが、以下のようにしてもよい。すなわち、各無線タグが、当該無線タグの位置を示す絶対座標の識別符号を記憶し、制御装置１４０が、無線タグ読取装置１２０により読み取られた無線タグの絶対座標の識別符号を絶対座標値に変換することにより、車椅子１の絶対位置を特定することとしてもよい。
【００７８】
さらに、上記した算出装置１０によって算出された駅構内における車椅子１の現時点の位置及び向きを利用して、当該車椅子１の利用者に対して、目的地までの移動経路を提示する誘導案内を行うこととしてもよい。具体的には、記憶装置１６０内に、駅構内において車椅子が利用可能な経路がどのようにつながっているかや、当該経路沿いに配置された設備や機器等に関する情報を含む地図データを予め記憶しておく。そして、制御装置１４０は、車椅子１の現時点の絶対位置を含む地図を表示装置（不図示）上に表示し、車椅子１の現在位置を報知する。またこの際、当該地図上に目的地までの移動経路を表示する、目的地へ向かうための進行方向を表示する、さらには現時点での絶対向きが目的地へ向かうための進行方向と異なる場合に進むべき進行方向を報知する等、車椅子１の利用者に目的地へ到達するための誘導案内を行う。
【００７９】
また、上記した実施形態では、算出装置は車椅子に具備されることとして説明したが、算出装置１０が搭載される移動体は車椅子に限定されるものではなく、例えば自動車や自律走行するロボット等にも同様に適用可能である。
また、上記した実施形態では、車椅子が移動する移動空間を駅構内としたが、これに限定されず、図書館や公民館といった施設等の建物内や道路であってもよいことは勿論である。
【図面の簡単な説明】
【００８０】
【図１】車椅子の背面図。
【図２】算出装置の主要機能ブロックの構成例を示す図。
【図３】現在位置・向き検出処理を説明するための図。
【図４】相対位置情報のデータ構成例を示す図。
【図５】通過無線タグ位置情報のデータ構成例を示す図。
【図６】車椅子移動情報のデータ構成例を示す図。
【図７】現在位置・向き検出処理の一例を示すフローチャート。
【符号の説明】
【００８１】
１ 車椅子
１０ 算出装置
１００ａ 左側光学センサ
１００ｂ 右側光学センサ
１２０ 無線タグ読取装置
１４０ 制御装置
１６０ 記憶装置
１６２ 現在位置・向き検出プログラム
１６４ 相対位置情報
１６６ 通過無線タグ位置情報
１６８ 車椅子移動情報
５０−１〜３ 駅構内無線タグ
【技術分野】
【０００１】
本発明は、移動体に設置され、該移動体の現時点の位置及び向きを算出する算出装置及び当該算出装置を具備した車椅子に関する。
【背景技術】
【０００２】
従来から、ナビゲーション装置を搭載した車椅子が知られている。このナビゲーション装置は、ＧＰＳ衛星から受信した電波をもとに当該車椅子の位置を特定するものであり、例えば車椅子利用者用の地図データをダウンロードしておくことによって、当該地図データを現在位置とともに表示する（特許文献１参照。）。
【特許文献１】特開２００１−３０４９０８号公報
【発明の開示】
【発明が解決しようとする課題】
【０００３】
ところで、前述のようなナビゲーション装置には、ＧＰＳ衛星からの電波を受信できない場合に備えて、車輪の回転数によって車椅子の移動量を算出する機能を備えたものも知られている。しかしながら、車輪の回転によって車椅子の移動量を測定した場合、測定値に利用者の体重等に起因する誤差が生じてしまい、車椅子の正確な現在位置を特定できず精度が悪いという問題があった。
【０００４】
また、車椅子の利用者を目的地まで誘導することを目的として、例えば、地磁気センサといった方位センサを車椅子に搭載することにすれば、車椅子の現在の向きを検出して利用者に対して進行方向が正しいか否かを提示することが可能となる。しかしながら、特に駅構内等の鉄道施設では、電車の架線による磁界等が外乱となって測定値に誤差が生じてしまうため、正しい誘導ができないという問題があった。
【０００５】
本発明は、上記した従来の問題に鑑みて為されたものであり、移動体の現時点の正確な位置及び向きを算出することを目的とする。また、更なる目的は、外部システム等を必要とせずに、移動体単体において自律的に現時点の正確な位置及び向きを算出することである。
【課題を解決するための手段】
【０００６】
以上の課題を解決するため、第１の発明の算出装置は、移動体に設置され、当該移動体の現時点の位置及び向きを算出する算出装置であって、
走行面に対向して設けられ、受光した前記走行面からの反射光又は前記走行面の映像に基づいて所定の検出方向の移動量を異なる位置で検出する複数の光学センサ（例えば、図１に示す左側光学センサ１００ａ、右側光学センサ１００ｂ）と、
前記各光学センサによって検出される移動量及び各光学センサの検出方向に基づいて、前記移動体の現時点の位置及び向きを算出する算出手段（例えば、図２に示す制御装置１４０）と、
を備える算出装置である。
【０００７】
この第１の発明によれば、走行面に対向して設けられた複数の光学センサによって、それぞれ移動体の走行面に対する検出方向への移動量を検出することで、当該移動体の現時点の位置及び向きを算出することができる。これにより、走行面を直接測定すること、複数の点で測定することができるので、移動体単体において自律的に現時点の正確な位置及び向きを算出することが可能である。
【０００８】
第２の発明は、第１の発明の算出装置において、
前記各光学センサの検出方向は、何れも前記移動体の前後方向であり、
前記各光学センサは、前記移動体の左右方向に離れて設置されている算出装置である。
【０００９】
この第２の発明によれば、前記複数の光学センサを、移動体の左右方向に離れるように設置し、当該各光学センサにより移動体の前後方向の移動量を検出することによって、移動体の現時点の位置及び向きを検出することができる。
【００１０】
第３の発明は、第２の発明の算出装置において、
前記移動体には、回転軸が固定された左右一対の車輪が設けられており、
前記複数の光学センサは、前記左右一対の車輪それぞれの接地位置近傍に設けられた少なくとも２つの光学センサである算出装置である。
【００１１】
この第３の発明によれば、回転軸が固定された左右一対の車輪が設けられた移動体において、当該移動体の左右一対の車輪それぞれの接地位置近傍に少なくとも２つの光学センサを設け、各車輪の回転移動方向への移動量を検出することによって、移動体の現時点の位置及び向きを検出することができる。
【００１２】
第４の発明は、第１〜第３の何れかの発明の算出装置において、
前記各光学センサは移動変位量を検出するセンサであり、
前記算出手段は、
前記各光学センサによって検出される前記移動変位量及び前記各光学センサの検出方向に基づいて、前記移動体の位置変位量及び向き変位量を求める変位量算出手段（例えば、図２に示す制御装置１４０）と、
前記変位量算出手段により算出された位置変位量及び向き変位量を、予め定義された基準位置及び基準向きに加算していくことで、前記移動体の現時点の位置及び向きを求める加算算出手段（例えば、図２に示す制御装置１４０）と、
を有する算出装置である。
【００１３】
この第４の発明によれば、各光学センサによって検出される移動変位量及び各光学センサの検出方向に基づいて移動体の位置変位量及び向き変位量を算出し、当該算出した位置変位量及び向き変位量を予め定義された基準位置及び基準向きに加算していくことで、当該移動体の現時点の位置及び向きを算出することができる。
【００１４】
第５の発明は、第４の発明の算出装置において、
前記加算算出手段は、前記基準位置及び基準向きに対する相対的な前記移動体の位置及び向きを求める手段（例えば、図２に示す制御装置１４０）であり、
前記算出手段は、移動空間中の異なる位置に予め定められた複数の通過位置を通過した際に前記加算算出手段が算出した前記移動体の位置及び向きから、前記移動体の前記移動空間に対する位置及び向きを算出する対空間算出手段（例えば、図２に示す制御装置１４０）を有する算出装置である。
【００１５】
この第５の発明によれば、異なる位置に予め定められた複数の通過位置を通過した際の、当該通過位置における移動体の基準位置及び基準向きに対する相対的な位置及び向きから、当該移動体の移動空間に対する位置及び向きを算出することができる。
【００１６】
第６の発明は、第５の発明の算出装置において、
前記通過位置には、当該移動空間に対する当該位置を示すデータを所定の近距離無線通信で発信する発信器（例えば、図１に示す無線タグ５０）が備えられており、
前記発信器と前記近距離無線通信を行う無線通信手段（例えば、図２に示す無線タグ読取装置１２０）と、
前記無線通信手段の通信によってデータが得られた時点の前記移動体の位置を、当該得られたデータに基づく通過位置と判断する通過位置判断手段（例えば、図２に示す制御装置１４０）と、
を備える算出装置である。
【００１７】
この第６の発明によれば、移動空間に備えられた発信器との近距離無線通信によってデータが得られた時点の移動体の位置を、当該得られたデータに基づく通過位置と判断することができる。
【００１８】
また、第７の発明は、第６の発明の算出装置において、
前記通過位置判断手段により判断された通過位置で、算出していた前記移動体の現時点の位置を補正する算出位置補正手段（例えば、図２に示す制御装置１４０）を備える算出装置である。
【００１９】
この第７の発明によれば、移動空間に備えられた発信器との近距離無線通信によってデータが得られた時点の移動体の位置を、当該得られたデータに基づく通過位置と判断することで、当該移動体の現時点の位置を補正することができる。
【００２０】
第８の発明は、第５〜第７の何れかの発明の算出装置において、
前記通過位置は複数有り、前記基準位置も通過位置の１つである算出装置である。
【００２１】
この第８の発明によれば、移動空間中の所定の通過位置を、移動体の基準位置とすることができる。
【００２２】
第９の発明は、第１〜第８の何れかの発明の算出装置において、
前記移動体の地上高を測定する地上高測定手段（例えば、距離センサ）と、
前記各光学センサによって検出される移動量に基づく前記算出手段の算出値が、前記移動体の地上高の変化により生じる誤差を、前記地上高測定手段によって測定される地上高に基づいて補正する算出誤差補正手段（例えば、図２に示す制御装置１４０）と、
を備える算出装置である。
【００２３】
この第９の発明によれば、各光学センサによって検出される移動量に基づいて移動体の現時点の位置及び向きを算出する際の、当該移動体の地上高の変化によって生じる誤差を補正することができる。
【００２４】
第１０の発明は、第１〜第９の何れかの発明の算出装置を具備した前記移動体である車椅子である。
【００２５】
この第１０の発明によれば、第１〜第９の何れかの発明と同等の効果を奏する算出装置を具備した車椅子を実現できる。
【発明の効果】
【００２６】
本発明によれば、走行面に対向して設けられた複数の光学センサによって、それぞれ移動体の走行面に対する検出方向への移動量を検出することで、当該移動体の現時点の位置及び向きを算出することができる。これにより、走行面を直接測定すること、複数の点で測定することができるので、移動体単体において自律的に現時点の正確な位置及び向きを算出することが可能である。
【発明を実施するための最良の形態】
【００２７】
以下、図面を参照し、本発明を適用した算出装置について、移動体を車椅子とし、移動空間（絶対座標系）を駅構内として、算出装置が、駅構内を移動する車椅子の現時点の位置及び向きを算出する場合を例にとって説明する。尚、以下では、説明を簡明にするため、車椅子１が移動空間のＸＹ平面上を移動することとして説明する。
【００２８】
図１は、車椅子１の背面図である。本実施形態では、車椅子１本体の左右側部に設けられ、回転軸が固定された左右一対の車輪５ａ、５ｂの接地位置近傍において、それぞれ光学センサ１００ａ、１００ｂが設けられている。この光学センサ１００ａ、１００ｂは、それぞれ車椅子１の走行面（地面）と対向して設けられ、受光した走行面からの反射光又は前記走行面の映像に基づいて車椅子１の移動を光学的に検出する。
【００２９】
具体的には、各光学センサ１００ａ、１００ｂは、例えばイメージセンサ、走行面の画像をイメージセンサに投影するレンズ、走行面の画像の移動量を判断する画像処理回路、画像メモリ等により構成され、イメージセンサが走行面の画像を連続して取り込み、画像処理回路が取り込まれた画像を画像処理して前回取り込まれた画像と比較することで、画像の移動量を検出する。詳細は後述するが、このように各光学センサ１００ａ、１００ｂによって検出された走行面の画像の移動量（例えば、撮影画像中の移動ドット数）が、それぞれ予め設定された所定の変換係数に従って車椅子１の前後方向への移動変位量（例えば、２ｃｍといった実際に車椅子１が移動した距離）に変換され、これらに基づいて車椅子１の現時点の位置及び向きが算出されることとなる。尚、以下では、左側部の車輪５ａの接地位置近傍に設けられた光学センサ１００ａのことを適宜「左側光学センサ１００ａ」、右側部の車輪５ｂの接地位置近傍に設けられた光学センサ１００ｂのことを適宜「右側光学センサ１００ｂ」という。
【００３０】
また、車椅子１は、無線タグ読取装置１２０を備えている。この無線タグ読取装置１２０は、アンテナや制御回路等により構成されるものであり、駅構内の所定位置に設置される発信器としての無線タグ５０との間で電磁誘導による近距離無線通信を行って、無線タグ５０から当該無線タグ５０の設置位置のデータ（設置位置データ）を受信する。この設置位置データは、駅構内における当該無線タグの位置を示す絶対座標値で表される。詳細は後述するが、この無線タグ読取装置１２０が読み取った無線タグ５０の設置位置データによって、駅構内における車椅子１の絶対位置が特定・補正されるとともに、前記所定の変換係数が補正されることとなる。
【００３１】
［機能構成］
図２は、車椅子に設けられた算出装置１０の主要機能ブロックの構成例を示す図である。図２において、算出装置１０は、左側光学センサ１００ａと、右側光学センサ１００ｂと、無線タグ読取装置１２０と、制御装置１４０と、記憶装置１６０と、図示しない入力装置及び表示装置とを備えて構成されている。
【００３２】
また、図２において、駅構内の所定位置に設置される無線タグの例として、Ａ駅の南口券売機前、南口旅行案内所前、南口改札の各位置にそれぞれ設置された無線タグ５０−１〜５０−３を示している。各無線タグは、無線タグ読取装置１２０との間で近距離無線通信を行うものであり、メモリやアンテナ、電源回路、制御回路等で構成され、メモリに記憶された設置位置データを無線タグ読取装置１２０に送信する。
【００３３】
左側光学センサ１００ａ及び右側光学センサ１００ｂは、図１に示して説明したように、回転軸が固定された左右一対の車輪５ａ、５ｂそれぞれの接地位置近傍において走行面に対向するように設けられ、走行面の画像の移動量を検出して検出値を制御装置１４０に出力する。この左側光学センサ１００ａ及び右側光学センサ１００ｂによる画像の移動量の検出処理は、例えば数ミリ秒毎といった所定の時間間隔で実行される。尚、この左側光学センサ１００ａ及び右側光学センサ１００ｂによる移動量の検出処理は、走行面の画像が変化した際に実行されるものであってもよい。また、左側光学センサ１００ａ及び右側光学センサ１００ｂは、走行面の移動変位量を直接検出するものであってもよい。
【００３４】
無線タグ読取装置１２０は、駅構内に設置された無線タグとの間で近距離無線通信を行って、当該無線タグから送信された設置位置データを制御装置１４０に出力する。例えば、車椅子１がＡ駅の南口改札を通過した場合には、無線タグ読取装置１２０と南口改札に設置された無線タグ５０−３との間で近距離無線通信が行われ、無線タグ読取装置１２０は、受信した無線タグ５０−３の設置位置データを制御装置１４０に出力する。
【００３５】
制御装置１４０は、ＣＰＵ等で構成され、算出装置１０を構成する各機能部への指示やデータの転送等を行って算出装置１０を統括的に制御する。具体的には、左側光学センサ１００ａ及び右側光学センサ１００ｂから入力される検出値や、無線タグ読取装置１２０から入力される設置位置データ、或いは図示しない入力装置から入力される操作信号等に応じた処理プログラムを記憶装置１６０から読み出して実行し、処理結果を記憶装置１６０に保存する。
【００３６】
記憶装置１６０は、更新記憶可能なフラッシュメモリ等のＲＯＭやＲＡＭといった各種ＩＣメモリ、或いはハードディスクドライブ等で構成され、算出装置１０の動作に係る各種処理プログラムや当該処理プログラムによる処理結果等のデータを記憶する。特に、本実施形態を実現するため、現在位置・向き検出プログラム１６２が格納され、制御装置１４０は、この現在位置・向き検出プログラム１６２に従って現在位置・向き検出処理を実行する。
【００３７】
具体的には、制御装置１４０は、左側光学センサ１００ａ及び右側光学センサ１００ｂの各検出値を前記所定の変換係数に従って車椅子１の前後方向への移動変位量に変換し、これらに基づいて車椅子１の走行面に対する位置変位量及び向き変位量を算出する処理を行う。詳細には、制御装置１４０は、左側光学センサ１００ａ及び右側光学センサ１００ｂの検出値から得られた車椅子１の移動変位量の平均値をもとに車椅子１の位置変位量を算出するとともに、差分をもとに車椅子１の向き変位量を算出する。
【００３８】
そして、制御装置１４０は、算出した位置変位量及び向き変位量を予め定義された基準位置及び基準向きに加算していくことで、車椅子１の現時点の位置及び向きを自律的に算出する。
【００３９】
さらに、制御装置１４０は、無線タグ読取装置１２０から設置位置データが入力された場合には、当該設置位置データによって表される無線タグの設置位置を車椅子１の通過位置と判断し、入力された設置位置データに基づいて、当該時点での車椅子１の駅構内における絶対位置を特定・補正するとともに、前記所定の変換係数を補正する処理を行う。
【００４０】
ここで、現在位置・向き検出処理について図３を参照して説明する。制御装置１４０は、無線タグ読取装置１２０から入力される設置位置データをもとに算出するが、車椅子１の現時点の位置及び向きを、車椅子１の駅構内における絶対位置が特定されるまでの間は予め定義された基準位置及び基準向きに対する車椅子１の相対位置及び相対向きとして算出する。
【００４１】
図３（ａ）は、算出された相対位置及び相対向きに基づく、当該車椅子１の移動軌跡の一例を示す図である。本実施形態では、車椅子１の相対位置は、移動開始位置を原点とした座標系（相対座標系：ＸR−ＹR）の座標値として算出されるものであって、相対位置及び相対向きは、例えば、相対座標系ＸR−ＹRの原点を前記予め定義された基準位置、ＸR軸方向を基準向き（０°）とし、この基準位置及び基準向きに前述のように算出された位置変位量及び向き変位量を加算していくことで算出される。
【００４２】
また、図３（ａ）では、地点Ａの無線タグから設置位置データを受信した時点での車椅子１の相対位置Ｐ１０と、地点Ｂの無線タグから設置位置データを受信した時点での車椅子１の相対位置Ｐ２０とを示している。制御装置１４０は、このように近距離無線通信を行った無線タグの設置位置（地点Ａ、Ｂ）を車椅子１の通過位置と判断する。そして、制御装置１４０は、無線タグ読取装置１２０が２つ目の無線タグと近距離無線通信を行った時点で、駅構内における車椅子１の現時点の絶対位置及び絶対向きを算出する。
【００４３】
例えば、図３（ｂ）は、地点Ａ及び地点Ｂの各無線タグと近距離無線通信を行った時点での車椅子１の相対向きをもとに、図３（ａ）に示す相対座標系ＸR−ＹRにおける移動軌跡を車椅子１が移動する駅構内に対応する絶対座標系ＸA−ＹAに座標変換した図である。このように、制御装置１４０は、無線タグ読取装置１２０が２つ目の無線タグと近距離無線通信を行った時点で、当該２つ目の無線タグの設置位置（地点Ｂ）に従って駅構内における車椅子１の絶対位置（地点Ｂ）を特定するとともに、２つの無線タグの設置位置の位置関係（地点Ａ及び地点Ｂの位置関係）と、各無線タグと近距離無線通信を行った時点での車椅子１の相対向きとに基づいて、特定した絶対位置（地点Ｂ）における車椅子１の絶対向きを算出する。
【００４４】
そして、前述のように、車椅子１の駅構内における絶対位置が特定されて絶対向きが算出されたならば、当該特定された絶対位置を基準位置、算出された絶対向きを基準向きとし、この基準位置及び基準向きに前述のように算出された位置変位量及び向き変位量を加算していくことで、車椅子１の現時点の位置及び向きを得る。
【００４５】
尚、無線タグ読取装置１２０が新たに無線タグと近距離無線通信を行った際には、当該無線タグの設置位置に基づいて、車椅子１の絶対位置が適宜補正されることとなる。
【００４６】
図３（ｃ）は、無線タグ読取装置１２０が地点Ｃの無線タグと近距離無線通信を行うまでの駅構内に対応する絶対座標系ＸA−ＹAにおける車椅子１の移動を示す図である。図３（ｃ）によれば、無線タグ読取装置１２０が地点Ｃの無線タグと近距離無線通信を行った時点での車椅子１の絶対位置Ｐ３０及び絶対向きと、実際の無線タグの設置位置（地点Ｃ）との位置及び車椅子の向きに誤差が生じているが、このような場合には、制御装置１４０は、車椅子１の絶対位置を、無線タグの設置位置（地点Ｃ）に補正するとともに絶対向きを再度算出する。そして、制御装置１４０は、当該補正された絶対位置を基準位置、再度算出された絶対向きを基準向きとし、この基準位置及び基準向きに前述のように算出された位置変位量及び向き変位量を加算していくことで、車椅子１の現時点の位置及び向きを得る。
【００４７】
さらにこの際、制御装置１４０は、前回近距離無線通信を行った無線タグの設置位置（地点Ｂ）と、無線タグ読取装置１２０が地点Ｃの無線タグと近距離無線通信を行った時点での車椅子１の絶対位置Ｐ３０との位置関係、及び実際の無線タグの設置位置（地点Ｃ）との位置関係に従って、前記所定の変換係数を補正する。したがって、例えば車椅子１の利用者の体重や重心位置等に起因する各光学センサ１００ａ、１００ｂの走行面からの地上高の変化によって生じる、該光学センサ１００ａ、１００ｂの検出値（例えば、画像中の１０ドット）から実際の移動変位量（例えば、５ｃｍ）を求める際の変換誤差を、補正することが可能となる。
【００４８】
図２に戻り、記憶装置１６０には、データとして、相対位置情報１６４と、通過無線タグ位置情報１６６と、車椅子移動情報１６８とが格納される。
【００４９】
相対位置情報１６４は、移動開始位置から車椅子１の絶対位置が特定されるまでの間の車椅子１の相対位置及び相対向きを蓄積記憶する。図４は、相対位置情報１６４のデータ構成例を示す図である。図４に示すように、相対位置情報１６４には、移動開始時を基準とした経過時間（ｔ）と対応付けて、相対座標系ＸR−ＹRにおける車椅子１の相対位置の座標値と、相対向きと、無線タグ読取フラグとが設定される。制御装置１４０は、駅構内における車椅子１の絶対位置が特定されるまでの間は、左側光学センサ１００ａ及び右側光学センサ１００ｂからの検出値をもとに車椅子１の相対位置及び相対向きを算出し、移動開始からの経過時間（ｔ）と対応付けて相対位置情報１６４に追加して書き込む。
【００５０】
また、無線タグ読取フラグは、該当する相対位置で無線タグを読み取ったか否かを表すフラグ情報であり、制御装置１４０は、無線タグ読取装置１２０から設置位置データが入力された場合には、当該時点での相対位置に対応する無線タグ読取フラグに“ＯＮ”を設定する。
【００５１】
通過無線タグ位置情報１６６は、無線タグ読取装置１２０から入力された無線タグの設置位置データを蓄積記憶する。図５は、通過無線タグ位置情報１６６のデータ構成例を示す図である。前述のように、無線タグ読取装置１２０から入力される設置位置データは、車椅子１が移動する駅構内における当該無線タグの位置を示す絶対座標値で表される。この通過無線タグ位置情報１６６には、制御装置１４０により通過位置と判断された無線タグの設置位置が移動開始からの経過時間（ｔ）と対応付けて蓄積記憶される。
【００５２】
車椅子移動情報１６８は、絶対位置が特定されてからの車椅子１の絶対位置及び絶対向きを蓄積記憶する。図６は、車椅子移動情報１６８のデータ構成例を示す図である。図６に示すように、車椅子移動情報１６８には、移動開始時を基準とした経過時間（ｔ）と対応付けて、絶対座標系ＸA−ＹAにおける車椅子１の絶対位置の座標値と、絶対向きとが設定される。制御装置１４０は、駅構内における車椅子１の絶対位置が特定された以降は、左側光学センサ１００ａ及び右側光学センサ１００ｂの検出値をもとに車椅子１の絶対位置及び絶対向きを算出し、移動開始からの経過時間（ｔ）と対応付けて車椅子移動情報１６８に追加して書き込む。
【００５３】
［処理の流れ］
次に、本実施形態において制御装置１４０が実行する現在位置・向き検出処理の流れについて説明する。図７は、現在位置・向き検出処理の流れの一例を示すフローチャートである。尚、ここで説明する処理は、制御装置１４０が現在位置・向き検出プログラム１６２を読み出して実行することにより実現される。
【００５４】
現在位置・向き検出処理において、制御装置１４０は、先ず、左側光学センサ１００ａ及び右側光学センサ１００ｂの各検出値を前記所定の変換係数に従って車椅子１の前後方向への移動変位量に変換し、これらに基づいて車椅子１の走行面に対する位置変位量及び向き変位量を算出する（ステップＳ１０）。
【００５５】
続いて、制御装置１４０は、相対座標系ＸR−ＹRの原点を前記予め定義された基準位置、ＸR軸方向を基準向きとし、この基準位置及び基準向きにステップＳ１０で算出された位置変位量及び向き変位量を加算していくことで、車椅子１の相対位置及び相対向きを算出する（ステップＳ２０）。またこの際、制御装置１４０は、移動開始からの経過時間と対応付けて、算出した相対位置及び相対向きを相対位置情報１６４に追加して書き込む。
【００５６】
そして、制御装置１４０は、無線タグを検知した場合、すなわち、無線タグ読取装置１２０から無線タグの設置位置データが入力された場合には（ステップＳ３０：ＹＥＳ）、ステップＳ２０で算出した相対位置及び相対向きに対応する無線タグ読取フラグを“ＯＮ”に設定して、相対位置情報１６４を更新する（ステップＳ４０）。
【００５７】
続いて、制御装置１４０は、相対位置情報１６４の無線タグ読取フラグを参照して検知した無線タグは２つ目の無線タグか否かを判定し、２つ目ではない場合、すなわち検知した無線タグが１つ目の無線タグの場合には（ステップＳ５０：ＮＯ）、ステップＳ１０に戻って上記した処理を繰り返す。
【００５８】
一方、制御装置１４０は、２つ目の無線タグと判定した場合には（ステップＳ５０：ＹＥＳ）、入力された設置位置データに基づいて車椅子１の現時点の絶対位置を特定する（ステップＳ６０）。そして、制御装置１４０は、相対位置情報１６４及び通過無線タグ位置情報１６６を参照し、２つの無線タグの設置位置の位置関係と、各無線タグと近距離無線通信を行った時点での車椅子１の相対向きとに基づいて、車椅子１の現時点の絶対向きを算出する（ステップＳ７０）。
【００５９】
次に、制御装置１４０は、ステップＳ６０で特定した絶対位置及びステップＳ７０で算出した絶対向きを移動開始からの経過時間と対応付けて車椅子移動情報１６８に設定する（ステップＳ８０）。
【００６０】
続いて、制御装置１４０は、ループＡの処理を当該現在位置・向き検出処理を終了するまで繰り返す（ステップＳ９０〜ステップＳ１５０）。
【００６１】
ループＡでは、制御装置１４０は、先ず、左側光学センサ１００ａ及び右側光学センサ１００ｂの各検出値を前記所定の変換係数に従って車椅子１の前後方向への移動変位量に変換し、これらに基づいて車椅子１の走行面に対する位置変位量及び向き変位量を算出する処理を行う（ステップＳ１００）。
【００６２】
続いて、制御装置１４０は、車椅子移動情報１６８に設定される最新の絶対位置及び絶対向きに、ステップＳ１００で算出された位置変位量及び向き変位量を加算していくことで、車椅子１の現時点の絶対位置及び絶対向きを算出する（ステップＳ１１０）。またこの際、制御装置１４０は、移動開始からの経過時間と対応付けて、算出した絶対位置及び絶対向きを車椅子移動情報１６８に追加して書き込む。
【００６３】
そして、無線タグを検知した場合には（ステップＳ１２０：ＹＥＳ）、制御装置１４０は、当該検知した無線タグの設置位置を車椅子１が通過したと判断し、先ず、通過無線タグ位置情報１６６及び車椅子移動情報１６８を参照して、前回検出した無線タグの設置位置と今回検出した無線タグの設置位置との位置関係、及び前回検出した無線タグの設置位置と車椅子１の現時点の絶対位置との位置関係に従って、前記所定の変換係数を補正する（ステップＳ１３０）。
【００６４】
続いて、制御装置１４０は、入力された設置位置データに基づいて車椅子１の現時点の絶対位置及び絶対向きを補正する（ステップＳ１４０）。すなわち、制御装置１４０は、車椅子移動情報１６８に設定される最新の絶対位置を入力された設置位置データに置き換える処理を行う。この結果、新たに検知した無線タグの設置位置が基準位置となり、このときの絶対向きが基準向きとなる。
【００６５】
そして、現在位置・向き検出処理を終了するならばループＡを終了し、本処理を終了する。
【００６６】
以上説明したように、本実施形態によれば、回転軸が固定された左右一対の車輪それぞれの接地位置近傍に設けられた、当該車椅子１の前後方向を検出方向とした左側光学センサ１００ａ及び右側光学センサ１００ｂの各検出値によって、車椅子１の走行面に対する位置変位量及び向き変位量を算出し、算出した位置変位量及び向き変位量を予め定義された基準位置及び基準向きに加算していくことで、車椅子１単体において自律的に現時点の位置及び向きを算出することができる。
【００６７】
また、無線タグ読取装置１２０が駅構内に設置された無線タグと近距離無線通信を行ってその設置位置のデータを受信することで、当該時点での車椅子１の駅構内における絶対位置を特定・補正するとともに、前記所定の変換係数を補正することが可能となる。
【００６８】
したがって、駅構内における車椅子１の現時点の絶対位置及び向きを正確に検知することができる。さらに、外部システム等を必要とせずに、移動体単体において自律的に現時点の正確な位置及び向きを算出することができる。
【００６９】
［変形例］
以上、本発明についての好適な実施形態について説明したが、本発明は、上記したものに限らず、発明の趣旨を逸脱しない限りにおいて適宜変更可能である。
【００７０】
例えば、上記した実施形態では、算出装置１０の備える無線タグ読取装置１２０が駅構内に設置された無線タグと近距離無線通信を行うことにより、車椅子１の駅構内における絶対位置及び絶対向きを特定・補正する場合を例にとって説明したが、絶対位置及び絶対向きを特定・補正する方法はこれに限られない。
【００７１】
具体的には、以下のようにしてもよい。すなわち、算出装置１０を、例えばＧＰＳ衛星からの電波を受信するＧＰＳ受信装置をさらに備えた構成とし、当該ＧＰＳ受信装置で受信した電波から車椅子１の現在位置情報を抽出することにより、駅構内における車椅子１の初期の絶対位置を特定するとともに、適宜のタイミングで車椅子１の絶対位置を補正することとしてもよい。
また、絶対向きについては、算出装置１０を、例えば地磁気センサといった方位センサを備えた構成とし、当該方位センサの検出値に基づいて駅構内における車椅子１の初期の絶対向きを特定することとしてもよい。また、電車の架線による磁界等の外乱の影響が少ない場所においては、この方位センサの検出値に基づいて車椅子１の絶対向きを補正することとしてもよい。
【００７２】
また、光学センサ１００ａ、１００ｂとして、自動焦点機能を備えた光学センサ１００ａ、１００ｂを用いることとしてもよい。或いは、算出装置１０を、赤外線やレーザ或いは超音波などを照射してその反射を検知するまでの時間差から距離を求める距離センサを備えた構成とし、この距離センサの検出値をもとに前記所定の変換係数を補正してもよい。
これによれば、車椅子１の走行面の凹凸の変化や、光学センサ１００ａ、１００ｂから車椅子１の走行面までの距離の変動等による、各光学センサ１００ａ、１００ｂの検出値の誤差を補正することができる。
【００７３】
また、上記した実施形態では、車椅子１が無線タグ読取装置１２０を具備し、駅構内の所定位置に設置された無線タグと近距離無線通信を行うことで、当該車椅子１の駅構内における絶対位置を特定・補正することとしたが、これに限定されるものではなく、算出装置１０を、赤外線通信やＢｌｕｅｔｏｏｔｈ（登録商標）等の近距離無線通信装置を備えた構成とし、駅構内の所定位置に設置された近距離無線通信装置からその設置位置のデータを受信することにより、車椅子１の駅構内における絶対位置を特定・補正することとしても構わない。
【００７４】
また、上記した実施形態では、無線タグ読取装置１２０が２つの無線タグと近距離無線通信を行った場合に車椅子１の絶対位置を特定することとしたが、例えば、移動空間を建物とした場合であって、建物の入り口が１つしかなく、また、この入り口から建物内に入る車椅子１の向きが必ず一定方向になるような場合には、当該建物の入り口に設置された一の無線タグと近距離無線通信を行うだけで車椅子１の絶対位置を特定することができる。
【００７５】
また、上記した実施形態で説明した、相対位置情報１６４（図４参照）、通過無線タグ位置情報１６６（図５参照）、及び車椅子移動情報１６８（図６参照）のデータ構成は一例であって、これに限られない。
【００７６】
例えば、上記した実施形態では、相対位置情報１６４として、移動開始位置から車椅子１の絶対位置が特定されるまでの間の車椅子１の相対位置及び相対向きを蓄積記憶することとしたが、無線タグを読み取った時点、すなわち無線タグ読取装置１２０から設置位置データが入力された時点での相対位置及び相対向き、及び現時点での相対位置及び相対向きのみを記憶しておくこととしてもよい。
また、通過無線タグ位置情報１６６として、無線タグ読取装置１２０から入力された無線タグの設置位置データを蓄積記憶することとしたが、無線タグ読取装置１２０から入力された最新の無線タグの設置位置データのみを記憶しておくこととしてもよい。
また、車椅子移動情報１６８として、絶対位置が特定されてからの車椅子１の絶対位置及び絶対向きを蓄積記憶することとしたが、無線タグを最後に読み取った時点、すなわち無線タグ読取装置１２０から設置位置データが最後に入力された時点での絶対位置及び絶対向き、及び現時点での絶対位置及び絶対向きのみを記憶しておくこととしてもよい。
或いは、無線タグ読取装置１２０から設置位置データが最後に入力された時点での絶対位置及び絶対向きと、当該時点からの現時点における相対位置及び相対向きのみを記憶することとしてもよい。
【００７７】
また、上記した実施形態では、無線タグが、当該無線タグの位置を示す絶対座標値で表される設置位置データを記憶し、算出装置１０が、無線タグの位置を示す絶対座標値そのものを読み取ることで車椅子１の絶対位置を特定することとしたが、以下のようにしてもよい。すなわち、各無線タグが、当該無線タグの位置を示す絶対座標の識別符号を記憶し、制御装置１４０が、無線タグ読取装置１２０により読み取られた無線タグの絶対座標の識別符号を絶対座標値に変換することにより、車椅子１の絶対位置を特定することとしてもよい。
【００７８】
さらに、上記した算出装置１０によって算出された駅構内における車椅子１の現時点の位置及び向きを利用して、当該車椅子１の利用者に対して、目的地までの移動経路を提示する誘導案内を行うこととしてもよい。具体的には、記憶装置１６０内に、駅構内において車椅子が利用可能な経路がどのようにつながっているかや、当該経路沿いに配置された設備や機器等に関する情報を含む地図データを予め記憶しておく。そして、制御装置１４０は、車椅子１の現時点の絶対位置を含む地図を表示装置（不図示）上に表示し、車椅子１の現在位置を報知する。またこの際、当該地図上に目的地までの移動経路を表示する、目的地へ向かうための進行方向を表示する、さらには現時点での絶対向きが目的地へ向かうための進行方向と異なる場合に進むべき進行方向を報知する等、車椅子１の利用者に目的地へ到達するための誘導案内を行う。
【００７９】
また、上記した実施形態では、算出装置は車椅子に具備されることとして説明したが、算出装置１０が搭載される移動体は車椅子に限定されるものではなく、例えば自動車や自律走行するロボット等にも同様に適用可能である。
また、上記した実施形態では、車椅子が移動する移動空間を駅構内としたが、これに限定されず、図書館や公民館といった施設等の建物内や道路であってもよいことは勿論である。
【図面の簡単な説明】
【００８０】
【図１】車椅子の背面図。
【図２】算出装置の主要機能ブロックの構成例を示す図。
【図３】現在位置・向き検出処理を説明するための図。
【図４】相対位置情報のデータ構成例を示す図。
【図５】通過無線タグ位置情報のデータ構成例を示す図。
【図６】車椅子移動情報のデータ構成例を示す図。
【図７】現在位置・向き検出処理の一例を示すフローチャート。
【符号の説明】
【００８１】
１ 車椅子
１０ 算出装置
１００ａ 左側光学センサ
１００ｂ 右側光学センサ
１２０ 無線タグ読取装置
１４０ 制御装置
１６０ 記憶装置
１６２ 現在位置・向き検出プログラム
１６４ 相対位置情報
１６６ 通過無線タグ位置情報
１６８ 車椅子移動情報
５０−１〜３ 駅構内無線タグ
【特許請求の範囲】
【請求項１】
移動体に設置され、当該移動体の現時点の位置及び向きを算出する算出装置であって、
走行面に対向して設けられ、受光した前記走行面からの反射光又は前記走行面の映像に基づいて所定の検出方向の移動量を異なる位置で検出する複数の光学センサと、
前記各光学センサによって検出される移動量及び各光学センサの検出方向に基づいて、前記移動体の現時点の位置及び向きを算出する算出手段と、
を備えることを特徴とする算出装置。
【請求項２】
前記各光学センサの検出方向は、何れも前記移動体の前後方向であり、
前記各光学センサは、前記移動体の左右方向に離れて設置されている、
ことを特徴とする請求項１に記載の算出装置。
【請求項３】
前記移動体には、回転軸が固定された左右一対の車輪が設けられており、
前記複数の光学センサは、前記左右一対の車輪それぞれの接地位置近傍に設けられた少なくとも２つの光学センサである、
ことを特徴とする請求項２に記載の算出装置。
【請求項４】
前記各光学センサは移動変位量を検出するセンサであり、
前記算出手段は、
前記各光学センサによって検出される前記移動変位量及び前記各光学センサの検出方向に基づいて、前記移動体の位置変位量及び向き変位量を求める変位量算出手段と、
前記変位量算出手段により算出された位置変位量及び向き変位量を、予め定義された基準位置及び基準向きに加算していくことで、前記移動体の現時点の位置及び向きを求める加算算出手段と、
を有する、
ことを特徴とする請求項１〜３の何れか一項に記載の算出装置。
【請求項５】
前記加算算出手段は、前記基準位置及び基準向きに対する相対的な前記移動体の位置及び向きを求める手段であり、
前記算出手段は、移動空間中の異なる位置に予め定められた複数の通過位置を通過した際に前記加算算出手段が算出した前記移動体の位置及び向きから、前記移動体の前記移動空間に対する位置及び向きを算出する対空間算出手段を有する、
ことを特徴とする請求項４に記載の算出装置。
【請求項６】
前記通過位置には、当該移動空間に対する当該位置を示すデータを所定の近距離無線通信で発信する発信器が備えられており、
前記発信器と前記近距離無線通信を行う無線通信手段と、
前記無線通信手段の通信によってデータが得られた時点の前記移動体の位置を、当該得られたデータに基づく通過位置と判断する通過位置判断手段と、
を備えることを特徴とする請求項５に記載の算出装置。
【請求項７】
前記通過位置判断手段により判断された通過位置で、算出していた前記移動体の現時点の位置を補正する算出位置補正手段を備えることを特徴とする請求項６に記載の算出装置。
【請求項８】
前記基準位置も通過位置の１つであることを特徴とする請求項５〜７の何れか一項に記載の算出装置。
【請求項９】
前記移動体の地上高を測定する地上高測定手段と、
前記各光学センサによって検出される移動量に基づく前記算出手段の算出値が、前記移動体の地上高の変化により生じる誤差を、前記地上高測定手段によって測定される地上高に基づいて補正する算出誤差補正手段と、
を備えることを特徴とする請求項１〜８の何れか一項に記載の算出装置。
【請求項１０】
請求項１〜９の何れか一項に記載の算出装置を具備した前記移動体である車椅子。
【請求項１】
移動体に設置され、当該移動体の現時点の位置及び向きを算出する算出装置であって、
走行面に対向して設けられ、受光した前記走行面からの反射光又は前記走行面の映像に基づいて所定の検出方向の移動量を異なる位置で検出する複数の光学センサと、
前記各光学センサによって検出される移動量及び各光学センサの検出方向に基づいて、前記移動体の現時点の位置及び向きを算出する算出手段と、
を備えることを特徴とする算出装置。
【請求項２】
前記各光学センサの検出方向は、何れも前記移動体の前後方向であり、
前記各光学センサは、前記移動体の左右方向に離れて設置されている、
ことを特徴とする請求項１に記載の算出装置。
【請求項３】
前記移動体には、回転軸が固定された左右一対の車輪が設けられており、
前記複数の光学センサは、前記左右一対の車輪それぞれの接地位置近傍に設けられた少なくとも２つの光学センサである、
ことを特徴とする請求項２に記載の算出装置。
【請求項４】
前記各光学センサは移動変位量を検出するセンサであり、
前記算出手段は、
前記各光学センサによって検出される前記移動変位量及び前記各光学センサの検出方向に基づいて、前記移動体の位置変位量及び向き変位量を求める変位量算出手段と、
前記変位量算出手段により算出された位置変位量及び向き変位量を、予め定義された基準位置及び基準向きに加算していくことで、前記移動体の現時点の位置及び向きを求める加算算出手段と、
を有する、
ことを特徴とする請求項１〜３の何れか一項に記載の算出装置。
【請求項５】
前記加算算出手段は、前記基準位置及び基準向きに対する相対的な前記移動体の位置及び向きを求める手段であり、
前記算出手段は、移動空間中の異なる位置に予め定められた複数の通過位置を通過した際に前記加算算出手段が算出した前記移動体の位置及び向きから、前記移動体の前記移動空間に対する位置及び向きを算出する対空間算出手段を有する、
ことを特徴とする請求項４に記載の算出装置。
【請求項６】
前記通過位置には、当該移動空間に対する当該位置を示すデータを所定の近距離無線通信で発信する発信器が備えられており、
前記発信器と前記近距離無線通信を行う無線通信手段と、
前記無線通信手段の通信によってデータが得られた時点の前記移動体の位置を、当該得られたデータに基づく通過位置と判断する通過位置判断手段と、
を備えることを特徴とする請求項５に記載の算出装置。
【請求項７】
前記通過位置判断手段により判断された通過位置で、算出していた前記移動体の現時点の位置を補正する算出位置補正手段を備えることを特徴とする請求項６に記載の算出装置。
【請求項８】
前記基準位置も通過位置の１つであることを特徴とする請求項５〜７の何れか一項に記載の算出装置。
【請求項９】
前記移動体の地上高を測定する地上高測定手段と、
前記各光学センサによって検出される移動量に基づく前記算出手段の算出値が、前記移動体の地上高の変化により生じる誤差を、前記地上高測定手段によって測定される地上高に基づいて補正する算出誤差補正手段と、
を備えることを特徴とする請求項１〜８の何れか一項に記載の算出装置。
【請求項１０】
請求項１〜９の何れか一項に記載の算出装置を具備した前記移動体である車椅子。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【公開番号】特開２００６−６５７６２（Ｐ２００６−６５７６２Ａ）
【公開日】平成１８年３月９日（２００６．３．９）
【国際特許分類】
【出願番号】特願２００４−２５０３１５（Ｐ２００４−２５０３１５）
【出願日】平成１６年８月３０日（２００４．８．３０）
【出願人】（０００１７３７８４）財団法人鉄道総合技術研究所 (1,666)
【Ｆターム（参考）】
【公開日】平成１８年３月９日（２００６．３．９）
【国際特許分類】
【出願日】平成１６年８月３０日（２００４．８．３０）
【出願人】（０００１７３７８４）財団法人鉄道総合技術研究所 (1,666)
【Ｆターム（参考）】
[ Back to top ]