JP7438453B2 - ロボット制御装置、ロボット制御プログラムおよびロボット制御方法 - Google Patents

Description

本開示は、多関節ロボットを始点から終点へ移動させるロボット制御装置、ロボット制御プログラムおよびロボット制御方法に関する。

始点から終点までロボットを動作させる通常のポイントトゥポイント制御において、作業実施中の処理を減らし演算速度を上げるため、ロボット本体および周辺環境に関する制約を考慮した動作指令を作業実施前に生成することがある。また、生産性の向上のため、軌道を作業実施前に生成する際には、動作時間など生産性を定量的に表現する評価値を一定の範囲内に収める軌道を生成することが望ましい。ロボット作業の対象物体の位置および姿勢が固定されていない場合には、対象物体の実際の位置および姿勢に応じて動作軌道を生成する必要がある。全ての制約を満たす動作軌道を生成するには、計算時間がかかるため、すでに生成済みの動作軌道の情報を用いて軌道生成にかかる時間を短縮する取り組みが広く行われている。

特許文献１に記載の技術では、複数の作業領域をある順番で通過して作業を行う動作軌道があらかじめ生成されている場合を想定している。動作軌道は複数の作業領域区間に分割されている。周辺障害物の配置または形状が変化することで、動作軌道の一部が障害物と干渉すると判断された際に、干渉が発生する作業領域区間のみ軌道を再生成している。

特許第６５６０８４１号公報

特許文献１では、干渉が発生する特定の作業領域区間の軌道を変更することが可能であるが、変更対象となる区間は障害物との干渉が発生したと判定される区間で固定されている。しかし、対象物体の位置および姿勢が異なるとき、変更対象とする区間を適切に設定しなければ、変更しない区間との接続を考えた際に評価値が許容できる範囲を超えて悪化する場合がある。例えば、事前に生成した軌道よりもロボットの手先を大きく傾ける必要がある場合に、変更対象の区間が短いと、手先の変更動作を待つ待ち時間が必要となり、動作時間が長くなる可能性がある。

本開示は、上記に鑑みてなされたものであり、対象物体の位置および姿勢がばらつく場合においても、評価値が一定の範囲内となる軌道を生成する時間を短縮することが可能なロボット制御装置を得ることを目的としている。

上述した課題を解決し、目的を達成するために、本開示におけるロボット制御装置は、ロボットのエンドエフェクタを始点から終点まで移動させて、対象物体に対して予め設定されたタスクを実行する。ロボット制御装置は、対象物体が取り得る複数の位置および姿勢の組の各々に対応して、参照軌道および分岐点が記憶される記憶部と、タスクの実行時に、対象物体の位置および姿勢を計測する計測部と、計測された対象物体の位置および姿勢に対応する参照軌道および分岐点を記憶部から取得し、計測された対象物体の位置および姿勢を終点に設定し、取得された参照軌道をそのまま使用して始点から分岐点までのロボットの動作軌道である第１の動作軌道を生成し、取得された分岐点から終点までのロボットの動作軌道である第２の動作軌道を生成する個別軌道生成部と、第１の動作軌道および第２の動作軌道を含む動作指令に従ってロボットを駆動制御するロボット制御部と、を備える。参照軌道は、始点から、対象物体が取り得る複数の位置および姿勢の組のうちの一つである第１点までのロボットの動作軌道であって、障害物との干渉を回避でき、かつ評価値が第一の範囲に入ることを満足する動作軌道である。分岐点は、参照軌道上の一点であって、分岐点から第１点までの動作軌道の評価値が第一の範囲とは異なる第二の範囲に入ることを満足する点である。

本開示によれば、対象物体の位置および姿勢がばらつく場合においても、評価値が一定の範囲内となる軌道を生成する時間を短縮することが可能となるという効果を奏する。

実施の形態１におけるロボットシステムの構成を示す概念図 実施の形態１における対象物体の平面内の回転ずれを概念的に示す平面図 実施の形態１におけるハンドアプローチの複数の候補を示す概念図 実施の形態１におけるロボット制御装置の全体構成を示すブロック図 実施の形態１における目標集合を説明するための概念図 実施の形態１における目標集合内の位置定義を説明するための図 実施の形態１における対象物体の回転ずれ角が異なる複数のパターンを説明するための図 実施の形態１における対象物体へのハンドアプローチが異なる複数のパターンを説明するための図 実施の形態１における目標集合から個別分岐点記憶部に参照軌道および分岐点を追加する軌道生成部の動作を示すフローチャート 実施の形態１における参照軌道の生成に使用する対象物体の位置の選択例を示す概念図 実施の形態１における参照軌道の生成に使用する対象物体の位置の他の選択例を示す概念図 実施の形態１における参照軌道の生成に使用する対象物体の位置の他の選択例を示す概念図 実施の形態１における参照軌道と分岐点との関係を示す概念図 実施の形態１における分岐点を算出する手順を示すフローチャート 実施の形態１における参照軌道と障害物との関係を示す概念図 実施の形態１における分岐点の選択範囲に関する概念図 実施の形態１における個別軌道生成部による軌道生成の方法を示す概念図 実施の形態１における個別軌道生成部およびロボット制御部の処理手順を示すフローチャート 実施の形態２における個別軌道の生成の動作手順を示すフローチャート 実施の形態２における参照軌道および個別軌道を示す概念図 実施の形態１および実施の形態２にかかるロボット制御装置のハードウェア構成を示すブロック図

以下に、実施の形態にかかるロボット制御装置、ロボット制御プログラムおよびロボット制御方法を図面に基づいて詳細に説明する。

実施の形態１．
図１は、実施の形態１におけるロボットシステム１００の構成を示す概念図である。図１に示すように、ロボットシステム１００は、複数の軸および複数のアームを有する多関節のロボット１０１と、ロボット１０１のアームの先端に装着されているエンドエフェクタ１０２と、ベルトコンベア１０３と、外部センサ１０４とを備えている。ロボット１０１は、エンドエフェクタ１０２を始点Ｐｓから終点Ｐｅまで移動させ、予め設定されたタスクを実行する。終点Ｐｅは、固定されておらず、ベルトコンベア１０３上を流れる対象物体２００の位置および姿勢に基づいて定義される。計測部としての外部センサ１０４は、対象物体２００の位置および姿勢を、ロボット１０１の実動作の直前に入手する。

ベルトコンベア１０３は、移動速度Ｖ[mm/s]をもって一定方向に搬送動作をしており、ベルトコンベア１０３上には対象物体２００を固定する治具が存在しない。このため、対象物体２００はロボット１０１に対する相対位置および姿勢が毎回同じにはならない。

図２は、実施の形態１における対象物体２００の平面内の回転ずれを概念的に示す平面図である。また、図３は、実施の形態１におけるハンドアプローチの複数の候補を示す概念図である。

