特表 2022-539563 ジャイロスコープおよびオプティカルフローセンサスケールの較正

(19)【発行国】日本国特許庁(JP)

(12)【公報種別】公表特許公報(A)

(11)【公表番号】

(43)【公表日】2022-09-12

(54)【発明の名称】ジャイロスコープおよびオプティカルフローセンサスケールの較正

(51)【国際特許分類】

   G01C 21/28 20060101AFI20220905BHJP

   G01C 19/00 20130101ALI20220905BHJP

   B25J 19/02 20060101ALI20220905BHJP

【ＦＩ】

G01C21/28

G01C19/00 Z

B25J19/02

【審査請求】未請求

【予備審査請求】未請求

(21)【出願番号】P 2021577607

(86)(22)【出願日】2020-06-25

(85)【翻訳文提出日】2022-02-22

(86)【国際出願番号】 US2020039513

(87)【国際公開番号】W WO2020264089

(87)【国際公開日】2020-12-30

(31)【優先権主張番号】62/868,591

(32)【優先日】2019-06-28

(33)【優先権主張国・地域又は機関】US

(81)【指定国・地域】

(71)【出願人】

【識別番号】520330641

【氏名又は名称】シーバ・テクノロジーズ・インコーポレイテッド

(74)【代理人】

【識別番号】100108453

【弁理士】

【氏名又は名称】村山 靖彦

(74)【代理人】

【識別番号】100110364

【弁理士】

【氏名又は名称】実広 信哉

(74)【代理人】

【識別番号】100133400

【弁理士】

【氏名又は名称】阿部 達彦

(72)【発明者】

【氏名】ダグラス・チャールズ・カールソン

(72)【発明者】

【氏名】ブライアン・エー・クック

(72)【発明者】

【氏名】ジャンルエ・ジャオ

(72)【発明者】

【氏名】ユン・リ

【テーマコード（参考）】

2F105

2F129

3C707

【Ｆターム（参考）】

2F105AA02

2F105AA06

2F105AA08

2F105BB07

2F105BB17

2F129AA03

2F129BB22

2F129BB38

2F129GG17

3C707KS24

(57)【要約】

ジャイロスコープに関するスケール係数を計算する方法は、ジャイロスコープによってロボットの物理運動を検知するステップと、オプティカルフロー（ＯＦ）センサ（および／またはカメラ）よって、情報を含む１つまたは複数の画像信号を検知するステップと、検知された物理運動および情報に基づいて、センサ較正パラメータの予測を導出するステップとを含むことができる。

【特許請求の範囲】

【請求項1】

ジャイロスコープによってロボットの物理運動を検知するステップと、
オプティカルフロー（ＯＦ）センサ（および／またはカメラ）によって、情報を含む１つまたは複数の画像信号を検知するステップと、
前記検知された物理運動および前記情報に基づいて、センサ較正パラメータの推定を導出するステップと
を含む方法。

【請求項2】

前記情報が、前記１つまたは複数の画像信号の各フレームにおいてそれぞれの画像の関数を含む、請求項１に記載の方法。

【請求項3】

前記関数が画質および／または画像輝度に関連するものである、請求項２に記載の方法。

【請求項4】

前記情報および／またはセンサ較正パラメータの前記推定に基づいて前記ジャイロスコープを較正するステップをさらに含む、請求項１に記載の方法。

【請求項5】

前記ジャイロスコープを較正するステップが、
前記情報と前記検知された物理運動との間の関係を識別するステップと、
前記識別された関係に基づいて、前記ジャイロスコープのスケールパラメータを較正するステップと
を含む、請求項４に記載の方法。

【請求項6】

前記ロボットの前記物理運動が、定位置回転および／または３６０度を超える回転である、請求項１に記載の方法。

【請求項7】

前記ロボットの前記物理運動が、任意の表面、または未知の表面パターンを有する表面において検知される、請求項１に記載の方法。

【請求項8】

前記１つまたは複数の画質信号が周期信号である、請求項１に記載の方法。

【請求項9】

前記情報に基づいて、表面に対する前記ロボットの角運動を推定するステップと、
前記推定された角運動に基づいて前記ジャイロスコープのスケールを較正するステップと
をさらに含む、請求項１に記載の方法。

【請求項10】

前記ＯＦセンサおよび／またはカメラにおいて、既知のロボットジオメトリに基づいて角速度を直線速度に関連付けるステップと、
前記ＯＦセンサおよび／またはカメラの変位スケールを計算するステップと
をさらに含む、請求項１に記載の方法。

【請求項11】

前記情報に基づいて、センサ較正用の既知の表面上の可視パターンの空間周波数を判定するステップをさらに含む、請求項１に記載の方法。

【請求項12】

前記検知された空間周波数に基づいて角運動を推定するステップと、
前記推定された角運動に基づいて前記ジャイロスコープのスケールを較正するステップと
をさらに含む、請求項１１に記載の方法。

【請求項13】

前記１つまたは複数の画像信号を検知するステップが、１つまたは複数の反射性基準マークを検知するステップを含む、請求項１に記載の方法。

【請求項14】

前記検知された１つまたは複数の反射性基準マークに基づいて角運動を推定するステップと、
前記推定された角運動に基づいて前記ジャイロスコープのスケールを較正するステップと
をさらに含む、請求項１３に記載の方法。

【請求項15】

ロボットの物理運動を検知するように構成されたジャイロスコープと、
情報を含む１つまたは複数の画像信号を生成するように構成されたオプティカルフロー（ＯＦ）センサおよび／またはカメラと、
前記検知された物理運動および前記情報に基づいて、センサ較正パラメータの推定を導出するように構成されたプロセッサと
を備えるシステム。

【請求項16】

前記情報が、前記１つまたは複数の画像信号の各フレームにおいてそれぞれの画像の関数を含む、請求項１５に記載のシステム。

【請求項17】

前記関数が画質および／または画像輝度に関連するものである、請求項１６に記載のシステム。

【請求項18】

前記プロセッサが、前記情報および／またはセンサ較正パラメータの前記推定に基づいて前記ジャイロスコープを較正するようにさらに構成されている、請求項１５に記載のシステム。

【請求項19】

前記プロセッサが、
前記情報と前記検知された物理運動との間の関係を識別するステップと、
前記識別された関係に基づいて、前記ジャイロスコープのスケールパラメータを較正するステップと
によって前記ジャイロスコープを較正するようにさらに構成されている、請求項１８に記載のシステム。

【請求項20】

前記ロボットの前記物理運動が、定位置回転および／または３６０度を超える回転である、請求項１５に記載のシステム。

【請求項21】

前記ロボットの前記物理運動が、任意の表面、または未知の表面パターンを有する表面において検知される、請求項１５に記載のシステム。

【請求項22】

前記１つまたは複数の画質信号が周期信号である、請求項１５に記載のシステム。

【請求項23】

前記プロセッサが、
前記情報に基づいて、表面に対する前記ロボットの角運動を推定して、
前記推定された角運動に基づいて前記ジャイロスコープのスケールを較正する
ようにさらに構成されている、請求項１５に記載のシステム。

【請求項24】

前記プロセッサが、
前記ＯＦセンサおよび／またはカメラにおいて、既知のロボットジオメトリに基づいて角速度を直線速度に関連付けて、
前記ＯＦセンサおよび／またはカメラの変位スケールを計算する
ようにさらに構成されている、請求項１５に記載のシステム。

【請求項25】

前記プロセッサが、前記情報に基づいて、センサ較正用の既知の表面上の可視パターンの空間周波数を判定するようにさらに構成されている、請求項１５に記載のシステム。

【請求項26】

前記プロセッサが、
前記検知された空間周波数に基づいて角運動を推定して、
前記推定された角運動に基づいて前記ジャイロスコープのスケールを較正する
ようにさらに構成されている、請求項２５に記載のシステム。

【請求項27】

前記ＯＦセンサおよび／またはカメラが、１つまたは複数の反射性基準マークを検知することによって前記１つまたは複数の画像信号を検知するように構成されている、請求項１５に記載のシステム。

【請求項28】

前記プロセッサが、
前記検知された１つまたは複数の反射性基準マークに基づいて角運動を推定して、
前記推定された角運動に基づいて前記ジャイロスコープのスケールを較正する
ようにさらに構成されている、請求項２７に記載のシステム。

【請求項29】

ロボット上に配設されたジャイロスコープを較正するための方法であって、
較正表面上に前記ロボットを配置するステップと、
前記較正表面上で前記ロボットを回転させるステップと、
ジャイロスコープを使用して前記ロボットの第１の方向を判定するステップと、
画像センサを使用して前記ロボットの第２の方向を判定するステップと、
前記第１の方向および前記第２の方向に基づいて前記ジャイロスコープを較正するステップと
を含む方法。

【請求項30】

前記ロボットを配置する前記ステップが、
前記較正表面上で前記ロボットを中心合わせするステップ
をさらに含む、請求項２９に記載の方法。

【請求項31】

前記較正面が、光学的に認識し得るマーキングをもたらすように設計された表面である、請求項２９に記載の方法。

【請求項32】

前記較正面が、前記ロボットによって、前記ロボットの回転にわたって所定レベルの光学的変動を有するものと識別される表面である、請求項２９に記載の方法。

【請求項33】

前記画像センサが、オプティカルフローセンサおよびカメラのうちの１つである、請求項２９に記載の方法。

【請求項34】

画像センサを使用して前記ロボットの第２の方向を判定する前記ステップが、
前記ロボットの前記第２の方向を複数のオーバラップする窓へと分割するステップと、
前記複数の窓の各々に対して自己相関関数を実行するステップと
をさらに含む、請求項２９に記載の方法。

【請求項35】

ロボット上に配設されたジャイロスコープを較正するためのシステムであって、
較正面と、
前記較正面上に配設されたロボットと、
前記ロボット上に配設されたジャイロスコープと、
前記ロボット上に配設された画像センサと、
前記ジャイロスコープよって生成されたデータを使用して前記ロボットの第１の方向を生成し、前記画像センサによって生成されたデータを使用して前記ロボットの第２の方向を生成するためのプロセッサであって、前記第１の方向および前記第２の方向を使用して前記ジャイロスコープ用の較正パラメータを生成するようにさらに構成されているプロセッサと
を備えるシステム。

【請求項36】

前記ロボットが前記較正面上に中心を置く、請求項３５に記載のシステム。

【請求項37】

前記較正面が、光学的に認識し得るマーキングをもたらすように設計された表面である、請求項３５に記載のシステム。

【請求項38】

前記較正面が、前記ロボットによって、前記ロボットの回転にわたって所定レベルの光学的変動を有するものと識別される表面である、請求項３５に記載のシステム。

【請求項39】

前記画像センサが、オプティカルフローセンサおよびカメラのうちの１つである、請求項３５に記載のシステム。

【請求項40】

前記プロセッサが、
前記ロボットの前記第２の方向を複数のオーバラップする窓へと分割するステップと、
前記複数の窓の各々に対して自己相関関数を実行するステップと
によって前記ロボットの前記第２の方向を判定する、請求項３５に記載のシステム。

【請求項41】

ロボット上に配設されたジャイロスコープを較正するための方法であって、
ドッキングステーションに前記ロボットをドッキングさせるステップであって、前記ロボットが、前記ジャイロスコープからの情報に基づいて第１の方向を有している、ステップと、
前記ロボットを、前記ドッキングステーションから離れさせるステップと、
前記ロボットを回転させるステップと、
前記ドッキングステーションに前記ロボットを再度ドッキングさせるステップであって、前記ロボットが、前記ジャイロスコープからの情報に基づいて第２の方向を有している、ステップと、
前記第１の方向と前記第２の方向との間の差に基づいて前記ジャイロスコープを較正するステップと
を含む方法。

【請求項42】

前記ドッキングさせるステップ、前記離れさせるステップ、前記回転させてドッキングさせるステップが、複数回繰り返されて複数の方向を生成し、前記較正するステップが前記複数の方向を使用して実行される、請求項４１に記載の方法。

【発明の詳細な説明】

【技術分野】

【0001】

関連出願
本出願は、２０１９年６月２８日出願の「Methods and Apparatus for Mutual Gyroscope Scale and Optical Flow Sensor Scale Calibration Through Optical Flow Image Quality Metadata」という名称の米国特許仮出願第６２／８６８，５９１号に関し、その優先権を主張するものであり、その開示は参照によってここで組み込まれる。

【背景技術】

【0002】

特に携帯電話、モバイルデバイス、デジタルカメラ、全地球測位システム（ＧＰＳ）ユニット、ラップトップコンピュータおよびパームトップコンピュータ、自動車、ロボット掃除機などの電子デバイスについては、機能を強化するために、センサ（たとえば運動センサ）を含むことがますます普及し、広範囲にわたっている。たとえば、センサは、角速度を測定するジャイロスコープ、直線加速度を測定する加速度計、および／または画像特徴の経時的変位を測定するオプティカルフロー（ＯＦ）センサを含み得る。

【0003】

表面ロボティクスにおける多くの用途では、高品質のオドメトリ測定をうまくやりこなす必要がある。いくつかの例では、一般的なロボットプラットホームは、１）慣性測定（たとえば角速度を測定するためのジャイロスコープ、および／または直線加速度を測定するための加速度計）、２）グラウンドに対する直線運動予測（たとえば、ホイール回転を直線距離に変換するホイールエンコーダ、および／またはグラウンド表面における可視ポイントの相対運動を報告するオプティカルフロー（ＯＦ）センサ）、３）環境における障害物に対する距離予測（たとえば光検知測距（ＬＩＤＡＲ）、赤外線近接、超音波）、ならびに／あるいは４）環境における障害物に対する接触検知（たとえばバンパスイッチ）といった、感知品質の１つもしくは複数、または任意の組合せを含み得る。

