JP2003094362A - 多関節ロボットの動作経路探索方法および装置 - Google Patents

Abstract

(57)【要約】 【課題】多関節ロボットの動作経路の探索を効率的に行
う。 【解決手段】動作経路探索部７２による探索経過時間を
経過時間計測部７４で計測し、探索スケジュール設定部
７０で設定した累積探索割当時間と比較し、探索経過時
間が累積探索割当時間を超過した場合、探索処理制御部
７８は、当該作業点に対する探索を中断する指示を動作
経路探索部７２に出し、動作経路探索部７２は、次の作
業点に対する探索を累積探索割当時間を基準として行
う。

Description

【発明の詳細な説明】

【０００１】

【発明の属する技術分野】本発明は、複数の作業点に対
する多関節ロボットの動作経路を探索する動作経路探索
方法および装置に関する。

【０００２】

【従来の技術】従来、製造ラインに設置された多関節ロ
ボットを直接操作させて作業姿勢のティーチングを行お
うとすると、多関節ロボットの操作を熟知したオペレー
タが製造ラインの現場で作業を行わなければならないた
め、その分、作業が非効率的となってしまう。また、こ
のような作業は、製造ラインを停止させた状態で行う必
要があるため、当該製造ラインの稼働率も低下してしま
う。

【０００３】そこで、近時、前記ティーチング作業の効
率化を図るため、あるいは、前記製造ラインの稼働率を
向上させるために、オフラインによるティーチングが行
われている。すなわち、コンピュータ上に多関節ロボッ
ト並びに作業対象物であるワークおよび周辺構造物のモ
デルを構築し、このモデルを用いてティーチングデータ
を作成した後、前記ティーチングデータを現場の多関節
ロボットに供給することにより、製造ラインを停止させ
ることなく、ティーチングデータを効率的に作成するこ
とが可能となる。

【０００４】ところで、このようなオフライティーチン
グにおいては、例えば、オペレータが複数の作業点を指
示することにより、周辺構造物や多関節ロボットの仕様
を考慮して、コンピュータが多関節ロボットの動作経路
を自動計算することも可能になってきている。

【０００５】しかしながら、動作経路の自動計算が可能
であるとはいっても、モデルの設定が不適切であった場
合のように、適切な条件が設定されていないと、動作経
路の解が得られなかったり、あるいは、１つの作業点に
対する処理に相当な時間を要し、限られた時間内で動作
経路を算出できない、といった不具合が指摘されてい
る。従って、例えば、夜間や休日におけるコンピュータ
の十分な空き時間を利用して無人で動作経路の自動計算
を行わせたとしても、必ずしも良好な計算結果が得られ
るものとは限らない。

【０００６】

【発明が解決しようとする課題】本発明は、上述した不
具合を解決するためになされたものであり、多関節ロボ
ットの動作経路の探索を極めて効率的に行うことのでき
る多関節ロボットの動作経路探索方法および装置を提供
することを目的とする。

【０００７】

【課題を解決するための手段】前記の課題を解決するた
めに、本発明方法では、複数の作業点に対する多関節ロ
ボットの動作経路を探索する動作経路探索方法におい
て、各作業点に係る動作経路の探索に割り当てる探索割
当時間を設定するステップと、前記各作業点の前記動作
経路を探索するステップと、前記動作経路の探索に係る
探索開始からの探索経過時間を計測するステップと、前
記探索経過時間を、前記動作経路の探索に係る当該作業
点に割り当てられた前記探索割当時間を探索開始からの
前記各作業点の前記探索割当時間に累積した累積探索割
当時間と比較するステップと、前記探索経過時間が前記
累積探索割当時間を超過した際、当該作業点に係る動作
経路の探索を中断し、次の作業点に係る探索に移行する
ステップと、からなることを特徴とする。

【０００８】この場合、動作経路の探索に要した探索経
過時間が累積探索割当時間を超過した際、その作業点に
対する探索を中断し、次の作業点に対する動作経路の探
索を行うため、累積探索割当時間内で探索の完了する作
業点の動作経路を効率的に算出することができる。ま
た、前段の作業点に対する動作経路の探索が累積探索割
当時間内で完了した場合、次の作業点の探索に与えられ
る探索割当時間が増加することになるため、当該作業点
の動作経路を探索できる確率が増大する。