図２では、ベルトコンベア１０３の積載面を上から見ている。ベルトコンベア１０３上には対象物体２００を固定する機構がないため、対象物体２００はベルトコンベア１０３の積載面の法線ベクトル、ここでは紙面に垂直な方向のベクトルを回転軸として回転ずれが生じる。この回転ずれをベルトコンベア１０３に対する平面内回転と呼び、その回転角を回転ずれ角と呼ぶ。

対象物体２００を不定形物と仮定した際、対象物体２００の形状に応じて、エンドエフェクタ１０２を対象物体２００に近づける軌道を適切に選択しなければ、タスクの達成が困難となる場合がある。本実施の形態では、図３に示すように、エンドエフェクタ１０２を対象物体２００に近づける軌道であるハンドアプローチを、エンドエフェクタ１０２に対し事前に複数用意し、対象物体２００の形状からタスクを達成可能なハンドアプローチを一つ選択する。図３では、ハンドアプローチＨＡおよびハンドアプローチＨＢを含む２つのハンドアプローチが示されている。

実施の形態１では、ロボット１０１に対する対象物体２００の位置および姿勢のばらつきは、三次元の並進方向の位置ずれと、ベルトコンベア１０３に対する平面内回転と、エンドエフェクタ１０２と対象物体２００の形状に基づいて選択されるハンドアプローチとを含む３つの要素のセットで一つのパターンとみなす。

図４は、実施の形態１のロボット制御装置の全体構成を示すブロック図である。ロボット制御装置は、周辺装置情報取得部３０１と、タスク情報取得部３０２と、目標集合設定部３０３と、参照軌道生成部３０４および分岐点指定部３０５を含む軌道生成部３１０と、記憶部としての個別分岐点記憶部３０６と、センサ情報取得部３０７と、個別軌道生成部３０８と、ロボット制御部３０９とを有する。

周辺装置情報取得部３０１は、ロボット１０１の周辺装置に関する情報である周辺装置情報を取得する。周辺装置情報は、ベルトコンベア１０３の移動速度Ｖである。タスク情報取得部３０２は、軌道生成を行うタスクに関する情報であるタスク情報を取得する。タスク情報は、少なくとも、使用するエンドエフェクタ１０２の種類、対象物体２００の種類、タスクの目標動作を含む。タスクの目標動作には、対象物体２００の把持、配置などが含まれる。

目標集合設定部３０３は、周辺装置情報取得部３０１から周辺装置情報であるベルトコンベア１０３の移動速度Ｖを取得する。また、目標集合設定部３０３は、タスク情報取得部３０２からタスク情報を取得する。

目標集合設定部３０３は、ベルトコンベア１０３の移動速度Ｖと、タスク情報とを用いて対象物体２００の存在し得る位置の集合である目標集合２０１と、目標集合２０１の内部での対象物体２００の存在し得る姿勢と、ハンドアプローチとの組み合わせを算出する。

図５は、実施の形態１における目標集合２０１を説明するための概念図である。本実施の形態における目標集合２０１の算出方法について述べる。本実施の形態では、図５に示す目標集合２０１は、ベルトコンベア１０３の移動速度Ｖに基づいて計算される。対象物体２００に対するロボット１０１の動作にかかる時間（動作時間）の上限値をＴ[s]とおくと、コンベア移動方向の目標集合２０１の長さは、Ｔ×Ｖと設定できる。また、コンベア移動方向と直交する方向の目標集合２０１の長さは、例えばベルトコンベア１０３の幅Ｗ[mm]と設定できる。対象物体２００に対するロボット１０１の動作時間とは、例えば、ロボット１０１が始点Ｐｓから終点Ｐｅまで移動されて、予め設定されたタスクの実行を終了するまでの時間である。本実施の形態では、コンベア高さ方向のばらつきは考慮していないが、コンベア高さ方向のばらつきを考慮し三次元の目標集合２０１を生成してもよい。

目標集合２０１の範囲は、ロボットシステム１００のユーザーが想定する作業領域の限界として、ベルトコンベア１０３の移動速度Ｖに関係なくユーザーが直接指定してもよい。

次に、目標集合２０１に含まれる、対象物体２００のばらつきパターンの算出方法について述べる。図６は、実施の形態１における目標集合２０１内の位置定義を説明するための図である。図７は、実施の形態１における対象物体２００の回転ずれ角が異なる複数のパターンを説明するための図である。図８は、実施の形態１における対象物体２００へのハンドアプローチが異なる複数のパターンを説明するための図である。

図６に示すように、目標集合２０１内の空間を任意の大きさで複数に分割し、分割された複数のグリッドの各々の中心位置にグリッド点Ｇを定義する。各グリッド点Ｇは、自グリッド点の位置を示す位置情報を有している。対象物体２００の並進ずれの位置は、グリッド点Ｇを指定することで規定する。図６では、目標集合２０１内がマトリックス状にＮ１（＝２５）個のグリッドに分割されており、２５個のグリッド点Ｇを有している。図７では、対象物体２００の平面内回転の回転ずれ角が異なるＮ２（＝３）個のパターンが示されている。図８では、異なるＮ３（＝３）個のハンドアプローチＨＡ，ＨＢ，ＨＣの軌道が示されている。

各グリッド点Ｇについて、対象物体２００の平面内回転の回転ずれ角が異なるＮ２個のパターンのバリエーションと、ハンドアプローチが異なるＮ３個のパターンのバリエーションが考えられるため、一つのグリッド点Ｇに対し、ばらつきパターンは最大Ｎ２×Ｎ３個存在する。Ｎ２，Ｎ３に関しては、予め１以上の数を設定しておく。回転ずれ角の刻み量は任意に決定してよい。したがって、目標集合２０１内には合計Ｎ１×Ｎ２×Ｎ３個の対象物体２００のばらつきパターンが設定され、軌道生成部３１０は、Ｎ１×Ｎ２×Ｎ３個の各ばらつきパターンについて分岐点の算出を行う。

次に、図４に示す軌道生成部３１０について述べる。軌道生成部３１０は参照軌道生成部３０４と、分岐点指定部３０５とで構成される。

図９は、実施の形態１における目標集合２０１から個別分岐点記憶部３０６に参照軌道および分岐点を追加する軌道生成部３１０の動作を示すフローチャートである。図１０は、実施の形態１における参照軌道の生成に使用する対象物体２００の位置の選択例を示す概念図である。図１１は、実施の形態１における参照軌道の生成に使用する対象物体２００の位置の他の選択例を示す概念図である。図１２は、実施の形態１における参照軌道の生成に使用する対象物体２００の位置の他の選択例を示す概念図である。

