JP7484915B2 - 移動体制御装置および移動体制御方法 - Google Patents

Description

本開示は、移動体制御装置および移動体制御方法に関する。

従来、自律移動する移動体において、移動体に搭載されたセンサ等によって計測された情報に基づき、自己位置を推定する技術がある。この自己位置を推定する手法として、ジャイロセンサ等の内界センサの情報に基づいて自己位置を推定するデッドレコニング手法が知られている。具体的には、デットレコニング手法では、移動体の移動量であるセンサ値の差分を積分して自己位置を推定する。

ところで、内界センサであるジャイロセンサのセンサ値には、温度変化等の動的な環境変化によって、オフセット値が含まれる場合があり、デットレコニング手法では、このオフセット値の蓄積により自己位置に誤差が生じるおそれがある。これに対して、従来は、移動体の静止状態を判定して、このオフセット値を補正する技術が提案されている（例えば、特許文献１参照）。

国際公開第２０１０／００１９７０号

しかしながら、従来技術は、移動体の静止状態を高精度に判定する点で改善の余地があった。なお、静止状態の判定結果は、オフセット値の補正処理に用いられる場合に限らず、移動体の各種制御処理に用いられるため、静止状態の判定の高精度化は、様々な処理を行う上で重要である。

そこで、本開示では、移動体の静止状態を高精度に判定することができる移動体制御装置および移動体制御方法を提案する。

上記の課題を解決するために、本開示に係る一形態の移動体制御装置は、第１検出部と、第２検出部と、静止判定部とを備える。前記第１検出部は、自律移動する移動体に搭載されたセンサに基づいて、前記移動体の移動状態を検出する。前記第２検出部は、前記移動体の現在地における地図情報、前記移動体の周辺に存在する物体情報および前記移動体が有する可動部の動作情報のうち、少なくとも１つの情報を検出する。前記静止判定部は、前記第１検出部によって検出された前記移動状態および前記第２検出部によって検出された前記情報に基づいて、前記移動体が静止状態であるか否かを判定する。

本開示の実施形態に係る移動体制御方法の概要を示す図である。 実施形態に係る移動体制御装置の構成を示すブロック図である。 禁止地点が登録されたマップ情報を示す図である。 実施形態に係る移動体制御装置が実行する制御処理の手順を示すフローチャートである。

以下に、本開示の実施形態について図面に基づいて詳細に説明する。なお、以下の各実施形態において、同一の部位には同一の符号を付することにより重複する説明を省略する。

また、本明細書及び図面において、実質的に同一の機能構成を有する複数の構成要素を、同一の符号の後に異なる数字を付して区別する場合もある。ただし、実質的に同一の機能構成を有する複数の構成要素の各々を特に区別する必要がない場合、同一符号のみを付する。

＜実施形態に係る移動体の構成＞
まず、図１を用いて、本開示の実施形態に係る移動体制御方法の概要について説明する。図１は、本開示の実施形態に係る移動体制御方法の概要を示す図である。図１では、移動体１００の一例として、地上を車輪で自律走行するロボットを示している。なお、移動体１００は、自律歩行するロボットや、自律飛行するロボット（例えば、ドローン）、自動運転車等であってもよい。また、移動体１００は、例えば、荷物等を運搬する運搬ロボットや、各種の産業用ロボット、家庭で使用されるペットロボット、玩具等の装置であってもよい。

また、図１には、人型を模した双腕の移動体１００を示している。具体的には、図１に示すように、移動体１００は、ベース部１１１と、胴体部１１２と、アーム１１３と、頭部１１４と、を備える。ベース部１１１は、基部であり、移動体１００を移動させる移動機構１１５を備える。移動機構１１５は、移動体１００を移動させる手段であり、車輪または脚等によって構成される。胴体部１１２は、ベース部１１１上に可動可能に支持されている。アーム１１３は、胴体部１１２から延伸し、可動可能に設けられている。頭部１１４は、胴体部１１２の上部に可動可能に設けられている。

頭部１１４には、例えば、人の目に相当する位置に移動体１００の前方を撮像するカメラ１７が設けられる。なお、カメラ１７は、移動体１００の後方や、側方を撮像する位置に設けられてもよい。また、カメラ１７は、頭部１１４以外に、ベース部１１１や、胴体部１１２、アーム１１３等に設けられてもよい。

アーム１１３は、胴体部１１２に複数設けられる。アーム１１３の数は、１本でも、３本以上でもよく、任意である。図１に示す一例では、胴体部１１２の２つの側面に対称的に２本のアーム１１３が設けられる場合を示している。アーム１１３は、例えば７自由度アームである。なお、アーム１１３の先端には、物体を把持することが可能な把持部（例えば、ハンド）等が設けられてもよい。

また、アーム１１３は、複数のリンクが関節部により回動可能に連結されている。例えば、アーム１１３は、複数の関節部１１３ａ１、１１３ａ２と、関節部１１３ａ１によって連結される複数のリンク１１３ｂ１、１１３ｂ２と、から構成される多関節アームである。図１に示す一例では、説明を容易にするため、アーム１１３の構成を簡略化して図示している。実際には、アーム１１３が所望の自由度を有するように、関節部１１３ａ１、１１３ａ２及びリンク１１３ｂ１、１１３ｂ２の形状、数及び配置、並びに関節部１１３ａ１、１１３ａ２の回転軸の方向等が適宜設定され得る。

例えば、関節部１１３ａ１、１１３ａ２には、アクチュエータが設けられている。関節部１１３ａ１、１１３ａ２は、当該アクチュエータの駆動により所定の回転軸まわりに回転可能に構成されている。当該アクチュエータの駆動が移動体制御装置１によって制御されることにより、各関節部１１３ａ１、１１３ａ２の回転角度が制御され、アーム１１３の駆動が制御される。これにより、アーム１１３は、動作及び姿勢（形態）の制御が実現され得る。この際、移動体制御装置１は、力制御又は位置制御等、各種の公知の制御方式によってアーム１１３の駆動を制御することができる。

図１に示す一例では、アーム１１３を可動部として機能させる場合について説明するが、これに限定されない。移動体１００は、例えば、胴体部１１２、アーム１１３および頭部１１４の少なくとも１つを可動部として機能させてもよい。また、可動部は、移動体１００の左右のアーム１１３としてもよいし、左右のいずれか一方のアーム１１３としてもよい。

本実施形態では、移動体１００は、移動体制御装置１をさらに備える。移動体制御装置１は、移動体制御方法を実行する。なお、移動体制御装置１は、移動体１００に内蔵される装置であってもよく、あるいは、移動体１００と通信可能に接続されるサーバ装置であってもよい。