【０００９】なお、複数の前記作業点に係る前記動作経
路の探索に割り当てる複数作業点探索割当時間を設定
し、複数の前記作業点に対する探索が終了した後、前記
探索経過時間から前記複数作業点探索割当時間に対する
探索残り時間を演算し、探索を中断した当該作業点に対
する前記動作経路の探索を前記探索残り時間において行
うことにより、与えられた前記複数作業点探索割当時間
内で動作経路をさらに効率的に探索することができる。

【００１０】上記の探索は、各作業点の動作経路の探索
を構成する複数のプロセス処理に対してそれぞれ探索割
当時間を設定し、各プロセス処理毎に行うことができ
る。

【００１１】また、本発明装置では、複数の作業点に対
する多関節ロボットの動作経路を探索する動作経路探索
装置において、各作業点に係る動作経路の探索に割り当
てる探索割当時間を設定し、探索スケジュールを決定す
る探索スケジュール設定部と、前記各作業点の前記動作
経路を探索する動作経路探索部と、前記動作経路の探索
に係る探索開始からの探索経過時間を計測する経過時間
計測部と、前記探索経過時間を、前記動作経路の探索に
係る当該作業点に割り当てられた前記探索割当時間を探
索開始からの前記各作業点の前記探索割当時間に累積し
た累積探索割当時間と比較して判定する経過時間比較判
定部と、前記探索経過時間が前記累積探索割当時間を超
過した際、当該作業点に係る動作経路の探索を中断し、
次の作業点に係る探索に移行する処理を行う探索処理制
御部と、を備えることを特徴とする。

【００１２】

【発明の実施の形態】図１は、本発明の多関節ロボット
の動作経路探索方法および装置が適用される実施形態で
あるオフラインティーチング装置１０と、このオフライ
ンティーチング装置１０によって作成されたティーチン
グデータが適用される多関節ロボット装置１２との概略
構成を示す。

【００１３】多関節ロボット装置１２は、ベース１４に
対して複数の回動自在なリンク１６、１８および２０を
介して連結される溶接ガン等のエンドエフェクタ２２を
備え、ロボット制御部２４に設定されたティーチングデ
ータに従って動作する。なお、多関節ロボット装置１２
およびロボット制御部２４は、現場の製造ラインに配設
される。

【００１４】オフラインティーチング装置１０は、コン
ピュータによって構成されるものであり、図２に示すよ
うに、制御部２６は、オフラインティーチング装置１０
の全体の制御を行うＣＰＵ２８と、記憶部であるＲＯＭ
３０およびＲＡＭ３２と、ハードディスクドライブ３４
によってデータが読み書きされるハードディスク３６
と、フレキシブルディスクやコンパクトディスク等の外
部記録媒体３８に対してデータの読み書きを行う記録媒
体ドライブ４０と、多関節ロボット装置１２の動作経路
データを作成する動作経路データ作成回路４２と、作成
された動作経路データに基づいて多関節ロボット装置１
２の動作シミュレーションを行うシミュレーション回路
４４とを備える。なお、制御部２６には、オペレータに
よるティーチング作業の補助、シミュレーション画像の
表示等を行うためのディスプレイ４６が描画制御回路４
８を介して接続されるとともに、インタフェース５０を
介してキーボード５２およびマウス５４が接続される。

【００１５】ハードディスク３６には、多関節ロボット
装置１２の動作経路データを作成するための動作経路作
成プログラム５６と、動作経路データを作成するための
条件データ５８と、動作経路データの作成時に生成され
る処理結果データ６０とが格納される。

【００１６】動作経路作成プログラム５６は、図３に示
すように、オペレータによって指示された所望の打点
（作業点）Ｄ１、Ｄ２、…に対して多関節ロボット装置
１２のエンドエフェクタ２２を到着させる経路を探索す
るプロセス処理Ｐ１、打点Ｄ１、Ｄ２、…からエンドエ
フェクタ２２を引き抜く経路を探索するプロセス処理Ｐ
２、干渉物６２を回避しながら中継点Ｅ１、Ｅ２間を移
動させる経路を探索するプロセス処理Ｐ３、および、探
索された複数の経路からエンドエフェクタ２２の姿勢、
移動時間等に係る最適な経路を探索するプロセス処理Ｐ
４（図示せず）の各処理を行うことにより、所望の動作
経路データを作成するプログラムである。