まず、参照軌道生成部３０４は目標集合設定部３０３で算出された目標集合２０１と、目標集合２０１に含まれる対象物体２００の全てのばらつきパターンとを読み込む（Ｓ１０１）。

次に、参照軌道生成部３０４は、複数のばらつきパターンのうち一部のグリッド点Ｇを持つばらつきパターンを選択し、選択されたばらつきパターンを用いて評価値が第一の範囲内となる参照軌道を生成する（Ｓ１０２）。すなわち、参照軌道生成部３０４は、既定の始点Ｐｓを動作始点とし、目標集合２０１内の少なくとも一つの特定のばらつきパターンを終点Ｐｅとし、任意の軌道生成手法を用いて評価値が第一の範囲内となる参照軌道を生成する。

本実施の形態では、評価値として前述した動作時間を選択する。第一の範囲として、動作時間がＴ１[s]以内と設定する。したがって、動作時間がＴ１以内である参照軌道が生成される。なお、評価値として、対象物体２００に対するロボット１０１の動作を繰り返し実行した際のロボット１０１の予測寿命、対象物体２００に対するロボット１０１の動作を実行した際にロボット１０１が消費する電力などを使用してもよい。

Ｓ１０２で選択するばらつきパターンは任意に選択してよいが、例えば図１０に示すように、目標集合２０１の中心位置のグリッドのグリッド点Ｇを位置情報として有するばらつきパターンを選択することが考えられる。また、目標集合２０１が広範囲にわたる場合は、図１１に示すように、目標集合２０１の中心のグリッドのグリッド点Ｇのばらつきパターンと、目標集合２０１の四隅部分にあたるグリッド点Ｇを位置情報として有するばらつきパターンを選択してもよい。図１１の手法では、複数のグリッド点Ｇが選択されるので、複数の参照軌道が生成される。回転ずれ角については、例えば、Ｎ２個のパターンのバリエーションのうちの一つをあらかじめ選択しておく。

また、Ｓ１０２で選択するばらつきパターンは、図１２に示すように、目標集合２０１内で、実際の動作時に発生頻度が最も高かったグリッドＧ１に含まれるグリッド点を位置情報として持つばらつきパターンを選択してもよい。グリッドＧ１は、太い線で示している。この選択方法を選ぶと、実動作時に最も発生確率が高いパターンに対し評価値が第一の範囲内に収まる軌道を生成できるため生産性が向上する。

参照軌道を生成するための軌道生成手法として、ＲＲＴ（Rapidly Exploring Random Trees）などのランダムサンプリング手法、ＣＨＯＭＰ（Covariant Hamiltonian Optimization for Motion Planning）などの軌道パラメータ最適化手法、グラフ解法、強化学習手法など公知技術を使用できる。また、これらの手法を組み合わせて使用してもよい。加えて、システムユーザーがマニュアル教示した軌道を使用してもよい。

本実施の形態では、参照軌道の軌道生成に関する制約として、ロボット１０１の各軸モータの角度制約、角速度制約、角加速度制約、およびロボット１０１とロボットシステム１００に含まれる障害物と衝突しないことを考慮する。したがって、生成された参照軌道は、作業空間内にある障害物との干渉を回避できる軌道である。

次に、目標集合設定部３０３で算出した各ばらつきパターンについて、分岐点を記録したかどうか確認する（Ｓ１０３）。全てのばらつきパターンについて分岐点を記録した場合は（Ｓ１０３：Ｙｅｓ）、処理を終了する。そうでない場合は（Ｓ１０３：Ｎｏ）、Ｓ１０４へ移る。

分岐点指定部３０５は、全てのばらつきパターンのうち、まだ分岐点が記録されていないパターンの中から一つを選択する（Ｓ１０４）。

次に、分岐点指定部３０５は、参照軌道を一本選択する（Ｓ１０５）。参照軌道が一本の場合は、その軌道を選択する。本実施の形態では、図１１のように、参照軌道が複数本存在する場合は、対象として選択されたばらつきパターンの位置に対し、一番近い終点Ｐｅであるグリッド点Ｇを持つ参照軌道を選択する。例えば、図１１において、最も左側で上から２番目のグリッドがばらつきパターンとして選択された場合は、上左角のグリッドを終点Ｐｅとして持つ参照軌道が選択される。同じ近さの複数の参照軌道が存在する場合は、その複数の参照軌道から一つの参照軌道を選択するためのルールを予め設定しておく。

図１３は実施の形態１における参照軌道２０２と分岐点２０４との関係を示す概念図である。分岐点２０４と参照軌道２０２との関係性について述べる。目標集合２０１内の、参照軌道２０２以外の終点Ｐｅに到達するためのロボット１０１の動作軌道を個別軌道２０３と呼ぶ。個別軌道２０３は、参照軌道２０２と軌道の一部を共有する。個別軌道２０３が参照軌道２０２とは別の軌道となる区間の開始位置を、分岐点２０４と呼ぶ。すなわち、分岐点２０４は一本の個別軌道２０３に対し一点、参照軌道２０２の中の点から選択される。図１３には、障害物２０５が図示されている。

図１４は、実施の形態１における分岐点２０４を算出する手順を示すフローチャートであり、図９のＳ１０６で行う処理の詳細を示すものである。Ｓ１０６では、評価値が第二の範囲内となる分岐点の候補が探索される。図１５は、実施の形態１における参照軌道２０２と障害物２０５との関係を示す概念図である。図１６は、実施の形態１における分岐点２０４の選択範囲に関する概念図である。

まず、分岐点指定部３０５による分岐点２０４の指定処理について述べる。分岐点指定部３０５は、参照軌道２０２の中から分岐点２０４の候補となる動作点を複数抽出する（Ｓ２０１）。分岐点２０４の候補となる動作点は、ロボット１０１に設置されたエンドエフェクタ１０２の位置および姿勢を一意に決定する状態量の組で表される。本実施の形態では、ロボット１０１の各軸モータの角度の組で、分岐点２０４の候補となる動作点を表す。このとき参照軌道２０２は、ロボット１０１の各軸モータの角度の組に始点Ｐｓを時刻０と置いたときの時刻ラベルを付与したデータの集合で構成される。

次に、本実施の形態における、分岐点２０４の候補となる動作点を含む参照軌道２０２の区間について述べる。参照軌道２０２は、前述したように、作業空間内にある障害物２０５との干渉を回避できる軌道である。参照軌道２０２の早い段階で分岐点２０４を指定し、個別軌道２０３の終点Ｐｅまでの残り部分を生成しようとすると、考慮すべき障害物２０５の数が多くなり、個別軌道２０３の生成に時間がかかる。このため、可能な限り障害物２０５が回避された段階で、分岐点２０４から個別軌道２０３へ軌道を分岐させることが望ましい。