ここで、移動体１００の自己位置の推定方法について説明する。移動体１００の自己位置を推定する場合、大別して、内界センサのセンサ値に基づいて自己位置を推定するデッドレコニング手法と、外界センサのセンサ値に基づいて自己位置を推定するスターレコニング手法とを用いる。

デッドレコニング手法は、加速度センサや、ジャイロセンサ、車輪エンコーダ等の内界センサのセンサ値に基づいて、移動体１００の移動（移動量や移動方向）を演算し、この移動の蓄積によって自己位置を推定する方法である。つまり、デッドレコニング手法とは、移動体１００の相対的な自己位置を推定する方法である。デッドレコニング手法を用いることで、例えば、トンネル内等のように、ＧＰＳ（Global Positioning System）信号やＧＮＳＳ（Global Navigation Satellite System）信号を受信できない、あるいは、受信が不安定になるような環境下であっても、高精度に自己位置を推定することができる。

スターレコニング手法とは、ＧＰＳセンサや、Place Recognition（画像特徴点地図マッチング）、Ｌｉｄａｒ（Laser Imaging Detection and Ranging）、ＴｏＦ（Time of Flight）等の外界センサのセンサ値に基づいて、移動体１００の絶対位置を直接演算する自己位置推定方法である。

なお、デッドレコニング手法およびスターレコニング手法を比較した場合、デッドレコニング手法の方が、自己位置の取得レートが高い。これは、内界センサのセンサ値の取得レートが外界センサのセンサ値の取得レートに比べて高いためである。

ところで、内界センサの１つであるジャイロセンサのセンサ値には、オフセット値が含まれる場合がある。このオフセット値は、例えば、温度変化等の動的な環境変化によって生じる場合がある。

そして、ジャイロセンサにおいて、このオフセット値を含んだセンサ値を用いて、デッドレコニング手法による自己位置推定を行った場合、センサ値の差分を積分することで、オフセット値も蓄積することとなる。そして、オフセット値の蓄積により、自己位置に誤差が生じるおそれがあった。

これに対して、従来は、移動体の静止状態を判定し、静止状態である場合に、オフセット値をリセット（補正）していた。具体的には、従来は、ジャイロセンサを含む他の内界センサを用いて静止状態の判定を行い、オフセット値をリセットしていた。

しかしながら、従来は、静止状態の判定を高精度に行う点で更なる改善の余地があった。具体的には、従来は、内界センサのセンサ値が一定値で安定した場合に静止状態であると判定するため、移動体の周辺の状況によって静止判定の精度が低下するおそれがあった。例えば、従来は、移動体が動く歩道や、エレベータ等に乗っている場合にも静止状態であると判定するおそれがあり、この場合、ジャイロセンサは、動く歩道等の動きに応じたセンサ値で安定することとなる。つまり、移動体が動く歩道等に乗っている場合、誤ったセンサ値を基準にしてオフセット値をリセットするおそれがあった。そして、ジャイロセンサのオフセット値を誤った基準でリセットすることで、ジャイロセンサのゼロ点がずれてしまうため、移動体が所定の角速度で回転しているにも関わらず、静止状態であると誤判定するおそれがあった。なお、静止状態の判定結果は、オフセット値の補正処理に用いられる場合に限らず、移動体の各種制御処理に用いられるため、静止状態の判定の高精度化は、様々な処理を行う上で重要である。

そこで、実施形態に係る移動体制御方法では、内界センサの他に、移動体周辺の情報を加味して静止状態を判定する。

具体的には、図１に示すように、実施形態に係る移動体制御方法では、まず、移動体１００に搭載された各種センサ（車輪エンコーダや、ジャイロセンサ等）に基づいて、移動体１００の移動状態を検出する（移動状態検出処理）。より具体的には、実施形態に係る移動体制御方法では、移動体１００が移動中の状態（移動中状態）であるか停止中の状態（停止状態）であるかを検出する。つまり、移動状態検出処理では、内界センサを用いて停止状態を判定する。

また、実施形態に係る移動体制御方法では、地図情報、物体情報および動作情報を検出する（情報検出処理）。なお、実施形態に係る移動体制御方法では、地図情報、物体情報および動作情報のうち、少なくとも１つの情報を検出できればよい。

地図情報とは、移動体１００の現在地における地図に関する情報である。例えば、地図情報には、静的な情報が含まれる。具体的には、静的な地図情報には、ランドマークの情報等といった建物に関する情報に加え、動く歩道や、ベルトコンベア、エレベータ等の施設が保有する設備に関する情報が含まれる。また、地図情報には、動的な情報が含まれてもよい。具体的には、動的な地図情報には、工事現場や、駐車場に停車中の車両（トラック等）の位置情報等が含まれる。つまり、地図情報には、移動体１００に温度変化が生じるような情報（建物の情報）や、移動体１００の動作とは無関係に移動体１００を動かすような情報（工事現場の揺れ等）が含まれる。

物体情報とは、移動体１００の周辺に存在する物体に関する情報である。具体的には、物体情報には、移動体１００の周辺に存在する人や他のロボット等の移動物体（動的な物体）や、壁や置物等の停止物体（静的な物体）に関する情報が含まれる。また、物体情報は、移動体１００が外力を加え得る物体の情報であればよく、例えば、風（空気）や、雨等の情報であってもよい。

動作情報とは、移動体１００が有する可動部の動作状態に関する情報である。具体的には、動作情報とは、胴体部１１２、アーム１１３および頭部１１４が動作中であるか否かを示す情報である。

そして、実施形態に係る移動体制御方法では、移動状態検出処理で検出した移動状態および情報検出処理で検出した情報に基づいて、移動体１００が静止状態であるか否かを判定する（静止判定処理）。

例えば、実施形態に係る移動体制御方法では、移動状態検出処理により移動体１００が停止状態であることが検出され、かつ、情報検出処理で検出した情報が所定の条件を満たす場合には、移動体１００が静止状態ではないと判定する。なお、所定の条件を満たす場合とは、静止状態と判定すべきではない場合のことであり、例えば、移動体１００に外力を加え得る物体が存在することを示す物体情報が検出された場合や、移動体１００の現在地が後述する禁止地点（動く歩道等）であることを示す地図情報が検出された場合、移動体１００の可動部が動作中であることを示す動作情報が検出された場合である。

具体例を挙げると、実施形態に係る移動体制御方法では、移動体１００に接触したり押したりする可能性がある物体（人や、ロボット等）が存在する場合や、移動体１００が動く歩道に乗っている場合、移動体１００のアーム１１３が動作中である場合等には、静止状態ではないと判定する。