【0004】

消費者ロボット（たとえば平面ロボット、ロボット掃除機すなわちＲＶＣ）などのロボットシステムは、ナビゲーションおよび同時の位置確認とマッピング（ＳＬＡＭ）のために１つまたは複数の慣性測定ユニット（ＩＭＵ）（またはＩＭＵセンサ）および１つまたは複数のＯＦセンサを含み得る。１つまたは複数の加速度計およびジャイロスコープ（たとえばＭＥＭＳジャイロスコープ）を含有し得るＩＭＵがもたらす直線加速度および角速度の測定結果は、何かの初期配向に対する配向（方向）を取得するために使用され得る。ＯＦセンサは、グラウンド表面に対するセンサの直線速度の測定結果をもたらす。いくつかの例では、ＯＦセンサは、画像特徴の経時的変位を測定し得る。たとえば、ＯＦセンサは、サンプリングされる都度、連続したサンプル画像の間で移動した特徴画素の平均数を表す２次元（２Ｄ）変位ベクトルを報告し得る。場合によっては、ＯＦセンサは、ｘ軸およびｙ軸において、２つのサンプリングポイント間の変位を測定してよい。

【0005】

消費者ロボットは、スケーリングされたジャイロスコープの測定結果を積分することによって方向予測を取得し得る。ジャイロスコープスケールは、たとえば老化の影響によって部品の寿命が変化する可能性がある。ＯＦセンサは、画質データ（ならびに表面に対する直線運動）をもたらし得る。

【0006】

ロボットシステムについては、ロボットシステムの高精度動作を達成するには正確な較正が重要であるため、センサ較正パラメータを取得してセンサを較正することが必須である。

【先行技術文献】

【特許文献】

【0007】

【特許文献1】米国特許第８，０７３，５６４号

【発明の概要】

【課題を解決するための手段】

【0008】

一実施形態によれば、スケール較正のための方法は、ジャイロスコープによってロボットの物理運動を検知するステップと、オプティカルフロー（ＯＦ）センサ（および／またはカメラ）によって、情報を含む１つまたは複数の画像信号を検知し、検知された物理運動および情報に基づいて、センサ較正パラメータの予測を導出するステップとを含む。

【0009】

別の実施形態によれば、スケール較正用のシステムは、ロボットの物理運動を検知するように構成されたジャイロスコープと、情報を含む１つまたは複数の画像信号を生成するように構成されたオプティカルフロー（ＯＦ）センサおよび／またはカメラと、検知された物理運動および情報に基づいて、センサ較正パラメータの予測を導出するように構成されたプロセッサとを含む。

【0010】

一実施形態によれば、ロボット上に配設されたジャイロスコープを較正するための方法は、較正表面上にロボットを配置するステップと、較正表面上でロボットを回転させるステップと、ジャイロスコープを使用してロボットの第１の方向を判定するステップと、画像センサを使用してロボットの第２の方向を判定するステップと、第１の方向および第２の方向に基づいてジャイロスコープを較正するステップとを含む。

【0011】

一実施形態によれば、ロボット上に配設されたジャイロスコープを較正するためのシステムは、較正面と、較正面上に配設されたロボットと、ロボット上に配設されたジャイロスコープと、ロボット上に配設された画像センサと、ジャイロスコープよって生成されたデータを使用してロボットの第１の方向を生成し、画像センサによって生成されたデータを使用してロボット第２の方向を生成するためのプロセッサであって、第１の方向および第２の方向を使用してジャイロスコープ用の較正パラメータを生成するようにさらに構成されているプロセッサとを含む。

【0012】

一実施形態によれば、ロボット上に配設されたジャイロスコープを較正するための方法は、ドッキングステーションにロボットをドッキングさせるステップであって、ロボットが、ジャイロスコープからの情報に基づいて第１の方向を得る、ステップと、ロボットを回転させてドッキングステーションから離れさせるステップと、ドッキングステーションにロボットを再度ドッキングさせるステップであって、ロボットが、ジャイロスコープからの情報に基づいて第２の方向を得る、ステップと、第１の方向と第２の方向との間の差に基づいてジャイロスコープを較正するステップとを含む。

【0013】

添付図面に関連して例として与えられる以下の詳細な説明から、より詳細な理解が得られるであろう。説明における図は例である。そのため、図および詳細な説明は、限定するものと見なされるべきではなく、他の同様に有効な例が可能であり、有望である。さらに、図における類似の参照数字は類似の要素を指示する。

【図面の簡単な説明】

【0014】

【図1】１つまたは複数の実施形態による、記号参照を有する例示的ロボットシステムにおけるセンサの物理的配置の図である。

【図2】１つまたは複数の実施形態による、オプティカルフロースケール感度の一例を示す図表である。

【図3A】１つまたは複数の実施形態による、柔らかい表面上で動作するオプティカルフローセンサの一例を示す図表である。

【図3B】１つまたは複数の実施形態による、硬い表面上で動作するオプティカルフローセンサの一例を示す図表である。

【図4】１つまたは複数の実施形態による、表面周期較正パターンの一例を示す図表である。

【図5】１つまたは複数の実施形態による、中央画素における、一般的な視野にわたる運動に関する異なる輝度の一例を示すグラフである。

【図6】１つまたは複数の実施形態による、視野平均にわたって保存されたピーク信号周波数の一例を示すグラフを含む図である。

【図7】１つまたは複数の実施形態による、測定された信号およびピーク周波数におけるジャイロスコープスケール誤差の影響の一例を示すグラフを含む図である。

【図8】１つまたは複数の実施形態による、周波数検知アルゴリズムによるジャイロスケール較正の一例のブロック図である。

【図9A】自然木の木目を有する例示的表面の図である。

【図9B】１つまたは複数の実施形態による、（たとえば図９Ａの）自然木の木目を有する表面において動作するオプティカルフローセンサの角度／方向の位置の関数として検知された平均強度の一例を示すグラフである。

【図10】１つまたは複数の実施形態による、（たとえばスケール誤差のない）木材表面上の円運動に関する全体的な自己相関結果の一例を示すグラフである。

【図11A】１つまたは複数の実施形態による、周期検知手法用の工学的パターンの一例を示す図表である。

【図11B】１つまたは複数の実施形態による、（たとえば図１１Ａの）工学的パターンを有する表面において動作するオプティカルフローセンサの角度／方向の位置の関数として検知された平均強度の一例を示すグラフである。

【図12】１つまたは複数の実施形態による、グローバルアライメントバーによってピーク周波数が損なわれることのない、工学的表面上の運動の自己相関およびＤＦＴの一例を示すグラフを含む図である。

【図13】１つまたは複数の実施形態による、運動によって誘起された変化が、基礎をなす信号に蓄積しないときの自己相関の状況を含む、非円形性によって導入された誤差のＣＤＦの一例を示すグラフである。

【図14】１つまたは複数の実施形態による、画質の自己相関を使用する、ジャイロスコープスケールの較正アルゴリズムの一例のブロック図である。

【図15】１つまたは複数の実施形態による、基準マークベースの角距離検知のための例示の物理的配置を示すブロック図である。

【図16A】１つまたは複数の実施形態による、例示的マーク検知メカニズムを示すブロック図である。

【図16B】１つまたは複数の実施形態による、例示的マーク検知メカニズムを示すブロック図である。

【図17】１つまたは複数の実施形態による、基準マークの配向とセンサの配向との間の関係の一例を示す図表である。

【図18】１つまたは複数の実施形態による、回転の中心がロボットの中心にはない円運動の一例を示す図表である。

【図19】説明された実施形態に関連して使用され得るロボットのブロック図表現である。

【発明を実施するための形態】

【0015】

本発明の以下の詳細な説明は添付図面を参照する。別々の図面における同一の参照番号は、同一の要素または類似の要素を識別する。また、以下の詳細な説明は本発明を限定するものではない。その代わりに、本発明の範囲は添付の特許請求の範囲によって定義される。

【0016】

前述のように、ロボット電気掃除機などのロボットシステムは、１つまたは複数の加速度計を含むＩＭＵおよび／またはジャイロスコープを有し得て、ロボットの制御に用いる方向情報をもたらす。ロボットは、画像特徴の変位を経時的に測定するＯＦセンサなどの他のセンサを含むかまたは内蔵し得る。平面ロボットシステムは、すべてのセンサからのデータにアクセスできるプロセッサなどのコントローラをも有し得、したがって、ロボットの運動ならびに位置状態および／または配向状態を計算することができる。たとえば、ホイールエンコーダとカメラとの両方が動きを示さず、すべてのモータがアイドル状態であれば、コントローラは、ロボットが静止していると合理的に想定し得る。

【0017】

加えて、ロボットは、任意の軸のまわりの回転および／または任意の方向の並進、ならびに／あるいはロボットの他の部品（たとえばロボットの本体に対して移動するメカニカルアーム）に対するロボットの部品の回転および並進を含む任意数のやり方でロボットを移動させるためのモータを含み得る。コントローラは、モータを制御することによってロボットの運動を指導するようにも適合され得る。

【0018】

様々な実施形態において、ＯＦセンサおよびＩＭＵは同一のロボット上にあってよく、したがって、両者の角速度は全体的に同一であるはずであり、それらの運動パラメータは、他方を使用して一方を較正することができ得るように関連付けられ得る。たとえば、ＯＦセンサおよびＩＭＵは、同一の剛体（たとえば平面ロボットシステム）上にあり得、ＯＦセンサの運動量とＩＭＵの運動量（たとえば両者の速度）は、剛体の式によって関連付けられ得る。一例では、ロボットのコントローラ（または他の処理デバイス）は、ＯＦセンサの較正を改善するために、ＩＭＵまたはＩＭＵのセンサならびに／あるいは他のセンサおよび構成要素（たとえばカメラ、ホイールエンコーダ）からのデータを使用し得る。別の例では、コントローラ（または他の処理デバイス）は、ロボットシステムのＩＭＵ（たとえばＩＭＵのジャイロスケール）を較正するためにＯＦセンサからのデータを使用し得る。たとえば、ＯＦセンサ精度が十分に優れていれば、ロボットシステムのジャイロスコープスケールを較正するためにＯＦセンサが使用されてよい。

【0019】

センサシステムの説明
図１は、ロボットシステムにおけるセンサの物理的配置に関する例示の図である。図１の図は、様々な量と参照フレームとを互いに関連付けるために使用される表記法を要約するものである。

【0020】

表記法

【0021】

【数1】

【0022】

は、ポイントＡにおける参照Ｂのフレームにおいて測定されたベクトル

【0023】

【数2】

【0024】

を指定するものである。ロボットフレームはＲで指定されている。ＲからＩＭＵ（Ｉ）へのベクトルの回転およびオプティカルフロー（Ｏ）フレームは、方向余弦マトリクスＲ_Ｒ→ＩおよびＲ_Ｒ→Ｏによって、たとえば次式のようにそれぞれ表される。

【0025】

【数3】

【0026】

ロボットのＺ軸は、ロボットが運転するグラウンド表面に対して垂直であると定義する。場合によっては、正確なセンサ動作のために、オプティカルフローセンサのＺ軸もグラウンドに対して垂直でなければならない。ロボット中心に対するＩＭＵの変位およびオプティカルフローのセンサの変位は、それぞれ

【0027】

【数4】

【0028】

、

【0029】

【数5】

【0030】

によって表される。

【0031】

剛体想定の下では、全体的なフレームにおける角速度はすべてのポイントで同一である。運動がＸ－Ｙ面に拘束される共通ケースについては、角速度

【0032】

【数6】

【0033】

のｘ成分および／またはｙ成分は無視され得、すなわち

【0034】

【数7】

【0035】

であり、また

【0036】

【数8】

【0037】

という特性は、これらのフレームのＺ軸が（たとえば地表フレームのＺ軸に）すべて整列する場合には、参照フレームに無関係であり得ることが留意される。簡単さのために、ωは、角速度ベクトル

【0038】

【数9】

【0039】

または角速度ωの両方を表し、どちらを表しているかは状況から推測され得る。いくつかの例では、量は、絶対的な地表フレーム項で表され得る。いくつかの例では、（たとえば測定に関する）量は、グローバル座標フレームにおける線形位置または初期配向の影響を受けない。

【0040】

ジャイロスコープの誤差原因
様々な実施形態において、平面運動の場合には、真の角速度ωは次式の関係によってジャイロスコープ測定値ｘに関連付けられ得、

【0041】

【数10】

【0042】

ω_ｚｒｏ（ｋ）は温度ｋにおけるゼロ速度オフセット（ＺＲＯ）であり、デバイスの静止状態で感知されて報告された角速度である。より具体的には、静止したジャイロスコープ（たとえばＭＥＭＳジャイロスコープ）は、一般的には非ゼロの角速度（ＺＲＯ、これは誤差である）を報告し、ＺＲＯは一般的にはセンサ温度の関数として変化する。

【0043】