例えば、図１５に示すように、作業空間に存在する障害物２０５の外周に一定の距離Ｌでマージンを取った仮障害物２０６を設定する。距離Ｌは任意に指定してよい。分岐点２０４の候補となる区間は、参照軌道２０２を終点Ｐｅ側から始点Ｐｓ側にさかのぼった際に、仮障害物２０６と衝突する点Ｐｘ１までの区間Ｃ１とする。すなわち、参照軌道２０２のうち、仮障害物２０６に対しエンドエフェクタ１０２と、ロボット本体との干渉が発生しない区間の中から分岐点２０４が選択される。ロボット本体は、ロボット１０１のエンドエフェクタ１０２以外の部分のことを指す。

また、選択したばらつきパターンの位置が、参照軌道２０２の終点Ｐｅよりも始点Ｐｓに近い場合は、参照軌道２０２の終点Ｐｅ付近に分岐点２０４を指定すると、分岐点２０４から選択したばらつきパターンの位置まで、個別軌道２０３が引き返す可能性があり、評価値の値が悪化する恐れがある。このため、図１６に示すように、参照軌道２０２の終点Ｐｅと、選択したばらつきパターンの位置Ｐｘ２との間の範囲ｄに対応する、参照軌道２０２上の区間Ｃ２に含まれる動作点を分岐点２０４の候補から除外する。

次に、分岐点指定部３０５は、全ての分岐点２０４の候補について、個別軌道２０３の評価値を計算したか否かを確認する（Ｓ２０２）。分岐点指定部３０５は、全ての分岐点２０４の候補について、個別軌道２０３の評価値を計算していない場合（Ｓ２０２：Ｎｏ）、Ｓ２０１で抽出した分岐点２０４の複数の候補の中から一点選択する（Ｓ２０３）。そして、分岐点指定部３０５は、選んだ分岐点２０４の一つの候補から、Ｓ１０４で選択された一つのばらつきパターンの位置までの軌道である個別軌道２０３を生成する（Ｓ２０４）。ここで、分岐点指定部３０５は、この個別軌道２０３の生成の際、後述する個別軌道生成部３０８で行われる個別軌道２０３の生成と同じ手法を用いる。分岐点指定部３０５は、Ｓ２０４で生成された個別軌道２０３の評価値の値を計算する（Ｓ２０５）。

図１７は、実施の形態１における個別軌道生成部３０８による軌道生成の方法を示す概念図である。分岐点指定部３０５も、図１７と同様に処理によって、個別軌道２０３を生成する。以下、個別軌道２０３の生成方法について述べる。本実施の形態では、関節補間手法を用いて分岐点２０４以降の軌道を生成する。関節補間手法は、個別軌道２０３を生成するための第１の演算の一つである。

図１７は、ロボット１０１の軸数が２個の場合について示した概念図であるが、２個以上の軸数についても同様の手法を適用できる。図１７では、軸１の指令角速度のタイムチャートおよび軸２の指令角速度のタイムチャートが示されている。図１７において、ｋｔは加速時間を示し、ｇｔは減速時間を示し、ｔｔが定速時間を示している。

まず、個別軌道生成部３０８は、ロボット１０１の各軸モータが出力可能な最高速度に対して、分岐点２０４から終点Ｐｅである選択された一つのばらつきパターンの位置までの角度変化量が最大となる軸を選択する。この角度変化量が最大となる軸のことを、本実施の形態では代表軸ｊ´と呼ぶ。図１７によれば、軸１の角度変化量が軸２の角度変化量より大きいので、軸１が代表軸ｊ´となる。代表軸ｊ´は、複数の軸ｊ（ｊ＝１，２，…）から式（１）を満たす軸ｊを選択する。ここで、θ_ｓｊは分岐点２０４における軸ｊの角度、θ_Ｇｊは終点Ｐｅである選択された一つのばらつきパターンの位置における軸ｊの角度、ｖ_ｍａｘ_ｊは軸ｊのモータが実現できる最高速度であるとする。式（１）の右辺は、軸ｊの角度変化量が、軸ｊのモータの実現できる最高速度ｖ_ｍａｘ_ｊに対しどの程度の大きさにあるかを示している。

代表軸である軸ｊ´（ｊ´＝１）の軌道上での最高速度ｖｊ´_ｍａｘはｖｊ´_ｍａｘ＝ｖ_ｍａｘ_ｊ´とする。このとき、代表軸ｊ´以外の軸ｊのモータの動作中の最高速度ｖｊ_ｍａｘを、式（２）のように仮置きする。式（２）において、（θ_Ｇｊ－θ_ｓｊ）は代表軸ｊ´以外の軸ｊの角度変化量を示し、（θ_Ｇｊ´－θ_ｓｊ´）は、代表軸ｊ´の角度変化量を示している。

仮置きした各軸の動作中の最高速度ｖｊ_ｍａｘと、各軸の分岐点２０４での角速度ｖｊ_ｓ、各軸の終点Ｐｅでの角速度ｖｊ_ｅと、ロボット１０１の速度制約、加速度制約とから加速時間ｋｔおよび減速時間ｇｔが決定される。加速時間ｋｔおよび減速時間ｇｔが決定されると、代表軸ｊ´に関する以下の式（３）を定速時間ｔｔについて解くことで定速時間ｔｔが決定される。式（３）では、便宜上、式（３）中の各記号に´を付すことを省略している。

式（３）をｖｊ_ｍａｘについて解くことで、仮置きした代表軸ｊ´以外の軸ｊの最高速度ｖｊ_ｍａｘを決定する。以上の計算によって、ロボット１０１に含まれる全ての軸について、分岐点２０４以降の角速度指令値が求められる。したがって、角速度指令値を時刻で積分することで、分岐点２０４以降の動作点と時刻ラベルとの組が計算できる。

分岐点指定部３０５は、このようにして、分岐点２０４の複数の候補の中から選択された一つの分岐点２０４から、Ｓ１０４で選択された一つのばらつきパターンの位置までの軌道である個別軌道２０３を生成した後（Ｓ２０４）、生成された個別軌道の評価値を計算する（Ｓ２０５）。次に、分岐点指定部３０５は、計算された評価値の値が、第二の範囲内か否かを確認する（Ｓ２０６）。本実施の形態では、第二の範囲として動作時間Ｔ２[s]以内と設定する。Ｔ２＞Ｔ１と設定する。第二の範囲は、第一の範囲より広い範囲が設定される。