つまり、実施形態に係る移動体制御方法では、たとえ内界センサで移動体１００が停止状態であることが検出されたとしても、静止状態と判定すべきではないことを示す情報（地図情報や、物体情報、動作情報）が検出された場合には、静止状態であると判定しないようにする。

これにより、内界センサが停止状態を示した場合であっても、移動体１００の周辺の影響により移動体１００が動いているような状況下において、静止状態ではないと判定できる。すなわち、実施形態に係る移動体制御方法によれば、移動体１００の静止状態を高精度に判定することができる。

つづいて、実施形態に係る移動体制御方法では、静止判定処理の判定結果に基づいて、ジャイロセンサのオフセット値を補正する（オフセット値補正処理）。例えば、実施形態に係る移動体制御方法では、オフセット値をゼロにする、すなわち、オフセット値をリセットする。あるいは、オフセット値が比較的大きい（所定の閾値以上の）場合、直ちにオフセット値をゼロにせずに、段階的にオフセット値を小さくしてもよい。換言すれば、オフセット値補正処理は、ジャイロセンサのゼロ点を補正する処理であるともいえる。

このように、実施形態に係る移動体制御方法では、静止判定処理を高精度化できることで、ジャイロセンサのオフセット値補正処理を高精度に行うことができる。

なお、図１では、オフセット値補正処理を示したが、オフセット値補正処理に代えて、移動体１００の他の制御処理に静止判定処理の判定結果が用いられてもよい。あるいは、静止判定処理の判定結果をそのまま外部（他の移動体１００や、端末装置等）へ出力してもよい。

次に、図２を用いて、実施形態に係る移動体制御装置１の構成について説明する。図２は、実施形態に係る移動体制御装置１の構成を示すブロック図である。図２に示すように、移動体制御装置１は、可動部エンコーダ１１と、車輪エンコーダ１２と、加速度センサ１３と、ジャイロセンサ１４と、Ｌｉｄａｒ装置１５と、ＴｏＦ装置１６と、カメラ１７と、ＧＰＳ１８と、重量センサ１９とに接続される。

可動部エンコーダ１１は、可動部（胴体部１１２、アーム１１３および頭部１１４）が回転した際の角度の変化量である回転角度を計測するセンサである。

車輪エンコーダ１２は、移動機構１１５における車輪が回転した際の角度の変化量である回転角度を計測するセンサである。

加速度センサ１３は、移動体１００が移動した際の速度の変化量である加速度を計測するセンサである。

ジャイロセンサ１４は、移動体１００の姿勢の変化量である角速度を計測するセンサである。

Ｌｉｄａｒ装置１５は、Ｌｉｄａｒ方式により測距する測距センサであり、移動体１００から周辺の物体までの距離を計測する。

ＴｏＦ装置１６は、ＴｏＦ方式により測距する測距センサであり、移動体１００から周辺の物体までの距離を計測する。

カメラ１７は、ＲＧＢカメラ等のレンズ系、駆動系、及び撮像素子を有し、画像（静止画像又は動画像）を撮像するセンサである。カメラ１７は、例えば、移動体１００の外部を撮像可能に設けられることで、移動体１００の周辺を撮像することができる。

ＧＰＳ１８は、ＧＰＳ衛星からのＧＰＳ信号を受信することで、移動体１００の現在地である緯度、経度及び高度を含む位置情報を測定するセンサである。

重量センサ１９は、移動体１００の重量や、移動体１００に積載された積載物の重量を計測するセンサである。

また、移動体制御装置１は、制御部２と、記憶部３とを備える。制御部２は、第１検出部２１と、第２検出部２２と、積載物検出部２３と、静止判定部２４と、補正部２５と、更新部２６と、移動体制御部２７とを備える。記憶部３は、マップ情報３１を記憶する。

ここで、移動体制御装置１は、たとえば、ＣＰＵ（Central Processing Unit）、ＲＯＭ（Read Only Memory）、ＲＡＭ（Random Access Memory）、データフラッシュ、入出力ポートなどを有するコンピュータや各種の回路を含む。

コンピュータのＣＰＵは、たとえば、ＲＯＭに記憶されたプログラムを読み出して実行することによって、制御部２の第１検出部２１、第２検出部２２、積載物検出部２３、静止判定部２４、補正部２５、更新部２６および移動体制御部２７として機能する。

また、制御部２の第１検出部２１、第２検出部２２、積載物検出部２３、静止判定部２４、補正部２５、更新部２６および移動体制御部２７の少なくともいずれか一つまたは全部をＡＳＩＣ（Application Specific Integrated Circuit）やＦＰＧＡ（Field Programmable Gate Array）等のハードウェアで構成することもできる。

また、記憶部３は、たとえば、ＲＡＭやデータフラッシュに対応する。ＲＡＭやデータフラッシュは、マップ情報３１や、各種プログラムの情報等を記憶することができる。なお、移動体制御装置１は、有線や無線のネットワークで接続された他のコンピュータや可搬型記録媒体を介して上記したプログラムや各種情報を取得することとしてもよい。

マップ情報３１は、地図に関する情報である。マップ情報３１には、地名や、ランドマークの情報等といった施設に関する情報等、および、動く歩道や、ベルトコンベア、エレベータ等の施設が保有する設備に関する情報等の静的な情報が含まれる。また、マップ情報３１には、工事現場や、駐車場に停車中の車両（トラック等）の位置情報等の動的に変化する情報が含まれてもよい。マップ情報３１は、２次元または３次元で表現される電子データであってもよく、あるいは、情報が動的に変化するダイナミックマップであってもよい。

また、マップ情報３１には、後述の静止判定部２４が静止状態であると判定することを禁止する禁止地点が登録されている。ここで、図３を用いて、マップ情報３１に登録された禁止地点について説明する。

図３は、禁止地点が登録されたマップ情報３１を示す図である。図３に示すように、禁止地点の情報には、例えば、「禁止地点ＩＤ」、「位置」、「地点情報」、「期間」および「禁止範囲」等が含まれる。

「禁止地点ＩＤ」は、各禁止地点を識別する識別情報である。「位置」は、登録された禁止地点の位置を示す情報である。なお、図３では、便宜上、位置を「＃１」等で表現しているが、実際には、緯度・経度等で表現される。「地点情報」は、登録された禁止地点に関する情報である。「期間」は、禁止地点として登録される期間の情報である。「禁止範囲」は、禁止地点としての範囲を示す情報である。