一般に、３軸ジャイロスコープ測定は、センサ出力を物理運動に対して正確に関連付けるために、スケール、直交軸スキュー、および回転パラメータの較正が必要である。平面運動を想定すると、意味のあるデータを有するのは１つの軸（Ｚ）のみであり、これらの較正項は単一のスケール値αに吸収され得る。実際には、多くの消費者表面ロボットが、コスト低減または精度改善の理由から１軸ジャイロスコープを使用する。

【0044】

様々な実施形態において、ω_ｚｒｏ（ｋ）が測定され、特徴付けられ、かつ／または補正され得るが、考慮に入れるべき誤差原因は他にもいくつかある。たとえば、誤差原因の１つにはセンサの老化の影響がある。より詳細には、ジャイロスコープスケールは、冷熱サイクルによる機械的ストレスの累積によって経時変化する可能性がある。場合によっては、現在の商業用等級のＭＥＭＳジャイロスコープには、およそ１％の一般的な老化の影響がある。

【0045】

センサの非線形性誤差は、ジャイロスコープの測定が角速度に対して直線的に関連付けられるという想定が成り立たないとき導入され得る別の誤差原因である。一般に、現在の商用ＭＥＭＳジャイロスコープについては、非線形性の影響は小さいので、実用のためには簡単な線形スケールで十分であり得る。

【0046】

ＭＥＭＳジャイロスコープに関する別の全般的な懸念に、直線加速度に対する感度がある（たとえば、直線加速度は、角速度出力のバイアスにおける変化の原因となる）。しかしながら、平面運動の場合には、直線加速度に対する実際の寄与が最大なのは重力であり、大抵の平面運動のシナリオにおいて、通常の環境下では重力に対する配向は変化せず、また現在の商用ＭＥＭＳジャイロスコープでは直線加速度の影響は比較的小さい。それゆえに、直線加速度に対する感度が、ジャイロスコープの読取り値における著しい誤差を引き起こす可能性は低い。

【0047】

このような理由で、本明細書で論じられる様々な実施形態は、現場に配置したロボットにおいて、（誤差の他の原因とは対照的に）老化によって誘起されるスケール変化の抑制に的を絞ることにする。場合によっては、簡単さのために、上記の式は、ＺＲＯが測定されてジャイロスコープの測定値から除去されており、しかも公称スケールのいくつかの範囲は既知であると想定する（たとえば、各部品のスケール値の平均、最大および／または最小を製造業者が提供する）。

【0048】

オプティカルフローのスケール感度
オプティカルフローセンサは、画像検知器に投影された表面フィーチャの相対運動を検知することによって動作する。画像検知器またはセンサチップは、たとえば画像センサチップを取り付けたロボットの検知された視覚動作に関連した測定結果を出力するためのオプティカルフローアルゴリズムを実行するプロセッサに接続され得る。図２は、焦点距離が一定のセンサに関して、画像センサ（上部）と感知表面（下部）との間の距離が、単一の追跡ポイントの観測された運動に影響を及ぼす様子を図解で示すものである。

【0049】

オプティカルフローセンサは、一般的には（たとえば追跡する表面を固定レンズの焦点に保つように）いくらかの公称高さに設置されているが、硬い表面と柔らかい表面との間を移動するとき、または（たとえば積荷の重さが変化することによって）ロボットのサスペンションが変化するとき、異なる有効表面高さが出現する可能性がある。図３Ａおよび図３Ｂを参照して、灰色の矩形はロボットのホイールの真横向きの表示を表し、三角形はオプティカルフローセンサの公称の視野範囲を示す。図３Ａおよび図３Ｂは、それぞれ、柔らかい表面（たとえばカーペット）と硬い表面（たとえばタイル）との間でＯＦセンサの視野範囲が変化し得る様子を示すものである。

【0050】

関連する手法
位置測定またはセンサ較正を実行するために、空間的に変化する信号が使用され得る。ロボットシステムは、ＯＦ画質データを使用してＩＭＵを較正し得る。以前に測定されたＲＦまたは磁気「指紋」との相関によるデバイスの局所化は、数十年にわたる文献において周知である。新規の、または改善された手法は、以前に観測された信号に類似の信号特性を識別することによってセンサの局所化を試行するのではなく、信号の既知の空間的特徴を利用することに的を絞るものである。いくつかの例では、信号を特別の軌跡に関連付ける拘束運動（たとえば平面上の回転）の利点があるが、空間における自由運動の場合には実用的ではないであろう。

【0051】

いくつかの現在の実装形態では、磁力計測定によるジャイロスコープスケールの較正が使用される。この手法における基本的仮説は、デバイスが（たとえば３６０°回転されて）同一の方向を複数回向くとき、較正されていない地磁界の水平成分に再現性があるということである。この方法を実行するために使用される基礎的な磁界は、実際には、表面結合のロボット動作に対して優れた性能を与えるほど十分には安定していない可能性がある。構成材料（たとえば配線、金属製補強材）およびロボット自体（たとえば回転しているモータ）の影響によって、経時変化する磁場環境またはこの手法の効果を制限するのに十分な変位が生成される可能性がある。

【0052】

表面画質測定によるジャイロスコープのスケール推定
いくつかの例では、標準的なオプティカルフローセンサは、経時的な位置変化ばかりでなく、種々の画質メトリクスをも出力し得る。これらは、一般的には、照明源を調整するため、または位置出力はどれだけ信頼することができるか大まかに測定するために使用される。報告される値には、最低の画素輝度、最高の画素輝度、平均の画素輝度、「表面品質」（一般的には視野内の追跡可能なポイントの数の代用）、および／または画像センサ利得のうちの１つまたは複数が含まれ得る。

【0053】

これらの画質信号は、オプティカルフローセンサが表面上を移動するので変化する。位置と画質との間の関係が既知であれば、これは、接続されたジャイロスコープの運動を推定するために利用され得る。ジャイロスコープの真の運動が予測されれば、ジャイロスコープを較正することが可能になる。円運動の場合には、ロボットシステムは、空間領域において繰り返すパターンの周波数、デバイスのすべての回転について１回繰り返すパターンの周期、または離散基準マークの位置のいずれかを検知することによってジャイロスコープスケールを推定してよい。ジャイロスコープスケールの推定は、以下でより詳細に説明する。

【0054】

上記で開示された手法の例示的実施形態は、車輪付きロボットを適所で回転させながらＯＦセンサの画質出力およびジャイロスコープの角速度出力を取り込み、次いで、このデータを組み合わせて／比較して、ジャイロスコープの挙動を特徴付けるものである。

【0055】

工学的表面上のパターンの周波数検知
一実施形態では、ロボットシステムのデバイスが、（たとえばＯＦセンサによって検知可能な基準マーカを伴う）工学的較正面の上部において回転され得る（またはそのように構成されている）場合には、ロボットシステムは、ジャイロスコープで導出された方向（積分されたジャイロスコープ出力）と、較正面に関連して予期された信号特性との間の観測された対応を、較正のために使用し得る。図４はそのような工学的較正面の１つを示し、オプティカルフローセンサから見えるポイントの輝度が、そのポイントの検知された輝度に対応する。たとえば、図４では中央から５３本の帯が放射状に広がっている。ＯＦセンサが、このパターン上で中心合わせされる円を通って移動するとき、ＯＦセンサの中心画素の輝度は、パターンに対するその角度位置によって規定される。回転の中心（ＣｏＲ）をパターンの中心において回転するロボットについては、ＯＦセンサの任意の非ゼロ半径において観測された輝度は、３６０°当たり５３サイクルの周波数を伴う空間領域において三角パターンを示すことになる。輝度が、中心から外に向かって放射状に広がる各ラインに沿って一定であるため、このことが成立する。ＯＦセンサの視野にわたる平均の輝度は、これを平滑化したバージョンであり得る。図５には、このパターンに関する理想的な輝度対位置の関数、ならびに例示的ＯＦセンサによって報告されたいくつかの一般的な画質メトリック（たとえば最低の画素輝度、最高の画素輝度、その視野にわたる平均の画素輝度）が示されている。

【0056】

様々な実施形態において、感知表面の平均輝度を使用すると、様々なピッチ検知アルゴリズムに適する信号が生成される。本明細書で説明された手法は、特定の画質メトリックまたはピッチ検知方法に限定されない。いくつかの例では、同一または類似の結果を達成するために、「視野にわたる平均輝度」および／または離散フーリエ変換（ＤＦＴ）技法を使用する代わりに、別のピッチ検知技術または画質メトリックが使用され得る。

【0057】

一例では、図６は、単一画素における元の信号と、空間領域において、１０ｃｍの半径で表面上を移動する１ｃｍの方形窓における平均画素値（上部）と、同一の信号のＤＦＴ出力のサブセットであって、周波数領域においてピーク周波数が指示されたもの（下部）との間の関係を明示するものである。ジャイロスコープとＯＦセンサとが剛体に取り付けられて、剛体がパターン中心のまわりの円において移動していれば、ジャイロスコープの出力信号を積分すると、一定の角度オフセットを法とするパターンに対するＯＦセンサの方向（たとえばジャイロスコープとＯＦセンサとの間の方向）および未知の初期の方向をもたらすはずある。この解析には、包含されているセンサ間の、またはセンサと回転の中心との間の、初期配向または真の変位が既知である必要はない。一実施形態では、ロボットシステムは、画質信号にＤＦＴを実行して、ジャイロスコープで導出された方向の領域において、ジャイロスコープ角度位置に対する画質信号の優位周波数を取得する。この計算は、初期の方向の影響を受けないことに留意されたい。次いで、ロボットシステムは、そこから、ＯＦセンサから取得された（たとえば既知の）真のパターン周波数に対して正確に対応する、ジャイロスコープで導出された方向のスケール値を計算し得る。たとえば、ＤＦＴによって、ジャイロスコープが測定した３６０°の回転に対応するＯＦ出力の優位周波数が、予期された５３ではなく５２であるという結果がもたらされた場合には、ジャイロスコープ出力を５３／５２（すなわち１．１０９２３）だけスケーリングすれば、移動した角距離に伴う誤差を蓄積しない、正確な全体の方向をもたらすことになる。

【0058】

図６は、図４に示されたパターンの上を移動したときの、位置領域および周波数領域におけるＯＦ輝度のメタデータ出力を示す。そこで、ジャイロスコープを使用して検知された角度位置は、この場合、真の角度位置である。５３サイクル／回転におけるピークは、ＯＦセンサが１回転するごとに５３のピークがカウントされることを指示する。図７は、図４のパターンの測定を繰り返し、図６のものと類似の輝度のメタデータ出力を生成するが、角度位置がグラウンドトゥルース角度位置ではない系列を加算するものであり、ジャイロスコープから取得された角度位置はスケール誤差を有する。これは５２サイクル／回転にピークをもたらす。予期されたサイクル／回転が先験的に既知（５３）であるので、システムは、相違がジャイロスコープスケール誤差によるものであると判定することができる。

【0059】

より具体的には、図７の上側のグラフは、スケーリングされていないジャイロスコープ信号（破線）と、表面パターン／ＯＦ信号に対する実際の方向（たとえばスケール誤差対真の方向を用いて測定されたもの）との間の関係を示す。図７の下側のグラフは、スケール補正前のＤＦＴ出力（破線、スケール誤差を伴って測定されたもの）、およびスケール補正の後のＤＦＴ出力（実線、真の方向）を示す。

【0060】

場合によっては、この手法にはいくつかの関連する前提条件があり得る。たとえば、
・オプティカルフローセンサは表面パターンの中心のまわりで回転する必要がある。
○回転の中心と表面パターンの中心とは同一ポイントである必要がある。そうでなければ、表面パターンの周波数が位置によって変化してしまう。
○車輪付きロボットについては、既知のポイントのまわりで（任意の初期の方向で）回転し始める必要があり、かつ／または
○車輪付きロボットについては、回転の全体にわたって円運動を維持する必要がある。
・表面パターンは既知の信号特性を生成する必要がある。
○値の範囲は必ずしも既知である必要はないが、空間領域における周波数の変化は先験的に既知でなければならない。
○表面は、オプティカルフローセンサが測定可能な特性（たとえば表面の反射率）における意味のある変化をもたらすように設計される必要がある。
○オプティカルフローセンサが、出力信号に影響を及ぼす自動利得制御を使用する場合には、最善の結果を得るように自動利得制御を補償するべきである。
・ジャイロスコープの測定結果は、試験運動のコースにわたって積分されたときには、安定した方向予測を生成することができなければならない。
○試験の間中、スケールが一定である必要がある。
○温度によって導入されたジャイロスコープ出力のオフセット（たとえばＺＲＯ）は、積分に先立って信号から確実に除去され得る。
・ピッチ検知方法の選択には、いくつかの本質的な制限があり得る。
○ＤＦＴの周波数分解能は、たとえばデータ持続時間の逆数を用いてスケーリングされ、必要な精度を有する結果を得るためには長い測定が必要となり得る。

【0061】