【００１７】条件データ５８は、図４に示すように、工
程別打点探索割当時間データ、プロセス処理探索割当時
間データ、打点データ、打順データおよびプロセス処理
優先度データを有する。

【００１８】工程別打点探索割当時間データは、例え
ば、図５に示すように、ワーク６４に設定される複数の
打点Ｄ１〜Ｄ８を動作経路データ作成の難易度に応じた
工程６６Ａ、６６Ｂにグループ化し、各工程６６Ａ、６
６Ｂ毎に１打点の各プロセス処理Ｐ１〜Ｐ４を行うため
に割り当てられる打点探索割当時間ＴＡ、ＴＢである。

【００１９】プロセス処理探索割当時間データは、例え
ば、図６に示すように、各打点での探索を構成するプロ
セス処理Ｐ１〜Ｐ４に対して割り当てられるプロセス処
理探索割当時間ｔ１〜ｔ４であり、本実施形態では、工
程６６Ａに対し、ＴＡ＝ｔ１＋ｔ２＋ｔ３＋ｔ４として
設定される。なお、このプロセス処理探索割当時間ｔ１
〜ｔ４は、打点探索割当時間ＴＡ、ＴＢを各プロセス処
理Ｐ１〜Ｐ４に配分するための比率として設定すること
もできる。

【００２０】打点データは、打点Ｄ１、Ｄ２、…におけ
るエンドエフェクタ２２の姿勢および座標に係るデータ
である。打順データは、各打点Ｄ１、Ｄ２、…に対する
動作経路の探索順序を設定するデータである。プロセス
処理優先度データは、プロセス処理Ｐ１〜Ｐ４の処理順
を設定するデータである。本実施形態では、プロセス処
理Ｐ１〜Ｐ４の順で処理を行うものとする。

【００２１】処理結果データ６０は、図７に示すよう
に、処理実績データおよび動作経路データからなる。処
理実績データは、探索した動作経路の工程、打点数、中
断時の探索に要した時間、中断されたプロセス処理等の
データである。動作経路データは、探索された動作経路
のデータである。

【００２２】動作経路データ作成回路４２は、図８に示
すように、条件データに基づき動作経路を探索するため
の探索スケジュールを設定する探索スケジュール設定部
７０と、設定された探索スケジュールに従って動作経路
の探索を行い、処理結果データを出力する動作経路探索
部７２と、探索開始からの経過時間を計測する経過時間
計測部７４と、探索スケジュール設定部７０で設定され
た累積探索割当時間（後述）と経過時間計測部７４で計
測された経過時間とを比較し、時間超過の有無を判定す
る経過時間比較判定部７６と、経過時間比較判定部７６
で時間超過と判定された際、当該打点での探索を中断
し、動作経路探索部７２に対して次の打点に対する探索
を指示する探索処理制御部７８とを備える。

【００２３】本実施形態のオフラインティーチング装置
１０は、基本的には以上のように構成されるものであ
り、次に、その動作について図９および図１０に示すフ
ローチャートに従って説明する。

【００２４】動作経路の探索に先立ち、ハードディスク
３６から動作経路作成プログラム５６を読み込み、動作
経路データ作成回路４２にロードする。次いで、動作経
路データ作成回路４２の探索スケジュール設定部７０
は、条件データ５８である工程別打点探索割当時間デー
タおよびプロセス処理探索割当時間データを読み込むと
ともに（ステップＳ１）、打点データ、打順データおよ
びプロセス処理優先度データを読み込み（ステップＳ
２）、探索スケジュールの設定を行う。

【００２５】先ず、打順データおよびプロセス処理優先
度データに従い、探索順序を設定する（ステップＳ
３）。

【００２６】次に、工程別打点探索割当時間データと打
順データとを用いて、各工程６６Ａ、６６Ｂ（図５参
照）別に打順に従った打点Ｄ１〜ＤＮ毎の打点累積探索
割当時間Ｈ１〜ＨＮを設定する（ステップＳ４）。Ｎ
は、各工程６６Ａ、６６Ｂの打点数を表す。この場合、
工程６６Ａ、６６Ｂの打点探索割当時間をＴＡ、ＴＢと
すると、工程６６Ａの打点累積探索割当時間Ｈ１〜ＨＮ
は、 Ｈ１＝ＴＡ Ｈ２＝２・ＴＡ …… ＨＮ＝Ｎ・ＴＡ として設定され、工程６６Ｂの打点累積探索割当時間Ｈ
１〜ＨＮは、 Ｈ１＝ＴＢ Ｈ２＝２・ＴＢ …… ＨＮ＝Ｎ・ＴＢ として設定される。図１１における点線は、各打点Ｄ１
〜ＤＮに割り当てられた打点累積探索割当時間Ｈ１〜Ｈ
Ｎを示している。