図３に示す例において、禁止地点ＩＤ「１」で識別される禁止地点は、位置「＃１」に位置する動く歩道であり、登録される期間は「無し」、つまり、無期限で登録され続けることを示している。また、禁止地点ＩＤ「１」で識別される禁止地点は、動く歩道の入口および出口から３ｍ以内が禁止範囲に設定されている。つまり、後述する静止判定部２４は、移動体１００の現在地が、禁止地点ＩＤ「１」として登録された動く歩道の入口および出口から３ｍ以内に位置している場合には、静止状態の判定処理を禁止する。

また、図３に示す例において、禁止地点ＩＤ「２」で識別される禁止地点は、位置「＃２」で行われている工事現場であり、登録される期間、つまり、工事期間は「２０１９年５月１日～２０１９年６月１日」までであることを示している。また、禁止地点ＩＤ「２」で識別される禁止地点は、工事現場から半径１０ｍ以内が禁止範囲に設定されている。

次に、制御部２の各機能ブロック（第１検出部２１、第２検出部２２、積載物検出部２３、静止判定部２４、補正部２５、更新部２６および移動体制御部２７）について説明する。

第１検出部２１は、移動体１００に搭載されたセンサに基づいて、移動体１００の移動状態を検出する。具体的には、第１検出部２１は、車輪エンコーダ１２、加速度センサ１３およびジャイロセンサ１４等の複数の内界センサのセンサ値を組み合わせたセンサーフュージョンによって移動状態を検出する。

より具体的には、第１検出部２１は、車輪エンコーダ１２、加速度センサ１３およびジャイロセンサ１４それぞれのセンサ値のスカラー量が所定の閾値未満で、かつ、センサ値のばらつきが所定の閾値範囲内である状態が所定期間以上継続している場合に、移動体１００が停止状態（移動中でない状態）であると検出する。なお、センサ値のばらつきは、例えば、標準偏差である。

一方、第１検出部２１は、車輪エンコーダ１２、加速度センサ１３およびジャイロセンサ１４それぞれのセンサ値のスカラー量が所定の閾値以上である場合や、センサ値のばらつきが所定の閾値範囲内である状態の継続時間が所定期間未満である場合には、移動体１００が移動中の状態（停止でない状態）であると検出する。

そして、第１検出部２１は、検出結果を静止判定部２４へ通知する。

第２検出部２２は、移動体１００の現在地における地図情報、移動体１００の周辺に存在する物体情報および移動体１００が有する可動部の動作情報のうち、少なくとも１つの情報を検出する。

例えば、第２検出部２２は、記憶部３に記憶されたマップ情報３１を参照して、ＧＰＳ１８により取得した位置情報に対応する情報を地図情報として検出する。具体的には、第２検出部２２は、マップ情報３１の中から、かかる位置情報に対応する地点の情報を抽出し、地図情報として検出する。例えば、第２検出部２２は、移動体１００の現在地が禁止地点（あるいは、図３に示す禁止範囲）であることを示す地図情報や、移動体１００の現在地が禁止地点以外の地点であることを示す地図情報を検出し、静止判定部２４へ通知する。なお、第２検出部２２は、禁止地点であることを示す地図情報を通知する場合、図３に示す禁止地点に関する情報を併せて通知する。

なお、第２検出部２２は、マップ情報３１から地図情報を抽出する場合に限らず、例えば、Ｌｉｄａｒ装置１５や、ＴｏＦ装置１６およびカメラ１７等の外界センサに基づいて、例えば、移動体１００の周囲が工事現場である等の地図情報を検出してもよい。

また、第２検出部２２は、Ｌｉｄａｒ装置１５や、ＴｏＦ装置１６およびカメラ１７等の外界センサに基づいて物体情報を検出する。物体情報には、物体の種別（移動物体か静止物体かの情報）や、移動物体の場合の種別（車等の乗り物か人かの情報）、移動体１００との相対的な位置情報、相対的な速度情報、物体の大きさ等が含まれる。

また、第２検出部２２は、可動部エンコーダ１１に基づいて動作情報を検出する。具体的には、第２検出部２２は、移動体１００の可動部が動作中であるか停止中であるかを示す動作情報を検出する。

積載物検出部２３は、移動体１００に積載された積載物に関する積載物情報を検出する。例えば、積載物検出部２３は、重量センサ１９のセンサ値に基づいて、積載物の有無や積載物の重量等の情報を含む積載物情報を検出する。また、積載物検出部２３は、例えば、カメラ１７で撮像された画像に基づいて、積載物の種別（液体や固体等）や、積載物の大きさ等の情報を含む積載物情報を検出する。

静止判定部２４は、移動体１００が止まっている状態（静止状態）であるか、動いている状態（動作中状態または移動中状態）であるかを判定する。具体的には、静止判定部２４は、第１検出部２１によって検出された移動状態（移動中状態または停止状態）および第２検出部２２によって検出された情報（地図情報、物体情報および動作情報）に基づいて、移動体１００の静止状態を判定する。

例えば、静止判定部２４は、第１検出部２１によって移動中状態であることが検出された場合、第２検出部２２によって検出された情報の内容に関わらず、移動体１００が静止状態ではないと判定する。換言すれば、静止判定部２４は、移動体１００が移動中状態であると判定する。

また、静止判定部２４は、第１検出部２１によって停止状態あることが検出された場合、第２検出部２２によって検出された情報に基づいて、移動体１００の静止状態を判定する。

具体的には、静止判定部２４は、第１検出部２１によって停止状態あることが検出され、かつ、第２検出部２２によって移動体１００に外力を加え得る物体が存在することを示す物体情報が検出された場合、移動体１００が静止状態ではないと判定する。

これにより、例えば、移動体１００の周囲に存在する人やロボット等の他の移動体１００の外力により、移動体１００が停止中にも関わらず動いてしまうに状況において、静止状態ではないと判定できる。また、移動体１００がドローン等の飛行体である場合に、風等の物体情報を検出することで、ドローンが浮遊状態で停止中にも関わらず風等で揺れてしまう状況において、静止状態ではないと判定できる。すなわち、移動体１００の静止状態を高精度に判定できる。

一方、静止判定部２４は、第１検出部２１によって停止状態あることが検出され、かつ、第２検出部２２によって移動体１００に外力を加え得る物体が存在しないことを示す物体情報が検出された場合、移動体１００が静止状態であると判定する。

また、静止判定部２４は、第１検出部２１によって停止状態あることが検出され、かつ、第２検出部２２によって移動体１００に外力を加え得る地点（例えば、禁止地点）であることを示す地図情報が検出された場合、移動体１００が静止状態ではないと判定する。

より具体的には、静止判定部２４は、第１検出部２１によって停止状態であることが検出され、かつ、マップ情報３１に基づいて第２検出部２２によって移動体１００の現在地が禁止地点であることを示す地図情報が検出された場合、移動体１００が静止状態ではないと判定する。