図８には一実施形態によるスケール較正が表されている。ステップ８００において、ロボットは、たとえば図４に示された表面などの較正面上で中心合わせされる。次いで、ステップ８０２では、ロボットが適所において回転され、ロボットの回転中に、ジャイロスコープおよびオプティカルフローセンサが、時間に対してそれぞれ角速度および画質を取り込む。次に、ステップ８０４において、公称のスケール係数ｃ_{ｎｏｍｉｎａｌ}を掛けた角速度ωが積分されて、ジャイロスコープで導出されたロボットの初期の方向が取得される。次いで、ステップ８０６において、較正されていない方向グリッドに対して対応する画質値が補間され、その結果が、ステップ８０８において離散フーリエ変換されて、優位周波数に対応するｆ_ｐｅａｋ値が取得される。これによって、ステップ８１０に示されるようにｃ_{ｃｏｒｒｅｃｔｅｄ}＝ｃ_{ｎｏｍｉｎａｌ}＊［ｆ_ｐｅａｋ／ｆ_{ｐａｔｔｅｒｎ}］を計算することにより、較正された、または補正されたスケール係数を計算することができ、なおここで、ｆ_{ｐａｔｔｅｒｎ}は先験的に既知である。スケーリングされた出力が所定の公差値の範囲内であれば（ステップ８１２）、補正されたスケール係数が、ジャイロスコープの出力補正用に保存され得（ステップ８１４）、処理は終結し得る。スケーリングされた出力が許容差の範囲内でなければブロック８１６に進み、センサを再較正するか否かを決定することができる。

【0062】

図８を参照しながら上記で説明された技術は、たとえば工場（たとえば較正パターンを与えることができ、優れた円運動を得るのに必要な表面組織を実現することができ、かつ／またはロボットを特定の位置に配置してからその較正を開始することができるところ）における車輪付きロボットの最終的な較正において実際に使用するのに適している。この技術には、組立て前にセンサを個々に較正するやり方に対していくつかの利点がある。たとえば、この技術は、製造プロセスにおいて何らかのストレスが生じた後にセンサ特性を測定することができ、オプティカルフローセンサが期待範囲内の画質値を報告している（たとえばレンズ組立体の欠陥がなく、その障害もない）ことを検証することができ、かつ／またはロボットの円運動する能力を検証するために使用され得る。

【0063】

この処理によって、ジャイロスコープの信頼できるスケール較正が得られなければ、上記の項目のうち１つに障害があって、このロボットに関連する製造の問題が示唆されていることになる。

【0064】

オプティカルフロー利得の補償
可能な最善の位置追跡のために、ＯＦセンサは、ある種の自動利得制御（たとえば画像が暗いときには露光時間を長くすること、および／または画像が明るいときに露光時間を短くすること）を実施してよい。ピッチ検知のために使用される信号がこれの影響を受ける場合には、利得設定を基に、前もって信号を調整するように注意するべきである。

【0065】

これを達成するための例示的アルゴリズムが、以下に擬似コードとして示される。

【0066】

【数11】

【0067】

上記コードの高レベルでは、利得設定および関心のある信号が記録されて、利得設定における変化と対応する信号値における平均変化とのマップを作成するのに使用され得る。最もよく観測されたゲイン値に隣接したデータのセクションを、最も一般的な利得設定下で観測されたおおよその測定範囲にマッピングするために、オフセットが繰り返し与えられてよい。すべてのデータが同一のおおよその利得設定を得るまで、この処理が繰り返されてよい。遷移の両側において、基礎をなす信号は必ずしも同一ではないが、この処理／プロシージャは、そうしないと利得制御の存在下で生じる信号における大きなジャンプの影響を軽減し得る。

【0068】

任意表面上の画質周期検知
周波数検知手法は、既知の空間周波数を有する信号を検知することと、完ぺきに近い円で移動することとに頼るものであった。この概念は、任意の表面において使用するように一般化され得る。詳細には、少数の厳しくない制約条件が満たされる場合には、センサが、ほぼ円形の同一の軌道を通って複数回回転することができれば、１回転当たり１サイクルの周波数を有する繰返しパターンが検知され得る。たとえば、信号は、１回転の間に十分に変化する空間的変動を有すること、および／または検知される画質メトリックは円運動からの小さな逸脱によって激烈に変化することのない十分な空間コヒーレンスを有することが必要とされ得る。

【0069】

一実施形態では、本明細書で説明された手法は、円形軌道にわたって表面（たとえば自然木表面）の輝度を考慮に入れる。たとえば、図９Ａは、自然木木目の一例を示し、図９Ｂは、そのような表面の上でＯＦセンサを円運動させたときの角度位置の関数として検知された平均輝度のグラフを示す。パターンが繰り返す角距離は名目上３６０°（垂直な破線）であり、３６０°とジャイロスコープ出力を積分することによって得られる角距離との間の比は、ジャイロスコープに関する正確なスケール係数をもたらすはずである。

【0070】

一例では、信号の周期は、１）複数の回転にわたって、推定された角度位置および対応する信号を記録して、２）得られた系列の自己相関を実行することにより、効率的に抽出され得る。自己相関の最大値に対応するシフトは、ジャイロスコープで導出された方向の角度位置領域における信号周期（たとえば３６０°の回転）である。

【0071】

図１０は、（たとえばスケール誤差のない）真のデバイス方向を使用して、自然木表面の上のほぼ完全な円運動に関する単一の自己相関の一例を示す２つのグラフを含む。グラフの下部における各ラベルは、ピーク間で測定された長さ（度）、この周期に関する誤差、およびそのポイントに対するすべてのデータにわたる平均の周期誤差を示す。３６０°ごとに相関ピークが生じているが、それらの間により小さいピークが見られることに留意されたい。これらはパターンの１８０°シフトに対応し、自然木木目の両側の組織の類似性を強調するものである。極大値のうちのいくつか（たとえば３６０度シフトに対応しない極大値）は、真の３６０°相関よりもよく関連付けられ得、したがって、不正確な回転に対するエイリアシングの可能性を最小化するかまたは除去するために、各ピークを求める探索領域を制限するように、最小値および最大値のスケール値が使用されてよい。真のスケールが公称スケールのｘ％以内にあることが分かっていれば、真のピーク間の周期は、ジャイロスコープの方向の３６０°のｘ％以内にあることになる。いくつかの例では、この情報（たとえばスケール値の標準値、最小値、および／または最大値）は、センサ製造業者によって提供され得る。

【0072】

工学的表面（たとえば信号における好ましい空間的変動を用いて設計された表面）が、単一の全体的最大値を有する場合、または、高周波パターンのアラインメントに対するエイリアシングを回避するように、スケール誤差が十分に制限されている場合には、この手法は、このような表面にも適用され得る。図４に示される表面は、図１１Ａおよび／または図１１Ｂに表示されるように、基本パターンから離れて、グローバルアラインメントのための手段を与える特徴を付加することによって強化され得る。このパターンは、引き続き５３サイクル／回転の信号が支配的であるが、より広いブラックバーを配置することにより、最善の単一アラインメントをもたらすことに留意されたい。回転から回転へと、５つの広いブラックバーのすべてを広いバーと整列させる（すなわち、すべての５つの広いバーを再びそれ自体と整列させる）のは、このパターンにおける３６０度のシフトだけである。回転から回転への、３６０度以外の回転量では、２つ以上のより広いブラックバーが、別の広いブラックバーと整列することはない（弱い相関をもたらす）。たとえば、時計方向に９０度回転させると、図１１Ａの３時の位置にあるより広いブラックバーが、図１１Ａの６時の位置にあるより広い黒色の位置と整列し得るが、他の４つの広いブラックバーはそのように整列することはない。このパターンは、この方法と、上記で開示された工学的表面上のパターンの周波数検知において説明された方法との両方を実行するのに適する。本明細書で表されたパターンは代表的なものであり、１つまたは複数の好ましい信号特性を有する他のパターンも使用され得る。

【0073】

この段落で説明された各手法（および／または上記で開示された工学的表面上のパターンの周波数検知で説明された各手法）が異なる結果をもたらすときには、これは、ジャイロスコープおよびオプティカルフローセンサは期待通りに作動している（たとえば優れた回転周期を確立している）が、ロボットの動作は、優位周波数を公称のものからシフトさせるほど十分に非円形であることを意味し得る。一例では、図１２は、図１１Ａに表された工学的表面の上でほぼ円形の回転を実行するときの、元の信号、その（検知された周期を伴う）自己相関、および対応するＤＦＴを示す。

【0074】

車輪付きロボットの動きは、完全な円運動にはなり得ない。このため、長いデータ収集に対して最善の単一相関を得ることには、基礎をなす信号における変化として非円形性が現れることになる。一例では、これらの問題は、はるかに長い入力系列にわたって相関を最大化する最善の単一周期を見いだそうとするのではなく、オーバラップする７２０°の窓にわたって複数の相関を実行することによって軽減され得る。たとえば、図１３は、方向誤差のない、工学的表面上の非円形の運動をシミュレートしたときの、回復された周期の長さの分布を示す。この場合、運動は、（平滑な表面上の適所で回転しようとしている）２輪ロボットの位置測定を使用することにより、工学的表面においてほぼ円形の運動を使用して収集されたデータからサンプリングして得られた。実線で示されたデータでは、周期予測は、オーバラップする２回転の窓ごとに得られたものであり、これらの予測の誤差の累積分布関数（ＣＤＦ）がプロットされている。破線および点線は、同一のデータを使用して、それぞれオーバラップする４回転の窓および８回転の窓を用いて周期を予測したものである。この場合、長い窓における相関のためにより多くのデータを得るという利点よりも、蓄積された非円形運動が観測パターンをシフトさせるという不利益の方が重要であった。これをシミュレートするために使用された運動は、オプティカルフローセンサの回転の中心に対するほぼ一定の半径（１０ｃｍ）を維持したが、回転の中心は、各回転に対してランダムな方向におよそ３ｍｍ移動した。周期を予測するために使用される最適の窓長さは、ロボットが円運動をうまく維持することができる程度に依拠して変化することになり、たとえば、運動が円形に近ければ近いほど、窓はより長くなり得る。

【0075】

複数のオーバラップする窓の結果を集約するために使用されるメカニズムは、多少任意である。一例には、結果における外れ値を棄却し、次いで残りの結果の加重平均を得る手法があり、より大きい自己相関値を有する窓に対してより大きい重みが割り当てられる。

【0076】

図１４は、一実施形態による、画質の自己相関を使用する、例示のジャイロスコープスケールの較正アルゴリズム／メカニズムを示すブロック図である。最初に、ステップ１４００において、何かの表面の上の適所で回転するロボットによって入力データ（未較正の方向および画質）が収集され、次いで、ステップ１４０２において、角速度ωに公称のスケール係数ｃ_{ｎｏｍｉｎａｌ}を掛けたものを積分して、ジャイロスコープで導出されたロボットの初期の方向が得られ、ステップ１４０４において、上記で説明された対応するステップ８０２、８０４および８０６と同一または同様のやり方で、未較正の方向グリッドに対して、対応する画質値が補間される。次いで、ステップ１４０６において、このデータが、前述のように、オーバラップする窓へと分割される（窓長さは、ロボット動作に期待する円形の程度によって規定される）。次いで、ステップ１４０８において、各窓の範囲内で自己相関が実行される。ブロック１４１０には自己相関に関連したサブステップが示されている。そこで、ステップ１４１２において、自己相関における全体的な最大値が識別され、ステップ１４１４において、このピークに隣接する２つの領域（予期されたスケール誤り限界（たとえば全体的なピークから＋／－３６０°に近い）の範囲内にある）が初期の検索領域として設定される。場合によっては、ステップ１４１６、１４１８および１４２０によって説明されるように、現在の窓からピークがなくなるまでこの処理が繰り返される（たとえば、現在の検索領域における最大の自己相関を見いだし、検索領域を拡張する）。各窓において発見されたピークツーピークの周期（ステップ１４２２）がステップ１４２４において集約されて、既知の３６０°回転に対応する、ジャイロスコープの、推定された未較正の単一周期が得られる。これは、ステップ１４２６において、較正されたジャイロスコープスケール値を得るために使用される。流れ図において参照された変数Ｆ１～Ｆ５の値は、以下のＴａｂｌｅ １（表１）で説明される。

【0077】

【表1】

【0078】

適切な較正面の識別
本明細書で説明された手法は、１回転にわたって単一の全体的適合をもたらすために、様々な実施形態において適切な変動を使用することがある。この段落で説明される手法は、１回転にわたって単一の全体的な最良適合をもたらすために適切な変動を必要とするが、不完全な回転によってもたらされる微小変位にわたるそれほど大きくない変動は、大いに異なる信号を与える。

【0079】

１つまたは複数の特徴を有する表面を識別するための簡単な近似は、画質信号の短期分散

【0080】

【数12】

【0081】

および長期分散

【0082】

【数13】

【0083】

を記録することであり、これらは相関のために使用される。分散は、短距離の窓（回転の中心の１回転で導入されるドリフト程度の長さｄ_ｓを有する）と長距離の窓（周期検知のために使用される回転の円周程度の長さｄ_ｌを有する）との両方に対して計算するべきである。適切な較正面は、

【0084】

【数14】

【0085】

が閾値ｔ_ｌを上回り、同じ測定周期中に

【0086】

【数15】

【0087】

