(57)【要約】【課題】新型で改良された指標を使用した同時位置決め地図作成ナビゲーション方法を提供する。【解決手段】本出願は、指標を使用した同時位置決め地図作成ナビゲーション方法を提供する。当該方法は、位置決め対象の初期化領域を設置し、前記位置決め対象の初期化領域、前記位置決め対象の進行経路、前記位置決め対象のドッキング装置のうちの少なくとも１つにおいて位置・姿勢情報、指標情報、及び非指標類図形情報のうちの少なくとも１種を含む指標が設置されていることと、前記位置決め対象の初期化領域からスタートし、前記指標に基づいて位置決め対象の初期位置・姿勢を確定する操作のうちの少なくとも１種を実行するように、位置決め対象を制御することと、進行経路において前記指標を通過した場合、前記指標に基づいて前記位置決め対象の現在位置・姿勢を更新することと、ドッキング装置とドッキングする時に、前記指標に基づいて前記位置決め対象と前記ドッキング装置との相対位置・姿勢を調整することとを含む。【選択図】図１
2019537077.tif 000002
【特許請求の範囲】
【請求項１】
位置決め対象の初期化領域を設置し、前記位置決め対象の初期化領域、前記位置決め対象の進行経路、前記位置決め対象のドッキング装置のうちの少なくとも１つにおいて位置・姿勢情報、指標情報、及び非指標類図形情報のうちの少なくとも１種を含む指標が設置されていることと、
前記位置決め対象の初期化領域からスタートし、前記指標に基づいて位置決め対象の初期位置・姿勢を確定する操作のうちの少なくとも１種を実行するように、位置決め対象を制御することと、
進行経路において前記指標を通過した場合、前記指標に基づいて前記位置決め対象の現在位置・姿勢を更新することと、
ドッキング装置とドッキングする時に、前記指標に基づいて前記位置決め対象と前記ドッキング装置との相対位置・姿勢を調整することとを含む、指標を使用した同時位置決め地図作成ナビゲーション方法。
【請求項２】
前記位置決め対象は、同時位置決め地図作成ナビゲーションにおいて進行しているロボットと、ドッキング装置とドッキングする必要がある移動装置とを含む、請求項１に記載の方法。
【請求項３】
前記ドッキング装置は、コンベヤー又はアームを含む、請求項１又は２に記載の方法。
【請求項４】
前記位置決め対象の初期化領域に設置した指標は、位置・姿勢情報を含む第１の指標であり、且つ、
前記第１の指標に基づいて位置決め対象の初期位置・姿勢を確定することは、
前記第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第１の指標の位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接抽出することを含む、請求項１に記載の方法。
【請求項５】
前記位置決め対象の初期化領域に設置した指標は、指標情報を含む第１の指標であり、且つ、
前記第１の指標に基づいて位置決め対象の初期位置・姿勢を確定することは、
前記第１の指標においてスタートする場合、前記第１の指標に含まれる指標情報を記録し、前記指標情報を座標原点として位置決めし地図を作成することと、
前記位置決め対象が前記第１の指標を繰り返し複数回通過した場合、前記第１の指標の指標情報を用いてマッチングを行い、前記位置決め対象の位置・姿勢情報を取得し、前記位置決め対象の複数の位置・姿勢情報と誤差を記録して、前記第１の指標の複数の位置・姿勢情報と誤差に変換することと、
ガウスモデルにより前記第１の指標の複数の位置・姿勢情報を結合して前記第１の指標の最適位置・姿勢情報と誤差を推定することと、
前記第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第１の指標の最適位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接確定することとを含む、請求項１に記載の方法。
【請求項６】
前記位置決め対象の進行経路に設置した指標は、位置・姿勢情報を含む第２の指標であり、且つ、
前記第２の指標に基づいて位置決め対象の現在位置・姿勢を更新することは、
前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の位置・姿勢情報から前記位置決め対象の現在位置・姿勢情報を直接抽出することを含む、請求項１に記載の方法。
【請求項７】
前記位置決め対象の進行経路に設置した指標は、指標情報を含む第２の指標であり、且つ、
前記第２の指標に基づいて位置決め対象の現在位置・姿勢を更新することは、
前記位置決め対象が前記第２の指標を繰り返し複数回通過した場合、前記第２の指標の指標情報を用いてマッチングを行い、前記位置決め対象の位置・姿勢情報を取得し、前記位置決め対象の複数の位置・姿勢情報と誤差を記録して、前記第２の指標の複数の位置・姿勢情報と誤差に変換することと、
ガウスモデルにより前記第２の指標の複数の位置・姿勢情報を結合して前記第２の指標の最適位置・姿勢情報と誤差を推定することと、
前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の最適位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接確定することとを含む、請求項１に記載の方法。
【請求項８】
前記位置決め対象の進行経路に設置した指標は、非指標類図形情報を含む第２の指標であり、且つ、
前記第２の指標に基づいて位置決め対象の現在位置・姿勢を更新することは、
前記位置決め対象が同一の指標を通過した時の位置・姿勢の類似性を用いて、前記位置決め対象の繰り返し複数回通過した指標が第２の指標であるか否かを確定することと、
前記第２の指標である場合、前記第２の指標を通過した前記位置決め対象の複数の位置・姿勢情報と誤差を記録して、前記第２の指標の複数の位置・姿勢情報と誤差に変換することと、
ガウスモデルにより前記第２の指標の複数の位置・姿勢情報を結合して前記第２の指標の最適位置・姿勢情報と誤差を推定することと、
前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の最適位置・姿勢情報から前記位置決め対象の現在位置・姿勢情報を直接確定することとを含む、請求項１に記載の方法。
【請求項９】
前記位置決め対象の進行経路に設置した指標は、第２の指標であり、且つ複数の第２の指標が設置されている、請求項１に記載の方法。
【請求項１０】
前記複数の第２の指標における２つの隣り合う第２の指標同士に前記２つの隣り合う第２の指標を連結する補助位置決めストライブを含み、前記位置決め対象が前記補助位置決めストライブを通過した時に、前記位置決め対象の前記補助位置決めストライブに対する角度ずれを補正して前記位置決め対象を前記補助位置決めストライブに沿って進行させる、請求項９に記載の方法。
【請求項１１】
位置決め対象の初期化領域を設置し、前記位置決め対象の初期化領域、前記位置決め対象の進行経路、及び前記位置決め対象のドッキング装置のうちの少なくとも１つにおいて、位置・姿勢情報、指標情報、非指標類図形情報のうちの少なくとも１種を含む指標が設置されているように設置される初期化領域設置手段と、
前記位置決め対象の初期化領域からスタートし、前記指標に基づいて位置決め対象の初期位置・姿勢を確定する操作のうちの少なくとも１種を実行するように、位置決め対象を制御するように設置される位置決め対象スタート手段と、
進行経路において前記指標を通過した場合、前記指標に基づいて前記位置決め対象の現在位置・姿勢を更新するように設置される位置・姿勢更新手段と、
ドッキング装置とドッキングする時に、前記指標に基づいて前記位置決め対象と前記ドッキング装置との相対位置・姿勢を調整するように設置されるドッキング手段とを含む、指標を使用した同時位置決め地図作成ナビゲーション装置。
【請求項１２】
前記位置決め対象は、同時位置決め地図作成ナビゲーションにおいて進行しているロボットと、ドッキング装置とドッキングする必要がある移動装置とを含む、請求項１１に記載の装置。
【請求項１３】
前記ドッキング装置は、携帯コンベヤー又はアームを含む、請求項１１又は１２に記載の装置。
【請求項１４】
前記位置決め対象の初期化領域に設置した指標は、位置・姿勢情報を含む第１の指標であり、且つ、
前記位置決め対象スタート手段は、更に、
前記第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第１の指標の位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接抽出するように設置される、請求項１１に記載の装置。
【請求項１５】
前記位置決め対象の初期化領域に設置した指標は、指標情報を含む第１の指標であり、且つ、
前記位置決め対象スタート手段は、更に、
前記第１の指標においてスタートする場合、前記第１の指標に含まれる指標情報を記録し、前記指標情報を座標原点として位置決めし地図を作成し、
前記位置決め対象が前記第１の指標を繰り返し複数回通過した場合、前記第１の指標の指標情報を用いてマッチングを行い、前記位置決め対象の位置・姿勢情報を取得し、前記位置決め対象の複数の位置・姿勢情報と誤差を記録して、前記第１の指標の複数の位置・姿勢情報と誤差に変換し、
ガウスモデルにより前記第１の指標の複数の位置・姿勢情報を結合して前記第１の指標の最適位置・姿勢情報と誤差を推定し、
前記第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第１の指標の最適位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接確定するように設置される、請求項１１に記載の装置。
【請求項１６】
前記位置決め対象の進行経路に設置した指標は、位置・姿勢情報を含む第２の指標であり、且つ、
前記位置・姿勢更新手段は、更に、
前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の位置・姿勢情報から前記位置決め対象の現在位置・姿勢情報を直接抽出するように設置される、請求項１１に記載の装置。
【請求項１７】
前記位置決め対象の進行経路に設置した指標は、指標情報を含む第２の指標であり、且つ、
前記位置・姿勢更新手段は、更に、
前記位置決め対象が前記第２の指標を繰り返し複数回通過した場合、前記第２の指標の指標情報を用いてマッチングを行い、前記位置決め対象の位置・姿勢情報を取得し、前記位置決め対象の複数の位置・姿勢情報と誤差を記録して、前記第２の指標の複数の位置・姿勢情報と誤差に変換し、
ガウスモデルにより前記第２の指標の複数の位置・姿勢情報を結合して前記第２の指標の最適位置・姿勢情報と誤差を推定し、
前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の最適位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接確定するように設置される、請求項１１に記載の装置。
【請求項１８】
前記位置決め対象の進行経路に設置した指標は、非指標類図形情報を含む第２の指標であり、且つ、
前記位置・姿勢更新手段は、更に、
前記位置決め対象が同一の指標を通過した時の位置・姿勢の類似性を用いて、前記位置決め対象の繰り返し複数回通過した指標が第２の指標であるか否かを確定し、
前記第２の指標である場合、前記第２の指標を通過した前記位置決め対象の複数の位置・姿勢情報と誤差を記録して、前記第２の指標の複数の位置・姿勢情報と誤差に変換し、
ガウスモデルにより前記第２の指標の複数の位置・姿勢情報を結合して前記第２の指標の最適位置・姿勢情報と誤差を推定し、
前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の最適位置・姿勢情報から前記位置決め対象の現在位置・姿勢情報を直接確定するように設置される、請求項１１に記載の装置。
【請求項１９】
前記位置決め対象の進行経路に設置した指標は、第２の指標であり、且つ複数の第２の指標が設置されている、請求項１１に記載の装置。
【請求項２０】
前記複数の第２の指標における２つの隣り合う第２の指標同士に前記２つの隣り合う第２の指標を連結する補助位置決めストライブを添加し、前記位置決め対象が前記補助位置決めストライブを通過した時に、前記位置決め対象の前記補助位置決めストライブに対する角度ずれを補正して前記位置決め対象を前記補助位置決めストライブに沿って進行させるように設置される補助位置決め手段を更に含む、請求項１９に記載の装置。
【請求項２１】
シーンでリアルタイム位置決めし、地図を生成するように設置される位置決め対象と、
位置・姿勢情報、指標情報、非指標類図形情報のうちの少なくとも１種を含む指標と、
同時位置決め地図作成装置であって、
位置決め対象の初期化領域を設置し、前記位置決め対象の初期化領域、前記位置決め対象の進行経路及び前記位置決め対象のドッキング装置のうちの少なくとも１つにおいて指標が設置されているように設置される初期化領域設置手段、
前記位置決め対象の初期化領域からスタートし、前記指標に基づいて位置決め対象の初期位置・姿勢を確定する操作のうちの少なくとも１種を実行するように、位置決め対象を制御するように設置される位置決め対象スタート手段、
進行経路において指標を通過した場合、前記指標に基づいて位置決め対象の現在位置・姿勢を更新するように設置される位置・姿勢更新手段、
ドッキング装置とドッキングする場合、前記指標に基づいて前記位置決め対象と前記ドッキング装置との相対位置・姿勢を調整するように設置されるドッキング手段を含む、同時位置決め地図作成装置とを含む、指標を使用した同時位置決め地図作成ナビゲーションシステム。
【請求項２２】
前記位置決め対象は、同時位置決め地図作成ナビゲーションにおいて進行しているロボットと、ドッキング装置とドッキングする必要がある移動装置とを含む、請求項２１に記載のシステム。
【請求項２３】
前記ドッキング装置は、携帯コンベヤー又はアームを含む、請求項２１に記載のシステム。
【請求項２４】
前記位置決め対象の初期化領域に設置した指標は、位置・姿勢情報を含む第１の指標であり、且つ、
前記位置決め対象スタート手段は、
前記第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第１の指標の位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接抽出するように設置される、請求項２１に記載のシステム。
【請求項２５】
前記位置決め対象の初期化領域に設置した指標は、指標情報を含む第１の指標であり、且つ、
前記位置決め対象スタート手段は、
前記第１の指標においてスタートする場合、前記第１の指標に含まれる指標情報を記録し、前記指標情報を座標原点として位置決めし地図を作成し、
前記位置決め対象が前記第１の指標を繰り返し複数回通過した場合、前記第１の指標の指標情報を用いてマッチングを行い、前記位置決め対象の位置・姿勢情報を取得し、前記位置決め対象の複数の位置・姿勢情報と誤差を記録して、前記第１の指標の複数の位置・姿勢情報と誤差に変換し、
ガウスモデルにより前記第１の指標の複数の位置・姿勢情報を結合して前記第１の指標の最適位置・姿勢情報と誤差を推定し、
前記第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第１の指標の最適位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接確定するように設置される、請求項２１に記載のシステム。
【請求項２６】
前記位置決め対象の進行経路に設置した指標は、位置・姿勢情報を含む第２の指標であり、且つ、
前記位置・姿勢更新手段は、更に、
前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の位置・姿勢情報から前記位置決め対象の現在位置・姿勢情報を直接抽出するように設置される、請求項２１に記載のシステム。
【請求項２７】
前記位置決め対象の進行経路に設置した指標は、指標情報を含む第２の指標であり、且つ、
前記位置・姿勢更新手段は、更に、
前記位置決め対象が前記第２の指標を繰り返し複数回通過した場合、前記第２の指標の指標情報を用いてマッチングを行い、前記位置決め対象の位置・姿勢情報を取得し、前記位置決め対象の複数の位置・姿勢情報と誤差を記録して、前記第２の指標の複数の位置・姿勢情報と誤差に変換し、
ガウスモデルにより前記第２の指標の複数の位置・姿勢情報を結合して前記第２の指標の最適位置・姿勢情報と誤差を推定し、
前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の最適位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接確定するように設置される、請求項２１に記載のシステム。
【請求項２８】
前記位置決め対象の進行経路に設置した指標は、非指標類図形情報を含む第２の指標であり、且つ、
前記位置・姿勢更新手段は、更に、
前記位置決め対象が同一の指標を通過した時の位置・姿勢の類似性を用いて、前記位置決め対象の繰り返し複数回通過した指標が第２の指標であるか否かを確定し、
前記第２の指標である場合、前記第２の指標を通過した前記位置決め対象の複数の位置・姿勢情報と誤差を記録して、前記第２の指標の複数の位置・姿勢情報と誤差に変換し、
ガウスモデルにより前記第２の指標の複数の位置・姿勢情報を結合して前記第２の指標の最適位置・姿勢情報と誤差を推定し、
前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の最適位置・姿勢情報から前記位置決め対象の現在位置・姿勢情報を直接確定するように設置される、請求項２１に記載のシステム。
【請求項２９】
前記位置決め対象の進行経路に設置した指標は、第２の指標であり、且つ複数の第２の指標が設置されている、請求項２１に記載のシステム。
【請求項３０】
前記複数の第２の指標における２つの隣り合う第２の指標同士に前記２つの隣り合う第２の指標を連結する補助位置決めストライブを含み、
前記同時位置決め地図作成装置は、
前記位置決め対象が前記補助位置決めストライブを通過した時に、位置決め対象の補助位置決めストライブに対する角度ずれを補正して前記位置決め対象を前記補助位置決めストライブに沿って進行させるように設置される補助位置決め手段を更に含む、請求項２９に記載のシステム。
【発明の詳細な説明】
【技術分野】
【０００１】
本出願は、２０１７年０８月１６日に中国知的財産権局に提出した、出願番号２０１７１０７０３８１８．３の中国専利出願に基づいて優先権を主張し、そのすべての内容を本出願に援用する。
【０００２】
本出願は自動ナビゲーション分野に関し、例えば、指標を使用した同時位置決め地図作成ナビゲーション方法、装置及びシステムに関する。
【背景技術】
【０００３】
レーザレーダと視覚に基づく同時位置決め地図作成（Ｓｉｍｕｌｔａｎｅｏｕｓ  ｌｏｃａｌｉｚａｔｉｏｎ  ａｎｄ  ｍａｐｐｉｎｇ、ＳＬＡＭ）ナビゲーション方案は、完全に未知なシーンでリアルタイム位置決めを行い、シーンの二次元・三次元の地図を生成することができる。
【０００４】
例えば、完全に未知な環境に対して、ＳＬＡＭシステムは、初期化の位置・姿勢を基に、位置決め対象の進行過程において位置決めし地図を更新し続け、初期化位置・姿勢を基準とする地図を生成する。また、地図を確立した環境に対して、ＳＬＡＭシステムは初期化位置・姿勢領域で捜索し地図をマッチングし、初期位置・姿勢情報を取得し、位置決め対象の進行過程において位置決めし地図を更新し続ける。
【０００５】
ＳＬＡＭナビゲーションは、シーンで標識物を配置する必要がなく、その利便性から室内ナビゲーション方案における重要な分岐点となっている。ＳＬＡＭナビゲーションの精度は主に閉鎖精度によって決められ、シーンが大きくなる場合、地図の閉鎖を効果的に行うことができず、位置決めと地図の効果に極めて大きく影響することになる。また、ＳＬＡＭシステムの精度はセンサーの精度に影響されるため、低コストのＳＬＡＭシステムは、コンベヤーのドッキング、アーム操作などに必要となる精確な位置決めを満たすことができない。
【０００６】
そのため、上記課題に基づき、改良した同時位置決め地図作成ナビゲーション方法、装置及びシステムが必要とされる。
【発明の概要】
【発明が解決しようとする課題】
【０００７】
本出願は、新型で改良された指標を使用した同時位置決め地図作成ナビゲーション方法、装置及びシステムを提供する。
【課題を解決するための手段】
【０００８】
本出願は、位置決め対象の初期化領域を設置することと、前記位置決め対象の初期化領域において位置・姿勢情報又は指標情報を含む第１の指標を添加することと、位置決め対象が前記位置決め対象の初期化領域からスタートし、前記第１の指標に基づいて位置決め対象の初期位置・姿勢を確定することと、位置決め対象の進行経路において第２の指標を添加することと、位置決め対象が第２の指標を通過した場合、前記第２の指標に基づいて位置決め対象の現在位置・姿勢を更新することとを含む、指標を使用した同時位置決め地図作成ナビゲーション方法を提供する。
【０００９】
上記指標を使用した同時位置決め地図作成ナビゲーション方法において、前記位置決め対象は、同時位置決め地図作成ナビゲーションにおいて進行しているロボット、及び携帯コンベヤー、ラック、ケージトロリー（Ｃａｇｅ  Ｔｒｏｌｌｅｙ）及びアームなどの移動装置のうちの１つを含む。
【００１０】
上記指標を使用した同時位置決め地図作成ナビゲーション方法において、前記第１の指標は位置・姿勢情報を含み、且つ前記第１の指標に基づいて位置決め対象の初期位置・姿勢を確定することは、前記第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第１の指標の位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接抽出することを含む。
【００１１】
上記指標を使用した同時位置決め地図作成ナビゲーション方法において、前記第１の指標は指標情報を含み、且つ前記第１の指標に基づいて位置決め対象の初期位置・姿勢を確定することは、前記第１の指標の指標情報を用いてマッチングを行い、位置決め対象の複数の位置・姿勢情報と誤差共分散行列を記録し、第１の指標の複数の位置・姿勢情報と誤差共分散行列に変換することと、ガウスモデルにより前記複数の第１の指標の位置・姿勢情報を結合して前記第１の指標の最適位置・姿勢情報と誤差共分散行列を推定することと、前記第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第１の指標の最適位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接抽出することとを含む。
【００１２】
上記指標を使用した同時位置決め地図作成ナビゲーション方法において、前記第２の指標は位置・姿勢情報を含み、或いは指標情報を含み、或いは非指標類図形情報を含む。
【００１３】
上記指標を使用した同時位置決め地図作成ナビゲーション方法において、前記第２の指標は位置・姿勢情報を含み、且つ前記第２の指標に基づいて位置決め対象の現在位置・姿勢を更新することは、前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の位置・姿勢情報から前記位置決め対象の現在位置・姿勢情報を直接抽出することを含む。
【００１４】
上記指標を使用した同時位置決め地図作成ナビゲーション方法において、前記第２の指標は指標情報を含み、且つ前記第２の指標に基づいて位置決め対象の現在位置・姿勢を更新することは、前記第２の指標の指標情報を用いてマッチング行い、位置決め対象の複数の位置・姿勢情報と誤差共分散行列を記録し、第２の指標の複数の位置・姿勢情報と誤差共分散行列に変換することと、ガウスモデルにより前記複数の位置・姿勢情報を結合して前記第２の指標の最適位置・姿勢情報と誤差共分散行列を推定することと、前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の最適位置・姿勢情報から前記位置決め対象の現在位置・姿勢情報を直接抽出することとを含む。
【００１５】
上記指標を使用した同時位置決め地図作成ナビゲーション方法において、前記第２の指標は非指標類図形情報を含み、且つ前記第２の指標に基づいて位置決め対象の現在位置・姿勢を更新することは、位置決め対象が同一の指標を通過した時の位置・姿勢の類似性を用いて、位置決め対象の通過した指標が第２の指標であるか否かを確定することと、第２の指標を通過した位置決め対象の複数の位置・姿勢情報と誤差共分散行列を記録し、第２の指標の複数の位置・姿勢情報と誤差共分散行列に変換することと、ガウスモデルにより第２の指標の複数の位置・姿勢情報を結合して前記第２の指標の最適位置・姿勢情報と誤差共分散行列を推定することと、前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の最適位置・姿勢情報から前記位置決め対象の現在位置・姿勢情報を直接抽出することとを含む。
【００１６】
上記指標を使用した同時位置決め地図作成ナビゲーション方法において、前記第２の指標が複数の第２の指標を含む場合、前記位置決め対象の進行経路において第２の指標を添加することは、位置決め対象の進行経路において複数の第２の指標を添加することと、前記位置決め対象が前記第２の指標を通過した場合、前記第２の指標に基づいて前記位置決め対象の現在位置・姿勢を更新することとを含み、位置決め対象が前記複数の第２の指標を通過した場合、前記複数の第２の指標に基づいて位置決め対象の現在位置・姿勢を更新することを更に含む。
【００１７】
上記指標を使用した同時位置決め地図作成ナビゲーション方法において、複数の第２の指標における２つの隣り合う第２の指標同士に前記第２の指標を連結する補助位置決めストライブを含み、前記位置決め対象が前記補助位置決めストライブを通過した時に、位置決め対象の補助位置決めストライブに対する角度ずれを補正して前記位置決め対象を前記補助位置決めストライブに沿って進行させ、前記位置決め対象が第２の指標を通過し識別することを確保する。
【００１８】
上記指標を使用した同時位置決め地図作成ナビゲーション方法において、前記位置決め対象の進行経路におけるドッキング装置において第３の指標を添加することと、前記位置決め対象が前記第３の指標を通過した場合、前記第３の指標に基づいて前記ドッキング装置とのドッキング操作を完了することとを更に含む。
【００１９】
本出願は、位置決め対象の初期化領域を設置するように設置される初期化領域設置手段と、前記位置決め対象の初期化領域において位置・姿勢情報又は指標情報を含む第１の指標を添加するように設置される第１の指標添加手段と、位置決め対象が前記位置決め対象の初期化領域からスタートし、前記第１の指標に基づいて位置決め対象の初期位置・姿勢を確定するように設置される位置決め対象スタート手段と、位置決め対象の進行経路において第２の指標を添加するように設置される第２の指標添加手段と、位置決め対象が第２の指標を通過した場合、前記第２の指標に基づいて位置決め対象の現在位置・姿勢を更新するように設置される位置・姿勢更新手段とを含む、指標を使用した同時位置決め地図作成ナビゲーション装置を提供する。
【００２０】
上記指標を使用した同時位置決め地図作成ナビゲーション装置において、前記位置決め対象は、同時位置決め地図作成ナビゲーションにおいて進行しているロボット、及び携帯コンベヤー又はアームなどの移動装置のうちの１つを含む。
【００２１】
上記指標を使用した同時位置決め地図作成ナビゲーション装置において、前記第１の指標は位置・姿勢情報を含み、且つ前記位置決め対象スタート手段は、更に、前記第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第１の指標の位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接抽出するように設置される。
【００２２】
上記指標を使用した同時位置決め地図作成ナビゲーション装置において、前記第１の指標は指標情報を含み、且つ前記位置決め対象スタート手段は、更に、利用前記第１の指標の指標情報を用いてマッチングを行い、位置決め対象の複数の位置・姿勢情報と誤差共分散行列を記録し、第１の指標の複数の位置・姿勢情報と誤差共分散行列に変換し、ガウスモデルにより前記第１の指標の複数の位置・姿勢情報を結合して前記第１の指標の最適位置・姿勢情報と誤差共分散行列を推定し、前記第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第１の指標の最適位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接抽出するように設置される。
【００２３】
上記指標を使用した同時位置決め地図作成ナビゲーション装置において、前記第２の指標は位置・姿勢情報、指標情報、又は非指標類図形情報を含む。
【００２４】
上記指標を使用した同時位置決め地図作成ナビゲーション装置において、前記第２の指標は位置・姿勢情報を含み、且つ前記位置・姿勢更新手段は、更に、前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標位置・姿勢情報から前記位置決め対象の現在位置・姿勢情報を直接抽出するように設置される。
【００２５】
上記指標を使用した同時位置決め地図作成ナビゲーション装置において、前記第２の指標は指標情報を含み、且つ前記位置・姿勢更新手段は、更に、前記第２の指標の指標情報を用いてマッチングを行い、位置決め対象の複数の位置・姿勢情報と誤差共分散行列を記録し、第２の指標の複数の位置・姿勢情報と誤差共分散行列に変換し、ガウスモデルにより前記複数の位置・姿勢情報を結合して前記第２の指標の最適位置・姿勢情報と誤差共分散行列を推定し、前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の最適位置・姿勢情報から前記位置決め対象の現在位置・姿勢情報を直接抽出するように設置される。
【００２６】
上記指標を使用した同時位置決め地図作成ナビゲーション装置において、前記第２の指標は非指標類図形情報を含み、且つ前記位置・姿勢更新手段は、位置決め対象が同一の指標を通過した時の位置・姿勢の類似性を用いて、位置決め対象の通過した指標が第２の指標であるか否かを確定し、第２の指標を通過した位置決め対象の複数の位置・姿勢情報と誤差共分散行列を記録し、第２の指標の複数の位置・姿勢情報と誤差共分散行列に変換し、ガウスモデルにより第２の指標の複数の位置・姿勢情報を結合して前記第２の指標の最適位置・姿勢情報と誤差共分散行列を推定し、前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の最適位置・姿勢情報から前記位置決め対象の現在位置・姿勢情報を直接抽出するように設置される。
【００２７】
上記指標を使用した同時位置決め地図作成ナビゲーション装置において、前記第２の指標が複数の第２の指標を含む場合、前記第１の指標添加手段は、更に、位置決め対象の進行経路において複数の第２の指標を添加するように設置され、且つ、前記位置・姿勢更新手段は、位置決め対象が前記複数の第２の指標を通過した場合、前記複数の第２の指標に基づいて位置決め対象の現在位置・姿勢を更新するように設置される。
【００２８】
上記指標を使用した同時位置決め地図作成ナビゲーション装置において、複数の第２の指標における２つの隣り合う第２の指標同士に前記２つの隣り合う第２の指標を連結する補助位置決めストライブを添加し、前記位置決め対象が前記補助位置決めストライブを通過した時に、位置決め対象の補助位置決めストライブに対する角度ずれを補正して前記位置決め対象を前記補助位置決めストライブに沿って進行させるように設置される補助位置決め手段を更に含む。
【００２９】
上記指標を使用した同時位置決め地図作成ナビゲーション装置において、前記位置決め対象の進行経路におけるドッキング装置において第３の指標を添加するように設置される第３の指標添加手段と、前記位置決め対象が前記第３の指標を通過した場合、前記第３の指標に基づいて前記ドッキング装置とのドッキング操作を完了するように設置されるドッキング手段とを更に含む。
【００３０】
本出願は、シーンでリアルタイム位置決めし地図を生成するための位置決め対象と、位置・姿勢情報又は指標情報を含む第１の指標と、第２の指標と、同時位置決め地図作成装置であって、位置決め対象の初期化領域を設置するように設置される初期化領域設置手段、前記第１の指標を前記位置決め対象の初期化領域に添加するように設置される第１の指標添加手段、位置決め対象が前記位置決め対象の初期化領域からスタートし、前記第１の指標に基づいて位置決め対象の初期位置・姿勢を確定するように設置される位置決め対象スタート手段、第２の指標を前記位置決め対象の進行経路に添加するように設置される第２の指標添加手段、位置決め対象が第２の指標を通過した場合、前記第２の指標に基づいて位置決め対象の現在位置・姿勢を更新するように設置される位置・姿勢更新手段を含む同時位置決め地図作成装置とを含む、指標を使用した同時位置決め地図作成ナビゲーションシステムを提供する。
【００３１】
上記指標を使用した同時位置決め地図作成ナビゲーションシステムにおいて、前記位置決め対象は、同時位置決め地図作成ナビゲーションにおいて進行しているロボット、及び携帯コンベヤー又はアームなどの移動装置のうちの１つである。
【００３２】
上記指標を使用した同時位置決め地図作成ナビゲーションシステムにおいて、前記第１の指標は位置・姿勢情報を含み、且つ前記位置決め対象スタート手段は、前記第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第１の指標の位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接抽出するように設置される。
【００３３】
上記指標を使用した同時位置決め地図作成ナビゲーションシステムにおいて、前記第１の指標は指標情報を含み、且つ前記位置決め対象スタート手段は、前記第１の指標の指標情報を用いてマッチングを行い、位置決め対象の複数の位置・姿勢情報と誤差共分散行列を記録し、第１の指標の複数の位置・姿勢情報と誤差共分散行列に変換し、ガウスモデルにより前記第１の指標の複数の位置・姿勢情報を結合して前記第１の指標の最適位置・姿勢情報と誤差共分散行列を推定し、前記第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第１の指標の最適位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接抽出するように設置される。
【００３４】
上記指標を使用した同時位置決め地図作成ナビゲーションシステムにおいて、前記第２の指標は位置・姿勢情報、指標情報、又は非指標類図形情報を含む。
【００３５】
上記指標を使用した同時位置決め地図作成ナビゲーションシステムにおいて、前記第２の指標は位置・姿勢情報を含み、且つ前記位置・姿勢更新手段は、更に、前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の位置・姿勢情報から前記位置決め対象の現在位置・姿勢情報を直接抽出するように設置される。
【００３６】
上記指標を使用した同時位置決め地図作成ナビゲーションシステムにおいて、前記第２の指標は指標情報を含み、且つ前記位置・姿勢更新手段は、更に、前記第２の指標の指標情報を用いてマッチングを行い、位置決め対象の複数の位置・姿勢情報と誤差共分散行列を記録し、第２の指標の複数の位置・姿勢情報と誤差共分散行列に変換し、ガウスモデルにより前記複数の位置・姿勢情報を結合して前記第２の指標の最適位置・姿勢情報と誤差共分散行列を推定し、前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の最適位置・姿勢情報から前記位置決め対象の現在位置・姿勢情報を直接抽出するように設置される。
【００３７】
上記指標を使用した同時位置決め地図作成ナビゲーションシステムにおいて、前記第２の指標は非指標類図形情報を含み、且つ前記位置・姿勢更新手段は、更に、位置決め対象が同一の指標を通過した時の位置・姿勢の類似性を用いて、位置決め対象の通過した指標が第２の指標であるか否かを確定し、第２の指標を通過した位置決め対象の複数の位置・姿勢情報と誤差共分散行列を記録し、第２の指標の複数の位置・姿勢情報と誤差共分散行列に変換し、ガウスモデルにより第２の指標の複数の位置・姿勢情報を結合して前記第２の指標の最適位置・姿勢情報と誤差共分散行列を推定し、前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の最適位置・姿勢情報から前記位置決め対象の現在位置・姿勢情報を直接抽出するように設置される。
【００３８】
上記指標を使用した同時位置決め地図作成ナビゲーションシステムにおいて、当前記第２の指標が複数の第２の指標を含む場合、前記第１の指標添加手段は、更に、位置決め対象の進行経路において複数の第２の指標を添加するように設置され、且つ、前記位置・姿勢更新手段は、位置決め対象が前記複数の第２の指標を通過した場合、前記複数の第２の指標に基づいて位置決め対象の現在位置・姿勢を更新するように設置される。
【００３９】
上記指標を使用した同時位置決め地図作成ナビゲーションシステムにおいて、複数の第２の指標における２つの隣り合う第２の指標同士に補助位置決めストライブを含み、前記同時位置決め地図作成装置は、前記位置決め対象が前記補助位置決めストライブを通過した時に、位置決め対象の補助位置決めストライブに対する角度ずれを補正して前記位置決め対象を前記補助位置決めストライブに沿って進行させるように設置される補助位置決め手段を更に含む。
【００４０】
上記指標を使用した同時位置決め地図作成ナビゲーションシステムにおいて、前記位置決め対象の進行経路におけるドッキング装置において第３の指標を添加するように設置される第３の指標添加手段と、前記位置決め対象が前記第３の指標を通過した場合、前記第３の指標に基づいて前記ドッキング装置とのドッキング操作を完了するように設置されるドッキング手段とを更に含む。
【００４１】
本出願の実施例において、位置決め対象の初期化領域を設置し、前記位置決め対象の初期化領域、前記位置決め対象の進行経路、前記位置決め対象のドッキング装置のうちの少なくとも１つにおいて、位置・姿勢情報、指標情報、及び非指標類図形情報のうちの少なくとも１種を含む指標が設置されていることと、前記位置決め対象の初期化領域からスタートし、前記指標に基づいて位置決め対象の初期位置・姿勢を確定する操作のうちの少なくとも1種を実行するように、位置決め対象を制御することと、進行経路において前記指標を通過した場合、前記指標に基づいて前記位置決め対象の現在位置・姿勢を更新することと、ドッキング装置とドッキングする時に、前記指標に基づいて前記位置決め対象と前記ドッキング装置との相対位置・姿勢を調整することとを含む、指標を使用した同時位置決め地図作成ナビゲーション方法を提供する。
【００４２】
一実施例において、前記位置決め対象は、同時位置決め地図作成ナビゲーションにおいて進行しているロボットと、ドッキング装置とドッキングする必要がある移動装置とを含む。
【００４３】
一実施例において、前記ドッキング装置は、コンベヤー又はアームを含む。
【００４４】
一実施例において、前記位置決め対象の初期化領域に設置した指標は、位置・姿勢情報を含む第１の指標であり、且つ、前記第１の指標に基づいて位置決め対象の初期位置・姿勢を確定することは、前記第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第１の指標の位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接抽出することを含む。
【００４５】
一実施例において、前記位置決め対象の初期化領域に設置した指標は、指標情報を含む第１の指標であり、且つ、前記第１の指標に基づいて位置決め対象の初期位置・姿勢を確定することは、前記第１の指標においてスタートする場合、前記第１の指標に含まれる指標情報を記録し、前記指標情報を座標原点として位置決めし地図を作成することと、前記位置決め対象が前記第１の指標を繰り返し複数回通過した場合、前記第１の指標の指標情報を用いてマッチングを行い、前記位置決め対象の位置・姿勢情報を取得し、前記位置決め対象の複数の位置・姿勢情報と誤差を記録して、前記第１の指標の複数の位置・姿勢情報と誤差に変換することと、ガウスモデルにより前記第１の指標の複数の位置・姿勢情報を結合して前記第１の指標の最適位置・姿勢情報と誤差を推定することと、前記第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第１の指標の最適位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接確定することとを含む。
【００４６】
一実施例において、前記位置決め対象の進行経路に設置した指標は、位置・姿勢情報を含む第２の指標であり、且つ、前記第２の指標に基づいて位置決め対象の現在位置・姿勢を更新することは、前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の位置・姿勢情報から前記位置決め対象の現在位置・姿勢情報を直接抽出することを含む。
【００４７】
一実施例において、前記位置決め対象の進行経路に設置した指標は、指標情報を含む第２の指標であり、且つ、前記第２の指標に基づいて位置決め対象の現在位置・姿勢を更新することは、前記位置決め対象が前記第２の指標を繰り返し複数回通過した場合、前記第２の指標の指標情報を用いてマッチングを行い、前記位置決め対象の位置・姿勢情報を取得し、前記位置決め対象の複数の位置・姿勢情報と誤差を記録して、前記第２の指標の複数の位置・姿勢情報と誤差に変換することと、ガウスモデルにより前記第２の指標の複数の位置・姿勢情報を結合して前記第２の指標の最適位置・姿勢情報と誤差を推定することと、前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の最適位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接確定することとを含む。
【００４８】
一実施例において、前記位置決め対象の進行経路に設置した指標は、非指標類図形情報を含む第２の指標であり、且つ、前記第２の指標に基づいて位置決め対象の現在位置・姿勢を更新することは、前記位置決め対象が同一の指標を通過した時の位置・姿勢の類似性を用いて、前記位置決め対象の繰り返し複数回通過した指標が第２の指標であるか否かを確定することと、前記第２の指標である場合、前記第２の指標を通過した前記位置決め対象の複数の位置・姿勢情報と誤差を記録して、前記第２の指標の複数の位置・姿勢情報と誤差に変換することと、ガウスモデルにより前記第２の指標の複数の位置・姿勢情報を結合して前記第２の指標の最適位置・姿勢情報と誤差を推定することと、前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の最適位置・姿勢情報から前記位置決め対象の現在位置・姿勢情報を直接確定することとを含む。
【００４９】
一実施例において、前記位置決め対象の進行経路に設置した指標は、第２の指標であり、且つ複数の第２の指標が設置されている。
【００５０】
一実施例において、前記複数の第２の指標における２つの隣り合う第２の指標同士に前記２つの隣り合う第２の指標を連結する補助位置決めストライブを含み、前記位置決め対象が前記補助位置決めストライブを通過した時に、前記位置決め対象の前記補助位置決めストライブに対する角度ずれを補正して前記位置決め対象を前記補助位置決めストライブに沿って進行させる。
【００５１】
本出願の実施例は、初期化領域設置手段と、位置決め対象スタート手段と、位置・姿勢更新手段と、ドッキング手段とを含む指標を使用した同時位置決め地図作成ナビゲーション装置を提供する。初期化領域設置手段は、位置決め対象の初期化領域を設置し、前記位置決め対象の初期化領域、前記位置決め対象の進行経路、及び前記位置決め対象のドッキング装置のうちの少なくとも１つにおいて、位置・姿勢情報、指標情報、非指標類図形情報のうちの少なくとも１種を含む指標が設置されているように設置され、位置決め対象スタート手段は、前記位置決め対象の初期化領域からスタートし、前記指標に基づいて位置決め対象の初期位置・姿勢を確定する操作のうちの少なくとも１種を実行するように、位置決め対象を制御するように設置され、位置・姿勢更新手段は、進行経路において指標を通過した場合、前記指標に基づいて位置決め対象の現在位置・姿勢を更新するように設置され、ドッキング手段は、ドッキング装置とドッキングする場合、前記指標に基づいて前記位置決め対象と前記ドッキング装置との相対位置・姿勢を調整するように設置される。
【００５２】
一実施例において、前記位置決め対象は、同時位置決め地図作成ナビゲーションにおいて進行しているロボットと、ドッキング装置とドッキングする必要がある移動装置とを含む。
【００５３】
一実施例において、前記ドッキング装置は、携帯コンベヤー又はアームを含む。
【００５４】
一実施例において、前記位置決め対象の初期化領域に設置した指標は、位置・姿勢情報を含む第１の指標であり、且つ、前記位置決め対象スタート手段は、更に、前記第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第１の指標の位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接抽出するように設置される。
【００５５】
一実施例において、前記位置決め対象の初期化領域に設置した指標は、指標情報を含む第１の指標であり、且つ、前記位置決め対象スタート手段は、更に、前記第１の指標においてスタートする場合、前記第１の指標に含まれる指標情報を記録し、前記指標情報を座標原点として位置決めし地図を作成し、前記位置決め対象が前記第１の指標を繰り返し複数回通過した場合、前記第１の指標の指標情報を用いてマッチングして前記位置決め対象の位置・姿勢情報を取得し、前記位置決め対象の複数の位置・姿勢情報と誤差を記録して、前記第１の指標の複数の位置・姿勢情報と誤差に変換し、ガウスモデルにより前記第１の指標の複数の位置・姿勢情報を結合して前記第１の指標の最適位置・姿勢情報と誤差を推定し、前記第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第１の指標の最適位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接確定するように設置される。
【００５６】
一実施例において、前記位置決め対象の進行経路に設置した指標は、位置・姿勢情報を含む第２の指標であり、且つ、前記位置・姿勢更新手段は、更に、前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の位置・姿勢情報から前記位置決め対象の現在位置・姿勢情報を直接抽出するように設置される。
【００５７】
一実施例において、前記位置決め対象の進行経路に設置した指標は、指標情報を含む第２の指標であり、且つ、前記位置・姿勢更新手段は、更に、前記位置決め対象が前記第２の指標を繰り返し複数回通過した場合、前記第２の指標の指標情報を用いてマッチングし前記位置決め対象の位置・姿勢情報を取得し、前記位置決め対象の複数の位置・姿勢情報と誤差を記録して、前記第２の指標の複数の位置・姿勢情報と誤差に変換し、ガウスモデルにより前記第２の指標の複数の位置・姿勢情報を結合して前記第２の指標の最適位置・姿勢情報と誤差を推定し、前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の最適位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接確定するように設置される。
【００５８】
一実施例において、前記位置決め対象の進行経路に設置した指標は、非指標類図形情報を含む第２の指標であり、且つ、前記位置・姿勢更新手段は、前記位置決め対象が同一の指標を通過した時の位置・姿勢の類似性を用いて、前記位置決め対象の繰り返し複数回通過した指標が第２の指標であるか否かを確定し、前記第２の指標である場合、前記第２の指標を通過した前記位置決め対象の複数の位置・姿勢情報と誤差を記録して、前記第２の指標の複数の位置・姿勢情報と誤差に変換し、ガウスモデルにより前記第２の指標の複数の位置・姿勢情報を結合して前記第２の指標の最適位置・姿勢情報と誤差を推定し、前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の最適位置・姿勢情報から前記位置決め対象の現在位置・姿勢情報を直接確定するように設置される。
【００５９】
一実施例において、前記位置決め対象の進行経路に設置した指標は、第２の指標であり、且つ複数の第２の指標が設置されている。
【００６０】
一実施例において、前記複数の第２の指標における２つの隣り合う第２の指標同士に前記２つの隣り合う第２の指標を連結する補助位置決めストライブを添加し、前記位置決め対象が前記補助位置決めストライブを通過した時に、前記位置決め対象の前記補助位置決めストライブに対する角度ずれを補正して前記位置決め対象を前記補助位置決めストライブに沿って進行させるように設置される補助位置決め手段を更に含む。
【００６１】
本出願の実施例において、シーンでリアルタイム位置決めし地図を生成するように設置される位置決め対象と、位置・姿勢情報、指標情報、及び非指標類図形情報のうちの少なくとも１種を含む指標と、同時位置決め地図作成装置であって、位置決め対象の初期化領域を設置し、前記位置決め対象の初期化領域、前記位置決め対象の進行経路及び前記位置決め対象のドッキング装置のうちの少なくとも１つにおいて指標が設置されているように設置される初期化領域設置手段、前記位置決め対象の初期化領域からスタートし、前記指標に基づいて位置決め対象の初期位置・姿勢を確定する操作のうちの少なくとも１種を実行するように、位置決め対象を制御するように設置される位置決め対象スタート手段、進行経路において指標を通過した場合、前記指標に基づいて位置決め対象の現在位置・姿勢を更新するように設置される位置・姿勢更新手段、ドッキング装置とドッキングする場合、前記指標に基づいて前記位置決め対象と前記ドッキング装置との相対位置・姿勢を調整するように設置されるドッキング手段を含む同時位置決め地図作成装置とを含む、指標を使用した同時位置決め地図作成ナビゲーションシステムを提供する。
【００６２】
一実施例において、前記位置決め対象は、同時位置決め地図作成ナビゲーションにおいて進行しているロボットと、ドッキング装置とドッキングする必要がある移動装置とを含む。
【００６３】
一実施例において、前記ドッキング装置は、携帯コンベヤー又はアームを含む。
【００６４】
一実施例において、前記位置決め対象の初期化領域に設置した指標は、位置・姿勢情報を含む第１の指標であり、且つ、前記位置決め対象スタート手段は、前記第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第１の指標の位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接抽出するように設置される。
【００６５】
一実施例において、前記位置決め対象の初期化領域に設置した指標は、指標情報を含む第１の指標であり、且つ、前記位置決め対象スタート手段は、前記第１の指標においてスタートする場合、前記第１の指標に含まれる指標情報を記録し、前記指標情報を座標原点として位置決めし地図を作成し、前記位置決め対象が前記第１の指標を繰り返し複数回通過した場合、前記第１の指標の指標情報を用いてマッチングを行い、前記位置決め対象の位置・姿勢情報を取得し、前記位置決め対象の複数の位置・姿勢情報と誤差を記録して、前記第１の指標の複数の位置・姿勢情報と誤差に変換し、ガウスモデルにより前記第１の指標の複数の位置・姿勢情報を結合して前記第１の指標の最適位置・姿勢情報と誤差を推定し、前記第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第１の指標の最適位置・姿勢情報から前記位置決め対象の初期位置・姿勢情報を直接確定するように設置される。
【００６６】
一実施例において、前記位置決め対象の進行経路に設置した指標は、位置・姿勢情報を含む第２の指標であり、且つ、前記位置・姿勢更新手段は、更に、前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の位置・姿勢情報から前記位置決め対象の現在位置・姿勢情報を直接抽出するように設置される。
【００６７】
一実施例において、前記位置決め対象の進行経路に設置した指標は、指標情報を含む第２の指標であり、且つ、前期位置・姿勢更新手段は、更に、前記位置決め対象が前記第２の指標を繰り返し複数回通過した場合、前記第２の指標の指標情報を用いてマッチングを行い、前記位置決め対象の位置・姿勢情報を取得し、前記位置決め対象の複数の位置・姿勢情報と誤差を記録して、前記第２の指標の複数の位置決め情報と誤差に変換し、ガウスモデルにより前記第２の指標の複数の位置・姿勢情報を結合して前記第２の指標の最適位置・姿勢情報と誤差を推定し、前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の最適位置・姿勢情報から前記位置決め対象の現在位置・姿勢情報を直接確定するように設置される。
【００６８】
一実施例において、前記位置決め対象の進行経路に設置した指標は、非指標類図形情報を含む第２の指標であり、且つ、前記位置・姿勢更新手段は、更に、前記位置決め対象が同一の指標を通過した時の位置・姿勢の類似性を用いて、前記位置決め対象の繰り返し複数回通過した指標が第２の指標であるか否かを確定し、前記第２の指標である場合、前記第２の指標を通過した前記位置決め対象の複数の位置・姿勢情報と誤差を記録して、前記第２の指標の複数の位置・姿勢情報と誤差に変換し、ガウスモデルにより前記第２の指標の複数の位置・姿勢情報を結合して前記第２の指標の最適位置・姿勢情報と誤差を推定し、前記第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して前記第２の指標の最適位置・姿勢情報から前記位置決め対象の現在位置・姿勢情報を直接確定するように設置される。
【００６９】
一実施例において、前記位置決め対象の進行経路に設置した指標は、第２の指標であり、且つ複数の第２の指標が設置されている。
【００７０】
一実施例において、前記複数の第２の指標における２つの隣り合う第２の指標同士に前記２つの隣り合う前記第２の指標を連結する補助位置決めストライブを含み、前記同時位置決め地図作成装置は、前記位置決め対象が前記補助位置決めストライブを通過した時に、位置決め対象の補助位置決めストライブに対する角度ずれを補正して前記位置決め対象を前記補助位置決めストライブに沿って進行させるように設置される補助位置決め手段を更に含む。
【図面の簡単な説明】
【００７１】
【図１】図１は、本出願の実施例に係る指標を使用した同時位置決め地図作成ナビゲーション方法の模式的なフローチャートである。
【図２】図２は、本出願の実施例に係る指標の一例を示す模式図である。
【図３】図３は、本出願の実施例に係る指標の射影変換を示す模式図である。
【図４】図４は、本出願の実施例に係る指標画像の座標変換模式図である。
【図５】図５は、本出願の実施例に係る位置・姿勢情報を結合した模式図である。
【図６Ａ】図６Ａは、本出願の実施例に係る視覚的指標とレーザ指標の模式図である。
【図６Ｂ】図６Ｂは、本出願の実施例に係る視覚的指標とレーザ指標の模式図である。
【図７Ａ】図７Ａは、本出願の実施例に係る視覚的指標とレーザ指標に対して定義した座標系の模式図である。
【図７Ｂ】図７Ｂは、本出願の実施例に係る視覚的指標とレーザ指標に対して定義した座標系の模式図である。
【図８】図８は、本出願の実施例に係る類似する指標位置・姿勢に対して結合する模式図である。
【図９Ａ】図９Ａは、本出願の実施例に係る指標とカラーストライブとの連結形態の模式図である。
【図９Ｂ】図９Ｂは、本出願の実施例に係る指標とカラーストライブとの連結形態の模式図である。
【図１０】図１０は、本出願の実施例に係るロボットとカラーストライブとのずれを計算することを示す模式図である。
【図１１】図１１は、本出願の実施例に係る指標を使用した同時位置決め地図作成ナビゲーション装置の模式的なブロック図である。
【図１２】図１２は、本出願の実施例に係る指標を使用した同時位置決め地図作成ナビゲーションシステムの模式的なブロック図である。
【発明を実施するための形態】
【００７２】
以下の説明は、当業者が本発明を実現することができるように本発明を開示するために用いられる。以下の説明における好ましい実施例は例示的なものに過ぎず、当業者にとって、他の自明な変形を想到することができる。以下の説明において定義される本発明の基本原理は、他の実施形態、変形形態、改良形態、等価形態及び本発明の構想と範囲から逸脱しない他の技術案に適用することができる。
【００７３】
以下、明細書と請求の範囲に用いられる用語と語彙は、書面の意味に限らず、発明者が本発明を明瞭に共通して理解できるよう用いたものに過ぎない。したがって、以下の本発明の種々の実施例に対する説明の提供は、請求の範囲とそれらの等価物により定義されるように本発明を限定する目的ではなく、説明する目的だけであることは、当業者にとって自明である。
【００７４】
「一」という用語は、「少なくとも１つ」又は「１つ又は複数」と理解されるべきであることを理解されたい。即ち、１つの実施例において、１つの素子の数は、１つであってもよいが、他の実施例において、当該素子の数は、複数であってもよい。「一」という用語は、数を限定するものであると理解されてはいけない。
【００７５】
「第１の」、「第２の」などの序数は、種々のモジュールを説明するために用いられるが、ここでは、それらのモジュールを制限するものではない。当該用語は、１つのモジュールと他のモジュールを区別するために用いられるものに過ぎない。例えば、発明構想の教示から逸脱しない限り、第１のモジュールは、第２のモジュールと呼ばれてもよく、且つ同様に、第２のモジュールは、第１のモジュールと呼ばれてもよい。ここで用いられる「及び／又は」という用語は、１つ又は複数の関連する、挙げられた項目のいずれかとすべての組合せを含む。
【００７６】
ここで用いられる用語は、種々の実施例を説明するためのものに過ぎず、制限するものではない。文脈で明瞭に指示される以外、ここで用いられる単数形は、複数形を含んでもよい。また、「含む」及び／又は「有する」という用語は、本明細書に用いられる場合、記載する特徴、数、ステップ、操作、モジュール、素子やこれらの組合せの存在を指定するが、１つ又は複数の他の特徴、数、ステップ、操作、モジュール、素子やそれらの組合せの存在又は付加を排除しないことを理解すべきである。
【００７７】
技術と科学用語を含む、ここで用いられる用語は、当該用語を異なって限定しない限り、当業者にとって通常理解する用語と同様な意味を有している。通常使用する辞書において限定する用語は、関連技術における用語と一致する意味を有していると理解すべきである。
【００７８】
以下、図面と実施形態を結び付けて本出願について詳しく説明する。
【００７９】
本出願の実施例は、位置決め対象の初期化領域を設置することと、当該位置決め対象の初期化領域において位置・姿勢情報又は指標情報を含む第１の指標を添加することと、位置決め対象が当該位置決め対象の初期化領域からスタートし、当該第１の指標に基づいて位置決め対象の初期位置・姿勢を確定することと、位置決め対象の進行経路に第２の指標を添加することと、位置決め対象が第２の指標を通過した場合、当該第２の指標に基づいて位置決め対象の現在位置・姿勢を更新することとを含む、指標を使用した同時位置決め地図作成ナビゲーション方法を提供する。
【００８０】
図１は、本出願の実施例に係る指標を使用した同時位置決め地図作成ナビゲーション方法の模式的なフローチャートである。図１に示すように、本出願の実施例に係る指標を使用した同時位置決め地図作成ナビゲーション方法は、ステップＳ１〜ステップＳ５を含む。
【００８１】
ステップＳ１において、位置決め対象の初期化領域を設置する。
【００８２】
ステップＳ２において、当該位置決め対象の初期化領域において位置・姿勢情報又は指標情報を含む第１の指標を添加する。
【００８３】
ステップＳ３において、位置決め対象が当該位置決め対象の初期化領域からスタートし、当該第１の指標に基づいて位置決め対象の初期位置・姿勢を確定する。
【００８４】
ステップＳ４において、位置決め対象の進行経路において第２の指標を添加する。
【００８５】
ステップＳ５において、位置決め対象が第２の指標を通過した場合、当該第２の指標に基づいて位置決め対象の現在位置・姿勢を更新する。
【００８６】
そのため、本出願の実施例に係る指標を使用した同時位置決め地図作成ナビゲーション方法は、関連技術における位置決め対象の初期化位置・姿勢が不明確であるという問題、及び進行過程における位置・姿勢がオフセットするという問題を同時に解決することで、ＳＬＡＭナビゲーション方法の高精度と高ロバスト性を実現し、正確な位置決めを必要とする産業環境に適応することができる。
【００８７】
一実施例において、位置決め対象の初期化領域を設置し第１の指標を添加し、位置決め対象が当該位置決め対象の初期化領域からスタートし、当該第１の指標に基づいて位置決め対象の初期位置・姿勢を確定することにより、位置決め対象の初期化位置・姿勢が不明確であるという問題を解決することができる。このように、明確な初期化位置・姿勢情報に基づいて同時位置決め地図作成を行うことにより、ＳＬＡＭナビゲーションシステムのナビゲーション結果と実際環境とのマッチングを実現することができるので、当該ナビゲーションシステムと実際適用との結合に寄与する。また、既知の地図で再度位置決めすれば、位置決め対象の初期位置・姿勢を制限することができるので、地図とのマッチングをうまく実現できる。
【００８８】
また、位置決め対象の進行経路に指標を添加することにより、位置決め対象の進行過程においてＳＬＡＭナビゲーションシステムによる位置決めのずれを補正することができるので、地図の閉鎖を実現し、地図作成と位置決め効果の改良に寄与する。
【００８９】
上記指標を使用した同時位置決め地図作成ナビゲーション方法において、位置決め対象の進行経路に複数の第２の指標を添加することと、位置決め対象が当該複数の第２の指標を通過した場合、当該複数の第２の指標に基づいて位置決め対象の現在位置・姿勢を更新することとを更に含む。
【００９０】
つまり、本出願の実施例に係る指標を使用したＳＬＡＭナビゲーション方法において、位置決め対象の進行過程においてＳＬＡＭナビゲーションシステムの位置決めによるオフセットを補正するために、大きなシーンでは、位置決め対象の進行経路に複数の指標を添加することで、位置決め対象が各指標を通過した時に、指標に基づいて位置決め対象が当該指標を通過した時の現在位置・姿勢に対してリアルタイム更新を行うので、位置決め対象が大きなシーンで移動する時の累積オフセットを低減させ、ＳＬＡＭナビゲーションシステムが閉鎖検出を行うことができないことを回避する。
【００９１】
ここで、当業者であれば、本出願の実施例に係る指標を使用したＳＬＡＭナビゲーション方法において、位置決め対象は適用シーンに基づいて複数種の対象であってもよいことを理解するべきである。例えば、一般的なＳＬＡＭナビゲーション方法とナビゲーションシステムにおいて、リアルタイム位置決め地図作成を実現するためのロボットであるが、コンベヤーのドッキング、アーム操作などの正確な位置決めに用いられる場合、正確な位置決めを行う必要があるコンベヤー、アームなどである。
【００９２】
よって、上記指標を使用したＳＬＡＭナビゲーション方法において、当該位置決め対象はＳＬＡＭナビゲーションにおいて進行しているロボット、或いはコンベヤーのドッキング又はアーム操作などのシーンに適用される装置又は機器であってもよい。
【００９３】
本出願の実施例に係る指標を使用した同時位置決め地図作成ナビゲーション方法は、指標に基づいて位置決め対象の位置・姿勢を確定する方法であり、当該指標は、複数種の形態を有してもよい。
【００９４】
図２は、本出願の実施例に係る指標の一例を示す模式図である。例えば、図２に示すように、当該指標はＱＲコード（登録商標）（ＱＲＣｏｄｅ、ＤａｔａＭａｔｒｉｘなどの符号化形態）、バーコード及び他の視覚的指標などの人工指標物であってもよい。
【００９５】
また、記憶情報によれば、指標は、複数のタイプに分けられてもよい。例えば、１種の指標は位置・姿勢情報（ｘ、ｙ、θ）を含み、他の１種の指標は位置・姿勢情報を含まず、指標（Ｉｄｅｎｔｉｆｉｃａｔｉｏｎ、ＩＤ）情報のみを含み、別の１種の指標は非指標類図形情報を含んでもよい。
【００９６】
指標のタイプにより、相応する指標に基づく位置決め対象の位置・姿勢を確定する適用形態も異なり、以下、詳しく説明する。
【００９７】
まず、位置・姿勢情報を含む指標に対して、指標のコードワードに記憶した情報は、少なくとも当該指標のシーンにおける実際位置（ｘ、ｙ）を含む。指標に角度ずれがある場合、コードワードにおいて角度θの情報を更に提供する必要がある。
【００９８】
以下は、位置決め対象がＳＬＡＭナビゲーションシステムにおけるロボットであることを例として、指標に基づいて位置決め対象の位置を確定する具体的な形態について説明する。もちろん、当業者であれば、位置決め対象は、ロボットに限らず、上述したコンベヤーのドッキング又はアーム操作などのシーンに適用される移動装置であってもよいことを理解するべきである。
【００９９】
ＱＲｃｏｄｅ（ＱＲコード）を例として、ロボットがスタートする前に、ロボットをＱＲコードの上方まで移動させる。ロボットのスタート過程において、カメラ画像を撮像する。カメラのロボットにおける位置が一定であり、且つ地面が平らであるため、画像座標系は射影変換によって平面座標系に変換される。即ち、下記式（１）を満たす。
【０１００】
【数１】
2019537077.tif 000003
【０１０１】
式中において、Ｈは３×３行列であり、カメラから実際座標までの射影変換を説明する。uとνは、変換後の画素であり、u’とν’は、変換前の画素であり、ここで、３×３行列Ｈによって座標変換を行う。図３は、本出願の実施例に係る指標の射影変換を示す模式図である。そのため、図３に示すように、当該射影変換により、元画像を平面図に変換することができる。
【０１０２】
新たな図形において、画像は、ＱＲコードに正対し、且つ画像における画素のそれぞれ対応する実際地面距離は既知であり、画像における画素点（u、ν）は、唯一のロボット座標系の下座標（ｘ、ｙ）に対応し、対応形態は、下記式（２）で示される。
【０１０３】
【数２】
2019537077.tif 000004
【０１０４】
式中において、ｆは、焦点距離であって、１つの画素に対応する実際距離である。u０とν０とは、カメラの焦点距離中心の画像における横座標と縦座標を指し、カメラにおけるパラメータの一部である。
【０１０５】
上記式（２）は、行列の形態で下記式（３）に記載されてもよい。
【０１０６】
【数３】
2019537077.tif 000005
【０１０７】
式中において、Ｈｉは、画像座標系からロボット座標系までの変換行列である。
【０１０８】
図４は、本出願の実施例に係る指標画像の座標変換模式図である。図４に示すように、（u０、ν０）は、ロボット座標系原点の画像における座標である。画像座標は、右がuで、下がνであり、ロボット座標系は、右がｘで、下がｙである。
【０１０９】
続いて、画像においてＱＲコードが存在するか否かを検出する。下向きのカメラによってＱＲコードを走査してＱＲコードのカメラ座標系における座標（u、ν、θ）を取得する。変換行列Ｈｉに基づき、ＱＲコードのロボット座標系における位置を取得することができる。逆方向の変換により、ロボットのＱＲコードにおける座標を取得することができる。下記式（４）で示される。
【０１１０】
【数４】
2019537077.tif 000006
【０１１１】
式中において、ロボットのＱＲコード座標系における実際角度は−θである。
【０１１２】
用いられたＱＲコードを初期化し、コードワードにおいてＱＲコードのシーンにおける実際座標情報（ｘｂ、ｙｂ、θｂ）が記憶されており、ＱＲコードにおけるコードワードを復号することにより、ＱＲコードのシーンにおける実際位置・姿勢を取得する。そのため、ロボットのシーンにおける座標は、下記式（５）で示される。
【０１１３】
【数５】
2019537077.tif 000007
【０１１４】
ロボットのシーンにおける針路角、ロボットのＱＲコードにおける針路角「−θ」、及びＱＲコード自体の針路角θｂは、下記式（６）で示される。
【０１１５】
【数６】
2019537077.tif 000008
【０１１６】
ここまでは、ロボットがＱＲコードの可視位置においてスタートする場合、ＱＲコードのカメラにおける位置とＱＲコードのコードワードによってロボットの初期位置・姿勢（ｘｗ、ｙｗ、θｗ）を確定することができる。当該初期位置・姿勢でロボットをスタートさせることにより、システム座標系全体の一致性を保証することができる。
【０１１７】
つまり、指標が位置・姿勢情報を含む場合、位置決め対象は、配置された画像形成機器、例えばカメラで指標を撮像し指標の位置・姿勢情報を取得するため、位置決め対象の位置・姿勢情報と指標の位置・姿勢情報との間に確定した空間関係が存在する。そのため、指標に含まれる位置・姿勢情報を用いて指標に基づいて位置決め対象の画像形成機器に画像形成した位置・姿勢に対して座標変換を行うことにより、指標の位置・姿勢情報から位置決め対象の初期位置・姿勢情を直接抽出することができる。
【０１１８】
ここで、当業者であれば、指標の位置決め対象の画像形成機器における画像形成によって指標と位置決め対象、例えば上記ロボット的相対位置・姿勢を確定してもよく、他の形態でロボットと指標との相対位置・姿勢を確定してもよいため、座標変換を介して指標の位置・姿勢情報から位置決め対象の位置・姿勢情報を抽出する。且つ、相対的に、他の形態でロボットと指標との相対位置・姿勢を確定する場合、他の形態の座標で変換して指標の位置・姿勢情報から位置決め対象の位置・姿勢情報を直接抽出する方法を用いてもよいことを理解するべきである。
【０１１９】
そのため、上記指標を使用したＳＬＡＭナビゲーション方法において、当該第１の指標は位置・姿勢情報を含み、且つ当該第１の指標に基づいて位置決め対象の初期位置・姿勢を確定することは、当該第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して当該第１の指標の位置・姿勢情報から当該位置決め対象の初期位置・姿勢情報を直接抽出することであってもよい。
【０１２０】
更に、上記指標を使用したＳＬＡＭナビゲーション方法において、当該第１の指標の位置決め対象に対する位置・姿勢は、当該第１の指標に基づいて当該位置決め対象のために用意する画像形成機器において形成した画像の位置・姿勢により確定される。
【０１２１】
また、本出願の実施例に係る指標を使用したＳＬＡＭナビゲーション方法において、指標はＩＤを含んでもよいが、位置・姿勢情報は含まない。この情況に対して、ロボットが当該指標においてスタートする時に指標に含まれるＩＤを記録し、ＳＬＡＭ過程において当該ＩＤを座標原点として位置決めし地図を作成する。ロボットが当該指標を繰り返し通過した時に、当該指標に含まれるＩＤを用いてマッチングを行い、毎回のロボットの位置・姿勢を取得し、毎回のロボットの位置・姿勢の平均値μｗと共分散行列Σｗを記録し、上述した通りに逆方向の座標変換過程によって相応する指標の位置・姿勢平均値と共分散行列に変換する。その後、ガウスモデルにより、複数回得た指標の位置・姿勢情報を結合して、当該指標の最適位置・姿勢推定と共分散行列を推定し、上述した通りに逆方向の座標変換過程によって相応するロボット位置・姿勢をロボットの初期位置・姿勢に変換する。
【０１２２】
図５は、本出願の実施例に係る位置・姿勢情報を結合した模式図である。図５に示すように、ロボットが当該指標を５回通過した場合、ＳＬＡＭナビゲーション位置決めによって５つの異なる位置・姿勢と誤差（例えば、共分散行列）を取得する。位置・姿勢の結合により、右図における最適化後の位置・姿勢と誤差（即ち、最適位置・姿勢推定と誤差）を指標の実際位置・姿勢と誤差として取得した。ロボットが当該指標において再度スタートする場合、当該指標の最適位置・姿勢推定を指標の初期化位置・姿勢情報として用い、ロボットと当該指標との相対位置・姿勢に基づいてロボットの初期位置・姿勢と誤差を計算する。
【０１２３】
一実施例において、ロボットが当該指標をＮ回通過し或いは観察したと仮定する場合、ｋ回目の当該指標を通過し或いは観察した位置・姿勢が二次元のガウス分布を満たすように定義される。即ち、以下の通りである。
【０１２４】
【数７】
2019537077.tif 000009
【０１２５】
式中において、ｐ（ｐｋ）は、ｋ回目の位置・姿勢確率分布であり、μｋは位置・姿勢平均値であり、Σｋは共分散行列である。当該指標を複数回通過し或いは観察した場合、当該指標の最適推定は、以下の通りである。
【０１２６】
【数８】
2019537077.tif 000010
【０１２７】
毎回観察する時にいずれも単独分布であると仮定する場合、最適推定は、複数のガウス分布の乗積に変換されてもよい。即ち、以下の通りである。
【０１２８】
【数９】
2019537077.tif 000011
【０１２９】
ここで、ロボットと指標との相対位置・姿勢に基づいて指標に含まれる位置・姿勢情報からロボットの初期位置・姿勢情報を直接確定する方法について、上記の通りに説明したため、贅言するまでもない。
【０１３０】
そのため、上記指標を使用した同時位置決め地図作成ナビゲーション方法において、当該第１の指標は指標情報を含み、且つ当該第１の指標に基づいて位置決め対象の初期位置・姿勢を確定することは、当該第１の指標の指標情報を用いてマッチングを行い、位置決め対象の複数の位置・姿勢情報と誤差を記録して、第１の指標の複数の位置・姿勢情報と誤差に変換し、ガウスモデルにより当該第１の指標の複数の位置・姿勢情報を結合して当該第１の指標の最適位置・姿勢情報と誤差を推定し、当該第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して当該第１の指標の最適位置・姿勢情報から当該位置決め対象の初期位置・姿勢情報を直接抽出することであってもよい。
【０１３１】
このように、第１の指標が位置・姿勢情報又は指標情報を含む場合、位置決め対象が当該位置決め対象の初期化領域においてスタートする場合、当該第１の指標に基づいて位置決め対象の初期位置・姿勢を確定することができるので、位置決め対象の初期化位置・姿勢が不明確であるという問題を解決する。
【０１３２】
上述したように、位置決め対象の進行過程における位置決めのずれを解決するために、位置決め対象の進行経路に１つ又は複数の指標を添加して位置決めのずれを補正する。更に、位置決め対象の初期化において、指標は位置・姿勢情報又は指標情報を含む必要があることに対して、位置決め対象の進行経路に添加した指標は非指標類図形情報を含んでもよい。
【０１３３】
つまり、上記指標を使用したＳＬＡＭナビゲーション方法において、当該第２の指標は位置・姿勢情報を含み、或いは指標情報を含み、或いは非指標類図形情報を含んでもよい。
【０１３４】
更に、上記指標を使用したＳＬＡＭナビゲーション方法において、当該第３の指標は位置・姿勢情報を含み、或いは指標情報を含み、或いは非指標類図形情報を含んでもよい。
【０１３５】
位置・姿勢情報を含む第２の指標に対して、位置決め対象が当該第２の指標を通過した場合、上述した方法により、第２の指標の位置・姿勢情報からコードワード情報を抽出し、第２の指標の位置決め対象に対する位置・姿勢に基づき、位置決め対象の位置・姿勢情報を得て位置決め結果を直接修正することができる。
【０１３６】
指標情報を含む第２の指標に対して、位置決め対象が当該第２の指標を毎回通過した場合、位置決め対象の推定位置・姿勢と誤差（例えば、共分散行列）を記録し、第２の指標の位置・姿勢と誤差（例えば、共分散行列）に変換する。複数回の結合によって位置・姿勢情報（ｘｂ、ｙｂ、θｂ）を含む第２の指標を得ることができる。その後、得た位置・姿勢情報と誤差（例えば、共分散行列）によって位置決め対象の現在位置・姿勢を直接更新することができる。以上、当該方法についてはすでに説明したため、贅言はしない。
【０１３７】
つまり、上記指標を使用したＳＬＡＭナビゲーション方法において、当該第２の指標は、位置・姿勢情報を含み、且つ当該第２の指標に基づいて位置決め対象の現在位置・姿勢を更新することは、当該第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して当該第２の指標の位置・姿勢情報から当該位置決め対象の現在位置・姿勢情報を直接確定することであってもよい。
【０１３８】
或いは、上記指標を使用したＳＬＡＭナビゲーション方法において、当該第２の指標は指標情報を含み、且つ当該第２の指標に基づいて位置決め対象の現在位置・姿勢を更新することは、当該第２の指標の指標情報を用いてマッチングを行い、位置決め対象の複数の位置・姿勢情報と誤差を取得・記録し、第２の指標の複数の位置・姿勢情報と誤差に変換し、ガウスモデルにより当該複数の位置・姿勢情報を結合して当該第２の指標の最適位置・姿勢情報と誤差を推定し、当該第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して当該第２の指標の最適位置・姿勢情報から当該位置決め対象の現在位置・姿勢情報を直接確定することであってもよい。
【０１３９】
また、本出願の実施例に係る指標を使用した同時位置決め地図作成ナビゲーション方法において、第２の指標は、非指標類図形情報を含む指標であってもよい。非指標類図形情報は何らかの意味がある情報を含まなくてもよい。例えば、非指標類図形情報指標は、規則的な図形類指標であってもよく、位置決め対象の初期化領域において複数の上述した規則的な図形類指標を添加することができる。また、例えば、第２の指標は視覚的指標（規則的な図形）或いはレーザ指標（規則的なブロック）であってもよい。図６Ａ、図６Ｂは、本出願の実施例に係る視覚的指標とレーザ指標の模式図である。図６Ａに示すように、視覚的指標は、検出可能で向きがある図形であり、且つ図６Ｂに示すように、レーザ指標は規則的なブロックである。
【０１４０】
指標の検出において、図６Ａに示す視覚的指標に対して、三角形と矩形とが交差した３つの点（ｐ１、ｐ２、ｐ３）を検出し、この３つの点を基礎として、図７Ａに示す座標系を定義する。座標原点Ｏは、下記式（１０）で示される。
【０１４１】
【数１０】
2019537077.tif 000012
【０１４２】
式中において、ｘ軸の向きは、ｐ３−ｐ１であり、ｙ軸の向きはｐ２−Ｏである。最後に、当該指標のロボット座標系における座標を確定した。
【０１４３】
レーザ指標に対して、図７Ｂに示す座標系を定義する。それと同時に、指標ブロックを複数のレーザ点として離散し、ロボットのレーザレーダにより類似するパターンを監視した場合、ポイントクラウドマッチングの方案を用いて当該指標のレーザレーダ座標系における座標を検出した後、標定パラメータを用いて当該指標のロボット座標系における座標を求める。図７Ａ、図７Ｂは、本出願の実施例に係る視覚的指標とレーザ指標に対して定義した座標系の模式図である。
【０１４４】
ロボットが同一の指標を複数回通過し或いは観察した場合、ロボットが当該指標を複数回通過し或いは観察した位置・姿勢を用いて指標位置・姿勢の最適化を行うことができる。ＩＤを含む指標と異なる点について、ＩＤを含まない指標は、マッチングを行う時に対応した具体的なＩＤがなく、位置・姿勢情報を用いて対応する必要がある。図８に示すように、ロボットが複数回通過し或いは観察した指標と指標との間に一定の位置間隔が存在し、ロボットが当該指標を検出した場合、ロボットの位置・姿勢を取得し、ロボットの位置・姿勢を記録する。同一の指標に対して、記録した複数のロボットの位置・姿勢が類似する。類似する位置・姿勢情報を結合して当該指標の最適位置決め推定を求めることができる。ロボットが当該指標を再度検出した時に、記録した指標におけるロボットから最も近い指標をマッチングし、距離が一定の閾値より小さい場合、当該指標の位置・姿勢情報を用いてロボットの位置・姿勢情報を最適化し、そうでない場合、１つの新たな指標を作成する。ここで、図８は、本出願の実施例に係る類似する指標位置・姿勢を結合した模式図である。
【０１４５】
つまり、指標自体が非指標類図形情報を含む場合、ロボットの当該指標を通過した時の位置・姿勢の類似性によって同一の指標であるか否かを確定する。或いは、ロボットの指標を通過した時の類似する位置・姿勢を指標の相応するＩＤとすることができる。その後の過程は、実質上、上述した指標がＩＤ情報を含む場合と同様である。一実施例において、同一の指標であると確定した後、ロボットが当該指標を毎回通過した時の類似する位置・姿勢を得た後、指標の位置・姿勢を結合して異なる指標の最適位置決め推定を求めることができる。そのため、指標がいずれの情報も含まない場合、実質上、ロボットが指標を通過した時の位置・姿勢の類似性によって指標に対してＩＤを付与し、且つその後の過程は、以上で説明した、指標が指標情報を含む場合と同様である。
【０１４６】
そのため、上記指標を使用したＳＬＡＭナビゲーション方法において、当該第２の指標は非指標類図形情報を含み、且つ当該第２の指標に基づいて位置決め対象の現在位置・姿勢を更新することは、位置決め対象が同一の指標を通過した時の位置・姿勢の類似性を用いて、位置決め対象の通過した指標が第２の指標であるか否かを確定し、第２の指標であると、第２の指標を通過した位置決め対象の複数の位置・姿勢情報と誤差を記録して、第２の指標の複数の位置・姿勢情報と誤差に変換し、ガウスモデルにより第２の指標の複数の位置・姿勢情報を結合して当該第２の指標の最適位置・姿勢情報と誤差を推定し、当該第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して当該第２の指標の最適位置・姿勢情報から当該位置決め対象の現在位置・姿勢情報を直接抽出することであってもよい。
【０１４７】
更に、本出願の実施例に係る同時位置決め地図作成ナビゲーション方法において、位置決め対象の進行経路において複数の指標が設置された場合、各指標に対して上記形態に応じて位置決め対象の当該指標を通過した時の位置・姿勢を更新することで、累積オフセットを低減させ、ＳＬＡＭシステムの閉鎖検出を実現することができる。
【０１４８】
また、一実施例において、本出願の実施例に係る方法は、前記位置決め対象の進行経路におけるドッキング装置において第３の指標を添加することと、前記位置決め対象が前記第３の指標を通過した場合、位置決め対象が前記第３の指標に基づいて前記ドッキング装置とのドッキング操作を完了することとを更に含む。例えば、位置決め対象が物品を携帯して搬送すると、位置決め対象が第３の指標を通過した場合、第３の指標に基づいて位置決め対象とドッキング装置との相対位置・姿勢を調整して正確なドッキング目的を達成することができる。
【０１４９】
本出願の実施例に係るＳＬＡＭナビゲーション方法において、コンベヤー又はアームなどの正確なドッキングに対する高精度の位置決めニーズを解決するために、ドッキング領域において１つ又は複数の指標を添加して位置決め対象の正確な位置決めを行う。具体的な実現形態は、以上のロボットに対する説明と同様であり、冗長を回避するためにこれ以上贅言はしない。
【０１５０】
また、位置決め対象、例えばロボットが位置決めのずれが大きすぎて、進行する時に指標を正確に通過できないという問題を解決するために、指標同士にカラーストライブを添加することができる。このように、ロボットがカラーストライブを通過した場合、ロボットのカラーストライブに対する角度ずれを補正し、ロボットをカラーストライブに沿って進行させるので、ロボットが指標に直面した時に正確な位置決めを行うことを促進する。
【０１５１】
一実施例において、前記第２の指標が複数の第２の指標を含む場合、前記位置決め対象の進行経路に第２の指標を添加することは、位置決め対象の進行経路に複数の第２の指標を添加することと、前記位置決め対象が前記第２の指標を通過した場合、前記第２の指標に基づいて前記位置決め対象の現在位置・姿勢を更新することとを含み、位置決め対象が前記複数の第２の指標を通過した場合、前記複数の第２の指標に基づいて位置決め対象の現在位置・姿勢を更新することを更に含む。例えば、複数の第２の指標は２種の指標であってもよい。
【０１５２】
図９Ａ、図９Ｂは、本出願の実施例に係る指標とカラーストライブとの間の連結形態の模式図である。図９Ａ、図９Ｂに示すように、２種の典型的な指標とカラーストライブとの連結形態が示されている（指標はＱＲコードを例とする）。図９Ａにおいて直線で連結する形態が示されており、即ち２つの指標がｘ又はｙ方向に一致する場合、直線のカラーストライブで２つの指標を直接連結する。また、図９Ｂにおいて曲線連結が示されており、即ち、２つの指標がｘ又はｙ方向において一致しない、或いは角度が一致しない場合、平滑な曲線のカラーストライブを用いて連結してもよい。もちろん、当業者であれば、カラーストライブの連結形態はこの２種の連結形態に限らず、カラーストライブの曲線が平滑で、ロボットがカラーストライブに沿って進行できればよいことを理解するべきである。
【０１５３】
ロボットがカラーストライブを通過した場合、カラーストライブ曲線を検出する。ロボットから最も近い点を曲線から探し出して、当該点でロボットとカラーストライブとの間の位置ずれΔｄと角度ずれΔθ（例えば、図１０を参照）を算出する。同時に、カラーストライブの曲率Ｃを検出する。ロボットがカラーストライブの真上に位置する場合、即ちΔｄ＝０、Δθ＝０、カラーストライブの曲率を追跡することによってカラーストライブに沿って進行する目的を達成することができる。２輪差動ロボットを例として、制御パラメータが速度ｖと角速度ｗであり、開ループ追跡方法が、ｗ＝ｖ*Ｃを満たすものである。実際に制御する時に、制御にずれが生成され、且つロボットの初期位置とカラーストライブとにも一定のずれもある。そのため、開ループ位置決めｗ＝ｖ・Ｃを基に、位置ずれΔｄと角度ずれΔθを制御量としてＰＩＤ制御を行う。１つの簡単な方法は、下記式（１１）で示される。
【０１５４】
【数１１】
2019537077.tif 000013
【０１５５】
式中において、λ１とλ２は、２つのパラメータであり、角度ずれと位置ずれによる制御重みを制御することを示す。
【０１５６】
当該方法により、ロボットをカラーストライブに沿って進行させ、カラーストライブの終点に進行した時に終点にある指標を検出可能であることを保証する。指標を通過した場合、上記で説明した形態に基づいてロボットの位置・姿勢を補正することができる。ここで、図１０は、本出願の実施例に係るロボットとカラーストライブとの間のずれを計算することを示す模式図である。そのため、上記指標を使用した同時位置決め地図作成ナビゲーション方法において、複数の第２の指標における２つの隣り合う第２の指標同士に当該複数の第２の指標を連結する補助位置決めストライブを含み、当該位置決め対象が当該補助位置決めストライブを通過した時に、位置決め対象の補助位置決めストライブに対する角度ずれを補正して当該位置決め対象を当該補助位置決めストライブに沿って進行させ、前記位置決め対象が複数の第２の指標を通過し識別することを確保する。
【０１５７】
他の実施例において、複数の第２の指標は、２種の指標を含んでもよいし、少なくとも２種の指標を含んでもよい。少なくとも２種の指標の設置位置は、行列、矩形などの異なる形状であってもよく、いずれかの２種の指標同士に補助位置決めストライブを設置してもよい。本出願の実施例に係る指標を使用したＳＬＡＭナビゲーション方法により、ＳＬＡＭナビゲーションシステムの位置決め精度とロバスト性を向上させ、正確な位置決めを必要とする産業環境に適応することができる。
【０１５８】
本出願の実施例に係る他の態様によれば、位置決め対象の初期化領域を設置するように設置される初期化領域設置手段と、当該位置決め対象の初期化領域において位置・姿勢情報又は指標情報を含む第１の指標を添加するように設置される第１の指標添加手段と、位置決め対象が前記位置決め対象の初期化領域からスタートし、当該第１の指標に基づいて位置決め対象の初期位置・姿勢を確定するように設置される位置決め対象スタート手段と、位置決め対象の進行経路において第２の指標を添加するように設置される第２の指標添加手段と、位置決め対象が第２の指標を通過した場合、当該第２の指標に基づいて位置決め対象の現在位置・姿勢を更新するように設置される位置・姿勢更新手段とを含む指標を使用した同時位置決め地図作成ナビゲーション装置を提供する。
【０１５９】
図１１は、本出願の実施例に係る指標を使用した同時位置決め地図作成ナビゲーション装置の模式的なブロック図である。図１１に示すように、本出願の実施例に係る指標を使用した同時位置決め地図作成ナビゲーション装置２００は、位置決め対象の初期化領域を設置するように設置される初期化領域設置手段２１０と、当該初期化領域設置手段２１０により設置した位置決め対象の初期化領域において位置・姿勢情報又は指標情報を含む第１の指標を添加するように設置される第１の指標添加手段２２０と、位置決め対象が当該初期化領域設置手段２１０により設置した位置決め対象の初期化領域からスタートし、当該第１の指標添加手段２２０により添加した第１の指標に基づいて位置決め対象の初期位置・姿勢を確定するように設置される位置決め対象スタート手段２３０と、位置決め対象の進行経路において第２の指標を添加するように設置される第２の指標添加手段２４０と、位置決め対象が第の指標添加手段２４０により添加した第２の指標を通過した場合、当該第２の指標に基づいて位置決め対象の現在位置・姿勢を更新するように設置される位置・姿勢更新手段２５０とを含む。
【０１６０】
上記指標を使用した同時位置決め地図作成ナビゲーション装置において、当該位置決め対象は、同時位置決め地図作成ナビゲーションにおいて進行しているロボット、及び携帯コンベヤー又はアームなどの移動装置である。
【０１６１】
上記指標を使用した同時位置決め地図作成ナビゲーション装置において、当該第１の指標は位置・姿勢情報を含み、且つ当該位置決め対象スタート手段は、当該第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して当該第１の指標の位置・姿勢情報から当該位置決め対象の初期位置・姿勢情報を直接抽出するように設置される。
【０１６２】
上記指標を使用した同時位置決め地図作成ナビゲーション装置において、当該第１の指標は指標情報を含み、且つ前記位置決め対象スタート手段は、当該第１の指標の指標情報を用いてマッチングを行い、位置決め対象の複数の位置・姿勢情報と誤差を記録して、第１の指標の複数の位置・姿勢情報と誤差に変換し、ガウスモデルにより当該第１の指標の複数の位置・姿勢情報を結合して当該第１の指標の最適位置・姿勢情報と誤差を推定し、当該第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して当該第１の指標の最適位置・姿勢情報から当該位置決め対象の初期位置・姿勢情報を直接抽出するように設置される。
【０１６３】
上記指標を使用した同時位置決め地図作成ナビゲーション装置において、当該第２の指標は位置・姿勢情報、指標情報、又は非指標類図形情報を含む。
【０１６４】
上記指標を使用した同時位置決め地図作成ナビゲーション装置において、当該第２の指標は位置・姿勢情報を含み、且つ当該位置・姿勢更新手段は、当該第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して当該第２の指標の位置・姿勢情報から当該位置決め対象の現在位置・姿勢情報を直接抽出するように設置される。
【０１６５】
上記指標を使用した同時位置決め地図作成ナビゲーション装置において、当該第２の指標は指標情報を含み、且つ当該位置・姿勢更新手段は、当該第２の指標の指標情報を用いてマッチングを行い、位置決め対象の複数の位置・姿勢情報と誤差を記録して、第２の指標の複数の位置・姿勢情報と誤差に変換し、ガウスモデルにより当該複数の位置・姿勢情報を結合して当該第２の指標の最適位置・姿勢情報と誤差を推定し、当該第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して当該第２の指標の最適位置・姿勢情報から当該位置決め対象の現在位置・姿勢情報を直接抽出するように設置される。
【０１６６】
上記指標を使用した同時位置決め地図作成ナビゲーション装置において、当該第２の指標は非指標類図形情報を含み、且つ当該位置・姿勢更新手段は、位置決め対象が同一の指標を通過した時の位置・姿勢の類似性を用いて、位置決め対象の通過した指標が第２の指標であるか否かを確定し、第２の指標を通過した位置決め対象の複数の位置・姿勢情報と誤差を記録して、第２の指標の複数の位置・姿勢情報と誤差に変換し、ガウスモデルにより第２の指標の複数の位置・姿勢情報を結合して当該第２の指標の最適位置・姿勢情報と誤差を推定し、当該第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して当該第２の指標の最適位置・姿勢情報から当該位置決め対象の現在位置・姿勢情報を直接抽出するように設置される。
【０１６７】
上記指標を使用した同時位置決め地図作成ナビゲーション装置において、前記第２の指標が複数の第２の指標を含む場合、前記第１の指標添加手段は、位置決め対象の進行経路において複数の第２の指標を添加するように設置され、且つ当該位置・姿勢更新手段は、更に、位置決め対象が当該複数の第２の指標を通過した場合、当該複数の第２の指標に基づいて位置決め対象の現在位置・姿勢を更新するように設置される。
【０１６８】
上記指標を使用した同時位置決め地図作成ナビゲーション装置において、当該複数の第２の指標における２つの隣り合う第２の指標を連結する補助位置決めストライブを添加し、当該位置決め対象が当該補助位置決めストライブを通過した時に、位置決め対象の補助位置決めストライブに対する角度ずれを補正して当該位置決め対象を当該補助位置決めストライブに沿って進行させ、前記位置決め対象が第２の指標を通過し識別することを確保するように設置される補助位置決め手段を更に含む。
【０１６９】
上記指標を使用した同時位置決め地図作成ナビゲーション装置において、前記位置決め対象の進行経路におけるドッキング装置において第３の指標を添加するように設置される第３の指標添加手段と、前記位置決め対象が前記第３の指標を通過した場合、前記第３の指標に基づいて前記ドッキング装置とのドッキング操作を完了するように設置されるドッキング手段とを更に含む。
【０１７０】
ここで、当業者であれば、本出願の実施例に係る指標を使用した同時位置決め地図作成ナビゲーション装置において、第１の指標添加手段と第２の指標添加手段は、指標を添加するための同一の指標添加手段として集積されてもよく、且つ位置決め対象スタート手段における一部の機能も指標に基づいて位置決め対象の位置情報を更新するために用いられるように位置・姿勢更新手段に含まれてもよいことを理解するべきである。
【０１７１】
また、当業者であれば、本出願の実施例に係る指標を使用した同時位置決め地図作成ナビゲーション装置における他の詳細は、本出願の実施例に係る指標を使用した同時位置決め地図作成ナビゲーション方法に関する説明における相応する詳細と同様であり、冗長を回避するために贅言しないことを理解するべきである。
【０１７２】
本出願における別の態様によれば、シーンでリアルタイム位置決めし地図を生成するように設置される位置決め対象と、位置・姿勢情報又は指標情報を含む第１の指標と、第２の指標と、同時位置決め地図作成装置であって、位置決め対象の初期化領域を設置するように設置される初期化領域設置手段、当該第１の指標を当該位置決め対象の初期化領域に添加するように設置される第１の指標添加手段、位置決め対象が当該位置決め対象の初期化領域からスタートし、当該第１の指標に基づいて位置決め対象の初期位置・姿勢を確定するように設置される位置決め対象スタート手段、第２の指標を当該位置決め対象の進行経路に添加するように設置される第２の指標添加手段、位置決め対象が第２の指標を通過した場合、当該第２の指標に基づいて位置決め対象の現在位置・姿勢を更新するように設置される位置・姿勢更新手段を含む同時位置決め地図作成装置とを含む、指標を使用した同時位置決め地図作成ナビゲーションシステムを提供する。
【０１７３】
図１２は、本出願の実施例に係る指標を使用した同時位置決め地図作成ナビゲーションシステムの模式的なブロック図である。図１２に示すように、本出願の実施例に係る指標を使用した同時位置決め地図作成ナビゲーションシステム３００は、シーンでリアルタイム位置決めし地図を生成するように設置される位置決め対象３０１と、位置・姿勢情報又は指標情報を含む第１の指標３０２と、第２の指標３０３と、同時位置決め地図作成装置３１０であって、位置決め対象の初期化領域を設置するように設置される初期化領域設置手段３１１、当該第１の指標３０２を当該初期化領域設置手段３１１により設置した位置決め対象の初期化領域に添加するように設置される第１の指標添加手段３１２、位置決め対象３０１が当該初期化領域設置手段３１１により設置した位置決め対象の初期化領域からスタートし、当該第１の指標添加手段３１２により添加した第１の指標３０２に基づいて位置決め対象３０１の初期位置・姿勢を確定するように設置される位置決め対象スタート手段３１３、第２の指標３０３を当該位置決め対象の進行経路に添加するように設置される第２の指標添加手段３１４、位置決め対象３０１が当該第２の指標添加手段３１４により添加した第２の指標３０３を通過した場合、当該第２の指標３０３に基づいて位置決め対象３０１の現在位置・姿勢を更新するように設置される位置・姿勢更新手段３１５を含む同時位置決め地図作成装置３１０とを含む。
【０１７４】
上記指標を使用した同時位置決め地図作成ナビゲーションシステムにおいて、当該位置決め対象は、同時位置決め地図作成ナビゲーションにおいて進行しているロボット、及び携帯コンベヤー又はアームなどの移動装置である。
【０１７５】
上記指標を使用した同時位置決め地図作成ナビゲーションシステムにおいて、当該第１の指標は位置・姿勢情報を含み、且つ当該位置決め対象スタート手段は、更に、当該第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して当該第１の指標の位置・姿勢情報から当該位置決め対象の初期位置・姿勢情報を直接抽出するように設置される。
【０１７６】
上記指標を使用した同時位置決め地図作成ナビゲーションシステムにおいて、当該第１の指標は指標情報を含み、且つ当該位置決め対象スタート手段は、更に、当該第１の指標の指標情報を用いてマッチングを行い、位置決め対象の複数の位置・姿勢情報と誤差を記録して、第１の指標の複数の位置・姿勢情報と誤差に変換し、ガウスモデルにより当該第１の指標の複数の位置・姿勢情報を結合して当該第１の指標の最適位置・姿勢情報と誤差を推定し、当該第１の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して当該第１の指標の最適位置・姿勢情報から当該位置決め対象の初期位置・姿勢情報を直接抽出するように設置される。
【０１７７】
上記指標を使用した同時位置決め地図作成ナビゲーションシステムにおいて、当該第２の指標は位置・姿勢情報、指標情報、又は非指標類図形情報を含む。
【０１７８】
上記指標を使用した同時位置決め地図作成ナビゲーションシステムにおいて、当該第２の指標は位置・姿勢情報を含み、且つ当該位置・姿勢更新手段は、更に、当該第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して当該第２の指標の位置・姿勢情報から当該位置決め対象の現在位置・姿勢情報を直接抽出するように設置される。
【０１７９】
上記指標を使用した同時位置決め地図作成ナビゲーションシステムにおいて、当該第２の指標は指標情報を含み、且つ当該位置・姿勢更新手段は、更に、当該第２の指標の指標情報を用いてマッチングを行い、位置決め対象の複数の位置・姿勢情報と誤差を記録して、第２の指標の複数の位置・姿勢情報と誤差に変換し、ガウスモデルにより当該複数の位置・姿勢情報を結合して当該第２の指標の最適位置・姿勢情報と誤差を推定し、当該第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して当該第２の指標の最適位置・姿勢情報から当該位置決め対象の現在位置・姿勢情報を直接抽出するように設置される。
【０１８０】
上記指標を使用した同時位置決め地図作成ナビゲーションシステムにおいて、当該第２の指標は非指標類図形情報を含み、且つ当該位置・姿勢更新手段は、更に、位置決め対象が同一の指標を通過した時の位置・姿勢の類似性を用いて、位置決め対象の通過した指標が第２の指標であるか否かを確定し、第２の指標を通過した位置決め対象の複数の位置・姿勢情報と誤差を記録して、第２の指標の複数の位置・姿勢情報と誤差に変換し、ガウスモデルにより第２の指標の複数の位置・姿勢情報を結合して当該第２の指標の最適位置・姿勢情報と誤差を推定し、当該第２の指標の位置決め対象に対する位置・姿勢に基づき、座標変換を介して当該第２の指標の最適位置・姿勢情報から当該位置決め対象の現在位置・姿勢情報を直接抽出するように設置される。
【０１８１】
上記指標を使用した同時位置決め地図作成ナビゲーションシステムにおいて、前記第２の指標が複数の第２の指標を含む場合、前記第１の指標添加手段は、複数の第２の指標を位置決め対象の進行経路に添加するように設置され、且つ当該位置・姿勢更新手段は、更に、位置決め対象が当該複数の第２の指標を通過した場合、当該複数の第２の指標に基づいて位置決め対象の現在位置・姿勢を更新するように設置される。
【０１８２】
上記指標を使用した同時位置決め地図作成ナビゲーションシステムにおいて、当該複数の第２の指標における２つの隣り合う第２の指標同士に補助位置決めストライブを含み、当該位置決め地図作成装置は、当該位置決め対象が前記補助位置決めストライブを通過した時に、位置決め対象の補助位置決めストライブに対する角度ずれを補正して当該位置決め対象を当該補助位置決めストライブに沿って進行させるように設置される補助位置決め手段を含む。
【０１８３】
上記指標を使用した同時位置決め地図作成ナビゲーションシステムにおいて、前記同時位置決め地図作成装置は、前記位置決め対象の進行経路におけるドッキング装置において第３の指標を添加するように設置される第３の指標添加手段と、前記位置決め対象が前記第３の指標を通過した場合、前記第３の指標に基づいて前記ドッキング装置とのドッキング操作を完了するように設置されるドッキング手段とを更に含む。
【０１８４】
また、当業者であれば、本出願の実施例に係る指標を使用した同時位置決め地図作成ナビゲーション装置における他の詳細は、本出願の実施例に係る指標を使用した同時位置決め地図作成ナビゲーション方法に関する説明における相応する詳細と同様であり、冗長を回避するために贅言するまでもないことを理解するべきである。
【０１８５】
本出願に係る指標を使用した同時位置決め地図作成ナビゲーション方法、装置とシステムは、同時位置決め地図作成ナビゲーションシステムの位置決め精度とロバスト性を向上させ、正確な位置決めを必要とする産業環境に適応することができる。
【０１８６】
当業者にとっては、上記説明及び図面に示された本出願の実施例は、例示的なものに過ぎず、本出願を限定するものではないことを理解すべきである。本出願の目的はすでに完全且つ効果的に実現されている。本出願における機能及び構造原理も実施例で説明したため、当該原理を逸脱しない限り、本出願における実施形態は、いずれも変更・修正することができる。
【図１】
2019537077.tif 000014
【図２】
2019537077.tif 000015
【図３】
2019537077.tif 000016
【図４】
2019537077.tif 000017
【図５】
2019537077.tif 000018
【図６Ａ】
2019537077.tif 000019
【図６Ｂ】
2019537077.tif 000020
【図７Ａ】
2019537077.tif 000021
【図７Ｂ】
2019537077.tif 000022
【図８】
2019537077.tif 000023
【図９Ａ】
2019537077.tif 000024
【図９Ｂ】
2019537077.tif 000025
【図１０】
2019537077.tif 000026
【図１１】
2019537077.tif 000027
【図１２】
2019537077.tif 000028
【国際調査報告】
2019537077.tif 000029
2019537077.tif 000030
2019537077.tif 000031
2019537077.tif 000032
2019537077.tif 000033
2019537077.tif 000034