分岐点指定部３０５は、評価値が第二の範囲内にある場合は（Ｓ２０６：Ｙｅｓ）、選択した分岐点を正式な分岐点として指定する（Ｓ１０８）。評価値が第二の範囲内に入っていない場合は（Ｓ２０６：Ｎｏ）、手順は、Ｓ２０２に戻る。手順がＳ２０２に戻ると、Ｓ２０１で抽出された分岐点２０４の複数の候補のなかの他の候補が選択され、その後、Ｓ２０２～Ｓ２０６の処理が実行されることで、選択された他の候補の個別軌道２０３の評価値が第二の範囲内になるか否かが判定される。このようにして、Ｓ２０２～Ｓ２０６の処理が繰り返されることにより、個別軌道２０３の評価値が第二の範囲内になる分岐点２０４が得られる。

また、Ｓ２０２～Ｓ２０６の処理が繰り返された後、Ｓ２０２の判断がＹｅｓとなった場合は、Ｓ２０１で抽出された分岐点２０４の複数の候補が全て、第二の範囲から逸脱しないという条件を満たしていないことになる。このような場合、手順はＳ１０７に移行される。Ｓ１０７では、Ｓ１０２で生成された参照軌道２０２以外の参照軌道２０２を新たに生成し、参照軌道２０２に追加する。具体的には、Ｓ１０４で選択されたばらつきパターンと異なるばらつきパターンを選択し、新たに選択されたばらつきパターンを用いて評価値が第一の範囲内となる参照軌道２０２を生成する（Ｓ１０７）。そして、新たに生成された参照軌道２０２を用いてＳ２０２～Ｓ２０６の処理が繰り返されることで、評価値が第二の範囲内にある分岐点２０４が決定される。

Ｓ１０８で分岐点２０４が指定されると、分岐点指定部３０５は、Ｓ１０４で選択されたばらつきパターンと、Ｓ１０５で選択された参照軌道２０２またはＳ１０７で追加された参照軌道２０２と、Ｓ１０８で指定された分岐点２０４とをセットにして、個別分岐点記憶部３０６に記録する（Ｓ１０９）。すなわち、分岐点指定部３０５は、ばらつきパターンと、参照軌道２０２と、分岐点２０４とのセットである軌道セットデータを個別分岐点記憶部３０６に記録する。

個別分岐点記憶部３０６への記録が終了すると、手順はＳ１０３に移行される。Ｓ１０３では、目標集合設定部３０３で算出された全てのばらつきパターンについて分岐点２０４を記録したか否かが判定される。分岐点２０４が記録されていないばらつきパターンが残っている場合は、軌道生成部３１０は、Ｓ１０３～Ｓ１０９の処理、Ｓ２０１～Ｓ２０６の処理を繰り返し実行することで、全てのばらつきパターンについての分岐点２０４を個別分岐点記憶部３０６に記録する。

図１８は、実施の形態１における個別軌道生成部３０８およびロボット制御部３０９の処理手順を示すフローチャートである。ロボット制御部３０９は、ロボット１０１での実作業時、個別分岐点記憶部３０６の記録情報を用いてロボット１０１の動作指令を生成する。

まず、センサ情報取得部３０７は、外部センサ１０４を用いて、対象物体２００の実際の位置、姿勢、および形状を測定する（Ｓ３０１）。また、個別軌道生成部３０８は、タスク情報取得部３０２からエンドエフェクタ１０２の種類と対象物体２００の種類を取得し、周辺装置情報取得部３０１からベルトコンベア１０３の移動速度Ｖを取得する。個別軌道生成部３０８は、対象物体２００の形状およびタスク情報から、ハンドアプローチを選択する。

次に、個別軌道生成部３０８は、個別分岐点記憶部３０６から、対象物体２００の実際の位置および姿勢に最も近いばらつきパターンを有する軌道セットデータを読み出す。そして、個別軌道生成部３０８は、読み出した軌道セットデータに含まれる参照軌道２０２および分岐点２０４を取り出す（Ｓ３０２）。

つぎに、個別軌道生成部３０８は、Ｓ３０１で取得した対象物体２００の実際の位置および姿勢を終点Ｐｅ´として、取り出した分岐点２０４から、終点Ｐｅ´までの個別軌道を生成する（Ｓ３０３）。個別軌道の生成の際は、図１７を用いて説明した手法が用いられる。個別軌道生成部３０８は、始点ＰｓからＳ３０２で取り出された分岐点２０４までの軌道については、Ｓ３０２で取り出された参照軌道２０２をそのまま使用する。始点Ｐｓから分岐点２０４までの軌道が請求の範囲の第１の動作軌道に対応し、分岐点２０４から終点Ｐｅ´までの軌道が請求の範囲の第２の動作軌道に対応する。

最後に、個別軌道生成部３０８は、生成された分岐点２０４から終点Ｐｅ´までの個別軌道と、始点Ｐｓから分岐点２０４までの区間の参照軌道２０２とを含む動作指令をロボット制御部３０９に送信する（Ｓ３０４）。ロボット制御部３０９は、受信した動作指令に従ってロボット１０１を駆動する。これによって、ロボット１０１は、エンドエフェクタ１０２を始点Ｐｓから終点Ｐｅまで移動させ、対象物体２００に対し予め設定されたタスクを実行する。

このように実施の形態１によれば、始点Ｐｓから分岐点２０４までは、障害物２０５との干渉を回避できかつ評価値が第一の範囲に入ることを満足する動作軌道である参照軌道２０２をそのまま使用して動作軌道が生成され、分岐点から対象物体２００までは、対象物体２００の実際の位置および姿勢に合わせて動作軌道が生成されるため、対象物体２００の位置および姿勢がばらつく場合においても、評価値が一定の範囲内となる軌道を計算するための時間を短縮することが可能となり、生産性を向上させることができる。

また、実施の形態１によれば、個別軌道２０３を生成する際に評価値が一定の範囲内に収まるように分岐点２０４が選定される。このため、生成される軌道は一定の生産性を保証することができる。また、実施の形態１によれば、参照軌道２０２に含まれる動作点のうち、軌道周辺の障害物２０５の外周に一定の距離Ｌでマージンを取った仮障害物２０６に対し干渉が発生しない動作点の中から分岐点２０４の候補を選ぶようにしている。このため、個別軌道２０３の生成時に考慮すべき障害物２０５の数が減るため、個別軌道２０３の生成にかかる時間が短縮できる。

また、実施の形態１によれば、対象物体２００の想定されるばらつきにハンドアプローチの違いも含めているため、対象物体２００のばらつきに対応してエンドエフェクタ１０２の操作も含めてタスクを効率よく達成することができる。また、実施の形態１によれば、参照軌道２０２内に個別軌道２０３の評価値が指定の範囲内に収まるような分岐点２０４が無い場合に、参照軌道２０２を新たに生成し追加することで、目標集合２０１内の全てのばらつきパターンに対し動作軌道を生成することを保証できる。