が閾値ｔ_ｓを下回るものである。これらの閾値および距離の実際の選択は、センサおよびロボットにわたって変化し得る。したがって、この実施形態によれば、ロボットは、たとえば住宅または事務所において、表面に十分な大規模変動があって最善の単一相関をもたらす一方で円運動からのわずかな逸脱によって回転が全体として相違してしまうような小規模変動はあまりない表面を探索することによって、それ自体の較正面を選択することができる。たとえば、格子縞パターンには、最善の単一相関をもたらすのに十分な大規模変動があるが、ロボットが少しでもスリップすると、ある回転で見えるパターンと、次の回転で見えるパターンとが、大層異なるものになってしまう（小規模変動が高水準である）。他方では、全体として均一な表面においては、小規模変動は低水準である（ロボットがスリップしても、各回転で見えるパターンは最後の回転で見えるパターンに類似である）。しかしながら、大規模変動も低水準であり、全体的な最善の相関は存在しない。したがって、それらの２つのタイプの表面の間の、第１の所定の閾値を上回る十分な大規模変動をもたらす一方で、小規模変動が低水準であって第２の所定の閾値を下回るような表面が、較正のために使用するのに適切な表面として、ロボットによって識別され得る。

【0088】

画質を使用する、固定された基準マークの識別
ＯＦセンサを用い、互いに対して既知の空間的関係を有する離散点を検知することによって繰返しパターンを判定する、第３の手法／技術が、サイクル検知を置換する。

【0089】

この手法では、複数の別個の反射マーカが表面上の既知の位置に配置され得る。図１５は、反射体の可能な配置を示す。この例では、反射体は、平行な２つの反射細片１５０２ａおよび１５０２ｂである。車輪付きロボットは、その回転の中心１５０４が、各細片１５０２ａ、１５０２ｂに対して等距離かつ平行なライン１５０６上のどこかのポイントに位置するように、それ自体を配置し得る。次いで、ロボットは、ＯＦセンサ１５１０が最初に細片のうち１つ（たとえば１５０２ｂ）の中心の上に位置して、次いで他方の細片（たとえば１５０２ａ）（２つの細片は単なる例示であり、さらなる細片があってよい）の中心の上に位置するように、前後に回転し、その間、ジャイロスコープがそれら２つの位置の間の方向変化を測定する。これらのマークの間で測定された角距離は、２つの細片の間の既知の角距離と組み合わされてよく、ジャイロスコープと、ＯＦセンサによって測定されたグラウンドトゥルースとの間のスケールが得られる。オプティカルフローセンサは、ロボット上で、ロボットの回転の中心１５０４から一定の半径ｒのところに配置されている。

【0090】

この場合、ロボットシステムは、運動が始まったときと、ＯＦセンサが各反射細片の上で中心合わせされたそれぞれのときとの間で、ジャイロスコープによって測定された角速度を積分することにより、ＯＦセンサが第１の反射細片の中心の上にあるときの角度

【0091】

【数16】

【0092】

と、第２の反射細片の中心の上にあるときの角度

【0093】

【数17】

【0094】

とを判定し得る。ロボットシステムは、マーク間の既知の距離ｄおよびオプティカルフローセンサが回転する既知の半径ｒを用いて

【0095】

【数18】

【0096】

を得て、スケール係数

【0097】

【数19】

【0098】

を計算し得、これはジャイロスコープの測定結果を補正するために使用され得る。開始位置に意味がない共通ケースでは、

【0099】

【数20】

【0100】

として、最初に検知されたマークを離れるときに積分を開始することにより、積分誤差が低減され得る。

【0101】

一実施形態では、図１５を参照しながら上記で説明されたスケール係数計算を実行するために使用されるアルゴリズムの全体的な流れが、図１６Ａおよび図１６Ｂに表されている。上記で明示され、また図１６Ａに示されるように、全体的なアルゴリズムは、ステップ１６００において、ステップのセットを使用して第１のマークを求め、次いで、ステップ１６０２において、同じ（または類似の）ステップのセットを使用して第２のマークを求め、その後、ステップ１６０４において、検知された２つのマークの角度位置（下の表ではＦ０およびＦ１として識別される）に基づいて、スケール係数を計算する。各マークを探索するために使用されるステップの根本概念は、ＯＦセンサが反射面の上にあるときには画像輝度にプラトーがあって、反射面の中心はそのプラトー上のどこかにあるはず（しかし、観測される実際の最大値は、中心の上に直接あるわけではない）、ということである。したがって、このアルゴリズムは、このプラトーの各エッジの角度位置を得て、プラトーの上にあるとするのに必要な閾値を、所望の精度限界に達するまで上方修正し続ける。

【0102】

このアルゴリズムを実用的にするために、２つの停止条件が導入される。下の表においてφで指示される第１の停止条件は、ロボットシステムが探索を停止するポイントであって、検知されたマークの角度幅を規定し、この角度幅は、ピーク観測値が及び得る角度幅に関するものである。下の表の第２の停止条件τは、見えるマークの閾値が、観測されたピーク値にどれだけ近づき得るかを規定し、ロボットシステムがピーク値と非ピーク値との間の差を分解することができる細分性に関するものである。それぞれのマーク検知ステップ１６００および１６０２に関連したステップが図１６Ｂに示されている。

【0103】

この処理は、プラトー閾値ｘ_{ｔｈｒｅｓｈ}を初期化するステップ（図１６Ｂには示されていないが、下のＴａｂｌｅ ２（表２）でＦ１１とされている）によって始まる。次いで、ステップ１６０６において、ロボットは、マークの上で検知された輝度が閾値ｘ_{ｔｈｒｅｓｈ}を上回るまで、（時計回りまたは反時計回りのいずれかに）回転される。検知された輝度が閾値を越えるときの角度位置（Ｆ３）が第１の暫定マーカエッジとして記憶され、処理はステップ１６０８に進み、ロボットは輝度レベルが閾値を下回るまで回転され、すなわちロボットはマーカの他方のエッジから離れる。この角度位置（Ｆ４）が第２の暫定マーカエッジとして記録され、処理はステップ１６１０に進み、ここにおいて、第１の停止条件を使用して、（下の表の検査Ｆ５で示されるように）２つの記憶された角度位置の間の差が、マーカエッジが見つかったと考えられるほど十分に大きいかどうか、判定される。十分に大きいと判定されれば、処理はステップ１６１６に移り、マークの最終的な角度位置がＦ６として出力される。

【0104】

ステップ１６１０において、十分に大きいわけではないと判定された場合には、処理はステップ１６１２に移って別の検査がなされる。具体的には、第２の停止条件が検査されて、（光センサの分解能を所与として）閾値ｘ_{ｔｈｒｅｓｈ}を下げてもエッジ検知処理の精度の改善が期待できないかどうかが判定する。ステップ１６１２における（たとえば下の表のＦ７を使用した）検査によって、精度の改善は期待できないと判定された場合には、処理は、ステップ１６１６において、検知されたマークの最終的な角度位置を出力して終結する。精度の改善が期待できると判定された場合には、ステップ１６１４において閾値が（たとえばＦ８を使用して）下げられ得、処理は、停止条件のうちの１つが満たされるまで繰り返される。

【0105】

【表2】

【0106】

一実施形態では、この手法の主な要件は次の３つでよい。
・反射マークが各反射体の中心の優れた予測を得るために、画質信号は、反射マークが見えるときと見えないときとで十分に異なる必要がある。
・ロボットは、その回転の中心を、反射体配列の重心軸に位置合わせする必要がある。
・ロボットの回転半径は一定である必要があり、また横方向のドリフトがあってはならない。

【0107】

この手法は、較正が、はるかに大きなデータセットにわたる相関ではなく、２つの離散点を検知することに基づくので、以前に開示された手法よりも、小さな擾乱の影響を受けやすい。いくつかの例では、この手法は、工場設定の外でジャイロスコープスケールの較正を実行することができる解決策である。実用的な配備シナリオは、家庭用ロボットが使用する充電ステーションに２つの反射細片を付加することであり得る。ロボットは、充電するために充電ステーションに位置合わせして電気接触する必要があり、このことが、既知の姿勢から較正運動の最後までに必要な無制御運動の量を最小化するように利用され得る。

【0108】

変形形態
この手法は、冗長性と非円形運動の検知とのために任意数の基準マークを含むようにも拡張され得るが、上記の表現を実質的に変化させることはない。

【0109】

この手法は基準マークが１つでも実行可能であり、ロボットは検知の間で完全に回転する。この場合θは３６０°である。

【0110】

ジャイロスコープスケールと既知のジオメトリとを用いるオプティカルフロースケールの推定
ロボットシステムは、正確なジャイロスコープスケールと、ロボットの回転挙動の先験的な知見と、センサジオメトリとを用いて、オプティカルフローセンサの距離スケールの表面依存性を克服することができる。ＯＦセンサによって報告される距離と、ＯＦセンサが移動する実際の距離との間の関係は、画像センサから追跡表面までの垂直距離によって主に決定される。ロボットが異なる表面（たとえばカーペットまたはタイル）にわたって移動するとき、またはロボットの特性が変化するとき、画像センサから追跡表面までの垂直距離が変化する可能性がある（たとえば、運搬する重量が変化すると、ロボットのホイールサスペンションがグラウンドからシャーシを持ち上げる高さに影響がある）。このような理由で、動作中にオプティカルフロースケールを直接的かつ迅速に測定するように、手法を強化することが望まれよう。

【0111】

一旦、（たとえば「関連する手法」で説明された方法／手法によって）ジャイロスコープスケールが得られると、ロボットは適所で回転することができ、オプティカルフローセンサが移動した総距離は、ジャイロスコープを用いて（既知のデバイスジオメトリを用いて）推定され得、またオプティカルフローセンサ自体によって測定され得、回転が実行された表面に特有のスケール定数を得ることができる。

【0112】

様々な実施形態において、ロボットはその中心のまわりで回転してよく、このポイントに対するＯＦセンサの変位

【0113】

【数21】

【0114】

が分かる。一例では、簡易化のために、運動は平面的であり、各フレームのＺ軸は整列し、回転はＸ－Ｙ面に限定される（回転はＺ軸のまわりのスカラーである）と想定する。これは、ロボットシステムが、ＩＭＵによって測定された角速度を、ＯＦセンサにおいて測定されたものであるかのように扱ってよいことを意味する。ＩＭＵとＯＦセンサとの両方が、サンプル周波数

【0115】

【数22】

【0116】

で同時にサンプリングされると想定し、Δｔは連続したサンプルの間の時間である。

【0117】

ＯＦセンサ出力とジャイロスコープ出力との間の関係は、速度領域および／または位置領域の両方において、互いに対して解釈され得る。

【0118】

速度領域の解釈
オプティカルフローフレーム
様々な実施形態において、剛体の関係によって与えられるオプティカルフローセンサの直線速度は次式となる。

【0119】

【数23】

【0120】

ロボットシステムは、ロボットが純粋な回転

【0121】

【数24】

【0122】

を実行しており、角速度は経時的に変化すると想定して、ＩＭＵによって測定された角速度ω_Ｉを基に、オプティカルフローセンサにおける直線速度の予測

【0123】

【数25】

【0124】

を取得し得る。Ｒ_Ｒ→ＯがＺ軸のまわりの回転であって経時的に変化せず、ω_Ｉ（ｔ）が平面的（Ｚ軸のみ）であると想定されるので、直線速度の予測は次式のようにさらに簡単になり得る。

【0125】

【数26】

【0126】

各時点において、ロボットシステムは、ＯＦセンサから、

【0127】

【数27】

【0128】

で表される直線速度の測定値を取得し得る。ＯＦセンサは、２つの時点間の変位（画素数）を測定して、速度出力自体は生成しなくてよい。ＯＦセンサが一定のレートでポーリングされる（または適切に後処理される）との想定下では、同等の速度が得られる。

【0129】

次いで、ロボットシステムは、
Ｖ_Ｉ＝αＶ_Ｏ
という関係を得るために、適切な最適化（たとえば最小二乗法）を適用することにより、（未較正の）オプティカルフロー変位出力を（較正された）ジャイロスコープ速度に関連付ける予測されたスケール係数を取得し得、Ｖ_ＩおよびＶ_Ｏはｎ×２のマトリクスであり、各マトリクスのｉ番目の行は、各センサによって得られたｉ番目のサンプル

【0130】

【数28】

【0131】

および

【0132】

【数29】

【0133】

に対応する。

【0134】

地表フレーム
円形軌道にあるオプティカルフローセンサによって報告された変位は、角距離

【0135】

【数30】

【0136】

に変換され得、

【0137】

【数31】

【0138】

は、ＯＦセンサに関してｉ番目のサンプル期間において（時間ｔ＝ｉΔｔにおいて）報告された変位である。これは、オプティカルフローセンサによって予測された角速度

【0139】

【数32】

【0140】

をもたらす。次いで、ロボットシステムは、上記と同様に、適切な最適化方式を使用して
Ω_Ｉ＝αΩ_Ｏ
に最もよく当てはまるスケール係数αを取得し得、ここにおいて、上記の直線速度表現と同様に、Ω_ＩおよびΩ_Ｏはｎ×１のベクトルであり、各ベクトルのｉ番目の要素が、各センサによって供給されたｉ番目の角速度ω_Ｉ（ｉΔｔ）およびω_Ｏ（ｉΔｔ）に対応する。

【0141】

位置領域の解釈
オプティカルフローフレーム
オプティカルフローセンサが移動した（オプティカルフローセンサのフレームにおける）直線距離は、速度を時間に対して積分することによって取得され得る。ロボットは、これを得るためにＩＭＵを使用して

【0142】

【数33】

【0143】

を得、ここにおいて

【0144】

【数34】

【0145】

は、ＩＭＵによって計算された、オプティカルフローセンサの座標系における距離測定値である。これは２次元量であるが、

【0146】

【数35】

【0147】

