(57)【要約】開始位置から停止位置までのロボットの移動を制御するための方法およびコントローラであって、ロボットは、ローカルコントローラによって制御される駆動手段を有する、車輪の対を有する。各車輪の現在の速度および角位置と、フレーム構造に対するロボットの位置とに基づいて、マスタコントローラは、各車輪の現在の速度および角位置と、ロボットの現在のグローバル位置と、ロボットの開始位置および停止位置とに基づく、車輪の対に関する個々の速度駆動シーケンスを設定する。速度駆動シーケンスは、車輪の対を制御する、ローカルコントローラに伝送され、それによって、個々の駆動手段を介して、各車輪の加速および減速を制御する。ローカルコントローラは、車輪の対が同期されたままであることを確実にする。
2019533857.tif 000002
【特許請求の範囲】
【請求項１】
開始位置から停止位置までのロボット５０の移動を制御するための方法であって、前記ロボット５０は、グリッド４０を形成するフレーム構造上に敷設されたトラック２０上を移動し、前記ロボット５０は、各車輪６０に対して個々の駆動手段Ｄｒｉｖｅ１、Ｄｒｉｖｅ２、Ｄｒｉｖｅ３、Ｄｒｉｖｅ４に接続される、ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４によって制御される、車輪の対Ｗ１−２およびＷ３−４を有し、
車輪の対Ｗ１−２およびＷ３−４を制御する前記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４に接続される速度および角位置センサを用いて、各車輪６０を監視することを特徴とし、以下のステップ、すなわち、
−前記ロボット５０の開始位置および停止位置を受信するステップと、
−各車輪６０の現在の速度および角位置を前記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４から受信するステップと、
−前記フレーム構造に対する前記ロボット５０の位置を受信するステップと、
−各車輪６０の現在の速度および角位置と、前記ロボット５０の現在の位置と、前記ロボット５０の開始位置および停止位置とに基づいて、車輪の各対Ｗ１−２およびＷ３−４に対して速度駆動シーケンスＶｓｅｑ１−２、Ｖｓｅｑ３−４を設定するステップと、
−車輪の各対Ｗ１−２およびＷ３−４の加速および減速を制御するために、前記速度駆動シーケンスＶｓｅｑ１−２、Ｖｓｅｑ３−４を前記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４のそれぞれに伝送するステップと、
−前記開始位置から前記停止位置までの前記ロボット５０の移動を制御するために、上記のステップを繰り返すステップと
が、前記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４のそれぞれと通信するマスタコントローラ内で実施される、方法。
【請求項２】
前記ロボット５０の位置は、トラックに対する前記ロボット５０の外部追跡によって提供される前記ロボット５０のグローバルｘ、ｙ位置である、請求項１に記載の方法。
【請求項３】
前記ロボット５０の位置は、前記トラックに対する前記ロボット５０の絶対ローカル位置であって、前記ローカル位置は、前記ロボット５０内に備えられる追跡センサによって提供される、請求項１に記載の方法。
【請求項４】
速度駆動シーケンスは、前記ロボット５０を開始位置から移動させるための加速と、前記ロボット５０を停止位置に向かって移動させるための減速と、前記ロボット５０を前記開始位置と停止位置との間で移動させるための一定速度とを定義する、請求項１に記載の方法。
【請求項５】
各ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４は、１つの車輪５０の現在の速度が前記速度駆動シーケンスによって設定された前記車輪の対の設定速度から逸脱する場合、車輪の対Ｗ１−２およびＷ３−４の１つの車輪６０の速度を調節する、前記請求項のいずれかに記載の方法。
【請求項６】
前記速度駆動シーケンスは、所定のレートで伝送される、前記請求項のいずれかに記載の方法。
【請求項７】
前記速度駆動シーケンスは、前記ロボット５０が辿るルートに従って、異なる開始位置および停止位置を備える、前記請求項のいずれかに記載の方法。
【請求項８】
開始位置から停止位置までのロボット５０の移動を制御するためのマスタコントローラであって、前記ロボット５０は、グリッド４０を形成するフレーム構造上に敷設されたトラック２０上を移動し、前記ロボット５０は、各車輪６０に対して個々の駆動手段Ｄｒｉｖｅ１、Ｄｒｉｖｅ２、Ｄｒｉｖｅ３、Ｄｒｉｖｅ４に接続されるローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４によって制御される、車輪の対Ｗ１−２およびＷ３−４を有し、
前記マスタコントローラは、車輪の各対Ｗ１−２およびＷ３−４を制御する前記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４に接続されることを特徴とし、前記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４は、前記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４に接続される速度および角度センサを用いて、各車輪６０の速度および角位置を前記マスタコントローラに提供し、前記マスタコントローラは、
−前記ロボット５０の開始位置および停止位置と、前記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４によって提供される、各車輪６０の現在の速度および角位置とを受信するための入力手段と、
−前記フレーム構造に対する前記ロボット５０の位置を受信するための入力手段と、
−各車輪６０の現在の速度および角位置と、前記ロボット５０の現在の位置と、前記ロボット５０の開始位置および停止位置とに基づいて、車輪６０の各対Ｗ１−２およびＷ３−４に対して速度駆動シーケンスＶｓｅｑ１−２、Ｖｓｅｑ３−４を設定するための計算手段と、
−車輪６０の各対Ｗ１−２およびＷ３−４の加速および減速を制御するために、前記速度駆動シーケンスＶｓｅｑ１−２、Ｖｓｅｑ３−４を前記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４のそれぞれに伝送するための出力手段と
を備える、マスタコントローラ。
【請求項９】
前記ロボット５０内に備えられる追跡センサに接続されることを特徴とする、請求項８に記載のコントローラ。
【請求項１０】
前記ロボット５０内に具現化されることを特徴とする、請求項８または９に記載のコントローラ。
【請求項１１】
プロセッサによって実行されると、請求項１−７に記載の方法を実施する、ソフトウェアプログラム製品。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、フレーム構造上に敷設されたトラック上を移動する遠隔操作式ロボットに関し、より具体的には、フレーム構造に対して開始位置から停止位置までそれを平滑に移動させるために、各車輪を制御し、ロボットの車輪の対を同期させるための方法およびコントローラに関する。
【背景技術】
【０００２】
貯蔵容器を貯蔵システムから取り上げるための遠隔操作式車両またはロボットは、既知である。関連先行技術貯蔵システムの詳細な説明は、第ＥＰ１０３７８２８Ｂ１号に提示され、そのような貯蔵システムのために好適な先行技術車両の詳細は、ノルウェー特許第ＮＯ３１７３６６Ｂ１号および第ＷＯ２０１５１９３２７８Ａ１号に詳細に開示される。そのような先行技術貯蔵システムは、ある高さまで相互の上にスタックされた貯蔵容器を含有する、３次元貯蔵グリッドを備える。貯蔵グリッドは、通常、その上を複数の遠隔操作式車両またはロボットが側方に移動するように配列される上部レールまたはトラックによって相互接続される、アルミニウム製の列として構築される。各車両は、車両を１つの位置から別の位置に移動させるためと、貯蔵グリッド内に貯蔵される容器を取り上げ、搬送し、設置するために適合される、昇降デバイスを駆動するためとのモータを装備する。電力供給源は、電力を車両内に備えられるモータおよび駆動部に供給し、例えば、再充電可能バッテリである。車両は、典型的には、無線リンクを介して、制御システムと通信し、必要に応じて、充電ステーションにおいて再充電されることができる。
【０００３】
車輪の回転は、車輪に接続されるベルトによって、または車輪にまたは少なくとも部分的にその中に位置する個々の駆動手段によって、駆動されてもよい。最後の実施例は、開始位置と停止位置との間の加速および減速の高度な制御を伴う、応答性ロボットを提供するであろう。
【０００４】
直線トラック上を移動するロボットの車輪が、個々に制御および操作されるとき、それらは、ロボットを進み角度からずれて駆動せずに、ロボットを定常移動で移動させるために、１つのエンティティであるかのように制御されなければならない。
【０００５】
理想的には、類似サイズの車輪が、ロボットが移動するとき、同一速度で回転するであろう。しかしながら、各車輪が、別個に駆動されるとき、車輪に関する異なる回転速度に寄与し得る、いくつかの要因が存在する。そのような要因は、スピン、滑動、および車輪への異なる荷重であり得る。これが生じる場合、ロボットの移動は、平滑ではなくなり、進み角度からずれて駆動され得る。
【０００６】
したがって、本発明の目的は、トラック上で回転するときに車輪に関して生じ得る任意の擾乱に関係なく、トラック上で開始位置から停止位置までそれを平滑に移動させるために、ロボットの移動の最適制御のための方法およびデバイスを提供することである。これは、ロボットの各車輪を制御するコントローラのための速度駆動シーケンスを設定することによって達成され、コントローラは、ロボットを平滑に開始位置から停止位置まで移動させるための速度駆動シーケンスに従って車輪の対を同期させる。
【先行技術文献】
【特許文献】
【０００７】
【特許文献１】欧州特許第１０３７８２８号明細書
【特許文献２】ノルウェー国特許第３１７３６６号明細書
【特許文献３】国際公開第２０１５１９３２７８号
【発明の概要】
【課題を解決するための手段】
【０００８】
本発明は、開始位置から停止位置までのロボットの移動を制御するための方法によって定義され、ロボットは、グリッドを形成するフレーム構造上に敷設されたトラック上を移動し、ロボットは、各車輪に対して個々の駆動手段に接続されるローカルコントローラによって制御される、車輪の対を有する。
【０００９】
本方法は、車輪の対を制御するローカルコントローラに接続される速度および角位置センサを用いて、各車輪を監視することを特徴とし、以下のステップ、すなわち、
−ロボットの開始位置および停止位置を受信するステップと、
−各車輪の現在の速度および角位置をローカルコントローラから受信するステップと、
−フレーム構造に対するロボットのグローバル位置を受信するステップと、
−各車輪の現在の速度および角位置と、ロボットの現在のグローバル位置と、ロボットの開始位置および停止位置とに基づいて、車輪の各対に対して個々の速度駆動シーケンスを設定するステップと、
−車輪の各対の加速および減速を制御するために、速度駆動シーケンスをローカルコントローラのそれぞれに伝送するステップと、
−開始位置から停止位置までのロボットの移動を制御するために、上記のステップを繰り返すステップと、
が、ローカルコントローラのそれぞれと通信するマスタコントローラ内で実施される。
【００１０】
本方法のさらなる特徴は、従属請求項に定義される。
【００１１】
本発明はさらに、開始位置から停止位置までのロボットの移動を制御するためのマスタコントローラによって定義され、ロボットは、グリッドを形成するフレーム構造上に敷設されたトラック上を移動し、ロボットは、各車輪に対して個々の駆動手段に接続されるローカルコントローラによって制御される、車輪の対を有する。マスタコントローラは、車輪の各対を制御するローカルコントローラに接続され、ローカルコントローラは、ローカルコントローラに接続される速度および角度センサを用いて、各車輪の速度および角位置をマスタコントローラに提供し、マスタコントローラは、
−ロボットの開始位置および停止位置と、ローカルコントローラによって提供される、各車輪の現在の速度および角位置とを受信するための入力手段と、
−フレーム構造に対するロボットのグローバル位置を受信するための入力手段と、
−各車輪の現在の速度および角位置と、ロボットの現在のグローバル位置と、ロボットの開始位置および停止位置とに基づいて、車輪の各対に対して個々の速度駆動シーケンスを設定するための計算手段と、
−速度駆動シーケンスを車輪の各対の加速および減速を制御するローカルコントローラのそれぞれに伝送するための出力手段と、
を備える。
【００１２】
マスタコントローラのさらなる特徴は、従属請求項に定義される。
【図面の簡単な説明】
【００１３】
本発明は、ここで、図を参照して説明されるであろう。
【図１】図１は、いくつかのロボットが個別の貯蔵列の直上に配列される、貯蔵システムのあるセクションを示す。
【図２】図２は、個々に駆動される車輪のセットを伴う、遠隔操作式ロボットの実施例を示す。
【図３】図３は、ロボットの車輪の対を制御するためのマスタコントローラおよびローカルコントローラの概要を示す。
【発明を実施するための形態】
【００１４】
本発明は、開始位置から停止位置まで平滑に移動させるために、各車輪を制御し、ロボットの車輪の対を同期させるための方法およびコントローラによって定義される。ロボットの制御された平滑移動は、特に、進み角度からずれた移動を回避しながら、１つの点から別の点に効率的に移動させるために、ロボットがトラック上を移動するときに重要である。図１および２は、貯蔵システムの上部のトラック上を移動するロボットを図示する。
【００１５】
図１は、いくつかの遠隔操作式ロボット５０が容器貯蔵グリッド４０を作製するフレーム構造によって作製される個別の貯蔵列３０の直上に配列される、貯蔵システム１０のあるセクションを示す。容器貯蔵グリッド４０の上側部分は、ロボット５０がその上を走行するための専用支持トラック２０を具備する。ロボット５０は、ｘおよびｙ方向にトラック２０上で移動し、貯蔵容器を容器貯蔵グリッド４０内の貯蔵列３０から受容するように構成される。
【００１６】
図２は、遠隔操作式ロボット５０の実施例を示す。ロボット５０は、貯蔵容器を下層貯蔵システム１０から取り上げるために適合される。ロボット５０の本体は、貯蔵容器を受容するための空洞を備える。本実施例では、空洞は、ロボット５０内の中心に配列され、ロボット５０の本体によって囲繞される。ロボット５０の本体はさらに、貯蔵容器を上昇および下降させるための昇降デバイスを備える。しかしながら、本発明は、車輪を伴う任意のタイプのロボットに適用可能である。
【００１７】
ロボット５０はさらに、下層貯蔵システム１０上で第１および第２の方向ｘ、ｙに沿ってロボット５０の移動を可能にする、車輪６０を備える。車輪６０は、駆動力をロボット５０に提供するために、車輪６０にまたは少なくとも部分的にその中に位置する駆動手段に接続される。本構成は、ロボット５０内の最小空間を占有し、それによって、ロボット５０内への他の据付のための空間を空けるであろう。
【００１８】
ロボット５０はさらに、ロボット５０の移動を制御するように構成される、制御手段を備える。各車輪６０に対する制御手段は、駆動手段に接続され、これは、各車輪６０に接続される。ロボット５０はさらに、信号を受信および伝送するための無線通信を具備する。
【００１９】
図３は、本発明による、マスタコントローラの概要を示す。マスタコントローラは、開始位置から停止位置までのロボット５０の移動を制御するために適合され、ロボット５０は、グリッドを形成するフレーム構造上に敷設されたトラック上を移動し、ロボット５０は、図に図示されるように、ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４によって制御される、車輪の対Ｗ１およびＷ２、Ｗ３およびＷ４と、個々の駆動手段Ｄｒｉｖｅ１、Ｄｒｉｖｅ２、Ｄｒｉｖｅ３、Ｄｒｉｖｅ４と有する。各個々の駆動手段は、接続された車輪に適用される速度および力を制御する。
【００２０】
ロボット５０の各車輪を制御し、車輪の対を同期させるための本発明の方法は、マスタコントローラによって実施されるいくつかのステップを含む。マスタコントローラは、好ましくは、ロボット５０の内側に格納されるが、また、これの外部に位置してもよい。しかしながら、これは、ロボット５０内に格納される個々のローカル制御手段とマスタコントローラとの間のより多くの無線通信を要求する。
【００２１】
第１のステップは、ロボット５０に関する開始位置および停止位置を受信する。
【００２２】
開始位置および停止位置は、ボックスを貯蔵列３０から取り上げ、それを別の貯蔵列３０内に設置することに先立って、ロボット５０に関して設定されたルートに依存するであろう。具体的ロボット５０に関するルートは、全ての貯蔵容器およびその内容物の制御を有する、監督システムによって設定されるであろう。
【００２３】
ロボット５０の開始位置は、それが静止している位置となるであろう。ロボット５０は、本位置を常時追跡するであろう。本位置は、異なる方法において入手されることができる。１つの方法は、フレーム構造の上部のトラックに対するロボット５０のｘ、ｙ位置を追跡することである。これは、ロボット５０のグローバル位置となるであろう。本位置は、ロボット５０の外部に位置する追跡デバイスを用いて、またはロボット５０内に統合されるデバイスによって、入手されることができる。外部および統合された追跡デバイスの組み合わせは、位置決定の正確度を増加させるであろう。
【００２４】
統合された追跡デバイスを使用することによって、ロボット５０は、フレーム構造の上部にグリッドとして敷設されるトラック上を移動するとき、既知の開始位置からｘおよびｙ−方向に通過した横断数、すなわち、スプレッドシート内のセルの間のような移動を検出することによって、その位置を追跡可能となるであろう。
【００２５】
開始位置に加え、マスタコントローラはまた、ロボット５０の移動を制御するために、停止場所の情報を受信しなければならない。
【００２６】
ロボット５０が、貯蔵容器を１つの貯蔵列から取り上げ、それを別の貯蔵列内に降下させるための完全動作を実施するために、ルートに従って１つの方向のみに移動すべき場合、完全動作のために、１つの開始位置および停止位置のみが存在するであろう。しかしながら、ロボット５０は、最終目的地に到達するために、ルートに従って異なるｘおよびｙ−方向に移動する可能性がより高い。これは、完全ルートが異なる方向に沿って延設されている場合、または開始位置から停止位置までの最短ルートを遮断する他のロボットに起因する場合に該当し得る。この場合、第１の開始位置は、ロボット５０が、貯蔵容器を取り上げる、または降下させる位置となるであろう。第１の停止位置は、次いで、ルートを辿るためにロボット５０が方向を変化させなければならないルートの位置となるであろう。本停止位置は、次いで、次の開始位置となる等と続くであろう。ロボット５０が、３回方向を変化させる必要がある場合、３つの開始位置および停止位置、すなわち、ルートの第１、第２、および第３の区間が存在するであろう。
【００２７】
ロボット５０のルートの第１の区間の開始位置および停止位置が、確立された後、次のステップは、マスタコントローラに、ロボット５０の各車輪の現在の速度Ｖ１、Ｖ２、Ｖ３、Ｖ４と、角位置ｐｏｓ１、ｐｏｓ２、ｐｏｓ３、ｐｏｓ４とを受信させる。本情報は、各車輪上のこれらのパラメータを測定する速度および角位置センサを用いて提供される。
【００２８】
車輪の各対に対する現在の速度および角位置は、ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４に入力され、これは、それぞれ、車輪の対Ｗ１およびＷ２、Ｗ３およびＷ４の同期を制御する。
【００２９】
ロボット５０が、ルートに沿って移動すると、フレーム構造に対するロボット５０の位置が、持続的に追跡され、マスタコントローラに提供される。
【００３０】
一実施形態では、ロボット５０の位置は、トラックに対するロボット５０を追跡する外部追跡デバイスによって提供される、グローバルｘ、ｙ位置である。
【００３１】
本発明の別の実施形態では、ロボット５０はさらに、現在駆動しているトラックに対する絶対位置を検出するための追跡センサを備える。ロボット５０の絶対位置とグローバル位置の組み合わせは、決定された位置の正確度を改良するであろう。
【００３２】
マスタコントローラが、開始位置および停止位置と、各車輪Ｗ１、Ｗ２、Ｗ３、およびＷ４の現在の速度および角位置と、ロボット５０の現在の位置との情報を受信すると、マスタコントローラは、車輪の各対Ｗ１−２およびＷ３−４に対して個々の速度駆動シーケンスＶｓｅｑ１−２、Ｖｓｅｑ３−４を設定するために、本情報を使用するであろう。
【００３３】
各速度駆動シーケンスＶｓｅｑ１−２、Ｖｓｅｑ３−４は、設定開始位置および停止位置と、ロボット５０の現在の位置とに照らして、車輪の各対に対して速度および角位置データに基づいて確立される。
【００３４】
これらの速度駆動シーケンスＶｓｅｑ１−２、Ｖｓｅｑ３−４は、ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４のそれぞれに伝送され、これは、ひいては、車輪の各対に対する駆動部Ｄｒｉｖｅ１、Ｄｒｉｖｅ２、Ｄｒｉｖｅ３、Ｄｒｉｖｅ４を制御する。
【００３５】
各駆動シーケンスは、開始位置から停止位置までの移動の間の車輪の各対に対する加速、一定速度、および減速を定義する、一連の速度データを定義するであろう。車輪の各対に対するローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４は、車輪に関する個々の駆動手段Ｄｒｉｖｅ１、Ｄｒｉｖｅ２、Ｄｒｉｖｅ３、Ｄｒｉｖｅ４を制御するために、速度駆動シーケンスＶｓｅｑ１−２、Ｖｓｅｑ３−４を使用するであろう。
【００３６】
ロボット５０が、そのルートに沿って移動するとき、速度駆動シーケンスを定義するデータは、ロボット５０の加速、一定速度、および減速に従って持続的に更新されるであろう。これは、車輪の対に関する速度を定義する駆動シーケンスがルートに沿って変化し得ることを意味する。速度駆動シーケンスの更新レートは、設定され、所定のレートで伝送されることができる。また、開始位置から停止位置まで移動するときのロボット５０のルートに沿って変化してもよい。
【００３７】
上記に定義された異なるステップは、ロボット５０がその目的地に到達するまで、または方向を変化させるべきとき、繰り返される、すなわち、ステップは、ロボット５０に関する開始位置と停止位置との間で繰り返されるであろう。
【００３８】
本発明の一実施形態では、車輪の対を制御するローカルコントローラは、１つの車輪５０の現在の速度が速度駆動シーケンスによって設定された車輪の対の設定速度から逸脱する場合、車輪の駆動を制御し、車輪６０の速度を調節するであろう。これは、駆動方向に対して法線方向の同一軸に沿った車輪の対が、車輪の速度の減速、例えば、スピン、滑動、障害物等の可能性として考えられる要因に関係なく、常時、速度駆動シーケンスによって設定された速度に同期されるであろうことを意味する。
【００３９】
ローカルコントローラは、したがって、設定速度駆動シーケンスに従って、車輪の対を同期されたままにする。これは、１つまたはいくつかの車輪の速度が、何らかの理由から、速度駆動シーケンスによって設定された速度から逸脱する場合でも、ロボット５０の移動の精密な制御を提供するであろう。
【００４０】
同期は、車輪の対が全体的に同期されることを確実にするために、高速レートで実施されることができる。典型的には、各車輪の速度および角位置は、車輪の対が速度駆動シーケンスによって設定された速度に同期されたままにするために、毎秒６０，０００回測定され、対応する連続計算が、各車輪の駆動を制御するために実施される。
【００４１】
上記に説明される方法は、トラック上で回転するときに車輪に関して生じ得る任意の擾乱に関係なく、開始位置から停止位置まで進み角度からずれずに平滑に移動するために、ロボット５０の移動の最適制御を提供する。
【００４２】
本発明はまた、上記に説明される方法を実施するプロセッサによって実行されると、ソフトウェアプログラム製品によって定義される。プロセッサは、マスタコントローラの一部である、またはそれに接続される。
【００４３】
本発明はまた、開始位置から停止位置まで移動するときの上記に説明されるロボット５０の移動を制御するためのコントローラによって定義される。これは、ロボット５０の移動のためのマスタコントローラとして作用するであろう。
【００４４】
マスタコントローラは、車輪の対Ｗ１−２およびＷ３−４を制御する、ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４に接続される。ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４は、ローカルコントローラに接続される速度および角度センサを用いて、各車輪６０の速度および角位置データをマスタコントローラに提供する。
【００４５】
マスタコントローラは、ロボット５０の開始位置および停止位置と、ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４によって提供される、各車輪６０の現在の速度および角位置とを受信するための入力手段を備える。さらに、フレーム構造に対するロボット５０の位置を受信するための入力手段を備える。
【００４６】
マスタコントローラはさらに、各車輪６０の現在の速度および角位置と、ロボット５０の現在の位置と、ロボット５０の開始位置および停止位置とに基づいて、車輪の各対６０、すなわちＷ１−２およびＷ３−４に対して速度駆動シーケンスＶｓｅｑ１−２、Ｖｓｅｑ３−４を設定するための計算手段を備える。
【００４７】
マスタコントローラはさらに、速度駆動シーケンスＶｓｅｑ１−２、Ｖｓｅｑ３−４をローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４のそれぞれに伝送するための出力手段を備え、それによって、車輪６０の各対、すなわちＷ１−２およびＷ３−４の加速および減速を制御する。速度データは、したがって、マスタコントローラによって制御され、好ましくは、５ｍｓ毎に更新される。
【００４８】
マスタコントローラは、一実施形態では、ロボット５０の内側に格納される。これは、次いで、車輪の対Ｗ１−２およびＷ３−４を制御し、速度および角位置データを各車輪から読み取る、ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４に接続される。
【００４９】
マスタコントローラは、一実施形態では、フレーム構造に対するグローバル位置を提供する、デバイスに接続されてもよい。別の実施形態では、本情報は、ロボット５０の位置データをマスタコントローラに伝送する、外部手段によって提供されてもよい。ロボット５０のグローバル位置を提供するためのオンボードおよび外部手段の組み合わせもまた、実行可能である。
【００５０】
ロボット５０の位置を決定するための正確度は、ロボット５０内に備えられる追跡センサによって提供されるローカル位置データを提供することによって、改良されることができる。
【００５１】
本発明は、移動しているロボット５０の制御された平滑移動を提供するであろう。ロボットは、常時、トラックに沿って均一に移動する、すなわち、歪み荷重、滑動、または摩擦問題に起因する、進み角度からずれたロボット５０の移動を防止するであろう。
【図１】
2019533857.tif 000003
【図２】
2019533857.tif 000004
【図３】
2019533857.tif 000005
【手続補正書】
【提出日】令和1年6月25日(2019.6.25)
【手続補正１】
【補正対象書類名】特許請求の範囲
【補正対象項目名】全文
【補正方法】変更
【補正の内容】
【特許請求の範囲】
【請求項１】
開始位置から停止位置までのロボット（５０）の移動を制御し、グリッド（４０）を形成するフレーム構造上に敷設されたトラック（２０）上を移動する間の進み角度からずれた前記ロボット（５０）の移動を防止するための方法であって、前記ロボット（５０）は、各車輪（６０）に対して個々の駆動手段Ｄｒｉｖｅ１、Ｄｒｉｖｅ２、Ｄｒｉｖｅ３、Ｄｒｉｖｅ４に接続される、ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４によって制御される、車輪の対Ｗ１−２およびＷ３−４を有し、
ａ）前記車輪の各対Ｗ１−２およびＷ３−４を制御する前記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４に接続される速度および角位置センサを用いて、各車輪（６０）を監視するステップ
を含み、以下のステップ、すなわち、
ｂ）前記ロボット（５０）の開始位置および停止位置を受信するステップと、
ｃ）前記車輪の対の各車輪（６０）の現在の速度および角位置を前記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４から受信するステップと、
ｄ）前記フレーム構造に対する前記ロボット（５０）の位置を受信するステップと
が、前記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４のそれぞれと通信するマスタコントローラ内で実施され、
ｅ）各車輪（６０）の前記現在の速度および前記角位置と、前記ロボット（５０）の前記受信された位置と、前記ロボット（５０）の開始位置および停止位置とに基づいて、前記駆動方向に対して法線方向の同一軸に沿った車輪の各対Ｗ１−２およびＷ３−４に対して加速、一定速度、および減速を定義する速度データを含む速度駆動シーケンスＶｓｅｑ１−２、Ｖｓｅｑ３−４を設定するステップと、
ｆ）車輪の各対Ｗ１−２およびＷ３−４の加速および減速を制御するために、前記速度駆動シーケンスＶｓｅｑ１−２、Ｖｓｅｑ３−４を前記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４のそれぞれに伝送するステップであって、各ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４は、１つの車輪（６０）の現在の速度が前記速度駆動シーケンスＶｓｅｑ１−２、Ｖｓｅｑ３−４によって設定された前記車輪の対Ｗ１−２およびＷ３−４の設定速度から逸脱する場合、車輪の対Ｗ１−２およびＷ３−４の１つの車輪（６０）の速度を調節し、これにより、前記車輪の対Ｗ１−２およびＷ３−４を同期させる、ステップと、
ｇ）前記開始位置から前記停止位置までの前記ロボット（５０）の移動を制御するために、ステップｃ）〜ｆ）を繰り返すステップと
を特徴とする、方法。
【請求項２】
前記ロボット５０の位置は、トラックに対する前記ロボット５０の外部追跡によって提供される前記ロボット５０のグローバルｘ、ｙ位置である、請求項１に記載の方法。
【請求項３】
前記ロボット（５０）の位置は、前記トラックに対する前記ロボット（５０）の絶対ローカル位置であって、前記ローカル位置は、前記ロボット（５０）内に備えられる追跡センサによって提供される、請求項１に記載の方法。
【請求項４】
速度駆動シーケンスＶｓｅｑ１−２、Ｖｓｅｑ３−４は、前記ロボット（５０）を前記開始位置から移動させるための加速と、前記ロボット（５０）を前記停止位置に向かって移動させるための減速と、前記ロボット（５０）を前記開始位置と停止位置との間で移動させるための一定速度とを定義する、請求項１に記載の方法。
【請求項５】
前記速度駆動シーケンスは、所定のレートで伝送される、前記請求項のいずれかに記載の方法。
【請求項６】
前記速度駆動シーケンスは、前記ロボット（５０）が辿るルートに従って、異なる開始位置および停止位置を備える、前記請求項のいずれかに記載の方法。
【請求項７】
開始位置から停止位置までのロボット（５０）の移動を制御し、グリッド（４０）を形成するフレーム構造上に敷設されたトラック（２０）上を移動する間の前記ロボット（５０）の進み角度からずれた移動を防止するマスタコントローラであって、前記ロボット（５０）は、各車輪（６０）に対して個々の駆動手段Ｄｒｉｖｅ１、Ｄｒｉｖｅ２、Ｄｒｉｖｅ３、Ｄｒｉｖｅ４に接続されるローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４によって制御される、車輪の対Ｗ１−２およびＷ３−４を有し、
前記マスタコントローラは、前記車輪の各対Ｗ１−２およびＷ３−４を制御する前記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４に接続され、前記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４は、前記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４に接続される速度および角度センサを用いて、各車輪（６０）の速度および角位置を前記マスタコントローラに提供し、前記マスタコントローラは、
−前記ロボット（５０）の開始位置および停止位置と、前記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４によって提供される、前記車輪の対の各車輪（６０）の現在の速度および角位置とを受信するための入力手段と、
−前記フレーム構造に対する前記ロボット５０の位置を受信するための入力手段と
を備え、
−各車輪（６０）の前記現在の速度および角位置と、前記ロボット（５０）の前記受信された位置と、前記ロボット（５０）の開始位置および停止位置とに基づいて、前記駆動方向に対して法線方向の同一軸に沿った車輪の各対Ｗ１−２およびＷ３−４に対して加速、一定速度、および減速を定義する速度データを含む速度駆動シーケンスＶｓｅｑ１−２、Ｖｓｅｑ３−４を設定するための計算手段と、
−車輪の各対Ｗ１−２およびＷ３−４の加速および減速を制御するために、前記速度駆動シーケンスＶｓｅｑ１−２、Ｖｓｅｑ３−４を前記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４のそれぞれに伝送するための出力手段であって、各ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４は、１つの車輪（６０）の現在の速度が前記速度駆動シーケンスＶｓｅｑ１−２、Ｖｓｅｑ３−４によって設定された前記車輪の対Ｗ１−２およびＷ３−４の設定速度から逸脱する場合、車輪の対Ｗ１−２およびＷ３−４の１つの車輪（６０）の速度を調節し、これにより、前記車輪の対Ｗ１−２およびＷ３−４を同期させるように適合されている、出力手段と
をさらに備えることを特徴とする、マスタコントローラ。
【請求項８】
前記ロボット（５０）内に備えられる追跡センサに接続されることを特徴とする、請求項７に記載のコントローラ。
【請求項９】
前記ロボット（５０）内に具現化されることを特徴とする、請求項７または８に記載のコントローラ。
【請求項１０】
プロセッサによって実行されると、請求項１−６に記載の方法を実施する、ソフトウェアプログラム製品。
【手続補正２】
【補正対象書類名】明細書
【補正対象項目名】００１２
【補正方法】変更
【補正の内容】
【００１２】
マスタコントローラのさらなる特徴は、従属請求項に定義される。
本発明は、例えば、以下を提供する。
（項目１）
開始位置から停止位置までのロボット５０の移動を制御するための方法であって、上記ロボット５０は、グリッド４０を形成するフレーム構造上に敷設されたトラック２０上を移動し、上記ロボット５０は、各車輪６０に対して個々の駆動手段Ｄｒｉｖｅ１、Ｄｒｉｖｅ２、Ｄｒｉｖｅ３、Ｄｒｉｖｅ４に接続される、ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４によって制御される、車輪の対Ｗ１−２およびＷ３−４を有し、
車輪の対Ｗ１−２およびＷ３−４を制御する上記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４に接続される速度および角位置センサを用いて、各車輪６０を監視することを特徴とし、以下のステップ、すなわち、
−上記ロボット５０の開始位置および停止位置を受信するステップと、
−各車輪６０の現在の速度および角位置を上記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４から受信するステップと、
−上記フレーム構造に対する上記ロボット５０の位置を受信するステップと、
−各車輪６０の現在の速度および角位置と、上記ロボット５０の現在の位置と、上記ロボット５０の開始位置および停止位置とに基づいて、車輪の各対Ｗ１−２およびＷ３−４に対して速度駆動シーケンスＶｓｅｑ１−２、Ｖｓｅｑ３−４を設定するステップと、
−車輪の各対Ｗ１−２およびＷ３−４の加速および減速を制御するために、上記速度駆動シーケンスＶｓｅｑ１−２、Ｖｓｅｑ３−４を上記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４のそれぞれに伝送するステップと、
−上記開始位置から上記停止位置までの上記ロボット５０の移動を制御するために、上記のステップを繰り返すステップと
が、上記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４のそれぞれと通信するマスタコントローラ内で実施される、方法。
（項目２）
上記ロボット５０の位置は、トラックに対する上記ロボット５０の外部追跡によって提供される上記ロボット５０のグローバルｘ、ｙ位置である、項目１に記載の方法。
（項目３）
上記ロボット５０の位置は、上記トラックに対する上記ロボット５０の絶対ローカル位置であって、上記ローカル位置は、上記ロボット５０内に備えられる追跡センサによって提供される、項目１に記載の方法。
（項目４）
速度駆動シーケンスは、上記ロボット５０を開始位置から移動させるための加速と、上記ロボット５０を停止位置に向かって移動させるための減速と、上記ロボット５０を上記開始位置と停止位置との間で移動させるための一定速度とを定義する、項目１に記載の方法。
（項目５）
各ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４は、１つの車輪５０の現在の速度が上記速度駆動シーケンスによって設定された上記車輪の対の設定速度から逸脱する場合、車輪の対Ｗ１−２およびＷ３−４の１つの車輪６０の速度を調節する、上記項目のいずれかに記載の方法。
（項目６）
上記速度駆動シーケンスは、所定のレートで伝送される、上記項目のいずれかに記載の方法。
（項目７）
上記速度駆動シーケンスは、上記ロボット５０が辿るルートに従って、異なる開始位置および停止位置を備える、上記項目のいずれかに記載の方法。
（項目８）
開始位置から停止位置までのロボット５０の移動を制御するためのマスタコントローラであって、上記ロボット５０は、グリッド４０を形成するフレーム構造上に敷設されたトラック２０上を移動し、上記ロボット５０は、各車輪６０に対して個々の駆動手段Ｄｒｉｖｅ１、Ｄｒｉｖｅ２、Ｄｒｉｖｅ３、Ｄｒｉｖｅ４に接続されるローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４によって制御される、車輪の対Ｗ１−２およびＷ３−４を有し、
上記マスタコントローラは、車輪の各対Ｗ１−２およびＷ３−４を制御する上記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４に接続されることを特徴とし、上記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４は、上記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４に接続される速度および角度センサを用いて、各車輪６０の速度および角位置を上記マスタコントローラに提供し、上記マスタコントローラは、
−上記ロボット５０の開始位置および停止位置と、上記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４によって提供される、各車輪６０の現在の速度および角位置とを受信するための入力手段と、
−上記フレーム構造に対する上記ロボット５０の位置を受信するための入力手段と、
−各車輪６０の現在の速度および角位置と、上記ロボット５０の現在の位置と、上記ロボット５０の開始位置および停止位置とに基づいて、車輪６０の各対Ｗ１−２およびＷ３−４に対して速度駆動シーケンスＶｓｅｑ１−２、Ｖｓｅｑ３−４を設定するための計算手段と、
−車輪６０の各対Ｗ１−２およびＷ３−４の加速および減速を制御するために、上記速度駆動シーケンスＶｓｅｑ１−２、Ｖｓｅｑ３−４を上記ローカルコントローラＣｏｎｔｒｏｌｌｅｒ１−２、Ｃｏｎｔｒｏｌｌｅｒ３−４のそれぞれに伝送するための出力手段と
を備える、マスタコントローラ。
（項目９）
上記ロボット５０内に備えられる追跡センサに接続されることを特徴とする、項目８に記載のコントローラ。
（項目１０）
上記ロボット５０内に具現化されることを特徴とする、項目８または９に記載のコントローラ。
（項目１１）
プロセッサによって実行されると、項目１−７に記載の方法を実施する、ソフトウェアプログラム製品。
【国際調査報告】
2019533857.tif 000006
2019533857.tif 000007