【００２７】次に、プロセス処理探索割当時間データを
用いてプロセス処理累積探索割当時間ｈ１１〜ｈ１４、
ｈ２１〜ｈ２４、…、ｈＮ１〜ｈＮ４を設定する（ステ
ップＳ５）。例えば、ｈＮ１〜ｈＮ４は、打点ＤＮの各
プロセス処理Ｐ１〜Ｐ４に対する累積探索割当時間を表
す。この場合、工程６６Ａでの各打点Ｄ１〜ＤＮのプロ
セス処理累積探索割当時間ｈ１１〜ｈ１４、ｈ２１〜ｈ
２４、…、ｈＮ１〜ｈＮ４は、各プロセス処理Ｐ１〜Ｐ
４でのプロセス処理探索割当時間データであるプロセス
処理探索割当時間をｔ１〜ｔ４として、 ｈ１１＝ｔ１ ｈ１２＝ｈ１１＋ｔ２ ｈ１３＝ｈ１２＋ｔ３ ｈ１４＝ｈ１３＋ｔ４＝ＴＡ …… ｈＮ１＝ｈ（Ｎ−１）１＋ｔ１ ｈＮ２＝ｈＮ１＋ｔ２ ｈＮ３＝ｈＮ２＋ｔ３ ｈＮ４＝ｈＮ３＋ｔ４＝Ｎ・ＴＡ として設定される。工程６６Ｂでの各打点Ｄ１〜ＤＮの
プロセス処理累積探索割当時間ｈ１１〜ｈ１４、ｈ２１
〜ｈ２４、…、ｈＮ１〜ｈＮ４についても同様である。

【００２８】以上のようにして探索スケジュールを設定
した後、経過時間計測部７４が探索経過時間Ｈの計測を
開始し（ステップＳ６）、動作経路探索部７２による動
作経路の探索が開始される（ステップＳ７）。動作経路
探索部７２は、ステップＳ３で設定した探索順序に従
い、打点Ｄ１のプロセス処理Ｐ１から動作経路の探索を
開始する。

【００２９】一方、経過時間比較判定部７６は、探索ス
ケジュール設定部７０で設定した打点Ｄ１のプロセス処
理Ｐ１に対するプロセス処理累積探索割当時間ｈ１１
と、経過時間計測部７４によって計測された探索経過時
間Ｈとを逐次比較する（ステップＳ８）。

【００３０】Ｈ＜ｈ１１の範囲でプロセス処理Ｐ１（エ
ンドエフェクタ２２を打点Ｄ１に到着させる動作経路の
探索）が終了すると（ステップＳ９）、打点Ｄ１の次の
プロセス処理Ｐ２（エンドエフェクタ２２を打点Ｄ１か
ら引き抜く動作経路の探索）に移行する（ステップＳ１
０、Ｓ７）。この場合、プロセス処理Ｐ２に与えられる
プロセス処理探索割当時間ｔ２には、プロセス処理Ｐ１
で余った時間（ｈ１１−Ｈ）が加算されるため、プロセ
ス処理Ｐ２がより確実に遂行されることが期待される。

【００３１】一方、プロセス処理Ｐ１〜Ｐ４のいずれか
において、探索経過時間Ｈがプロセス処理累積探索割当
時間ｈ１１〜ｈ１４を超過したとき（ステップＳ９）、
探索処理制御部７８は、当該打点Ｄ１の探索を中断し
（ステップＳ１１）、次の打点Ｄ２に対する探索を動作
経路探索部７２に対して指示する（ステップＳ１２）。
なお、ステップＳ１０において、当該打点Ｄ１の全ての
プロセス処理Ｐ１〜Ｐ４が完了したときも同様に、次の
打点Ｄ２に対する探索を動作経路探索部７２に対して指
示する。