これにより、例えば、動く歩道で移動体１００が停止中に関わらず移動する場合や、工事現場近くで工事の振動により移動体１００が振動する場合等の状況において、静止状態ではないと判定できる。すなわち、移動体１００の静止状態を高精度に判定できる。

一方、静止判定部２４は、第１検出部２１によって停止状態あることが検出され、かつ、第２検出部２２によって移動体１００に外力を加え得る地点以外の地点であることを示す地図情報が検出された場合、移動体１００が静止状態であると判定する。

例えば、静止判定部２４は、移動体１００の現在地がオフセット値の生じやすい地点である場合には、移動体１００が静止状態であると判定する。具体的には、静止判定部２４は、移動体１００が建物の中に入る場合等の温度変化が生じる可能性が高い地点にいる場合には、移動体１００が静止状態であると判定する。つまり、温度変化によりジャイロセンサ１４にオフセット値が生じる可能性が高い地点にいる場合、静止状態であると判定し、後段の補正部２５にオフセット値を補正させる。なお、オフセット値が生じる可能性が高い地点とは、例えば、建物の扉等といった建物の内部へ入ることができる地点である。なお、このような地点については、予めマップ情報３１に埋め込んでおいてもよく、カメラ１７によって扉を検出してもよい。

また、静止判定部２４は、第１検出部２１によって停止状態あることが検出され、かつ、第２検出部２２によって移動体１００が有する可動部が動作中であることを示す動作情報が検出された場合、移動体１００が静止状態ではないと判定する。

これにより、例えば、移動体１００が停止中にも関わらず可動部の動作に伴う振動が生じてしまう状況において、静止状態ではないと判定できる。すなわち、移動体１００の静止状態を高精度に判定できる。

なお、移動体１００が二足歩行で移動する場合には、可動部によって手すりや壁等を把持しているか否かの情報を含む動作情報を加味して静止状態を判定してもよい。これにより、例えば、二足歩行の移動体１００が、停止中、かつ、可動部が停止中であっても、可動部によって手すりや壁等を把持していなければ、姿勢が不安定で揺れるおそれがあるため、静止状態ではないと判定する。換言すれば、移動体１００が停止中、かつ、可動部が停止中、かつ、可動部によって手すりや壁等を把持している安定状態の場合に限り、静止状態であると判定する。

一方、静止判定部２４は、第１検出部２１によって停止状態あることが検出され、かつ、第２検出部２２によって移動体１００が有する可動部が停止中であることを示す動作情報が検出された場合、移動体１００が静止状態であると判定する。

なお、静止判定部２４は、地図情報、物体情報および動作情報のうち、少なくとも１つの情報に基づいて静止状態の判定をしてもよいが、これら３つの情報すべてに基づいて静止状態の判定を行ってもよい。

つまり、静止判定部２４は、地図情報、物体情報および動作情報それぞれに基づいて静止状態の判定処理を行い、３つの判定処理すべてにおいて静止状態であると判定された場合に限り、最終的に静止状態を確定してもよい。

換言すれば、静止判定部２４は、３つの判定処理のうち、１つでも静止状態ではないと判定した場合、たとえ残り２つの判定処理で静止状態であると判定したとしても、静止状態ではないとの判定結果を確定する。

なお、静止判定部２４は、上記３つの判定処理に基づいて静止状態を確定する場合、例えば、各判定処理の判定結果に重みを付与し、３つの判定処理に重みを付与した演算結果が所定の閾値以上の場合に、静止状態であると確定してもよい。

なお、静止判定部２４は、上記３つの情報（地図情報、物体情報および動作情報）に加えて、積載物検出部２３で検出される積載物情報を加味して静止状態を判定してもよい。

例えば、静止判定部２４は、移動体１００に積載物が有る場合、移動体１００が静止状態ではないと判定する。具体的には、静止判定部２４は、第１検出部２１によって停止状態あることが検出され、かつ、第２検出部２２によって検出された３つの情報それぞれに基づく判定処理で静止状態であると判定された場合であっても、積載物が積載されている場合には、静止状態ではないと判定する。

これにより、例えば、移動体１００が停止しているにも関わらず、積載物である液体が揺れている場合や、積載物である箱の中身が動いている場合等の状況において、静止状態ではないと判定できる。

補正部２５は、静止判定部２４によって移動体１００が静止状態であると判定された場合、ジャイロセンサ１４に含まれるオフセット値を補正する。具体的には、補正部２５は、ジャイロセンサ１４からオフセット値の情報を取得し、ジャイロセンサ１４のセンサ値からオフセット値を差し引くことで、補正（リセット）されたセンサ値である補正センサ値を算出する。そして、補正部２５は、補正センサ値を移動体制御部２７へ出力する。

なお、補正部２５は、センサ値からオフセット値を差し引いて補正センサ値を算出したが、例えば、オフセット値が所定の閾値以上である場合、センサ値から段階的に（静止判定部２４の判定処理毎に）所定の値（例えば、オフセット値の半値）を差し引いて補正センサ値を段階的に算出し、複数回の判定処理後に最終的にセンサ値からオフセット値が差し引かれた補正センサ値を算出してもよい。つまり、補正部２５は、センサ値のオフセット値を徐々に補正してもよい。

これにより、オフセット値が比較的大きい場合に、センサ値からオフセット値を一度にすべて差し引くことで、ジャイロセンサ１４の角速度が急激に変化することを防止できる。

また、補正部２５によるオフセット値の補正は、移動体１００の周囲における温度変化を加味して行ってもよい。

例えば、補正部２５は、静止判定部２４によって移動体１００が静止状態であると判定され、かつ、移動体１００の周囲で所定時間内において所定の閾値以上の温度変化があった場合、オフセット値を補正する。つまり、補正部２５は、短時間で急減な温度変化（温度上昇もしくは温度低下）があった場合に、オフセット値を補正する。これにより、急な温度変化でオフセット値が生じ、ジャイロセンサ１４のゼロ点が急に変化した場合であっても、即座にオフセット値を補正することができる。

なお、移動体１００の周囲で上記の急な温度変化があった場合、移動体１００の内部、すなわち、ジャイロセンサ１４の搭載位置で温度変化が生じるまでに時間差がある。つまり、移動体１００の周囲で急な温度変化があったとしても、オフセット値が生じるまで時間差がある。このため、補正部２５は、かかる時間差を考慮したタイミングでオフセット値を補正してもよい。

具体的には、補正部２５は、上記の温度変化があったタイミングから所定期間経過後に、オフセット値を補正する。なお、所定期間は、例えば、移動体１００の管理者によって予め決定された固定値でもよく、あるいは、温度変化の内容（変化に要した時間、変化前後の温度差）に基づいて可変にしてもよい。