実施の形態２．
実施の形態１では、目標集合２０１に含まれる対象物体２００の全てのばらつきパターンに対し、参照軌道２０２および分岐点２０４を別々に設定した。これに対し、実施の形態２では、目標集合２０１に含まれる全てのばらつきパターンに対し、参照軌道２０２および分岐点２０４を１つ設定する。すなわち、実施の形態２では、１つの参照軌道２０２および１つの分岐点２０４は、全てのばらつきパターンで共用される。

図１９は、実施の形態２における個別軌道２０３の生成の動作手順を示すフローチャートである。図２０は、実施の形態２における参照軌道２０２および個別軌道２０３を示す概念図である。実施の形態２では、ロボットシステム１００は、実施の形態１と同じものを使用する。また、目標集合設定部３０３、参照軌道生成部３０４も実施の形態１と同じ処理を実行する。

図２０に示すように、実施の形態２では、目標集合２０１に含まれる対象物体２００の全てのばらつきパターンに対し、１つの参照軌道２０２および１つの分岐点２０４を有している。したがって、実施の形態２では、始点Ｐｓから分岐点２０４までの区間では、参照軌道２０２がそのまま使用され、分岐点２０４から実際の終点Ｐｅまでの区間では、分岐点２０４から実際の終点Ｐｅまでの個別軌道が実際の終点Ｐｅの位置、姿勢に応じて生成される。例えば、実際の終点Ｐｅが左上の角部であれば、個別軌道２０３－Ｃが生成され、実際の終点Ｐｅが左下の角部であれば、個別軌道２０３－Ｄが生成され、実際の終点Ｐｅが右上の角部であれば、個別軌道２０３－Ａが生成され、実際の終点Ｐｅが右下の角部であれば、個別軌道２０３－Ｂが生成される。

以下、図１９に従って、１つの参照軌道２０２および１つの分岐点２０４を生成するための手順を説明する。まず、目標集合設定部３０３は、実施の形態１と同様にして、目標集合設定部３０３で算出された目標集合２０１と、目標集合２０１に含まれる対象物体２００の全てのばらつきパターンを読み込む（Ｓ４０１）。

次に、参照軌道生成部３０４は、複数のばらつきパターンのうち一部のグリッド点Ｇを持つばらつきパターンを選択し、選択されたばらつきパターンを終点Ｐｅとし、既定の始点Ｐｓを動作始点とし、実施の形態１と同様にして、任意の軌道生成手法を用いて評価値が第一の範囲内となる参照軌道２０２を生成する（Ｓ４０２）。軌道の評価値は実施の形態１と同様に動作時間とする。

軌道生成手法として、ＲＲＴなどのランダムサンプリング手法、ＣＨＯＭＰなどの軌道パラメータ最適化手法、グラフ解法、強化学習手法などの公知技術を使用できる。また、これらの手法を組み合わせて使用してもよい。加えて、システムユーザーがマニュアル教示した軌道を使用してもよい。

次に、分岐点指定部３０５は、分岐点２０４の候補となる点を参照軌道２０２の動作点のなかから指定する（Ｓ４０３）。分岐点２０４を選択する対象となる区間は、図１４～図１６を用いて説明したように、実施の形態１と同じ手法を採用する。

次に、分岐点指定部３０５は、目標集合２０１の全てのばらつきパターンに対し、Ｓ４０３で指定した分岐点２０４を使用する場合の個別軌道２０３の評価値を計算したかどうか確認する（Ｓ４０４）。未計算のばらつきパターンがある場合は（Ｓ４０４：Ｎｏ）、未計算のばらつきパターンの中から一つ選択し、個別軌道２０３の評価値を計算する（Ｓ４０５）。各個別軌道２０３の評価値の計算方法は、実施の形態１と同様とする。全てのばらつきパターンに対し、評価値を計算し終わった場合は（Ｓ４０４：Ｙｅｓ）、Ｓ４０６に移る。

次に、分岐点指定部３０５は、Ｓ４０３で選択された分岐点の候補に対し、全てのばらつきパターンの評価値の期待値を計算する（Ｓ４０６）。

評価値の期待値の計算方法としては、例えば、全てのばらつきパターンの評価値の等価平均を採用する。また、目標集合２０１の中央部のばらつきパターンに対応する個別軌道２０３の評価値の重みが、目標集合２０１の外側周辺のばらつきパターンに対応する個別軌道２０３の評価値の重みより、高くなるような重み付き平均としてもよい。さらに、実際の生産ラインでの各ばらつきパターンの発生回数に基づき期待値を計算してもよい。

分岐点指定部３０５は、計算された評価値の期待値が、第二の範囲内に入っているか否かを確認する（Ｓ４０７）。第二の範囲として、動作時間がＴ２[s]以内（Ｔ２＞Ｔ１）とする。評価値の期待値が第二の範囲内に入っている場合は（Ｓ４０７：Ｙｅｓ）、Ｓ４０９へ移行する。評価値の期待値が第二の範囲内に入っていない場合は（Ｓ４０７：Ｎｏ）、参照軌道２０２の中に分岐点２０４の候補となる他の点が残っているか確認する（Ｓ４０８）。候補が残っている場合は（Ｓ４０８：Ｙｅｓ）、Ｓ４０３に戻り別の分岐点２０４の候補を設定する。候補が残っていない場合は（Ｓ４０８：Ｎｏ）、Ｓ４０９へ移行する。なお、実施の形態２では、Ｓ４０７の判断の際に、第二の範囲より広い第三の範囲を設定してもよい。

Ｓ４０９においては、分岐点指定部３０５は、分岐点２０４を一つ選択し、参照軌道２０２とセットにして個別分岐点記憶部３０６に追加する。本実施の形態では評価値の期待値すなわち動作時間の期待値が最小となる分岐点２０４を選択する。個別分岐点記憶部３０６には、一組の分岐点２０４と参照軌道２０２とが記憶されることになる。

ロボット１０１での実作業時は、個別分岐点記憶部３０６は、個別分岐点記憶部３０６に記憶された一組の分岐点２０４と参照軌道２０２とを用いて、図１８で説明したのと同様にして、ロボット１０１の動作軌道を生成する。まず、外部センサ１０４を用いて、対象物体２００の実際の位置、姿勢、および形状が測定される。つぎに、個別分岐点記憶部３０６から、一組の分岐点２０４と参照軌道２０２とが取り出される。つぎに、対象物体２００の実際の位置および姿勢を終点Ｐｅ´として、取り出した分岐点２０４から、終点Ｐｅ´までの個別軌道が、図１７を用いて説明した手法を用いて生成される。始点Ｐｓから分岐点２０４までの軌道については、参照軌道２０２をそのまま採用する。その後、生成された分岐点２０４から終点Ｐｅ´までの個別軌道と、始点Ｐｓから分岐点２０４までの区間の参照軌道２０２とを含む動作指令に基づいて、ロボット１０１が駆動される。