はロボットフレームにおける定数項ベクトルであり、全体的なフレームにおける回転の中心からオプティカルフローセンサへの（時変）ベクトルと混同されるべきではないことに留意されたい。

【0148】

ＯＦセンサは、ポーリングされるごとに、（前回ポーリングされたときからの）２次元の（２Ｄ）変位を報告し得る。ＯＦセンサ出力

【0149】

【数36】

【0150】

を、各期間において次式のように合計すれば十分であろう。

【0151】

【数37】

【0152】

これは、オプティカルフローセンサによって計算された、オプティカルフローセンサの座標系における距離測定値をもたらす。

【0153】

オプティカルフロースケールがこの運動の全体にわたって一定であり、ジャイロスコープはあらかじめ較正されていて、オプティカルフローセンサ出力には直交軸スキューがないとの想定の下で、ロボットシステムは、オプティカルフロー出力を、次式によって、移動した実際の直線距離に関連付け得る。

【0154】

【数38】

【0155】

オプティカルフローセンサの各軸に対してスケールが同一であるという単純化する想定の下で、ロボットシステムは、各センサで測定された総距離に基づいて（方向は無視して）単一のスケール定数

【0156】

【数39】

【0157】

を取得し得る。たとえば、オプティカルフローセンサの軸のうち１つが運動に対して垂直であるなら、上記の計算が使用され得る。

【0158】

地表フレーム
速度領域の解釈において上記で説明された方法／手法は、位置領域において解釈され得る。ジャイロスコープによって測定された角距離の合計は、一定のスケール係数ｃによって、オプティカルフロー変位および半径によって計算された、移動した角距離の合計に関連付けられ得る。

【0159】

【数40】

【0160】

以前に説明された方法との関係
ジャイロスコープスケール対未知表面の画質周期を測定するのに使用されるのと同一の物理運動が、オプティカルフローセンサ距離スケールを確立するために使用され、これらの２つの処理は組み合わされ得る。

【0161】

代替実施形態および拡張
ロボット動作を推定するために表面画質における周期信号を使用する一般概念には、さらなる領域特有の用途があり得る。この段落は、類似の状況における用途を見いだし得るいくつかの関連する方法について概説する。

【0162】

周期検知のための画像照合
上記で説明された方法は、オプティカルフローセンサによって報告された簡潔かつ高レベルの画質メトリックを使用して機能するものである。いくつかのオプティカルフローセンサは、運動が検知される実際の表面の画像へのアクセスを与える。これが利用可能なときには、いくつかのさらなる改善が可能である。

【0163】

画素スケール基準マークの検知
「適切な較正面の識別」で説明された方法は、基準マークの上を前後に走査することにより、基準マークが見える領域の中心を推定するステップを含み得る。この領域の形状が（たとえば偶然の直線運動によって）円弧でない場合、または感知されたマーク領域が（たとえば照明または傾斜変化によって）経時変化する場合には、マーク中心の予測が劣化することになる。

【0164】

しかしながら、ＯＦセンサがマーカの上でほぼ中心合わせされたとき、ロボットシステムがマークの実際の形状を分割することができれば、これらの問題の影響を弱めることができる。マークのエッジが十分に一直線であって既知の配向である場合には、ロボットシステムは、このエッジに対するセンサ配向を検知し得る。図１７は、センサの参照フレームにおいて感知されたマークの一例と、これが、マークの方向（この場合は「Ｎ」とラベルが付いている）に対応するあらゆる既知の配向に対するセンサの角度位置を得るように使用され得る様子とを示すものである。

【0165】

基準マークが互いに対して既知の配向を有する（たとえば平行である）場合には、ロボットシステムは、検査運動の開始および終了における方向の差を直接測定して、これを、ジャイロスコープの測定結果を積分したものと比較すればよい。較正運動が２つの基準マークをカバーすることができる限り、２つの基準マークの間の運動は、「適切な較正面の識別」において説明された真円度および回転の中心の制約を受けない。

【0166】

工学的表面上の真の方向
上記の手法は、複数の平行ラインから成る工学的表面上のほぼ連続した方向測定結果を得るようにさらに拡張され得る。

【0167】

非円形運動の本質的な検知
運動が完全に円形であるときには、ジャイロスコープによって測定された角速度は、簡単なスケール係数（ＯＦセンサから回転の中心までの距離およびそれぞれのセンサのスケールによって規定される）によって、オプティカルフローセンサにおいて感知された直線速度に関連付けられるはずである。このドキュメントにおいて提案された方法は、ジャイロスコープスケール（対、真の角速度）およびオプティカルフロースケール（対、移動した角距離）を推定するための手法を概説し、また較正運動が多少なりとも円形であることに頼るものである。

【0168】

運動の真円度は、センサのスケールまたは回転の真の半径のどちらも未知であっても測定可能であり、この基本技術は、上記の方法の実用的な用途のために有効であろう。ここまでに提示された表現は、簡単さのために、一般に、ロボットがその中心のまわりで回転していると想定していた。図１８は、円運動の回転の中心がロボット中心にはなく、そのような運動中の関連する量の間の関係の一例を示す図である。

【0169】

ロボットおよびオプティカルフローフレームにおけるオプティカルフローセンサの直線速度は、ロボットの速度とロボット中心に対するオプティカルフローセンサの変位とを使用して以前に説明されている。

【0170】

【数41】

【0171】

類似の剛体関係が、所与の時点において、回転の中心の速度および回転の中心に対するオプティカルフローセンサの変位からオプティカルフローセンサの速度を得るために、使用され得る。回転の中心は、必ずしもロボット中心にあるとは限らないことに留意されたい。

【0172】

【数42】

【0173】

そこで、オプティカルフローセンサによって測定される直線速度は次式となる。

【0174】

【数43】

【0175】

ロボットの運動が円形であるとき、回転中心の直線速度はゼロであり、回転の中心からオプティカルフローまでの半径はロボットフレームにおいて一定である。この場合、単一のスケールが、上記（たとえばジャイロスコープスケールと既知のジオメトリとを用いるオプティカルフロースケールの推定に関する段落）で説明されたように、運動の全体にわたって、オプティカルフローセンサによって測定された直線速度とＩＭＵにおいて測定された角速度とを関連付ける。運動の全体にわたってこれらの量を一貫して関連付ける単一のスケールがない場合には、ロボットシステムは、非円形運動の、回転の中心が動いている場合とオプティカルフローセンサから回転の中心までの距離が変化している場合との、一方または両方を想定してよい。

【0176】

非円形運動に対する適合
上記で（たとえば工学的表面上のパターンの周波数検知に関する段落において）示された工学的パターンは、回転の中心がパターンの中心に固定されている場合に最適のものである。上記で（たとえば任意表面上の画質周期検知に関する段落において）開示されたメカニズムは、非円形の運動に対してより強いものであり得るが、周波数検知手法でこれを達成するのは困難である。

【0177】

非円形性を識別することができ、さらにはデバイス軌跡全体を再構成するために使用することができる、新規パターンの開発が可能であろう。隣接セル間の表面品質が変化する、既知の間隔を伴うグリッドを使用する概念が、たとえば参考文献（２）に説明されている。ここで、より長い運動の全体にわたって可能なセル交差の位置を集めて、工学的表面上で可能性が最も高い軌跡を再構成するために使用するという類似の概念が適用可能であると思われる。

【0178】

たとえば、意図された運動範囲の少し外に配置されて、パターン中心からのドリフトを検知するように使用され得る反射面といった、組み合わせた工学的パターンも設計可能であると思われる。

【0179】

ドッキング運動によるジャイロスコープスケールの較正
上記で（たとえば、画質を使用する、固定された基準マークの識別に関する段落において）開示されたメカニズムのうちのいくつかは、複数の既知の角度位置を識別することに頼るものであり得る。一般的な消費者用途では、ロボットは、充電ドックに定期的かつ自動的に戻って、何かおおよそ既知の配向で、物理的に接触する必要がある。有効なドッキング位置の間に方向差がある場合には、ドッキング位置を離れて適所で回転し、再びドッキングすることによって、ジャイロスコープスケールを推定することができる。２つのドッキング位置の間の角度差の最大値がδ°であれば、ロボットがｎ回回転すると、ジャイロスコープスケール誤差は、最大で

【0180】

【数44】

【0181】

になる可能性がある。

【0182】

この方法には、消費者ロボットにとって一般的なもの以外のインフラストラクチュアを必要としないという利点がある。しかしながら、充電する表面は、一般的には広範囲のドッキング位置を許容するように設計されているため、２０度程度のδは異常ではない。可能性のある２０度の調整誤差を用いて０．２５％のスケール誤差を達成するには、約２０回転を必要とすることになる。対照的に、周期検知手法（たとえば任意表面上の画質周期検知に関する段落で開示されたメカニズム）なら、木材表面上の一般的な条件下では、８回転以上、≒８０％の時間でそのようなスケール誤差を達成する。経時的に（ドッキング中のロボットに押されて、または人に押されて、空間において）移動するドックに関連した実際の問題が、さらなる誤差を導入する可能性がある。

【0183】

要約
様々な実施形態において、（たとえばジャイロスコープによって検知された）運動と（たとえばＯＦセンサによって検知された）画質信号との間の関係が、センサ較正パラメータの推定を導出するために使用され得る。場合によっては、ロボットの運動を推定することによってジャイロスコープを較正するために、ＯＦセンサからの画質情報が使用され得る。これは、ＯＦセンサの、直線変位を測定するだけの一般的な用法と対照的である。

【0184】

様々な実施形態において、センサを較正するために、本明細書で開示された方法および／または技術は、最終的に設置された構成における（たとえば最終生産物に組み付けた後の）センサの較正をサポートし得る。一例では、経時的に生じる較正の変動および物理的老化を明らかにするために、センサが現場で再較正されることがある。別の例では、較正における環境変化の影響を捕捉するために、特に表面の変化に対してＯＦセンサスケールを適合させるために、センサが現場で再較正されることがある。

【0185】

一実施形態では、ジャイロスコープスケールは、ＯＦ画質信号における既知のパターンの周波数を検知することによって較正され得る。たとえば、ロボットシステムは、センサの１つまたは複数の最終的な設置された構成に対して、いくつかの工場較正処理を組み合わせるように構成されてよい。別の実施形態では、ジャイロスコープスケールは、未知のＯＦ画質信号の周期性を検知することによって較正され得る。たとえば、ロボットシステムは、較正の変動を明らかにするために、ジャイロスコープの、現場での再較正を実行するように構成され得、または現場での再較正を許容し得る。

【0186】

一実施形態では、ジャイロスコープスケールは、オプティカルフロー画質によって基準マークを検知することにより、較正され得る。ロボットシステムは、較正の変動を明らかにするために、ジャイロスコープの、現場での再較正を実行するように構成され得、または現場での再較正を許容し得る。別の実施形態では、オプティカルフロー距離スケールは、較正されたジャイロスコープおよび既知のジオメトリを用いて、デバイスの円運動によって較正され得る。たとえば、ロボットシステムは、環境変化の影響を捕捉するために、ＯＦセンサの、現場での再較正を実行するように構成され得、または現場での再較正を許容し得る。

【0187】

ロボット１９００の、例示の（非限定的な）高レベルアーキテクチャが、図１９に示されている。図１９において、たとえばロボット１９００に含まれ得る１つまたは複数のプロセッサ１９０２は、システムバス１９０４を含み、これによって、（１）通信チャネル１９０７を通じて他のデバイスとの通信を可能にする１つまたは複数の通信デバイス１９０６と、（２）１つまたは複数の加速度計１９０８、１つまたは複数のジャイロスコープ１９１０、１つまたは複数のオプティカルフローセンサ１９１２を含む１つまたは複数の感知器／センサと、（３）１つまたは複数のマニピュレータ１９１４と、（４）１つまたは複数の移動物１９１６とに対して、通信可能に結合されている。通信チャネル１９０７は、様々な通信プロトコルをサポートするばかりでなく、有線通信と無線通信との両方に適合可能であり得る。限定ではなく例として、通信チャネル１９０７は、たとえばＵＳＢ、ＩＥＥＥ－１３９４、８０２．１１、ＢＬＥ、セルラ（たとえばＬＴＥまたは５Ｇ）、ならびに他の有線通信プロトコルおよび無線通信プロトコルなどの、シリアル通信チャネルおよび／またはパラレル通信チャネルとして構成され得る。無線通信チャネルが使用される場合には、通信デバイス１９０６は、無線トランシーバおよびアンテナ（図１９には示されていない）を含むことになる。

【0188】

感知器は、たとえば光センサ、慣性センサ（たとえばジャイロスコープ、加速度計など）、熱センサ、触覚センサ、コンパス、距離センサ、ソナー、全地球測位システム（ＧＰＳ）、地中探知レーダ（ＧＰＲ）、対象物検知およびレンジセンシングのためのレーザ、撮像デバイス、磁力計などの任意数の異なるセンサを含み得る。感知器はまた、配備の範囲内の任意の他の既存のセンサであり得るが、単一の位置（たとえば温度センサまたは湿度センサ）からではなく、設備にわたって分散している同一のデータを取得するためにロボット上に取り付けられ得る（そうしないと静的なものになる）。

【0189】