更新部２６は、記憶部３に記憶されたマップ情報３１を更新する更新処理を行う。具体的には、更新部２６は、第２検出部２２によって禁止地点以外の地点であることが検出され、かつ、地図情報に基づいて静止判定部２４により静止状態ではないと判定された場合、かかる地点を禁止地点としてマップ情報３１に登録する更新処理を行う。

なお、更新部２６は、例えば、外部サーバや他の移動体１００と通信し、通信により得られた情報に基づいてマップ情報３１を更新してもよい。これにより、移動体１００が初めて通る場所であっても、上記の静止判定部２４が静止状態の判定を高精度に行うことができる。

移動体制御部２７は、各種センサに基づいて移動体１００の自律移動を制御する。また、移動体制御部２７は、ジャイロセンサ１４について、補正部２５で補正されたセンサ値である補正センサ値に基づいて移動体１００を制御する。

次に、図４を用いて、実施形態に係る移動体制御装置１が実行するオフセット値の補正処理の手順について説明する。図４は、実施形態に係る移動体制御装置１が実行する補正処理の手順を示すフローチャートである。なお、オフセット値自体は頻繁に変化するものではないため、以下に示す補正処理は、例えば、数秒毎の間隔に行えば足りる。

図４に示すように、制御部２は、各センサ（可動部エンコーダ１１、車輪エンコーダ１２、加速度センサ１３、ジャイロセンサ１４、Ｌｉｄａｒ装置１５、ＴｏＦ装置１６、カメラ１７、ＧＰＳ１８および重量センサ１９）のセンサ値を読み取る（ステップＳ１０１）。

つづいて、第１検出部２１は、車輪エンコーダ１２および加速度センサ１３のセンサ値に基づいて、移動体１００の移動状態を検出する（ステップＳ１０２）。

つづいて、第２検出部２２は、地図情報、物体情報および動作情報を検出する（ステップＳ１０３）。

つづいて、静止判定部２４は、ジャイロセンサ１４のセンサ値が一定以下であるか否かを判定する（ステップＳ１０４）。具体的には、静止判定部２４は、角速度のスカラー量や、ばらつきが所定の閾値以下であるか否かを判定する。

静止判定部２４は、ジャイロセンサ１４のセンサ値が一定以下であると判定した場合（ステップＳ１０４：Ｙｅｓ）、第１検出部２１によって検出された移動状態が停止状態であるか否かを判定する（ステップＳ１０５）。

静止判定部２４は、第１検出部２１によって検出された移動状態が停止状態である場合（ステップＳ１０５：Ｙｅｓ）、移動体１００の現在地が禁止地点以外の地点であるか否かを判定する（ステップＳ１０６）。

静止判定部２４は、移動体１００の現在地が禁止地点以外の地点である場合（ステップＳ１０６：Ｙｅｓ）、移動体１００の周囲に外力を加え得る物体の有無を判定する（ステップＳ１０７）。

静止判定部２４は、移動体１００の周囲に外力を加え得る物体が存在しない場合（ステップＳ１０７：Ｙｅｓ）、移動体１００の可動部が停止中であるか否かを判定する（ステップＳ１０８）。

静止判定部２４は、移動体１００の可動部が停止中である場合（ステップＳ１０８：Ｙｅｓ）、移動体１００が静止状態であると判定する（ステップＳ１０９）。

つづいて、補正部２５は、静止判定部２４が静止状態であると判定した場合、ジャイロセンサ１４のオフセット値を補正し（ステップＳ１１０）、処理を終了する。

一方、ステップＳ１０４において、静止判定部２４は、ジャイロセンサ１４のセンサ値が一定以下ではないと判定した場合（ステップＳ１０４：Ｎｏ）、移動体１００が静止状態ではないと判定し（ステップＳ１１１）、処理を終了する。

また、ステップＳ１０５において、静止判定部２４は、第１検出部２１によって検出された移動状態が停止状態でない場合（ステップＳ１０５：Ｎｏ）、ステップＳ１１１を実行し、処理を終了する。

また、ステップＳ１０６において、静止判定部２４は、移動体１００の現在地が禁止地点である場合（ステップＳ１０６：Ｎｏ）、ステップＳ１１１を実行し、処理を終了する。

また、ステップＳ１０７において、静止判定部２４は、移動体１００の周囲に外力を加え得る物体が存在する場合（ステップＳ１０７：Ｎｏ）、ステップＳ１１１を実行し、処理を終了する。

また、ステップＳ１０８において、静止判定部２４は、移動体１００の可動部が動作中である場合（ステップＳ１０８：Ｎｏ）、ステップＳ１１１を実行し、処理を終了する。

なお、図４において、ステップＳ１０４～ステップＳ１０８の判定処理の処理順序は、一例であって、ステップＳ１０４～ステップＳ１０８の処理順序が任意に入れ替わってもよい。

また、上記実施形態において説明した各処理のうち、自動的に行われるものとして説明した処理の全部又は一部を手動的に行うこともでき、あるいは、手動的に行われるものとして説明した処理の全部又は一部を公知の方法で自動的に行うこともできる。この他、上記文書中や図面中で示した処理手順、具体的名称、各種のデータやパラメータを含む情報については、特記する場合を除いて任意に変更することができる。例えば、各図に示した各種情報は、図示した情報に限られない。

また、図示した各装置の各構成要素は機能概念的なものであり、必ずしも物理的に図示の如く構成されていることを要しない。すなわち、各装置の分散・統合の具体的形態は図示のものに限られず、その全部又は一部を、各種の負荷や使用状況などに応じて、任意の単位で機能的又は物理的に分散・統合して構成することができる。

また、上述の実施形態は、処理内容を矛盾させない領域で適宜組み合わせることが可能である。また、上述の実施形態のフローチャート及びシーケンス図に示された各ステップは、適宜順序を変更することが可能である。

＜まとめ＞
以上説明したように、本開示の一実施形態によれば、移動体制御装置１は、第１検出部２１と、第２検出部２２と、静止判定部２４とを備える。第１検出部２１は、自律移動する移動体１００に搭載されたセンサに基づいて、移動体１００の移動状態を検出する。第２検出部２２は、移動体１００の現在地における地図情報、移動体１００の周辺に存在する物体情報および移動体１００が有する可動部の動作情報のうち、少なくとも１つの情報を検出する。静止判定部２４は、第１検出部２１によって検出された移動状態および第２検出部２２によって検出された情報に基づいて、移動体１００が静止状態であるか否かを判定する。

