(19)【発行国】日本国特許庁(JP)
(12)【公報種別】特許公報(B2)
(11)【特許番号】
(24)【登録日】2024-04-03
(45)【発行日】2024-04-11
(54)【発明の名称】自律移動ロボット及びその安定化方法
(51)【国際特許分類】
G05D 1/617 20240101AFI20240404BHJP
G05D 1/43 20240101ALI20240404BHJP
【ＦＩ】
G05D1/617
G05D1/43
【請求項の数】
11
(21)【出願番号】P 2022149539
(22)【出願日】2022-09-20
(65)【公開番号】P2023140262
(43)【公開日】2023-10-04
【審査請求日】2022-09-20
(31)【優先権主張番号】202210284402.3
(32)【優先日】2022-03-22
(33)【優先権主張国・地域又は機関】CN
(73)【特許権者】
【識別番号】502330713
【氏名又は名称】台達電子工業股▲ふん▼有限公司
【氏名又は名称原語表記】ＤＥＬＴＡ ＥＬＥＣＴＲＯＮＩＣＳ， ＩＮＣ．
【住所又は居所原語表記】Ｎｏ．２５２，ＳｈａｎＹｉｎｇ Ｒｄ．，Ｇｕｉｓｈａｎ Ｄｉｓｔ．，Ｔａｏｙｕａｎ Ｃｉｔｙ ３３３，Ｔａｉｗａｎ
(74)【代理人】
【識別番号】110001519
【氏名又は名称】弁理士法人太陽国際特許事務所
(72)【発明者】
【氏名】黄正豪
(72)【発明者】
【氏名】黄柏喬
(72)【発明者】
【氏名】林漢卿
(72)【発明者】
【氏名】王錫裕
【審査官】尾形 元
(56)【参考文献】
【文献】特開平５－４１７７（ＪＰ，Ａ）
【文献】特開２０１９－１１７４３１（ＪＰ，Ａ）
【文献】特開２０１７－７０６６（ＪＰ，Ａ）
【文献】特開２０１６－４９６１６（ＪＰ，Ａ）
【文献】特開２００６－１２３８５４（ＪＰ，Ａ）
(58)【調査した分野】(Int.Cl.，ＤＢ名)
Ｇ０５Ｄ １／００－ １／８７
(57)【特許請求の範囲】
【請求項1】
所定の経路方向に沿って前進する自律移動ロボットであって、
移動機構が配置されたシャーシを有する車体と、
前記車体に配置され、前記車体の圧力分布状態を検出して前記車体の重心位置を取得する平面圧力センサと、
前記車体に配置された可動部と、
前記移動機構と、前記平面圧力センサと、前記可動部とに接続され、前記重心位置が前記車体の安定領域から外れると、前記安定領域に対する前記重心位置の重心オフセット方向に反力を加えて前記重心位置を前記安定領域に戻す重心補償運動を行うように前記移動機構を前記重心オフセット方向へ移動制御するコントローラと、を含み、
前記コントローラは、前記重心オフセット方向が前記所定の経路方向と一致しない場合、前記移動機構を前記重心オフセット方向に向けて移動させて前記反力を加え、前記重心位置が前記安定領域に戻った後に再び前記所定の経路方向に向けて前進するように前記移動機構を制御するように構成されている、
自律移動ロボット。
【請求項2】
前記重心補償運動は、姿勢調整プロセスによって前記可動部を制御することであり、前記姿勢調整プロセスは、前記可動部の重心を前記重心オフセット方向とは逆方向に移動させるように、前記可動部の位置及び姿勢を調整する、
請求項１に記載の自律移動ロボット。
【請求項3】
前記可動部が前記姿勢調整プロセスを行う際に、まず前記車体上の負荷を掴んでから、前記位置及び前記姿勢の調整を行う、請求項２に記載の自律移動ロボット。
【請求項4】
前記車体の一方側に負荷を載置するための荷重領域を有し、前記重心補償運動は、前記重心オフセット方向とは逆方向に前記負荷を移動させるように前記可動部を制御することである、
請求項２に記載の自律移動ロボット。
【請求項5】
前記重心補償運動は、前記可動部によって前記負荷を移動し続けることであり、前記コントローラは、前記重心位置が前記安定領域に戻ったと判断すると、前記可動部を制御してその他の負荷を移動することを停止するように構成されている、
請求項４に記載の自律移動ロボット。
【請求項6】
前記コントローラは、前記重心位置が前記安定領域外の補償領域の内側にあるか外側にあるかで、前記可動部を制御して前記負荷を移動させる際に前記移動機構が動くか止まるかを決定するように構成されている、請求項５に記載の自律移動ロボット。
【請求項7】
平面圧力センサと移動機構が配置されたシャーシとを備える車体を有し、所定の経路方向に沿って前進する自律移動ロボットに適用される安定化方法であって、前記平面圧力センサにより前記車体の圧力分布状態を検出するステップａと、
前記圧力分布状態に基づいて前記車体の重心位置を算出するステップｂと、
前記重心位置が前記車体の中心位置に近接する安定領域から外れたと判断した場合には、前記安定領域に対する前記重心位置の重心オフセット方向に反力を加える重心補償運動を実行するように、前記移動機構を前記重心オフセット方向へ移動させ、前記重心オフセット方向が前記所定の経路方向と一致しない場合には、前記移動機構を前記重心オフセット方向に向けて移動させて前記反力を加え、前記重心位置が前記安定領域に戻った後に再び前記所定の経路方向に向けて前進するように前記移動機構を制御するステップｃと、を含む、
自律移動ロボットの安定化方法。
【請求項8】
前記車体には、可動部が配置され、前記ステップｃは、前記可動部の重心を前記重心オフセット方向とは逆方向に移動させるために、前記可動部の位置及び姿勢を調整する姿勢調整プロセスを行うように前記可動部を制御することを含む、
請求項７に記載の自律移動ロボットの安定化方法。
【請求項9】
前記車体の一方側に負荷を載置するための荷重領域を有し、前記ステップｃは、前記可動部を前記重心オフセット方向とは逆方向に前記負荷を移動させるように制御することを含む、
請求項８に記載の自律移動ロボットの安定化方法。
【請求項10】
前記重心位置が前記安定領域に収まると判断すると、振動を抑制するように前記可動部を制御するステップｄをさらに含む、請求項８に記載の自律移動ロボットの安定化方法。
【請求項11】
平面圧力センサと可動部とを備える車体を有する自律移動ロボットに適用される安定化方法であって、前記平面圧力センサにより車体の圧力分布状態を検出するステップａと、
前記圧力分布状態に基づいて前記車体の重心位置を算出するステップｂと、
前記重心位置が前記車体の中心位置に近接する安定領域に収まるのか、前記車体の周縁位置に近接する補償領域に収まるのかを判断するステップｃと、
前記重心位置が前記補償領域に収まると判断した場合には、前記車体に移動可能な負荷が載置されているか否かを判断するステップｄと、
前記負荷が存在しない又は移動できない場合には、前記可動部の重心を前記安定領域に対する前記重心位置の重心オフセット方向とは逆方向へ移動させるように前記可動部を制御するステップｅと、
前記負荷が移動可能な場合には、前記圧力分布状態に基づいて前記負荷の分布状態を確認するステップｆと、
前記ステップｆの後、前記負荷を前記逆方向に移動させるように前記可動部を制御するステップｇと、を含む、
自律移動ロボットの安定化方法。
【発明の詳細な説明】
【技術分野】
【0001】
本発明は、自律移動ロボットに関し、特に、自律移動ロボット及びその運動安定化方法に関する。
【背景技術】
【0002】
近年、モバイルロボット（Ｍｏｂｉｌｅ Ｒｏｂｏｔ）の需要が増加しつつあり、無人搬送車（Ａｕｔｏｎｏｍｏｕｓ Ｇｕｉｄｅｄ Ｖｅｈｉｃｌｅ、ＡＧＶ）や自律移動ロボット（Ａｕｔｏｎｏｍｏｕｓ Ｍｏｂｉｌｅ Ｒｏｂｏｔ、ＡＭＲ）など、様々なモバイルロボットが一般大衆の生活環境に普及しつつある。
【0003】
移動時に重心がシャーシの支持範囲を超えて転倒することを回避するために、製造業者はモバイルロボットのシャーシを重くしたり、シャーシのカウンタウェイトを均等にしたりすることが多い。これにより、モバイルロボット全体の重心ができるだけ車体の中心位置に収まるようにする。
【0004】
しかしながら、上記の方法では、モバイルロボット全体としてかさばる傾向がある。また、モバイルロボットに載置される負荷が増加して重心位置が高くなると、モバイルロボットが急発進やブレーキをかける際に負荷が振動しやすくなる。このように、モバイルロボット自体も負荷の揺れ状態を確保できずに転倒してしまうことがある。
【0005】
そのため、当該技術分野では、モバイルロボットの転倒を回避するために、モバイルロボットの重心位置を動的に調整できる有効なメカニズムが必要とされている。
【発明の概要】
【発明が解決しようとする課題】
【0006】
本発明の主な目的は、自律移動ロボットの動作時の慣性及び重心の変化を監視し、重心位置を動的に補償できる自律移動ロボット及びその安定化方法を提供することである。
【課題を解決するための手段】
【0007】
上記目的を達成するために、本発明に係る自律移動ロボットは、移動機構が配置されたシャーシを有する車体と、前記車体に配置され、前記車体の圧力分布状態を検出して前記車体の重心位置を取得する平面圧力センサと、前記車体に配置された可動部と、前記移動機構と、前記平面圧力センサと、前記可動部とに接続され、前記重心位置が前記車体の安定領域から外れると、可動部前記安定領域に対する前記重心位置の重心オフセット方向に反力を加えて前記重心位置を前記安定領域に戻す重心補償運動を行うように前記移動機構又は前記可動部を制御するコントローラと、を含む。
【0008】
上記目的を達成するために、本発明に係る自律移動ロボットの安定方法は、平面圧力センサを備える車体を有する自律移動ロボットに適用され、前記平面圧力センサにより前記車体の圧力分布状態を検出するステップａと、前記圧力分布状態に基づいて前記車体の重心位置を算出するステップｂと、前記重心位置が前記車体の中心位置に近接する安定領域から外れたと判断した場合には、前記安定領域に対する前記重心位置の重心オフセット方向に反力を加える重心補償運動を実行するステップｃと、を含む。
【0009】
上記目的を達成するために、本発明に係る自律移動ロボットの安定化方法は、平面圧力センサと可動部とを備える車体を有する自律移動ロボットに適用され、前記平面圧力センサにより車体の圧力分布状態を検出するステップａと、前記圧力分布状態に基づいて前記車体の重心位置を算出するステップｂと、前記重心位置が前記車体の中心位置に近接する安定領域に収まるのか、前記車体の周縁位置に近接する補償領域に収まるのかを判断するステップｃと、前記重心位置が前記補償領域に収まると判断した場合には、前記車体に移動可能な負荷が載置されているか否かを判断するステップｄと、前記負荷が存在しない又は移動できない場合には、前記可動部の重心を前記安定領域に対する前記重心位置の重心オフセット方向とは逆方向へ移動させるように前記可動部を制御するステップｅと、前記負荷が移動可能な場合には、前記圧力分布状態に基づいて前記負荷の分布状態を確認するステップｆと、前記ステップｆの後、前記負荷を前記逆方向に移動させるように前記可動部を制御するステップｇと、を含む。
【発明の効果】
【0010】
本発明は、自律移動ロボットを監視制御することにより、車体が転倒しにくいように重心位置を動的に補償することができる。これにより、製造業者は、自律移動ロボットのシャーシを重くする必要がなく、自律移動ロボットを軽量化設計に適用することができる。また、重心位置を動的に調整することにより、自律移動ロボットの負荷が増加したり、重心が高くなったり、負荷が揺れ動いたりした場合に、自律移動ロボットが転倒することを防止することもできる。
【図面の簡単な説明】
【0011】
【図1】本発明に係る自律移動ロボットの第１具体的な実施例を示す概略図である。
【図2】本発明に係る自律移動ロボットの第１具体的な実施例を示すブロック図である。
【図3】本発明に係る自律移動ロボットの重心の第１具体的な実施例を示す概略図である。
【図4】本発明に係る安定方法の第１具体的な実施例を示すフローチャートである。
【図5】本発明に係る安定方法の第２具体的な実施例を示すフローチャートである。
【図6】本発明に係る重心補償運動の第１具体的な実施例を説明するための概略図である。
【図7】本発明に係る重心補償運動の第２具体的な実施例を説明するための概略図である。
【図8A】本発明に係る重心補償運動の第３具体的な実施例の重心補償運動前を説明するための概略図である。
【図8B】本発明に係る重心補償運動の第３具体的な実施例の重心補償運動後を説明するための概略図である。
【図9】本発明に係る自律移動ロボットの第２具体的な実施例を示す概略図である。
【図10】本発明に係る自律移動ロボットの第３の具体的な実施例を示す概略図である。
【発明を実施するための形態】
【0012】
本発明の好ましい実施例については、図面を参照しながら以下に説明する。
【0013】
図１は、本発明に係る自律移動ロボットの第１具体的な実施例を示す概略図である。図１に示すように、本発明に係る自律移動ロボット１は、車体１１と、車体１１の一方側に配置されたシャーシ１２と、シャーシ１２に配置された移動機構１３と、車体１１に配置された平面圧力センサ（ｐｌａｎｅ－ｐｒｅｓｓｕｒｅ ｓｅｎｓｏｒ）２と、可動部３とを備えている。図１に示す実施例において、自律移動ロボット１は、自律移動ロボット（Ａｕｔｏｎｏｍｏｕｓ Ｍｏｂｉｌｅ Ｒｏｂｏｔ、ＡＭＲ）や無人搬送車（Ａｕｔｏｎｏｍｏｕｓ Ｇｕｉｄｅｄ Ｖｅｈｉｃｌｅ、ＡＧＶ）を例に挙げているが、これらに限定されない。
【0014】
本発明の１つの技術的特徴は、自律移動ロボット１の重心が不安定であるときに、運動を行うように移動機構１３又は可動部３を制御して、即時に重心位置に対して補償を行うことにより、自律移動ロボット１の転倒を避けることにある。本発明では、自律移動ロボット１の重心が予め定義された範囲外にある場合に、重心不安定現象が生じていると認定する。
【0015】
図１に示すように、車体１１は、上面１１１と底面１１２とを有する。シャーシ１２は、主に車体１１の底面１１２に配置され、移動機構１３は、シャーシ１２の下方に配置されている。図１に示す実施例において、移動機構１３は、シャーシ１２の隅部にそれぞれ設けられた車輪を例に挙げているが、これに限定されない。他の実施例において、移動機構１３は、車体１１を駆動して地面に対して移動する１つ又は複数のコンベヤ（Ｃｏｎｖｅｙｅｒ）としてもよい。ただし、上記説明は本発明の一部の具体的な実施例にすぎず、これに限定されない。
【0016】
平面圧力センサ２は、静電容量型センサであってもよく、誘導型センサであってもよいが、これらに限定されない。図１に示す実施例において、平面圧力センサ２は、シャーシ１２の一方側の面に配置され、シャーシ１２と平行な状態である。これにより、平面圧力センサ２は、水平面上の複数の位置点における車体１１の圧力値を検出することができる。自律移動ロボット１のコントローラ（図２に示すコントローラ１０）は、車体１１上の複数の位置点における圧力値により、現在の車体１１の圧力分布状態を判断することができる。また、コントローラ１０は、圧力分布状態に基づいて自律移動ロボット１の現在の重心位置をさらに推定することができる。
【0017】
他の実施例において、移動機構１３は、シャーシ１２の下方に配置された複数の車輪であり、平面圧力センサ２は、各車輪の車軸支点に設けられた複数の支点感圧センサ（図示せず）を含む。本実施例において、コントローラ１０は、演算アルゴリズムによって複数の支点感圧センサの計測値を演算することにより、車体１１の現在の圧力分布状態を解析し、さらに現在の重心位置を推定する。
【0018】
ただし、上記説明は本発明の一部の具体的な実施例にすぎず、本発明を限定するものではない。
【0019】
図１に示す実施例において、可動部３は、３次元空間を移動可能なロボットアームを例としている。図１に示すように、車体１１は、上面１１１に荷重領域１１１１が配置され、荷重領域１１１１は、自律移動ロボット１が搬送する負荷（ｐａｙｌｏａｄ）４を載置するために用いられる。自律移動ロボット１の重心位置は、荷重領域１１１１に負荷４が載置されたり、ロボットアームが荷重領域１１１１上の負荷４を出し入れたりする際に変化することがある。この場合、負荷４の載置により自律移動ロボット１が転倒する可能性がある。上記の問題を回避するために、本発明は、自律移動ロボット１の重心位置を即時に補償する。
【0020】
【0021】
図２に示すように、自律移動ロボット１は、コントローラ１０をさらに含む。コントローラ１０は、移動機構１３と、平面圧力センサ２と、可動部３とに接続されている。本発明において、コントローラ１０は、平面圧力センサ２から出力される圧力値に基づいて移動機構１３又は可動部３を制御することにより、自律移動ロボット１の重心位置を補償する。
【0022】
図３には、車体１１の上面図が示されている。図３に示すように、本発明では、車体１１に安定領域１４と補償領域１５とが予め定義され、安定領域１４は車体１１の中心位置に近接し、補償領域１５は車体１１の周縁位置に近接している。具体的には、自律移動ロボット１全体の重心位置５が安定領域１４内に収まっていれば、自律移動ロボット１が転倒するおそれがない。一方、自律移動ロボット１全体の重心位置５が補償領域１５に収まると、自律移動ロボット１は重心が不安定な状態となり、転倒するおそれがある。
【0023】
本発明において、平面圧力センサ２は、車体１１上の各位置点の圧力値を継続的に検出して出力し、コントローラ１０は、平面圧力センサ２が出力した圧力値に基づいて自律移動ロボット１全体の重心位置５を算出する。コントローラ１０は、重心位置５が安定領域１４内に収まると判断した場合、何の動作を行わなくてもよい。一方、コントローラ１０は、重心位置５が補償領域１５に収まると判断すると、移動機構１３又は可動部３を制御して重心補償運動を行う。
【0024】
具体的には、コントローラ１０は、重心位置５が補償領域１５に収まる場合に、安定領域１４に対する現在の重心位置５の重心オフセット方向（ＣｏＧ ｏｆｆｓｅｔ ｄｉｒｅｃｔｉｏｎ、例えば、図６に示す重心オフセット方向Ｄ１）を演算して取得することができる。本発明の重心補償運動は、移動機構１３及び／又は可動部３を制御して、重心オフセット方向Ｄ１に反力を加える対応運動を行うことである。この反力を車体１１に加えることにより、自律移動ロボット１の重心位置５を補償領域１５から安定領域１４に戻すことができる。一実施例において、重心オフセット方向は安定領域１４に対する重心位置５の重心オフセット方向、つまり、安定領域１４の中心点から現在の重心位置５までの方向である。他の実施例において、重心オフセット方向は無負荷の状態やロボットアームが既定位置にある初期の重心位置から、現在の重心位置５までの方向である。
【0025】
一実施例において、重心補償運動は、移動機構１３（例えば、車輪又はコンベヤ）を重心オフセット方向Ｄ１に向けて移動させるように制御することである。これにより、自律移動ロボット１の順方向出力により上記反力を加える。一実施例では、重心オフセット方向Ｄ１が自律移動ロボット１の所定の経路方向と一致しない場合には、自律移動ロボット１は、まず重心オフセット方向Ｄ１に向けて移動して反力を加え、重心位置５が安定領域１４に戻ったと判断した後、自律移動ロボット１は、再び所定の経路方向に向けて前進する。これにより、移動中に重心補償を行うことができる。
【0026】
他の実施例において、重心補償運動は、姿勢調整プロセスを実行するように可動部３を制御することである。具体的には、上記姿勢調整プロセスは、可動部３に自身の姿勢を調整させることで、可動部３の工具重心を重心オフセット方向Ｄ１とは逆方向に移動させ、車体１１に上記反力を加える。
【0027】
図２に示すように、可動部３には、可動部３の慣性変化量を計測する慣性計測装置（Ｉｎｅｒｔｉａｌ Ｍｅａｓｕｒｅｍｅｎｔ Ｕｎｉｔ、ＩＭＵ）３１が設けられていてもよい。慣性計測装置３１は、加速ゲージとジャイロとの組み合わせにより構成されていてもよく、可動部３の加速度状態や傾斜状態等の情報を計測して記録することができるが、これらに限定されない。
【0028】
本発明において、可動部３は、慣性計測装置３１によって計測した慣性変化量から可動部３の工具重心を算出することができる。上記実施例において、可動部３は、工具重心に基づいて姿勢調整プロセスを実行する。例えば、工具重心に基づいて可動部３の位置及び姿勢を決定するが、これらに限定されない。これにより、可動部３は、自身の工具重心を調整することにより、車体１１に反力を加えることができる。
【0029】
他の実施例において、重心補償運動は、荷重領域１１１１上の負荷４の載置位置を重心オフセット方向Ｄ１とは逆方向に移動させることであり、これにより車体１１に反力を加える。具体的には、上記重心補償運動は、主として、可動部３が負荷４を重心オフセット方向Ｄ１とは逆方向に移動させるように、可動部３を制御することである。
【0030】
一実施例において、可動部３は、例えばロボットアームであってもよい。重心補償運動は、荷重領域１１１１上の負荷４を挟持し、重心オフセット方向Ｄ１とは逆方向に沿って負荷４の載置位置を変更するように、可動部３を制御することである。
【0031】
なお、ロボットアームは、一般に３次元の動的識別（Ｄｙｎａｍｉｃ Ｉｄｅｎｔｉｆｉｃａｔｉｏｎ）プロセスを実行できる。上記動的識別プロセスは、ロボットアームが運動又は関連負荷を挟持すると、各軸の状態で即時にロボットアームの３次元環境における重心位置を推定し、この動的識別プロセスによって得た推定値は、上述した工具の重心である。
【0032】
ただし、上記説明は本発明の一部の具体的な実施例にすぎず、本発明を限定するものではない。
【0033】
図１～図４を参照する。図４は、本発明に係る安定方法の第１具体的な実施例を示すフローチャートである。図４は、図１～図３に示す自律移動ロボット１に主に適用される本発明に係る自律移動ロボットの安定化方法（以下、安定化方法と略称する）を示しているが、これに限定されない。
【0034】
図４に示すように、本発明の安定化方法は、まず、自律移動ロボット１上の平面圧力センサにより車体１１の圧力分布状態を計測し（ステップＳ１０）、コントローラ１０により、その圧力分布状態に基づいて車体１１の重心位置５を算出する（ステップＳ１２）。
【0035】
ステップＳ１２の後、コントローラ１０は、重心位置５が車体１１上の予め定義された安定領域１４から外れたか否かを判断する（ステップＳ１４）。重心位置５が安定領域１４から外れていない場合、コントローラ１０は補償動作を行わなくてもよい。
【0036】
上述したように、可動部３には、可動部３の慣性変化量を計測する慣性計測装置３１が配置されてもよい。別の実施例において、コントローラ１０は、重心位置５が安定領域１４から外れていないときに、慣性計測装置３１の計測値によって振動抑制制御（Ｖｉｂｒａｔｉｏｎ Ｓｕｐｐｒｅｓｓｉｏｎ Ｃｏｎｔｒｏｌ）プロセスを実行するように可動部３を制御してもよい。これにより、自律移動ロボット１の通常振動を常時抑制することができる。
【0037】
ステップＳ１２において、コントローラ１０は、自律移動ロボット１の重心位置５が車体１１上の安定領域１４から外れた（例えば、重心位置５が補償領域１５に収まっている）と判断した場合には、重心補償運動を実行する（ステップＳ１６）。本発明において、重心補償運動とは、倒立振子運動の一種である。具体的には、重心補償運動は、安定領域１４に対する重心位置５の重心オフセット方向Ｄ１に反力を提供する。車体１１に反力を直接加えることにより、重心位置５を安定領域１４内に戻すことができ、自律移動ロボット１を安定に戻すことができる。
【0038】
図６を併せて参照する。図６は、本発明に係る重心補償運動の第１具体的な実施例を説明するための概略図である。図６に示す実施例において、コントローラ１０は、重心位置５が安定領域１４から外れた（例えば、補償領域１５に収まる）と判断した場合に、重心補償運動を行うように車体１１上の移動機構１３（例えば、車輪又はコンベヤ）を制御する。
【0039】
図６に示すように、重心補償運動は、コントローラ１０が移動機構１３を制御して現在の重心オフセット方向Ｄ１に向けて移動させる（即ち、自律移動ロボット１全体を重心オフセット方向Ｄ１に向けて移動させるように移動機構１３を動作制御する）ことである。自律移動ロボット１の順方向出力によって重心オフセット方向Ｄ１に反力を加えることにより、重心位置５を補償領域１５から安定領域１４に戻す。ここで、重心オフセット方向Ｄ１が自律移動ロボット１の所定の経路方向と一致しない場合には、自律移動ロボット１は、まず重心オフセット方向Ｄ１に向けて移動して反力を加え、重心位置５が安定領域１４に戻ったと判断した後、自律移動ロボット１は、再び所定の経路方向に向けて前進する。
【0040】
図７を併せて参照する。図７は、本発明に係る重心補償運動の第２具体的な実施例を説明するための概略図である。図７に示す実施例において、コントローラ１０は、重心位置５が安定領域１４から外れたと判断した場合に、重心補償運動を行うように車体１１上の可動部３（例えばロボットアーム）を制御する。
【0041】
図７に示すように、重心補償運動は、コントローラ１０が可動部３を制御して姿勢調整プロセスを行うことである。具体的には、上記姿勢調整プロセスは、可動部３自身の工具重心を安定領域１４に対する重心位置５の重心オフセット方向Ｄ１とは逆方向Ｄ２に移動させるように、可動部３の位置姿勢を調整する。重心位置５を補償領域１５から安定領域１４に戻す。上記姿勢調整プロセスは、可動部３の位置及び姿勢を調整する際に、可動部３を特定方向に回転又は伸縮させることにより行うことができる。一実施例において、可動部３は、負荷を掴んでから位置及び姿勢の調整を行う。このようにして、重心位置５に影響を与える目的をより容易に達成することができる。
【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】
図９は、本発明に係る自律移動ロボットの第２具体的な実施例を示す概略図である。図９は、他の実施態様の自律移動ロボット６を示している。図９に示す実施例において、自律移動ロボット６上の可動部３は２次元空間内を垂直移動可能なパレット（Ｐａｌｌｅｔ）６１であり、１つ又は複数の負荷４がパレット６１に載置されている。
【0067】
本実施例において、コントローラ１０は、自律移動ロボット６の重心位置が安定領域１４から外れたと判断した場合に、図４及び図５に示す各ステップに基づいて、重心補償運動を行うようにパレット６１を制御してもよい。このとき、パレット６１は、負荷４を上下移動させることで工具重心の高さを調整することにより、自律移動ロボット６全体の重心位置５を補償する。
【0068】
図１０を併せて参照する。図１０は、本発明に係る自律移動ロボットの第３の具体的な実施例を示す概略図である。図１０は、他の実施態様の自律移動ロボット７を示している。図１０に示す実施例において、自律移動ロボット７上の可動部３は、２次元空間を水平移動可能なコンベヤ（Ｃｏｎｖｅｙｅｒ）７１であり、１つ又は複数の負荷４がコンベヤ７１に載置されている。
【0069】
本実施例において、コントローラ１０は、自律移動ロボット７の重心位置が安定領域１４から外れたと判断した場合に、図４及び図５に示す各ステップに基づいて、重心補償運動を行うようにコンベヤ７１を制御してもよい。このとき、コンベヤ７１は、負荷４を前後左右に移動させることで工具重心の位置を調整することにより、自律移動ロボット７全体の重心位置５を補償する。
【0070】
ただし、上記説明は本発明の一部の実施例にすぎず、自律移動ロボット１、６、７上の可動部３は、上述したロボットアーム、パレット６１、コンベヤ７１に限定されない。例えば、自律移動ロボットは、フォークリフト（Ｆｏｒｋｌｉｆｔ）、リーチフォークリフト（Ｒｅａｃｈ Ｔｒｕｃｋ）、幅狭通路フォークリフト（Ｖｅｒｙ Ｎａｒｒｏｗ Ａｉｓｌｅ）、牽引車（Ｔｏｗ Ｔｒａｃｔｏｒ）等であってもよく、可動部３は、例えば、リフタ（Ｌｉｆｔｉｎｇ Ｔｏｏｌ）、ローラ（Ｒｏｌｌｅｒ）、ピッカー（Ｍｕｌｔｉｐｌｅ／Ｓｉｎｇｌｅ Ｐｉｃｋｉｎｇ Ｔｏｏｌ）等であってもよいが、これらに限定されない。
【0071】
本発明は、自律移動ロボットの重心位置を継続的に算出するとともに、自律移動ロボット上の要素を制御することで重心位置を動的に補償することにより、自律移動ロボットの重心不安定による転倒を回避する。これにより、自律移動ロボットを軽量化した設計とすることができ、負荷の増加や重心の移動による自律移動ロボットの転倒を防止することができる。
【0072】
以上、本発明の好ましい実施例を説明したが、本発明は上記実施例に記載の範囲には限定されない。本発明の要旨を逸脱しない範囲で上記各実施例に多様な変更又は改良を加えることができ、上記変更又は改良を加えた形態も本発明の技術的範囲に含まれる。
【符号の説明】
【0073】
１、６、７ 自律移動ロボット
１０ コントローラ
１１ 車体
１１１ 上面
１１１１ 荷重領域
１１２ 底面
１２ シャーシ
１３ 移動機構
１４ 安定領域
１５ 補償領域
２ 平面圧力センサ
３ 可動部
３１ 慣性計測装置
４ 負荷
５ 重心位置
６１ パレット
７１ コンベヤ
Ｄ１ 重心オフセット方向
Ｄ２ （重心オフセット方向の）逆方向
１０ コントローラ
１１ 車体
１１１ 上面
１１１１ 荷重領域
１１２ 底面
１２ シャーシ
１３ 移動機構
１４ 安定領域
１５ 補償領域
２ 平面圧力センサ
３ 可動部
３１ 慣性計測装置
４ 負荷
５ 重心位置
６１ パレット
７１ コンベヤ
Ｄ１ 重心オフセット方向
Ｄ２ （重心オフセット方向の）逆方向
【図1】
【図2】
【図3】
【図4】
【図5】
【図6】
【図7】
【図8A】
【図8B】
【図9】
【図10】