【００３２】次の打点Ｄ２が指示された後、動作経路探
索部７２は、処理結果データ６０をハードディスク３６
に記録する（ステップＳ１３）。例えば、プロセス処理
Ｐ１での動作経路が探索された場合には、その動作経路
データが処理結果データ６０として記録される。また、
プロセス処理Ｐ２での動作経路の探索が中断された場合
には、プロセス処理Ｐ２が中断されたことを示すデータ
と、中断されるまでに得られた途中経過処理データとか
らなる処理実績データが処理結果データ６０として記録
される。

【００３３】以上の処理を工程６６Ａを構成する全ての
打点ＤＮに対して繰り返し、探索中断の有無に拘わらず
打点ＤＮまでの探索が完了すると（ステップＳ１４）、
探索スケジュール設定部７０は、処理結果データ６０に
基づいて探索中断打点の有無を判定し（ステップＳ１
５）、中断があった場合には、探索スケジュールの再設
定を行う。

【００３４】すなわち、探索スケジュール設定部７０
は、探索中断打点があった場合、ステップＳ４で求めた
打点ＤＮでの打点累積探索割当時間ＨＮ（複数作業点探
索割当時間）から、最後の打点ＤＮに対する探索が完了
した時点での探索経過時間Ｈを差し引き、これを探索残
り時間（ＨＮ−Ｈ）として設定する（ステップＳ１
６）。

【００３５】次いで、探索スケジュール設定部７０は、
例えば、図１１の○で示すように、打点Ｄ３において探
索が中断されており、処理結果データ６０から得られる
打点Ｄ３での中断の内容が、図６のハッチングで示すよ
うに、プロセス処理Ｐ１が終了し、プロセス処理Ｐ２が
中断され、且つ、プロセス処理Ｐ２に続くプロセス処理
Ｐ３およびＰ４の処理に至っていない場合、プロセス処
理Ｐ２〜Ｐ４に対して探索残り時間（ＨＮ−Ｈ）を割り
振り、プロセス処理累積探索割当時間ｈ３２〜ｈ３４を
再設定する（ステップＳ１７）。

【００３６】なお、探索残り時間（ＨＮ−Ｈ）を割り振
り方法としては、例えば、探索が全く行われていないプ
ロセス処理Ｐ３およびＰ４に対しては、プロセス処理探
索割当時間ｔ３およびｔ４を割り振り、プロセス処理Ｐ
２に対しては、プロセス処理探索割当時間（ＨＮ−Ｈ−
ｔ３−ｔ４）を割り振るようにすることができる。ま
た、中断された打点が複数ある場合には、各打点に対し
て探索残り時間（ＨＮ−Ｈ）を割り振るようにしてもよ
い。

【００３７】以上のようにして探索スケジュールを再設
定した後、ステップＳ７からの処理を繰り返すことによ
り、与えられた打点累積探索割当時間ＨＮ内で動作経路
を効率的に探索することができる。なお、工程６６Ｂに
ついても、同様にして動作経路の探索を行うことができ
る。

【００３８】多関節ロボット装置１２の動作経路の探索
が完了し、全ての動作経路データが処理結果データ６０
としてハードディスク３６に設定された後、シミュレー
ション回路４４は、動作経路データを用いて多関節ロボ
ット装置１２の動作シミュレーションを行う。シミュレ
ーションによって動作の確認された動作経路データは、
記録媒体ドライブ４０を介して外部記録媒体３８に記録
された後、多関節ロボット装置１２を構成するロボット
制御部２４にダウンロードされ、多関節ロボット装置１
２の制御に供される。

【００３９】

【発明の効果】以上のように、本発明によれば、各作業
点に係る動作経路を探索し、与えられた探索割当時間内
で探索が終了しない場合には、その作業点に対する探索
を中断して次の作業点に対する探索に移行し、探索割当
時間内で探索が終了した場合には、残りの時間を次の作
業点に対する探索割当時間に加算して探索を行うため、
探索割当時間を無駄なく使用して動作経路を効率的に探
索することができる。

【００４０】また、複数の作業点に対する探索処理が与
えられた時間内で終了した場合に、その残り時間を探索
を中断した作業点に割り振り、再度動作経路の探索を行
うことより、より多くの作業点に対する動作経路の探索
を与えられた探索割当時間内で効率的に行うことができ
る。

【図面の簡単な説明】

【図１】本実施形態のオフラインティーチング装置およ
び多関節ロボット装置の概略構成図である。

【図２】本実施形態のオフラインティーチング装置の回
路構成図である。