これにより、例えば、内界センサが停止状態を示した場合であっても、移動体１００の周辺の影響により移動体１００が動いているような状況下において、静止状態ではないと判定できるため、移動体１００の静止状態を高精度に判定することができる。

また、実施形態に係る静止判定部２４は、第１検出部２１によって移動体１００が停止状態であることが検出され、かつ、第２検出部２２によって移動体１００に外力を加え得る物体が存在することを示す物体情報が検出された場合、移動体１００が静止状態ではないと判定する。

これにより、移動体１００の周囲に存在する物体が移動体１００に外力を加えた場合に、静止状態ではないと判定できるため、静止状態を高精度に判定することができる。

また、実施形態に係る静止判定部２４は、第１検出部２１によって移動体１００が停止状態であることが検出され、かつ、第２検出部２２によって移動体１００に外力を加え得る地点であることを示す地図情報が検出された場合、移動体１００が静止状態ではないと判定する。

これにより、例えば、移動体１００が動く歩道に乗っている場合や、地面が振動するような工事現場の近くにいる場合等に、静止状態ではないと判定できるため、静止状態を高精度に判定することができる。

また、実施形態に係る移動体制御装置１は、記憶部３を備える。記憶部３は、静止状態であると判定することを禁止する禁止地点が登録されたマップ情報３１を記憶する。静止判定部２４は、第１検出部２１によって移動体１００が停止状態であることが検出され、かつ、マップ情報３１に基づいて第２検出部２２によって移動体１００の現在地が禁止地点であることを示す地図情報が検出された場合、移動体１００が静止状態ではないと判定する。

これにより、予めマップ情報３１に登録された禁止地点に基づいて静止状態を判定できるため、低負荷かつ高精度に静止状態を判定することができる。

また、実施形態に係る移動体制御装置１は、更新部２６をさらに備える。更新部２６は、第２検出部２２によって禁止地点以外の地点であることを示す地図情報が検出され、かつ、地図情報に基づいて静止判定部２４により静止状態ではないと判定された場合、当該地点を禁止地点としてマップ情報３１に登録する更新処理を行う。

これにより、工事現場等の一時的に禁止地点になっている場合や、新しい建物が建設された場合等に、新しいマップ情報３１に更新されることで、静止状態を高精度に判定することができる。

また、静止判定部２４は、第１検出部２１によって移動体１００が停止状態であることが検出され、かつ、第２検出部２２によって移動体１００が有する可動部が動作中であることを示す動作情報が検出された場合、移動体１００が静止状態ではないと判定する。

これにより、移動体１００が停止状態であることが検出され、かつ、第２検出部２２によって移動体１００が有する可動部が動作中である状況において、静止状態を高精度に判定することができる。

また、実施形態に係る移動体制御装置１は、補正部２５をさらに備える。補正部２５は、静止判定部２４によって移動体１００が静止状態であると判定された場合、ジャイロセンサ１４に含まれるオフセット値を補正する。

これにより、オフセット値を高精度に補正することができる。

また、補正部２５は、静止判定部２４によって移動体１００が静止状態であると判定され、かつ、移動体１００周辺で所定時間内において所定の閾値以上の温度変化があった場合、オフセット値を補正する。

これにより、温度変化によって生じるオフセット値を確実に補正することができる。

また、補正部２５は、温度変化があったタイミングから所定期間経過後に、オフセット値を補正する。

これにより、移動体１００の内蔵されたジャイロセンサ１４に温度変化が起きてオフセット値が生じる場合に、適切なタイミングでオフセット値を補正することができる。

また、実施形態に係る移動体制御装置１は、積載物検出部２３をさらに備える。積載物検出部２３は、移動体１００の積載物に関する積載物情報を検出する。静止判定部２４は、移動体１００に積載物が有る場合、移動体１００が静止状態ではないと判定する。

これにより、例えば、移動体１００が停止しているにも関わらず、積載物である液体が揺れている場合や、積載物である箱の中身が動いている場合等の状況において、静止状態を高精度に判定できる。

以上、本開示の各実施形態について説明したが、本開示の技術的範囲は、上述の各実施形態そのままに限定されるものではなく、本開示の要旨を逸脱しない範囲において種々の変更が可能である。また、異なる実施形態及び変形例にわたる構成要素を適宜組み合わせてもよい。

また、本明細書に記載された各実施形態における効果はあくまで例示であって限定されるものでは無く、他の効果があってもよい。

なお、本技術は以下のような構成も取ることができる。
（１）
自律移動する移動体に搭載されたセンサに基づいて、前記移動体の移動状態を検出する第１検出部と、
前記移動体の現在地における地図情報、前記移動体の周辺に存在する物体情報および前記移動体が有する可動部の動作情報のうち、少なくとも１つの情報を検出する第２検出部と、
前記第１検出部によって検出された前記移動状態および前記第２検出部によって検出された前記情報に基づいて、前記移動体が静止状態であるか否かを判定する静止判定部と
を備える移動体制御装置。
（２）
前記静止判定部は、
第１検出部によって前記移動体が停止状態であることが検出され、かつ、前記第２検出部によって前記移動体に外力を加え得る物体が存在することを示す前記物体情報が検出された場合、前記移動体が静止状態ではないと判定すること
前記（１）に記載の移動体制御装置。
（３）
前記静止判定部は、
第１検出部によって前記移動体が停止状態であることが検出され、かつ、前記第２検出部によって前記移動体に外力を加え得る地点であることを示す前記地図情報が検出された場合、前記移動体が静止状態ではないと判定すること
前記（１）または（２）に記載の移動体制御装置。
（４）
前記静止状態であると判定することを禁止する禁止地点が登録されたマップ情報を記憶する記憶部をさらに備え、
前記静止判定部は、
第１検出部によって前記移動体が停止状態であることが検出され、かつ、前記マップ情報に基づいて前記第２検出部によって前記移動体の現在地が前記禁止地点であることを示す前記地図情報が検出された場合、前記移動体が静止状態ではないと判定すること
前記（１）～（３）のいずれかに記載の移動体制御装置。
（５）
前記第２検出部によって前記禁止地点以外の地点であることを示す前記地図情報が検出され、かつ、当該地図情報に基づいて前記静止判定部により前記静止状態ではないと判定された場合、当該地点を前記禁止地点として前記マップ情報に登録する更新処理を行う更新部をさらに備えること
前記（４）に記載の移動体制御装置。
（６）
前記静止判定部は、
第１検出部によって前記移動体が停止状態であることが検出され、かつ、前記第２検出部によって前記移動体が有する可動部が動作中であることを示す前記動作情報が検出された場合、前記移動体が静止状態ではないと判定すること
前記（１）～（５）のいずれかに記載の移動体制御装置。
（７）
前記センサは、ジャイロセンサを含み、
前記静止判定部によって前記移動体が静止状態であると判定された場合、前記ジャイロセンサに含まれるオフセット値を補正する補正部をさらに備えること
前記（１）～（６）のいずれかに記載の移動体制御装置。
（８）
前記補正部は、
前記静止判定部によって前記移動体が静止状態であると判定され、かつ、前記移動体周辺で所定時間内において所定の閾値以上の温度変化があった場合、前記オフセット値を補正すること
前記（７）に記載の移動体制御装置。
（９）
前記補正部は、
前記温度変化があったタイミングから所定期間経過後に、前記オフセット値を補正すること
前記（８）に記載の移動体制御装置。
（１０）
前記移動体の積載物に関する積載物情報を検出する積載物検出部をさらに備え、
前記静止判定部は、
前記移動体に積載物が有る場合、前記移動体が静止状態ではないと判定すること
前記（１）～（９）のいずれかに記載の移動体制御装置。
（１１）
自律移動する移動体に搭載されたセンサに基づいて、前記移動体の移動状態を検出する第１検出工程と、
前記移動体の現在地における地図情報、前記移動体の周辺に存在する物体情報および前記移動体が有する可動部の動作情報のうち、少なくとも１つの情報を検出する第２検出工程と、
前記第１検出工程によって検出された前記移動状態および前記第２検出工程によって検出された前記情報に基づいて、前記移動体が静止状態であるか否かを判定する静止判定工程と
を含む移動体制御方法。