このように実施の形態２によれば、複数のばらつきパターンに対し参照軌道２０２と分岐点２０４との組を一組のみ設定するため、個別分岐点記憶部３０６に記憶されるデータ量が削減できる。また、実施の形態２によれば、参照軌道２０２内の候補から評価値の期待値が最小になる点が分岐点２０４として選定されるため、実施の形態１と同様に、生成される軌道は一定の生産性を保証する。ただし、対象物体２００のばらつきパターンごとに分岐点２０４が指定される実施の形態１と比較すると、個々のばらつきパターンに対する個別軌道の生産性は低下する可能性がある。

ここで、図４に示したロボット制御装置のハードウェア構成について説明する。図２１は、実施の形態１および実施の形態２にかかるロボット制御装置のハードウェア構成を示すブロック図である。

ロボット制御装置は、図２１に示した演算装置４０４および記憶装置４０５を含むハードウェア構成４０６によって実現することができる。演算装置４０４の例は、ＣＰＵ（Central Processing Unit、中央処理装置、処理装置、演算装置、マイクロプロセッサ、マイクロコンピュータ、プロセッサ、ＤＳＰ（Digital Signal Processor）ともいう）またはシステムＬＳＩ（Large Scale Integration）である。記憶装置４０５の例は、ＲＡＭ（Random Access Memory）またはＲＯＭ（Read Only Memory）である。

ロボット制御装置は、演算装置４０４が、記憶装置４０５で記憶されている、ロボット制御装置の動作を実行するためのプログラムを読み出して実行することで実現される。また、このプログラムは、ロボット制御装置の手順または方法をコンピュータに実行させるものであるともいえる。

記憶装置４０５は、分岐点２０４および参照軌道２０２を記憶する。記憶装置４０５は、演算装置４０４が各種処理を実行する際の一時メモリにも使用される。

演算装置４０４が実行するプログラムは、インストール可能な形式または実行可能な形式のファイルで、コンピュータが読み取り可能な記憶媒体に記憶されてコンピュータプログラムプロダクトとして提供されてもよい。また、演算装置４０４が実行するプログラムは、インターネットなどのネットワーク経由でロボット制御装置に提供されてもよい。

また、ロボット制御装置は専用のハードウェアで実現してもよい。また、ロボット制御装置の機能について、一部を専用のハードウェアで実現し、一部をソフトウェアまたはファームウェアで実現するようにしてもよい。例えば、目標集合設定部３０３、参照軌道生成部３０４、分岐点指定部３０５および個別分岐点記憶部３０６をコンピュータに実行させ、センサ情報取得部３０７、個別軌道生成部３０８およびロボット制御部３０９をロボットコントローラに実行させてもよい。

以上の実施の形態に示した構成は、本開示の内容の一例を示すものであり、別の公知の技術と組み合わせることも可能であるし、本開示の要旨を逸脱しない範囲で、構成の一部を省略、変更することも可能である。

１００ ロボットシステム、１０１ ロボット、１０２ エンドエフェクタ、１０３ ベルトコンベア、１０４ 外部センサ、２００ 対象物体、２０１ 目標集合、２０２ 参照軌道、２０３ 個別軌道、２０４ 分岐点、２０５ 障害物、２０６ 仮障害物、３０１ 周辺装置情報取得部、３０２ タスク情報取得部、３０３ 目標集合設定部、３０４ 参照軌道生成部、３０５ 分岐点指定部、３０６ 個別分岐点記憶部、３０７ センサ情報取得部、３０８ 個別軌道生成部、３０９ ロボット制御部、３１０ 軌道生成部、４０４ 演算装置、４０５ 記憶装置、４０６ ハードウェア構成、Ｐｅ 終点、Ｐｓ 始点。

Claims (15)

1. ロボットのエンドエフェクタを始点から終点まで移動させて、対象物体に対して予め設定されたタスクを実行するロボット制御装置であって、
   前記対象物体が取り得る複数の位置および姿勢の組の各々に対応して、参照軌道および分岐点が記憶される記憶部と、
   前記タスクの実行時に、前記対象物体の位置および姿勢を計測する計測部と、
   計測された前記対象物体の位置および姿勢に対応する前記参照軌道および前記分岐点を前記記憶部から取得し、計測された前記対象物体の位置および姿勢を前記終点に設定し、取得された前記参照軌道を使用して前記始点から前記分岐点までの前記ロボットの動作軌道である第１の動作軌道を生成し、取得された前記分岐点から前記終点までの前記ロボットの動作軌道である第２の動作軌道を生成する個別軌道生成部と、
   前記第１の動作軌道および前記第２の動作軌道を含む動作指令に従って前記ロボットを駆動制御するロボット制御部と、
   を備え、
   前記参照軌道は、前記始点から、前記対象物体が取り得る複数の位置および姿勢の組のうちの一つである第１点までの前記ロボットの動作軌道であって、障害物との干渉を回避でき、かつ評価値が第一の範囲に入ることを満足する動作軌道であり、
   前記分岐点は、前記参照軌道上の一点であって、前記分岐点から前記第１点までの動作軌道の前記評価値が前記第一の範囲とは異なる第二の範囲に入ることを満足する点である
   ことを特徴とするロボット制御装置。
2. 前記対象物体が取り得る複数の位置および姿勢の組の集合を目標集合に設定する目標集合設定部と、
   前記目標集合に含まれる前記対象物体の少なくとも一つの位置および姿勢の組を選択し、選択した前記対象物体の位置および姿勢の組に基づいて前記参照軌道を生成する参照軌道生成部と、
   生成された前記参照軌道上から前記分岐点の複数の候補点を抽出し、抽出された複数の候補点から前記第１点までの複数の動作軌道のなかから前記評価値が前記第二の範囲に入る動作軌道を選択し、選択された動作軌道に対応する候補点を前記第１点に対応する分岐点に決定する第１の処理を、前記対象物体が取り得る複数の位置および姿勢の組の全てについて実行して、前記対象物体が取り得る位置および姿勢の組毎に、前記分岐点を算出し、算出された分岐点および生成された前記参照軌道を前記記憶部に記憶する分岐点指定部と、
   を備えることを特徴とする請求項１に記載のロボット制御装置。