さらに、当業者なら、これらのセンサのうちの多くは、センサ入力を、有意義ですぐに使用可能な感知へと結合するために、ソースとセンサとの両方を含み得ることを理解するであろう。たとえば、ソナー感知器およびＧＰＲは、音響波形または可聴下周波の波形を生成して、反射波を感知する。同様に、レーザを含む感知器は、レーザビームにおける妨害または位相シフトを判定するために、レーザからの反射波を検知するように構成されたセンサを含み得る。オプティカルフローセンサ１９１２としての使用に適する撮像デバイスは、たとえば赤外線撮像装置、ビデオカメラ、スチールカメラ、デジタルカメラ、相補型金属酸化膜半導体（ＣＭＯＳ）撮像デバイス、電荷結合素子（ＣＣＤ）撮像装置などの、何らかの画像取込みに適するデバイスでよい。加えて、撮像デバイスは、レンズ、コリメータ、フィルタ、およびミラーなどの、取り込んだ画像を修正するための光学デバイスを含み得る。ロボット１９００は、撮像デバイスの配向を調整するために、撮像デバイスに結合されたパンおよびチルトの機構をも含み得る。

【0190】

マニピュレータ１９１４は、たとえば、真空装置、マグネチックピックアップデバイス、アームマニピュレータ、スコップ、グリッパ、カメラのパンおよびチルトマニピュレータ、個々のアクチュエータまたは結合されたアクチュエータなどを含み得る。移動物１９１６は、たとえば、１つまたは複数のホイール、軌道、脚、ローラ、プロペラなどを含み得る。移動物１９１６は、運動能力や操縦能力のために、モータ、アクチュエータ、レバー、リレーなどによって駆動され得る。さらに、感知器は、マニピュレータ１９１４またはたとえば走行記録計および歩数計などの移動物１９１６に関連して構成され得る。

【0191】

前述の図１９の議論および一般的なロボットに関連したハードウェアは、米国特許第８，０７３，５６４号（以後‘５６４特許）から適合されたものであり、この開示は参照によってここで組み込まれる。しかしながら、そのような要素は単なる例示であることを当業者なら理解するであろう。いくつかのロボットは、図１９に示された要素のすべてを含むわけではなく、一方、他のロボットは、図１９に表されたカテゴリに分類されないハードウェア要素を含み得る。それにもかかわらず、ロボット１９００は、以前に説明された、スケール較正に関する実施形態を含むことができる。

【0192】

結論
本発明の例示的実施形態に従ってデータを処理するためのシステムおよび方法は、記憶デバイスに含有されている命令のシーケンスを実行する１つまたは複数のプロセッサによって実行され得る。そのような命令は、２次データ記憶デバイスなどの他のコンピュータ可読媒体から記憶デバイスに読み込まれ得る。プロセッサは、記憶デバイスに含有されている命令のシーケンスを実行することにより、たとえば上記で説明されたように動作する。代替実施形態では、本発明を実施するために、配線回路が、ソフトウェア命令の代わりに、またはソフトウェア命令と組み合わせて使用され得る。そのようなソフトウェアは、たとえば、センサまたはこのソフトウェアを含有しているロボットまたは他のデバイスといったデバイスの中に収容されたプロセッサ上で作動してよく、たとえば、センサを含有しているデバイスと通信する、システムコントローラ、ゲーム機、パソコンなどの別のデバイス中に収容されたプロセッサまたはコンピュータ上で作動してもよい。そのような場合には、データは、センサを含有しているデバイスと、上記で説明されたようにセンサ較正を実行するソフトウェアを実行するプロセッサを含有しているデバイスとの間で、有線または無線で転送され得る。他の例示的実施形態によれば、センサ較正に関して上記で説明された処理のうちのいくつかは、センサを含有しているデバイスにおいて実行されてよく、残りの処理は、第２のデバイスにおいて、センサを含有しているデバイスから部分的に処理されたデータ受け取った後に実行される。

【0193】

前述の例示的実施形態は、１つまたは複数の回転センサおよび／またはＯＦセンサを含めて信号を感知することに関するものであるが、これらの例示的実施形態によるセンサ較正技術は、これらのタイプのセンサのみに限定されるわけではない。本明細書で説明されたセンサ較正技術が適用され得るデバイスには、たとえば、加速度計、光センサおよび慣性センサ（たとえば回転センサ、ジャイロスコープまたは加速度計）、磁力計および慣性センサ（たとえば回転センサ、ジャイロスコープまたは加速度計）、磁力計、ならびに光センサ（たとえばＯＦセンサ、カメラ、１つまたは複数の光ダイオード、１つまたは複数の光トランジスタ）、あるいは他のセンサの組合せが含まれる。加えて、本明細書で説明された例示的実施形態は、ロボットおよびロボット掃除機ならびに応用の状況でセンサ較正に関するものであるが、そのような技術は、そのように限定されることなく、たとえば携帯電話、医療用途、ゲーム、カメラ、軍事用途、ロボットデバイスなどの他の用途に関連した方法およびデバイスに採用され得る。

【0194】

前述の例示的実施形態は、本発明のすべての点において、限定的であるというよりもむしろ例示的であるように意図されている。したがって、本発明は、当業者によって、本明細書に含有されている説明から導出され得る詳細な実装形態において多くの変形形態が可能である。たとえば、前述の例示的実施形態のうちのいくつかは、とりわけ、デバイスの運動を検知するための慣性センサの使用法を説明しているが、慣性センサの代わりに、または慣性センサに加えて、他のタイプのセンサ（たとえば超音波センサ、磁気センサまたは光センサ）が、以前に説明された信号処理と共に使用され得る。すべてのそのような変形形態および修正形態は、以下の特許請求の範囲によって定義される本発明の範囲および趣旨の範囲内にあると見なされる。本出願の説明において使用されるいかなる要素、動作、または命令も、そのように明示的に記述されていなければ、本発明にとって決定的なものまたは不可欠なものと解釈されるべきではない。また、本明細書で使用される冠詞「１つの（ａ）」は、１つまたは複数の項目を含むように意図されている。

【0195】

上記では、特徴や要素は特定の組合せで説明されているが、当業者なら、それぞれの特徴または要素が、単独で、または他の特徴や要素との任意の組合せで、使用され得ることを理解するであろう。加えて、本明細書で説明された方法は、コンピュータまたはプロセッサによって実行するようにコンピュータ可読媒体に組み込まれたコンピュータプログラム、ソフトウェア、またはファームウェアにおいて実施され得る。非一時的コンピュータ可読記憶媒体の例は、それだけではないが、読取り専用メモリ（ＲＯＭ）、ランダムアクセスメモリ（ＲＡＭ）、レジスタ、キャッシュメモリ、半導体メモリ素子、内部ハードディスクおよび取外し可能ディスクなどの磁気媒体、磁気光学媒体、ならびにＣＤ－ＲＯＭディスクやデジタル多用途ディスク（ＤＶＤ）などの光媒体を含む。ＷＴＲＵ １０２、ＵＥ、端末、基地局、ＲＮＣ、または任意のホストコンピュータにおいて用いる無線周波数トランシーバを実施するために、ソフトウェアに関連したプロセッサが使用され得る。

【0196】

その上に、前述の実施形態では、処理プラットホーム、コンピュータシステム、コントローラ、およびプロセッサを含有する他のデバイスに言及している。これらのデバイスは、少なくとも１つの中央処理装置（「ＣＰＵ」）およびメモリを含有し得る。動作または命令の、行為や記号表現に対する参照は、コンピュータプログラミングの当業者の慣行に従って、様々なＣＰＵおよびメモリによって実行され得る。そのような行為や動作または命令は、「実行される」、「コンピュータで実行される」または「ＣＰＵで実行される」ものとして参照され得る。

【0197】

当業者なら、行為や象徴的に表現された動作または命令は、ＣＰＵによる電気信号の操作を含むことを認識するであろう。電気システムは、電気信号の変換および縮小と、ＣＰＵの動作を再構成するかまたは変更するための、メモリシステムの記憶場所におけるデータビットのメンテナンスと、信号の他の処理とを可能にするデータビットを表現する。データビットが維持される記憶場所は、データビットに対応するかまたはデータビットを表す、特定の電気的特性、磁気的特性、光学的特性、または有機的特性を有する物理的位置である。代表的な実施形態は、前述のプラットホームまたはＣＰＵに限定されず、他のプラットホームおよびＣＰＵが、提供された方法をサポートし得ることを理解されたい。

【0198】

データビットはまた、磁気ディスク、光ディスク、および任意の他の揮発性（たとえばランダムアクセスメモリ（「ＲＡＭ」））、または不揮発性（たとえば読取り専用メモリ（「ＲＯＭ」））のＣＰＵ可読大容量記憶システムを含むコンピュータ可読媒体上に維持され得る。コンピュータ可読媒体は、協働するかまたは相互接続されたコンピュータ可読媒体を含み得、これは、もっぱら処理システム上に存在するか、あるいは処理システムに対してローカルまたはリモートであり得る複数の相互接続された処理システムの間に分散している。代表的な実施形態は前述の記憶装置に限定されず、他のプラットホームおよび記憶装置が、説明された方法をサポートし得ることが理解される。

【0199】

例示の実施形態では、本明細書で説明された動作、処理などのうち任意のものが、コンピュータ可読媒体上に記憶されたコンピュータ可読命令として実施され得る。コンピュータ可読命令は、移動ユニットのプロセッサ、ネットワーク要素、および／または任意の他のコンピュータデバイスによって実行され得る。

【0200】

システムの態様の、ハードウェアの実装形態とソフトウェアの実装形態との間には、ほとんど相違がない。ハードウェアまたはソフトウェアの利用は、一般にコスト対効率のトレードオフを表す設計上の選択である（しかし、特定の状況では、ハードウェアとソフトウェアの間の選択が重要になることがあるという点で、必ずしもそうとは限らない）。本明細書で説明した処理および／またはシステムおよび／または他の技術に影響を及ぼし得る種々の手段（たとえばハードウェア、ソフトウェア、および／またはファームウェア）があり得、好ましい手段は、処理および／またはシステムおよび／または他の技術が配備される状況に応じて変化し得る。たとえば、開発者は、速度および精度が最重要視されると判断したときには、主としてハードウェアおよび／またはファームウェアの手段を選択してよい。融通性が最重要視されるのであれば、開発者は、主としてソフトウェアの実装形態を選択してよい。あるいは、開発者は、ハードウェア、ソフトウェア、および／またはファームウェアのいくつかの組合せを選択してもよい。

【0201】

前述の詳細な説明は、ブロック図、流れ図、および／または実例を使用することにより、装置および／または処理の種々の実施形態を説明している。このようなブロック図、流れ図、および／または実例が１つまたは複数の機能および／または動作を含んでいる限り、このようなブロック図、流れ図、または実例の範囲内の各機能および／または動作は、広範なハードウェア、ソフトウェア、ファームウェア、またはそれらの実質的に任意の組合せによって、個々に、かつ／または総体として実施され得ることが当業者には理解されよう。適切なプロセッサは、例として、汎用プロセッサ、専用プロセッサ、在来型プロセッサ、デジタル信号プロセッサ（ＤＳＰ）、複数のマイクロプロセッサ、ＤＳＰコアに関連した１つまたは複数のマイクロプロセッサ、コントローラ、マイクロコントローラ、特定用途向け集積回路（ＡＳＩＣ）、特定用途向け標準製品（ＡＳＳＰ）、フィールドプログラマブルゲートアレイ（ＦＰＧＡ）回路、任意の他のタイプの集積回路（ＩＣ）、および／またはステートマシンを含む。

【0202】

本開示は、様々な態様の説明として意図されている、本出願で説明された特定の実施形態という意味において、限定されない。本開示の趣旨および範囲から逸脱することなく、多くの変更形態および変形形態が作製され得ることが当業者には明らかであろう。本出願の説明において使用されるいかなる要素、動作、または命令も、そのように明示的に与えられていなければ、本発明にとって決定的なものまたは不可欠なものと解釈されるべきではない。本明細書に列挙されたものに加えて、本開示の範囲内の機能的に等しい方法および装置は、前述の説明から当業者には明らかであろう。そのような変更形態および変形形態は、添付の特許請求の範囲の範囲内であるように意図されている。本開示は、そのような特許請求の範囲が権利を与えられる等価物の全範囲に加えて、添付の特許請求の範囲の用語によってのみ限定されるべきである。本開示は、特定の方法またはシステムに限定されないことを理解されたい。

【0203】

ある特定の代表的な実施形態では、本明細書で説明された内容のいくつかの部分は、特定用途向け集積回路（ＡＳＩＣ）、フィールドプログラマブルゲートアレイ（ＦＰＧＡ）、デジタル信号プロセッサ（ＤＳＰ）、および／または他の集積された構成によって実施され得る。しかしながら、当業者なら、本明細書に開示された実施形態のいくつかの態様は、全体的に、または部分的に、集積回路で、１つまたは複数のコンピュータ上で作動する１つまたは複数のコンピュータプログラムとして（たとえば１つまたは複数のコンピュータシステムで作動する１つまたは複数のプログラムとして）、１つまたは複数のプロセッサ上で作動する１つまたは複数のプログラムとして（たとえば１つまたは複数のマイクロプロセッサ上で作動する１つまたは複数のプログラムとして）、ファームウェアとして、または実質的にそれらの任意の組合せとして、同等に実施され得ること、また、本開示を考慮すれば、回路の設計ならびに／あるいはソフトウェアおよび／またはファームウェアのコードの記述は、当業者の技量の範囲内に十分に入ることを理解するであろう。加えて、当業者なら、本明細書で説明された主題の仕組みは、様々な形式のプログラム製品として配布され得ること、また、本明細書で説明された主題の例示的実施形態は、実際に配布するために使用される信号を伝える媒体の特定タイプにかかわらず当てはまることを理解するであろう。信号を伝える媒体の実例には、それだけではないが、フロッピーディスク、ハードディスク装置、ＣＤ、ＤＶＤ、デジタルテープ、コンピュータメモリなどの記録可能なタイプの媒体と、デジタルおよび／またはアナログの通信媒体などの通過型（ｔｒａｎｓｍｉｓｓｉｏｎ ｔｙｐｅ）媒体（たとえば光ファイバケーブル、導波路、有線通信リンク、無線通信リンクなど）とが含まれる。