１ 移動体制御装置
２ 制御部
３ 記憶部
１１ 可動部エンコーダ
１２ 車輪エンコーダ
１３ 加速度センサ
１４ ジャイロセンサ
１５ Ｌｉｄａｒ装置
１６ ＴｏＦ装置
１７ カメラ
１８ ＧＰＳ
１９ 重量センサ
２１ 第１検出部
２２ 第２検出部
２３ 積載物検出部
２４ 静止判定部
２５ 補正部
２６ 更新部
２７ 移動体制御部
３１ マップ情報
１００ 移動体

Claims (9)

1. ジャイロセンサを少なくとも含む、自律移動する移動体に搭載されたセンサに基づいて、前記移動体の移動状態を検出する第１検出部と、
   前記移動体の周辺に存在する物体情報を検出する第２検出部と、
   前記第１検出部によって検出された前記移動状態および前記第２検出部によって検出された前記物体情報に基づいて、前記移動体が静止状態であるか否かを判定する静止判定部と、
   前記静止判定部によって前記移動体が静止状態であると判定された場合、前記ジャイロセンサに含まれるオフセット値を補正する補正部と、
   を備え、
   前記静止判定部は、
   前記第１検出部によって前記移動体が停止状態であることが検出され、かつ、前記第２検出部によって前記移動体に外力を加え得る物体が存在することを示す前記物体情報が検出された場合、前記移動体が静止状態ではないと判定する、
   移動体制御装置。
2. 前記第２検出部は、前記移動体の現在地における地図情報を検出することができ、
   前記静止判定部は、前記第２検出部によって検出された前記地図情報に基づいて、前記移動体が静止状態であるか否かを判定し、
   前記第１検出部によって前記移動体が停止状態であることが検出され、かつ、前記第２検出部によって前記移動体に外力を加え得る地点であることを示す前記地図情報が検出された場合、前記移動体が静止状態ではないと判定する、
   請求項１に記載の移動体制御装置。
3. 前記第２検出部は、前記移動体の現在地における地図情報を検出することができ、
   前記静止判定部は、前記第２検出部によって検出された前記地図情報に基づいて、前記移動体が静止状態であるか否かを判定し、
   前記静止状態であると判定することを禁止する禁止地点が登録されたマップ情報を記憶する記憶部をさらに備え、
   前記静止判定部は、
   前記第１検出部によって前記移動体が停止状態であることが検出され、かつ、前記マップ情報に基づいて前記第２検出部によって前記移動体の現在地が前記禁止地点であることを示す前記地図情報が検出された場合、前記移動体が静止状態ではないと判定する、
   請求項１又は２に記載の移動体制御装置。
4. 前記第２検出部によって前記禁止地点以外の地点であることを示す前記地図情報が検出され、かつ、当該地図情報に基づいて前記静止判定部により前記静止状態ではないと判定された場合、当該地点を前記禁止地点として前記マップ情報に登録する更新処理を行う更新部をさらに備える、
   請求項３に記載の移動体制御装置。
5. 前記第２検出部は、前記移動体が有する可動部の動作情報を検出することができ、
   前記静止判定部は、前記第２検出部によって検出された前記動作情報に基づいて、前記移動体が静止状態であるか否かを判定し、
   前記静止判定部は、
   前記第１検出部によって前記移動体が停止状態であることが検出され、かつ、前記第２検出部によって前記移動体が有する可動部が動作中であることを示す前記動作情報が検出された場合、前記移動体が静止状態ではないと判定する、
   請求項１～４のいずれか１項に記載の移動体制御装置。
6. 前記補正部は、
   前記静止判定部によって前記移動体が静止状態であると判定され、かつ、前記移動体の周辺で所定時間内において所定の閾値以上の温度変化があった場合、前記オフセット値を補正する、
   請求項１～５のいずれか１項に記載の移動体制御装置。
7. 前記補正部は、
   前記温度変化があったタイミングから所定期間経過後に、前記オフセット値を補正する
   請求項６に記載の移動体制御装置。
8. 前記移動体の積載物に関する積載物情報を検出する積載物検出部をさらに備え、
   前記静止判定部は、
   前記移動体に積載物が有り、且つ、当該積載物が移動している場合、前記移動体が静止状態ではないと判定する、
   請求項１～７のいずれか１項に記載の移動体制御装置。
9. ジャイロセンサを少なくとも含む、自律移動する移動体に搭載されたセンサに基づいて、前記移動体の移動状態を検出する第１検出工程と、
   前記移動体の周辺に存在する物体情報を検出する第２検出工程と、
   前記第１検出工程によって検出された前記移動状態および前記第２検出工程によって検出された前記物体情報に基づいて、前記移動体が静止状態であるか否かを判定する静止判定工程と、
   前記静止判定工程において前記移動体が静止状態であると判定された場合、前記ジャイロセンサに含まれるオフセット値を補正する補正工程と、
   を含み、
   前記静止判定工程においては、
   前記第１検出工程において前記移動体が停止状態であることが検出され、かつ、前記第２検出工程において前記移動体に外力を加え得る物体が存在することを示す前記物体情報が検出された場合、前記移動体が静止状態ではないと判定する、
   移動体制御方法。

Images