【図３】プロセス処理の説明図である。

【図４】本実施形態のオフラインティーチング装置で設
定される条件データの説明図である。

【図５】本実施形態のオフラインティーチング装置で設
定されるティーチングデータを分類する工程の説明図で
ある。

【図６】本実施形態のオフラインティーチング装置で設
定されるプロセス処理探索割当時間の説明図である。

【図７】本実施形態のオフラインティーチング装置で得
られる処理結果データの説明図である。

【図８】本実施形態のオフラインティーチング装置にお
ける動作経路データ作成回路のブロック図である。

【図９】本実施形態のオフラインティーチング装置にお
ける動作経路探索方法のフローチャートである。

【図１０】本実施形態のオフラインティーチング装置に
おける動作経路探索方法のフローチャートである。

【図１１】本実施形態のオフラインティーチング装置に
おける各打点に設定された累積探索割当時間と経過時間
との関係説明図である。

【符号の説明】

１０…オフラインティーチング装置 １２…多関節ロボ
ット装置 ２４…ロボット制御部 ２６…制御部 ３６…ハードディスク ４２…動作経路デ
ータ作成回路 ４４…シミュレーション回路 ５６…動作経路作
成プログラム ５８…条件データ ６０…処理結果デ
ータ ７０…探索スケジュール設定部 ７２…動作経路探
索部 ７４…経過時間計測部 ７６…経過時間比
較判定部 ７８…探索処理制御部

───────────────────────────────────────────────────── フロントページの続き (72)発明者 中島 陵 埼玉県狭山市新狭山１−10−１ ホンダエ ンジニアリング株式会社内 Ｆターム(参考） 3C007 BS10 LS00 LS10 LS11 LS15

Claims (4)

【特許請求の範囲】
1. 【請求項１】複数の作業点に対する多関節ロボットの動
   作経路を探索する動作経路探索方法において、 各作業点に係る動作経路の探索に割り当てる探索割当時
   間を設定するステップと、 前記各作業点の前記動作経路を探索するステップと、 前記動作経路の探索に係る探索開始からの探索経過時間
   を計測するステップと、 前記探索経過時間を、前記動作経路の探索に係る当該作
   業点に割り当てられた前記探索割当時間を探索開始から
   の前記各作業点の前記探索割当時間に累積した累積探索
   割当時間と比較するステップと、 前記探索経過時間が前記累積探索割当時間を超過した
   際、当該作業点に係る動作経路の探索を中断し、次の作
   業点に係る探索に移行するステップと、 からなることを特徴とする多関節ロボットの動作経路探
   索方法。
2. 【請求項２】請求項１記載の方法において、 複数の前記作業点に係る前記動作経路の探索に割り当て
   る複数作業点探索割当時間を設定するステップと、 複数の前記作業点に対する前記動作経路の探索が終了し
   た後、前記探索経過時間から前記複数作業点探索割当時
   間に対する探索残り時間を演算するステップと、 探索を中断した当該作業点に対する前記動作経路の探索
   を前記探索残り時間において行うステップと、 からなることを特徴とする多関節ロボットの動作経路探
   索方法。
3. 【請求項３】請求項１記載の方法において、 前記各作業点に対する前記動作経路の探索は、複数のプ
   ロセス処理からなり、前記探索割当時間は、前記各プロ
   セス処理に対して設定されることを特徴とする多関節ロ
   ボットの動作経路探索方法。
4. 【請求項４】複数の作業点に対する多関節ロボットの動
   作経路を探索する動作経路探索装置において、 各作業点に係る動作経路の探索に割り当てる探索割当時
   間を設定し、探索スケジュールを決定する探索スケジュ
   ール設定部と、 前記各作業点の前記動作経路を探索する動作経路探索部
   と、 前記動作経路の探索に係る探索開始からの探索経過時間
   を計測する経過時間計測部と、 前記探索経過時間を、前記動作経路の探索に係る当該作
   業点に割り当てられた前記探索割当時間を探索開始から
   の前記各作業点の前記探索割当時間に累積した累積探索
   割当時間と比較して判定する経過時間比較判定部と、 前記探索経過時間が前記累積探索割当時間を超過した
   際、当該作業点に係る動作経路の探索を中断し、次の作
   業点に係る探索に移行する処理を行う探索処理制御部
   と、 を備えることを特徴とする多関節ロボットの動作経路探
   索装置。