3. 前記参照軌道生成部は、前記対象物体が取り得る複数の位置および姿勢の組に共通の一つの参照軌道を生成することを特徴とする請求項２に記載のロボット制御装置。
4. 前記参照軌道生成部は、前記目標集合の中心位置に前記一つの参照軌道を設定することを特徴とする請求項３に記載のロボット制御装置。
5. 前記参照軌道生成部は、前記ロボットの実際の動作時に発生頻度が最も高かった位置に前記一つの参照軌道を設定することを特徴とする請求項３に記載のロボット制御装置。
6. 前記参照軌道生成部は、前記対象物体が取り得る位置および姿勢の組に応じて異なる前記第１点に前記参照軌道を設定することを特徴とする請求項２に記載のロボット制御装置。
7. 前記参照軌道生成部は、前記評価値が前記第二の範囲に入る条件を満たす前記分岐点が存在しない場合に、新たな参照軌道を生成することを特徴とする請求項２に記載のロボット制御装置。
8. 前記記憶部は、前記対象物体が取り得る複数の位置および姿勢の組の各々に対応して、前記参照軌道、前記分岐点および前記対象物体へのハンドアプローチの軌道の組を記憶することを特徴とする請求項１に記載のロボット制御装置。
9. ロボットのエンドエフェクタを始点から終点まで移動させて、対象物体に対して予め設定されたタスクを実行するロボット制御装置であって、
   前記対象物体が取り得る複数の位置および姿勢の組に対し共通する一つの参照軌道および一つの分岐点が記憶される記憶部と、
   前記タスクの実行時に、前記対象物体の位置および姿勢を計測する計測部と、
   前記記憶部から前記参照軌道および前記分岐点を取得し、計測された前記対象物体の位置および姿勢を前記終点に設定し、前記取得された参照軌道を使用して前記始点から前記分岐点までの前記ロボットの動作軌道である第１の動作軌道を生成し、取得された前記分岐点から前記終点までの前記ロボットの動作軌道である第２の動作軌道を生成する個別軌道生成部と、
   前記第１の動作軌道および前記第２の動作軌道を含む動作指令に従って前記ロボットを駆動制御するロボット制御部と、
   を備え、
   前記参照軌道は、前記始点から、前記対象物体が取り得る複数の位置および姿勢の組のうちの一つである第１点までの前記ロボットの動作軌道であって、障害物との干渉を回避でき、かつ評価値が第一の範囲に入ることを満足する動作軌道であり、
   前記分岐点は、前記参照軌道上の一点であって、前記分岐点から前記対象物体が取り得る複数の位置および姿勢の組までの複数の動作軌道の前記評価値の平均が前記第一の範囲とは異なる第二の範囲に入ることを満足する点である
   ことを特徴とするロボット制御装置。
10. 前記対象物体が取り得る複数の位置および姿勢の集合を目標集合に設定する目標集合設定部と、
    前記目標集合に含まれる前記対象物体の一つの位置および姿勢の組を選択し、選択した前記対象物体の位置および姿勢の組に基づいて前記参照軌道を生成する参照軌道生成部と、
    生成された前記参照軌道上から前記分岐点の複数の候補点を抽出し、抽出された複数の候補点のうちの１つの候補点から前記対象物体が取り得る複数の位置および姿勢の組までの複数の動作軌道の前記評価値の平均を求める第２の処理を、全ての候補点について実行し、前記複数の候補点のうちの前記評価値の平均が前記第二の範囲に入る候補点を前記分岐点に決定し、前記決定された分岐点および前記参照軌道を前記記憶部に記憶する分岐点指定部と、
    を備えることを特徴とする請求項９に記載のロボット制御装置。
11. 前記評価値の平均は、前記目標集合の中央部の前記評価値の重みが、前記目標集合の外側周辺の前記評価値の重みより、高くなる重み付き平均であることを特徴とする請求項１０に記載のロボット制御装置。
12. 前記分岐点指定部は、前記参照軌道のうち、前記障害物の外周に一定の距離でマージンを取った仮障害物に対し前記エンドエフェクタとロボット本体との干渉が発生しない区間の中から前記分岐点を選ぶことを特徴とする請求項２または請求項１０に記載のロボット制御装置。
13. 前記評価値は、前記ロボットの動作時間であることを特徴とする請求項１から請求項１２の何れか一つに記載のロボット制御装置。
14. ロボットのエンドエフェクタを始点から終点まで移動させて、対象物体に対して予め設定されたタスクを実行するロボット制御プログラムであって、
    前記対象物体が取り得る複数の位置および姿勢の組の各々に対応して、参照軌道および分岐点を記憶部に記憶するステップと、
    前記タスクの実行時に、前記対象物体の位置および姿勢を計測するステップと、
    計測された前記対象物体の位置および姿勢に対応する前記参照軌道および前記分岐点を前記記憶部から取得し、計測された前記対象物体の位置および姿勢を前記終点に設定し、取得された前記参照軌道を使用して前記始点から前記分岐点までの前記ロボットの動作軌道である第１の動作軌道を生成し、取得された前記分岐点から前記終点までの前記ロボットの動作軌道である第２の動作軌道を生成するステップと、
    前記第１の動作軌道および前記第２の動作軌道を含む動作指令に従って前記ロボットを駆動制御するステップと、
    をコンピュータに実行させ、
    前記参照軌道は、前記始点から、前記対象物体が取り得る複数の位置および姿勢の組のうちの一つである第１点までの前記ロボットの動作軌道であって、障害物との干渉を回避でき、かつ評価値が第一の範囲に入ることを満足する動作軌道であり、
    前記分岐点は、前記参照軌道上の一点であって、前記分岐点から前記第１点までの動作軌道の前記評価値が前記第一の範囲とは異なる第二の範囲に入ることを満足する点である
    ことを特徴とするロボット制御プログラム。
15. ロボットのエンドエフェクタを始点から終点まで移動させて、対象物体に対して予め設定されたタスクを実行するロボット制御方法であって、
    前記対象物体が取り得る複数の位置および姿勢の組の各々に対応して、参照軌道および分岐点を記憶部に記憶するステップと、
    前記タスクの実行時に、前記対象物体の位置および姿勢を計測するステップと、
    計測された前記対象物体の位置および姿勢に対応する前記参照軌道および前記分岐点を前記記憶部から取得し、計測された前記対象物体の位置および姿勢を前記終点に設定し、取得された前記参照軌道を使用して前記始点から前記分岐点までの前記ロボットの動作軌道である第１の動作軌道を生成し、取得された前記分岐点から前記終点までの前記ロボットの動作軌道である第２の動作軌道を生成するステップと、
    前記第１の動作軌道および前記第２の動作軌道を含む動作指令に従って前記ロボットを駆動制御するステップと、
    を備え、
    前記参照軌道は、前記始点から、前記対象物体が取り得る複数の位置および姿勢の組のうちの一つである第１点までの前記ロボットの動作軌道であって、障害物との干渉を回避でき、かつ評価値が第一の範囲に入ることを満足する動作軌道であり、
    前記分岐点は、前記参照軌道上の一点であって、前記分岐点から前記第１点までの動作軌道の前記評価値が前記第一の範囲とは異なる第二の範囲に入ることを満足する点である
    ことを特徴とするロボット制御方法。

Images