【0204】

本明細書で説明された主題は、種々の他の構成要素に内蔵されている、または接続されている、種々の構成要素を示すことがある。そのような表されたアーキテクチャは単なる例であって、実際には、同一の機能性を達成する他の多くのアーキテクチャが実施され得ることを理解されたい。概念的な意味で、同一の機能性を達成するための構成要素の何らかの機構は、所望の機能性が達成され得るように効果的に「関連付けられる」。そのゆえに、特定の機能性を達成するように組み合わされた、本明細書の任意の２つの構成要素は、アーキテクチャまたは中間要素に関係なく、所望の機能性を達成するように互いに「関連付けられた」ものと見なされ得る。同様に、そのように関連付けられた任意の２つの構成要素は、所望の機能性を達成するように、互いに対して「動作可能に接続されている」、または「動作可能に結合されている」と見られてよく、そのように関連付けられ得る任意の２つの構成要素は、所望の機能性を達成するために、互いに対して「動作可能に結合することができる」と見られてもよい。動作可能に結合することができるものの特定の例は、それだけではないが、物理的にペアになり得る構成要素および／または物理的に相互作用する構成要素および／または無線で相互作用可能な構成要素および／または無線で相互作用する構成要素および／または論理的に相互作用する構成要素および／または論理的に相互作用可能な構成要素を含む。

【0205】

本明細書における、実質的にあらゆる複数および／または単数の用語の使用に関して、当業者なら、状況および／または用途に対して適切に複数から単数へ変換し、かつ／または単数から複数へ変換することができる。様々な単数／複数置換は、本明細書では、特に明瞭にするために説明され得る。

【0206】

一般に、本明細書で使用される用語、特に添付の特許請求の範囲（たとえば添付の特許請求の範囲の本文）で使用される用語は、一般に「開放」用語として意図される（たとえば用語「～を含んでいる」は、「～を含んでいるがそれに限定されない」と解釈されるべきであり、用語「～を有する」は、「少なくとも～を有する」と解釈されるべきであり、用語「～を含む」は、「～を含むがそれに限定されない」と解釈されるべきである）ことが当業者には理解されよう。導入される請求項の記述で特定の数が意図された場合、そのような意図は、その請求項で明確に記述されることになり、そのような記述がない限りそのような意図はないことが当業者にはさらに理解されよう。たとえば、１つだけの品目が意図される場合には、「単一の」という用語または類似の語法が使用されることがある。理解の助けとして、以下の添付の特許請求の範囲および／または本明細書の説明は、請求項の記述を導入するのに、「少なくとも１つの」および「１つまたは複数の」といった導入の慣用句の使用を含むことがある。しかしながら、このような慣用句の使用は、同じ請求項が、導入の慣用句「１つまたは複数の」または「少なくとも１つの」や、「１つの（ａ）」または「１つの（ａｎ）」などの不定冠詞を含んでいるときさえ（たとえば「１つの（ａ）」および／または「１つの（ａｎ）」は、「少なくとも１つの」または「１つまたは複数の」を意味するように解釈されるべきである）、不定冠詞「１つの（ａ）」または「１つの（ａｎ）」による請求項の記述の導入が、いかなる特定の請求項も、そのような導入された請求項の記述を、そのような記述を１つしか含まない実施形態に限定することを意味するように解釈されるべきではない。同じことが、請求項の記述を導入するのに使用される定冠詞の使用にも当てはまる。また、導入された請求項の列挙の特定の数が明確に記述されても、当業者なら、このような記述が、少なくとも記述された数を意味するように解釈されるべきであることを理解するであろう（たとえば、「２つの記述」の他の修飾語を伴わないありのままの記述は、少なくとも２つの記述、または２つ以上の記述を意味する）。さらに、「Ａ、Ｂ、およびＣ、などのうち少なくとも１つ」に類似の伝統的表現法が使用される例では、一般に、このような構文は、当業者なら理解するはずの伝統的表現法の意味に意図される（たとえば、「Ａ、Ｂ、およびＣのうち少なくとも１つを有するシステム」は、Ａのみ、Ｂのみ、Ｃのみ、ＡとＢを一緒に、ＡとＣを一緒に、ＢとＣを一緒に、かつ／またはＡとＢとＣとを一緒に、などを含むことになるが、これらを有するシステムに限定されない）。「Ａ、Ｂ、またはＣ、などのうち少なくとも１つ」に類似の伝統的表現法が使用される例では、一般に、このような構文は、当業者なら理解するはずの伝統的表現法の意味に意図される（たとえば、「Ａ、Ｂ、またはＣのうち少なくとも１つを有するシステム」は、Ａのみ、Ｂのみ、Ｃのみ、ＡとＢを一緒に、ＡとＣを一緒に、ＢとＣを一緒に、かつ／またはＡとＢとＣとを一緒に、などを含むことになるが、これらを有するシステムに限定されない）。２つ以上の代替用語を示す実質的にあらゆる離接的な単語および／または慣用句は、それが、説明、特許請求の範囲、または図面におけるものであろうとなかろうと、用語のうちの１つ、用語のどちらか、または用語の両方を含む可能性を企図するように理解されるべきであることが当業者にはさらに理解されよう。たとえば慣用句「ＡまたはＢ」は、「Ａ」または「Ｂ」または「ＡおよびＢ」の可能性を含むように理解されることになる。さらに、本明細書で使用される、複数の品目および／または複数のカテゴリの列挙に続く「のうち任意のもの」という用語は、個々に、または他の品目および／または他のカテゴリの品目と関連して、品目および／または品目のカテゴリの「うち任意のもの」、「任意の組合せ」、「任意の複数」、および／または「複数の任意の組合せ」を含むように意図されている。その上に、本明細書で使用される「セット」または「グループ」という用語は、ゼロを含めてあらゆる数の品目を含むように意図されている。加えて、本明細書で使用される「数」という用語は、ゼロを含めてあらゆる数を含むように意図されている。

【0207】

また、開示の特徴または態様がマーカッシュ群に関して説明される場合、その開示は、それによって、任意の個々の要素またはマーカッシュ群の要素のサブグループに関しても説明されることを当業者なら理解するであろう。

【0208】

当業者には理解されるように、書面の説明を提供することといった観点などの何らかの目的およびすべての目的のために、本明細書で開示された範囲は、何らかの可能なサブ範囲およびすべての可能なサブ範囲ならびにそれらのサブ範囲の組合せを包含する。いかなる列挙された範囲も、同じ範囲が、少なくとも２等分、３等分、４等分、５等分、１０等分などに細分化されるのを十分に説明しかつ可能にするものと容易に理解され得る。限定的でない例として、本明細書で論じられた各範囲は、下部の３分の１、中間の３分の１および上部の３分の１などに容易に細分化され得る。当業者には理解されるように、「～まで」、「少なくとも」、「～よりも多くの」、「～よりも少ない」などのすべての語法は、記述された数を含んでおり、上記で論じたように、その次にサブ範囲に細分化することができる範囲を指す。最後に、当業者には理解されるように、１つの範囲は、それぞれの個々の要素を含む。したがって、たとえば、１～３のセルを有するグループは、１つ、２つ、または３つのセルを有するグループを指す。同様に、１～５のセルを有するグループは、１つ、２つ、３つ、４つ、または５つのセルを有するグループを指す。

【0209】

その上に、特許請求の範囲は、指定のない限り、与えられた順序または要素に限定するように読み取られるべきではない。加えて、あらゆる請求項における「～するための手段」という術語使用は、米国特許法第１１２条第６段落またはミーンズプラスファンクション請求フォーマットを引用するように意図されており、「～するための手段」という術語のないあらゆる請求項にはそのような意図はない。

【符号の説明】

【0210】

１５０２ａ 反射細片
１５０２ｂ 反射細片
１５０４ 回転の中心
１５０６ 平行なライン
１５１０ ＯＦセンサ
１９００ ロボット
１９０２ プロセッサ
１９０４ システムバス
１９０６ 通信デバイス
１９０７ 通信チャネル
１９０８ 加速度計
１９１０ ジャイロスコープ
１９１２ オプティカルフローセンサ
１９１４ マニピュレータ
１９１６ 移動物

【図1】

【図2】

【図3A】

【図3B】

【図4】

【図5】

【図6】

【図7】

【図8】

【図9A】

【図9B】

【図10】

【図11A】

【図11B】

【図12】

【図13】

【図14】

【図15】

【図16A】

【図16B】

【図17】

【図18】

【図19】

【手続補正書】

【提出日】2022-03-01

【手続補正1】

【補正対象書類名】特許請求の範囲

【補正対象項目名】全文

【補正方法】変更

【補正の内容】

【特許請求の範囲】

【請求項1】

ジャイロスコープによってロボットの物理運動を検知するステップと、
オプティカルフロー（ＯＦ）センサ（および／またはカメラ）によって、情報を含む１つまたは複数の画像信号を検知するステップと、
前記検知された物理運動および前記情報に基づいて、センサ較正パラメータの推定を導出するステップと
を含む方法。

【請求項2】

前記情報が、前記１つまたは複数の画像信号の各フレームにおいてそれぞれの画像の関数を含む、請求項１に記載の方法。

【請求項3】

前記関数が画質および／または画像輝度に関連するものである、請求項２に記載の方法。

【請求項4】

前記情報および／またはセンサ較正パラメータの前記推定に基づいて前記ジャイロスコープを較正するステップをさらに含む、請求項１に記載の方法。

【請求項5】

前記ジャイロスコープを較正するステップが、
前記情報と前記検知された物理運動との間の関係を識別するステップと、
前記識別された関係に基づいて、前記ジャイロスコープのスケールパラメータを較正するステップと
を含む、請求項４に記載の方法。

【請求項6】

前記ロボットの前記物理運動が、定位置回転および／または３６０度を超える回転である、請求項１に記載の方法。

【請求項7】

前記ロボットの前記物理運動が、任意の表面、または未知の表面パターンを有する表面において検知される、請求項１に記載の方法。

【請求項8】

前記１つまたは複数の画質信号が周期信号である、請求項１に記載の方法。

【請求項9】

前記情報に基づいて、表面に対する前記ロボットの角運動を推定するステップと、
前記推定された角運動に基づいて前記ジャイロスコープのスケールを較正するステップと
をさらに含む、請求項１に記載の方法。

【請求項10】

前記ＯＦセンサおよび／またはカメラにおいて、既知のロボットジオメトリに基づいて角速度を直線速度に関連付けるステップと、
前記ＯＦセンサおよび／またはカメラの変位スケールを計算するステップと
をさらに含む、請求項１に記載の方法。

【請求項11】

ロボットの物理運動を検知するように構成されたジャイロスコープと、
情報を含む１つまたは複数の画像信号を生成するように構成されたオプティカルフロー（ＯＦ）センサおよび／またはカメラと、
前記検知された物理運動および前記情報に基づいて、センサ較正パラメータの推定を導出するように構成されたプロセッサと
を備えるシステム。

【請求項12】

前記情報が、前記１つまたは複数の画像信号の各フレームにおいてそれぞれの画像の関数を含む、請求項１１に記載のシステム。

【請求項13】

前記関数が画質および／または画像輝度に関連するものである、請求項１２に記載のシステム。

【請求項14】

前記プロセッサが、前記情報および／またはセンサ較正パラメータの前記推定に基づいて前記ジャイロスコープを較正するようにさらに構成されている、請求項１１に記載のシステム。

【請求項15】

前記プロセッサが、
前記情報と前記検知された物理運動との間の関係を識別するステップと、
前記識別された関係に基づいて、前記ジャイロスコープのスケールパラメータを較正するステップと
によって前記ジャイロスコープを較正するようにさらに構成されている、請求項１４に記載のシステム。

【請求項16】

前記ロボットの前記物理運動が、定位置回転および／または３６０度を超える回転である、請求項１１に記載のシステム。

【請求項17】

前記ロボットの前記物理運動が、任意の表面、または未知の表面パターンを有する表面において検知される、請求項１１に記載のシステム。

【請求項18】

前記１つまたは複数の画質信号が周期信号である、請求項１１に記載のシステム。

【請求項19】

前記プロセッサが、
前記情報に基づいて、表面に対する前記ロボットの角運動を推定して、
前記推定された角運動に基づいて前記ジャイロスコープのスケールを較正する
ようにさらに構成されている、請求項１１に記載のシステム。

【請求項20】

前記プロセッサが、
前記ＯＦセンサおよび／またはカメラにおいて、既知のロボットジオメトリに基づいて角速度を直線速度に関連付けて、
前記ＯＦセンサおよび／またはカメラの変位スケールを計算する
ようにさらに構成されている、請求項１１に記載のシステム。

【国際調査報告】