JP2012106335A - 移動経路生成方法、移動経路生成装置、移動経路生成プログラム、ロボットアーム制御装置、およびロボットアーム制御プログラム - Google Patents
移動経路生成方法、移動経路生成装置、移動経路生成プログラム、ロボットアーム制御装置、およびロボットアーム制御プログラム Download PDFInfo
- Publication number
- JP2012106335A JP2012106335A JP2012039477A JP2012039477A JP2012106335A JP 2012106335 A JP2012106335 A JP 2012106335A JP 2012039477 A JP2012039477 A JP 2012039477A JP 2012039477 A JP2012039477 A JP 2012039477A JP 2012106335 A JP2012106335 A JP 2012106335A
- Authority
- JP
- Japan
- Prior art keywords
- movement path
- robot arm
- movement
- node
- network
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Landscapes
- Manipulator (AREA)
Abstract
【課題】本発明は、ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成方法等に関し、任意の現在位置から任意の目標位置への移動経路を実時間で簡単に作成する。
【解決手段】ロボットアームの移動空間を多数のサブ空間に分割して、各サブ空間それぞれについて各代表座標を定め、各サブ空間の代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成し、この作成された移動経路網を構成する各移動経路について、ロボットアームと、そのロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する。
【選択図】 図３
【解決手段】ロボットアームの移動空間を多数のサブ空間に分割して、各サブ空間それぞれについて各代表座標を定め、各サブ空間の代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成し、この作成された移動経路網を構成する各移動経路について、ロボットアームと、そのロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する。
【選択図】 図３
Description
本発明は、ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成方法および移動経路生成装置、演算装置を移動経路生成装置として動作させる移動経路生成プログラム、ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置、並びに、演算装置をロボットアーム制御装置として動作させるロボットアーム制御プログラムに関する。
人間型ロボットのような多関節ロボットは多くの自由度を持つため、移動中にアームの関節（リンク）が自分のボディやその他の障害物に干渉する恐れがある。移動経路を予め定義しておけば干渉を回避できるが、動的な経路生成ができず、あらかじめ決められた移動経路上を移動するということしかできないという問題がある。特に、何らかの外乱等の原因で決められた移動経路から外れた状態で停止した後動作を再開させようとしたとき、決められた移動経路から外れていると自動的な復旧が困難となる。また、オンラインで動的な移動経路を生成する場合は、干渉チェック計算を常に行なう必要があるため、計算量、メモリ使用量が多く、実時間で実現することが難しい。このため、動的な移動経路を、オンラインで実時間で生成する方法の確立が多関節ロボットの分野での１つの課題となっている。これを少ない計算量やメモリ使用量で実現することが望ましい。
ここで、特許文献１には、ロボットの動作範囲内に障害物が存在する場合、予め該障害物を３次元的なパスゾーンとして、ソフトマップ内で有し、軌道生成した経路上に該障害物が存在する時、３次元的なパスゾーンを考慮して複数の経路を最短時間経路の候補として選択し、選択した候補について各々軌道生成を行い、最短時間のものを最短時間経路として選択することが開示されている。
障害物との干渉を避けることは重要であるが、この特許文献１では軌道をどのように生成するかという点については記述がない。
本発明は、上記事情に鑑み、任意の現在位置から任意の目標位置への移動経路を実時間で簡単に決定することができるように移動経路網をあらかじめ準備しておくための移動経路生成方法および移動経路生成装置、並びに、演算装置をそのような移動経路生成装置として動作させる移動経路生成プログラム、さらに、そのあらかじめ準備された移動経路網を使って、ロボットアームを任意の現在位置から任意の目標位置への移動経路を実時間で生成してロボットアームを移動させるロボットアーム制御装置、および、演算装置をそのようなロボットアーム制御装置として動作させるロボットアーム制御プログラムを提供することを目的とする。
上記目的を達成するための本発明の移動経路生成方法のうちの第１の移動経路生成方法は、ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成方法であって、
ロボットアームの移動空間を複数の第１段階のサブ空間に分割し、各第１段階のサブ空間それぞれを複数の第２段階のサブ空間に分割し、以下同様に、各第ｎ−１段階のサブ空間それぞれを複数の第ｎ段階のサブ空間に分割（但し、ｎは２以上の整数）して、該移動空間全体の代表座標である原点座標、および、各第１段階のサブ空間それぞれ、各第２段階のサブ空間それぞれ、…、各第ｎ段階のサブ空間それぞれの各代表座標を定めることにより、該原点座標に置かれたノードから、該第１段階のサブ空間の代表座標に置かれたノード、該第２段階のサブ空間の代表座標に置かれたノード、…、第ｎ段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を作成する移動経路網作成ステップと、
移動経路網作成ステップで作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算ステップとを有する。
ロボットアームの移動空間を複数の第１段階のサブ空間に分割し、各第１段階のサブ空間それぞれを複数の第２段階のサブ空間に分割し、以下同様に、各第ｎ−１段階のサブ空間それぞれを複数の第ｎ段階のサブ空間に分割（但し、ｎは２以上の整数）して、該移動空間全体の代表座標である原点座標、および、各第１段階のサブ空間それぞれ、各第２段階のサブ空間それぞれ、…、各第ｎ段階のサブ空間それぞれの各代表座標を定めることにより、該原点座標に置かれたノードから、該第１段階のサブ空間の代表座標に置かれたノード、該第２段階のサブ空間の代表座標に置かれたノード、…、第ｎ段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を作成する移動経路網作成ステップと、
移動経路網作成ステップで作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算ステップとを有する。
ここで、上記第１の移動経路生成方法において、上記ロボットアームを現在位置から目標位置に移動させるにあたり、現在位置から、該現在位置に最近接した第１のノードに移動させ、該第１のノードに順次接続されたノードを経由して目標位置に最近接した第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動ステップをさらに有していてもよい。
本発明の第１の移動経路生成方法は、上記のツリー構造の移動経路網を生成しあらかじめ干渉チェックを行なって有効移動経路網を生成するものであるため、ロボットアームの現在位置から目標位置への移動経路を短時間で構築することができる。
また、本発明の移動経路生成方法のうちの第２の移動経路生成方法は、ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成方法であって、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成ステップと、
移動経路網作成ステップで作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算ステップとを有することを特徴とする。
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成ステップと、
移動経路網作成ステップで作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算ステップとを有することを特徴とする。
ここで、上記第２の移動経路生成方法において、上記ロボットアームを現在位置から目標位置に移動させるにあたり、上記有効移動経路網から、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第１のノードに移動させ、該第１のノードから前記最短移動経路を経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動ステップをさらに有していてもよい。
本発明の第２の移動経路生成方法は、いわば網目状の移動経路網を生成しあらかじめ干渉チェックを行なって有効移動経路網を生成するものであるため、ロボットアームの現在位置から目標位置への移動経路を生成するにあたっては、そのあらかじめ生成されている有効移動経路網について、第１のノードから第２のノードへの最短移動経路を探索すればよく、ロボットアームの現在位置から目標位置への移動経路を短時間で構築することができる。
また、本発明の移動経路生成装置のうちの第１の移動経路生成装置は、ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成装置において、
ロボットアームの移動空間を複数の第１段階のサブ空間に分割し、各第１段階のサブ空間それぞれを複数の第２段階のサブ空間に分割し、以下同様に、各第ｎ−１段階のサブ空間それぞれを複数の第ｎ段階のサブ空間に分割（但し、ｎは２以上の整数）して、該移動空間全体の代表座標である原点座標、および、各第１段階のサブ空間それぞれ、各第２段階のサブ空間それぞれ、…、各第ｎ段階のサブ空間それぞれの各代表座標を定めることにより、該原点座標に置かれたノードから、該第１段階のサブ空間の代表座標に置かれたノード、該第２段階のサブ空間の代表座標に置かれたノード、…、第ｎ段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を作成する移動経路網作成部と、
前記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えたことを特徴とする。
ロボットアームの移動空間を複数の第１段階のサブ空間に分割し、各第１段階のサブ空間それぞれを複数の第２段階のサブ空間に分割し、以下同様に、各第ｎ−１段階のサブ空間それぞれを複数の第ｎ段階のサブ空間に分割（但し、ｎは２以上の整数）して、該移動空間全体の代表座標である原点座標、および、各第１段階のサブ空間それぞれ、各第２段階のサブ空間それぞれ、…、各第ｎ段階のサブ空間それぞれの各代表座標を定めることにより、該原点座標に置かれたノードから、該第１段階のサブ空間の代表座標に置かれたノード、該第２段階のサブ空間の代表座標に置かれたノード、…、第ｎ段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を作成する移動経路網作成部と、
前記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えたことを特徴とする。
ここで、上記第１の移動経路生成装置において、上記ロボットアームを現在位置から目標位置に移動させるにあたり、現在位置から、該現在位置に最近接した第１のノードに移動させ、該第１のノードに順次接続されたノードを経由して目標位置に最近接した第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部をさらに備えていてもよい。
また、本発明の移動経路生成装置のうちの第２の移動経路生成装置は、ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成装置において、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成部と、
上記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えたことを特徴とする。
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成部と、
上記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えたことを特徴とする。
ここで、上記第２の移動経路生成装置において、前記ロボットアームを現在位置から目標位置に移動させるにあたり、上記有効移動経路網から、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の最短移動経路を求め、上記ロボットアームを、該現在位置から該第１のノードに移動させ、該第１のノードから前記最短移動経路を経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部をさらに備えていてもよい。
さらに、本発明の移動経路生成プログラムのうちの第１の移動経路生成プログラムは、プログラムを実行する演算装置で実行され、該演算装置を、ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成装置として動作させる移動経路生成プログラムであって、
前記演算装置を、
ロボットアームの移動空間を複数の第１段階のサブ空間に分割し、各第１段階のサブ空間それぞれを複数の第２段階のサブ空間に分割し、以下同様に、各第ｎ−１段階のサブ空間それぞれを複数の第ｎ段階のサブ空間に分割（但し、ｎは２以上の整数）して、該移動空間全体の代表座標である原点座標、および、各第１段階のサブ空間それぞれ、各第２段階のサブ空間それぞれ、…、各第ｎ段階のサブ空間それぞれの各代表座標を定めることにより、該原点座標に置かれたノードから、該第１段階のサブ空間の代表座標に置かれたノード、該第２段階のサブ空間の代表座標に置かれたノード、…、第ｎ段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を作成する移動経路網作成部と、
上記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えた移動経路生成装置として動作させることを特徴とする。
前記演算装置を、
ロボットアームの移動空間を複数の第１段階のサブ空間に分割し、各第１段階のサブ空間それぞれを複数の第２段階のサブ空間に分割し、以下同様に、各第ｎ−１段階のサブ空間それぞれを複数の第ｎ段階のサブ空間に分割（但し、ｎは２以上の整数）して、該移動空間全体の代表座標である原点座標、および、各第１段階のサブ空間それぞれ、各第２段階のサブ空間それぞれ、…、各第ｎ段階のサブ空間それぞれの各代表座標を定めることにより、該原点座標に置かれたノードから、該第１段階のサブ空間の代表座標に置かれたノード、該第２段階のサブ空間の代表座標に置かれたノード、…、第ｎ段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を作成する移動経路網作成部と、
上記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えた移動経路生成装置として動作させることを特徴とする。
ここで、本発明の第１の移動経路生成プログラムは、上記演算装置を、前記ロボットアームを現在位置から目標位置に移動させるにあたり、現在位置から、該現在位置に最近接した第１のノードに移動させ、該第１のノードに順次接続されたノードを経由して目標位置に最近接した第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部をさらに備えた移動経路生成装置として動作させるものであってもよい。
さらに、本発明の移動経路生成プログラムのうちの第２の移動経路生成プログラムは、プログラムを実行する演算装置内で実行され、該演算装置を、ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成として動作させる移動経路生成プログラムであって、
前記演算装置を、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成部と、
上記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えた移動経路生成装置として動作させることを特徴とする。
前記演算装置を、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成部と、
上記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えた移動経路生成装置として動作させることを特徴とする。
ここで、本発明の第２の移動経路生成プログラムは、上記演算装置を、前記ロボットアームを現在位置から目標位置に移動させるにあたり、上記有効移動経路網から、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第１のノードに移動させ、該第１のノードから前記最短移動経路を経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部をさらに備えた移動経路生成装置として動作させるものであってもよい。
また、本発明のロボットアーム制御装置のうちの第１のロボットアーム制御装置は、ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置において、
ロボットアームの移動空間を複数の第１段階のサブ空間に分割し、各第１段階のサブ空間それぞれを複数の第２段階のサブ空間に分割し、以下同様に、各第ｎ−１段階のサブ空間それぞれを複数の第ｎ段階のサブ空間に分割（但し、ｎは２以上の整数）して、該移動空間全体の代表座標である原点座標、および、各第１段階のサブ空間それぞれ、各第２段階のサブ空間それぞれ、…、各第ｎ段階のサブ空間それぞれの各代表座標を定めることにより作成された、該原点座標に置かれたノードから、該第１段階のサブ空間の代表座標に置かれたノード、該第２段階のサブ空間の代表座標に置かれたノード、…、第ｎ段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行なうことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
上記有効移動経路網に基づいて、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の移動経路を求め、上記ロボットアームを、現在位置から、該第１のノードに移動させ、該第１のノードに順次接続されたノードを経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部とを備えたことを特徴とする。
ロボットアームの移動空間を複数の第１段階のサブ空間に分割し、各第１段階のサブ空間それぞれを複数の第２段階のサブ空間に分割し、以下同様に、各第ｎ−１段階のサブ空間それぞれを複数の第ｎ段階のサブ空間に分割（但し、ｎは２以上の整数）して、該移動空間全体の代表座標である原点座標、および、各第１段階のサブ空間それぞれ、各第２段階のサブ空間それぞれ、…、各第ｎ段階のサブ空間それぞれの各代表座標を定めることにより作成された、該原点座標に置かれたノードから、該第１段階のサブ空間の代表座標に置かれたノード、該第２段階のサブ空間の代表座標に置かれたノード、…、第ｎ段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行なうことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
上記有効移動経路網に基づいて、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の移動経路を求め、上記ロボットアームを、現在位置から、該第１のノードに移動させ、該第１のノードに順次接続されたノードを経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部とを備えたことを特徴とする。
本発明の第１のロボットアーム制御装置は、上述した本発明の第１の移動経路生成方法により生成された有効移動経路網を記憶しておき、アーム移動制御部で、その有効移動経路網から第１のノードと第２のノードとを結ぶ移動経路を抽出し、さらに現在位置と第１のノードとの間、第２のノードと目標位置との間の移動経路を生成して、ロボットアームをその移動経路に沿って移動させるものであり、任意の現在位置から任意の目標位置へのロボットアームの移動経路を実時間的に生成してそのロボットアームを移動させることができる。
さらに、本発明のロボットアーム制御装置のうちの第２のロボットアーム制御装置は、ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置において、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定めることにより作成された、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行うことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
上記有効移動経路網から、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の最短移動経路を求め、上記ロボットアームを、該現在位置から該第１のノードに移動させ、該第１のノードから前記最短移動経路を経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部とを備えたことを特徴とする。
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定めることにより作成された、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行うことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
上記有効移動経路網から、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の最短移動経路を求め、上記ロボットアームを、該現在位置から該第１のノードに移動させ、該第１のノードから前記最短移動経路を経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部とを備えたことを特徴とする。
本発明の第２のロボットアーム制御装置は、上述した本発明の第２の移動経路生成方法により生成された有効移動経路網を記憶しておき、アーム移動制御部で、その有効移動経路網から第１のノードと第２のノードとを結ぶ最短移動経路を抽出し、さらに現在位置と第１のノードとの間、第２のノードと目標位置との間の移動経路を生成して、ロボットアームをその移動経路に沿って移動させるものであり、任意の現在位置から任意の目標位置へのロボットアームの移動経路を実時間的に生成してそのロボットアームを移動させることができる。
また、本発明のロボットアーム制御プログラムのうちの第１のロボットアーム制御プログラムは、プログラムを実行する演算装置で実行され、該演算装置を、ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置として動作させるロボットアーム制御プログラムであって、
上記演算装置を、
ロボットアームの移動空間を複数の第１段階のサブ空間に分割し、各第１段階のサブ空間それぞれを複数の第２段階のサブ空間に分割し、以下同様に、各第ｎ−１段階のサブ空間それぞれを複数の第ｎ段階のサブ空間に分割（但し、ｎは２以上の整数）して、該移動空間全体の代表座標である原点座標、および、各第１段階のサブ空間それぞれ、各第２段階のサブ空間それぞれ、…、各第ｎ段階のサブ空間それぞれの各代表座標を定めることにより作成された、該原点座標に置かれたノードから、該第１段階のサブ空間の代表座標に置かれたノード、該第２段階のサブ空間の代表座標に置かれたノード、…、第ｎ段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行なうことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
上記有効移動経路網に基づいて、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の移動経路を求め、上記ロボットアームを、現在位置から、該第１のノードに移動させ、該第１のノードに順次接続されたノードを経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部とを備えたロボットアーム制御装置として動作させることを特徴とする。
上記演算装置を、
ロボットアームの移動空間を複数の第１段階のサブ空間に分割し、各第１段階のサブ空間それぞれを複数の第２段階のサブ空間に分割し、以下同様に、各第ｎ−１段階のサブ空間それぞれを複数の第ｎ段階のサブ空間に分割（但し、ｎは２以上の整数）して、該移動空間全体の代表座標である原点座標、および、各第１段階のサブ空間それぞれ、各第２段階のサブ空間それぞれ、…、各第ｎ段階のサブ空間それぞれの各代表座標を定めることにより作成された、該原点座標に置かれたノードから、該第１段階のサブ空間の代表座標に置かれたノード、該第２段階のサブ空間の代表座標に置かれたノード、…、第ｎ段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行なうことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
上記有効移動経路網に基づいて、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の移動経路を求め、上記ロボットアームを、現在位置から、該第１のノードに移動させ、該第１のノードに順次接続されたノードを経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部とを備えたロボットアーム制御装置として動作させることを特徴とする。
さらに、本発明のロボットアーム制御プログラムのうちの第２のロボットアーム制御プログラムは、プログラムを実行する演算装置内で実行され、該演算装置を、ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置として動作させるロボットアーム制御プログラムであって、
上記演算装置を、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定めることにより作成された、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行うことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
上記有効移動経路網から、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の最短移動経路を求め、上記ロボットアームを、該現在位置から該第１のノードに移動させ、該第１のノードから上記最短移動経路を経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部とを備えたロボットアーム制御装置として動作させることを特徴とする。
上記演算装置を、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定めることにより作成された、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行うことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
上記有効移動経路網から、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の最短移動経路を求め、上記ロボットアームを、該現在位置から該第１のノードに移動させ、該第１のノードから上記最短移動経路を経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部とを備えたロボットアーム制御装置として動作させることを特徴とする。
以上の本発明によれば、ロボットアームを任意の現在位置から任意の目標位置へ移動する移動経路を実時間で簡単に定めることができる。
以下、本発明の実施形態について説明する。
図１は、人間型ロボットの一例を示す模式図である。
ここでは、このロボット１０のアーム１１，１２（代表的に一本のアーム１１を取り扱う）の移動について説明する。
図２は、ロボットアーム１１の移動空間Ｄ０を複数のサブ空間に分割したことを示す模式図である。
以下では、第１実施形態と第２実施形態について説明するが、第１実施形態と第２実施形態とでは分割方法が異なり、ここでは先ず第１実施形態における分割方法について説明する。
図３は、分かり易さのため、ロボットアームの移動空間を２次元的に表現したときの、第１実施形態の分割方法の説明図である。
この第１実施形態では、ロボットアームの移動空間が複数の第１段階のサブ空間に分割され、各第１段階のサブ空間それぞれが複数の第２段階のサブ空間に分割され、以下同様に、各第ｎ−１段階のサブ空間それぞれが複数の第ｎ段階のサブ空間に分割（但し、ｎは２以上の整数）される。
この分割方法の一例を図３を参照して具体的に説明する。ここでは、上記のｎはｎ＝３とする。
ここでは、ロボットアームの移動空間Ｄ０が４つの第１段階のサブ空間Ｄ１，Ｄ２，Ｄ３，Ｄ４に分割され、各第１段階のサブ空間Ｄ１，Ｄ２，Ｄ３，Ｄ４のそれぞれが４つの第２段階のサブ空間に分割される。４つの第１段階のサブ空間Ｄ１，Ｄ２，Ｄ３，Ｄ４のうちの１つの第１段階のサブ空間Ｄ１について例示すると、この第１段階のサブ空間Ｄ１が、さらに４つの第２段階のサブ空間Ｄ１１，Ｄ１２，Ｄ１３，Ｄ１４に分割される。このような分割により得られた第２段階のサブ空間が、さらにそれぞれ４つずつの第３段階のサブ空間に分割される。例示すると、第２段階の１つのサブ空間Ｄ１１が、４つの第３段階のサブ空間Ｄ１１１，Ｄ１１２，Ｄ１１３，Ｄ１１４に分割される。
このような各段階の分割が行なわれた後、その移動空間全体の代表座標である原点座標、および、各第１段階のサブ空間それぞれ、各第２段階のサブ空間それぞれ、…、各第ｎ段階のサブ空間それぞれの各代表座標を定めることにより、原点座標に置かれたノードから、第１段階のサブ空間の代表座標に置かれたノード、第２段階のサブ空間の代表座標に置かれたノード、…、第ｎ段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網が作成される。
ここでは、各段階の各サブ空間の代表座標として各サブ空間の中心点の座標が採用される。また、移動空間Ｄ０を分割するにあたっては、その移動空間Ｄ０の中心点（代表点）がロボットアーム先端の原点位置となるように、移動空間Ｄ０が定められる。移動空間Ｄ０をこのように定めた結果、移動空間Ｄ０がロボットのボディや他の障害物と重なる位置まで広がっても、後述する干渉チェックでロボットアームの移動経路から排除されるため問題は生じない。
図４は、ツリー構造の移動経路網の概念図である。ここでは図示の煩雑さを避けるため、第２段階のサブ空間まで分割したときの例を示してある。
このツリー構造の各ノードは各サブ空間の中心の座標点を表わしている。
ノードａの位置にあるロボットアームの先端をノードｂに移動させるには、ノードａから移動経路ｒ１を進んで一段階上のサブ空間の中心の座標点に進み、さらに移動経路ｒ２を進んでもう一段階上のサブ空間（ここでは移動空間全体）の中心の座標点（ここでは移動空間の原点の座標点）に進み、さらに移動経路ｒ３を進んで第１段階のサブ空間の中心の座標点に進み、さらに移動経路ｒ４を進んで目標位置であるノードｂ、すなわち第２段階のサブ空間の中心の座標点に進む。
この図４の移動経路上に×印が付されている箇所があるが、この意味については後述する。
ロボットアームの現在位置および目標位置は、ノード上にあるとは限らない。そこで、図３を参照して、ロボットアームの現在位置および目標位置がノード（サブ空間の中心点）にはない場合の移動経路について説明する。
ロボットアームの先端の現在位置がサブ空間Ｄ１１３内のａ点にあり、このロボットアームを、その先端がサブ空間Ｄ３４３内のｂ点に移動するように移動させるものとする。このとき、ロボットアーム先端は、ａ点とサブ空間Ｄ１１３の中心点との間がリニア補間された各点（すなわちａ点とサブ空間Ｄ１１３の中心点とを直線で結んだときのその直線上の各点）を経由してａ点からそのサブ空間Ｄ１１３の中心点に移動し、次にそのサブ空間Ｄ１１３の中心点から一段階上位のサブ空間Ｄ１１の中心点に直線的に移動し、さらに上位のサブ空間Ｄ１の中心点に直線的に移動し、さらにこの移動空間Ｄ０の中心点（原点Ｏ）に直線的に移動し、次にその原点Ｏからサブ空間Ｄ３の中心点まで直線的に移動し、さらに同様にサブ空間Ｄ３４の中心点に直線的に移動し、さらにサブ空間Ｄ３４３の中心点に直線的に移動し、さらにそのサブ空間Ｄ３４３内の目標位置ｂに直線的に移動する。
本発明の第１実施形態では、以上の動きによりロボットアームが任意の現在位置から任意の目標位置に移動する。
次に干渉チェックについて説明する。
以上の説明は、ロボットアームの移動経路上に何らの障害物が存在しない場合に成り立つものであるが、移動経路上にロボットアームの移動を防げる何らかの障害物が存在する場合がある。
そこで、上記のようにして構築したツリー構造の移動経路網が調べられ、接続された２つのノード間の移動経路上に障害物が存在しないかどうか、が事前に調べられる。
図４の×印を付した移動経路は、干渉チェック計算を行なった結果障害物が存在した移動経路であることを表わしている。
ここでは、２つのノードを結ぶ移動経路全てについて干渉チェックが行なわれて、障害物が存在した移動経路の先にある全てのノード（図４にハッチングを施したノード）が取り除かれ、有効な移動経路のみからなるツリー構造の移動経過網が再構築される。
ロボットアームの移動を制御する制御装置には、以上のようにして生成された有効移動経路網が記憶され、ロボットアームの移動にあたっては、その有効移動経路網が参照され、ロボットアームが、障害物との干渉が生じない領域間でのみ、上記の説明のとおりに移動するように制御される。
図５は、ロボットアームを、その先端を下に降ろした原点に移動する様子を示した模式図である。
この第１実施形態では、原点をルートノードとしたツリー構造の有効移動経路網が生成され、ロボットアームはその有効移動経路網に従って移動するため、ロボットアームは、離れた位置に移動するときは、現在位置から一旦原点に移動し、その原点から目標位置に向かって動くことになる。
図６は、第１実施形態の、ロボットアームの移動時のフローチャートである。
先ず、現在位置（移動空間上の現在の座標）を取得し（ステップＳ０１）、有効移動経路網が定義された階層ツリーに基づいて経路探索を行ない（ステップＳ０２）、現在位置に最も近いノードから目標位置に最も近いノードへの経路が作成される（ステップＳ０３）。この経路の作成に失敗したときはロボットアームを移動させずにそのまま終了するが（ステップＳ０４）、この経路の作成に成功したときは、現在位置から最も近いノードへ移動し（ステップＳ０５）、作成した経路に沿い、第１のノードから第２のノードまで、順次接続されたノード間をリニア補間で移動し（ステップＳ０６）、第２のノードから目標位置へ移動する（ステップＳ０７）。
次に本発明の第２実施形態について説明する。
図７は、第２実施形態の有効移動経路網を表わした図である。
ここでは、分かり易さのため２次元的な経路を示している。
第２実施形態では、ロボットアームの移動空間が多数のサブ空間に分割されるが、この第２実施形態では、第１実施形態とは異なり、多段階には分割せずに、比較的細かな１段階にのみ分割され、各サブ空間の中心点にノードが配置され、全てのノードについて、２つのノードを結ぶ移動経路が一旦作成され、全ての移動経路について干渉チェックが行なわれ、干渉が生じた移動経路は取り除かれて有効移動経路網が作成される。
この図６では、一点鎖線の領域に障害物が存在し、その障害物を避けた領域にのみ移動経路を有する有効移動経路網が形成されている。
図８は、第２実施形態のロボットアームの移動時のフローチャートである。図６に示す第１実施形態のロボットアームの移動時のフローチャートとの相違点について説明する。
ステップＳ１１〜Ｓ１３では、図７に示す有効移動経路網上で現在位置に最も近い第１のノードと目標位置に最も近い第２のノードとの間の移動経路の探索が行なわれ、それらのノード間での移動距離が最短の移動経路が作成される。
その最短の移動経路が作成されると（ステップＳ１４）、その後は、その移動経路に従ってロボットアームが現在位置から目標位置まで移動される（ステップＳ１５〜Ｓ１７）。
以下、本発明の各種形態を付記する。
（付記１）
ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成方法において、
ロボットアームの移動空間を複数の第１段階のサブ空間に分割し、各第１段階のサブ空間それぞれを複数の第２段階のサブ空間に分割し、以下同様に、各第ｎ−１段階のサブ空間それぞれを複数の第ｎ段階のサブ空間に分割（但し、ｎは２以上の整数）して、該移動空間全体の代表座標である原点座標、および、各第１段階のサブ空間それぞれ、各第２段階のサブ空間それぞれ、…、各第ｎ段階のサブ空間それぞれの各代表座標を定めることにより、該原点座標に置かれたノードから、該第１段階のサブ空間の代表座標に置かれたノード、該第２段階のサブ空間の代表座標に置かれたノード、…、第ｎ段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を作成する移動経路網作成ステップと、
前記移動経路網作成ステップで作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算ステップとを有することを特徴とする移動経路生成方法。
ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成方法において、
ロボットアームの移動空間を複数の第１段階のサブ空間に分割し、各第１段階のサブ空間それぞれを複数の第２段階のサブ空間に分割し、以下同様に、各第ｎ−１段階のサブ空間それぞれを複数の第ｎ段階のサブ空間に分割（但し、ｎは２以上の整数）して、該移動空間全体の代表座標である原点座標、および、各第１段階のサブ空間それぞれ、各第２段階のサブ空間それぞれ、…、各第ｎ段階のサブ空間それぞれの各代表座標を定めることにより、該原点座標に置かれたノードから、該第１段階のサブ空間の代表座標に置かれたノード、該第２段階のサブ空間の代表座標に置かれたノード、…、第ｎ段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を作成する移動経路網作成ステップと、
前記移動経路網作成ステップで作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算ステップとを有することを特徴とする移動経路生成方法。
（付記２）
前記ロボットアームを現在位置から目標位置に移動させるにあたり、現在位置から、該現在位置に最近接した第１のノードに移動させ、該第１のノードに順次接続されたノードを経由して目標位置に最近接した第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動ステップをさらに有することを特徴とする付記１記載の移動経路生成方法。
前記ロボットアームを現在位置から目標位置に移動させるにあたり、現在位置から、該現在位置に最近接した第１のノードに移動させ、該第１のノードに順次接続されたノードを経由して目標位置に最近接した第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動ステップをさらに有することを特徴とする付記１記載の移動経路生成方法。
（付記３）
ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成方法において、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成ステップと、
前記移動経路網作成ステップで作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算ステップとを有することを特徴とする移動経路生成方法。
ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成方法において、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成ステップと、
前記移動経路網作成ステップで作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算ステップとを有することを特徴とする移動経路生成方法。
（付記４）
前記ロボットアームを現在位置から目標位置に移動させるにあたり、前記有効移動経路網から、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第１のノードに移動させ、該第１のノードから前記最短移動経路を経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動ステップをさらに有することを特徴とする付記３記載の移動経路生成方法。
前記ロボットアームを現在位置から目標位置に移動させるにあたり、前記有効移動経路網から、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第１のノードに移動させ、該第１のノードから前記最短移動経路を経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動ステップをさらに有することを特徴とする付記３記載の移動経路生成方法。
（付記５）
ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成装置において、
ロボットアームの移動空間を複数の第１段階のサブ空間に分割し、各第１段階のサブ空間それぞれを複数の第２段階のサブ空間に分割し、以下同様に、各第ｎ−１段階のサブ空間それぞれを複数の第ｎ段階のサブ空間に分割（但し、ｎは２以上の整数）して、該移動空間全体の代表座標である原点座標、および、各第１段階のサブ空間それぞれ、各第２段階のサブ空間それぞれ、…、各第ｎ段階のサブ空間それぞれの各代表座標を定めることにより、該原点座標に置かれたノードから、該第１段階のサブ空間の代表座標に置かれたノード、該第２段階のサブ空間の代表座標に置かれたノード、…、第ｎ段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を作成する移動経路網作成部と、
前記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えたことを特徴とする移動経路生成装置。
ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成装置において、
ロボットアームの移動空間を複数の第１段階のサブ空間に分割し、各第１段階のサブ空間それぞれを複数の第２段階のサブ空間に分割し、以下同様に、各第ｎ−１段階のサブ空間それぞれを複数の第ｎ段階のサブ空間に分割（但し、ｎは２以上の整数）して、該移動空間全体の代表座標である原点座標、および、各第１段階のサブ空間それぞれ、各第２段階のサブ空間それぞれ、…、各第ｎ段階のサブ空間それぞれの各代表座標を定めることにより、該原点座標に置かれたノードから、該第１段階のサブ空間の代表座標に置かれたノード、該第２段階のサブ空間の代表座標に置かれたノード、…、第ｎ段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を作成する移動経路網作成部と、
前記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えたことを特徴とする移動経路生成装置。
（付記６）
前記ロボットアームを現在位置から目標位置に移動させるにあたり、現在位置から、該現在位置に最近接した第１のノードに移動させ、該第１のノードに順次接続されたノードを経由して目標位置に最近接した第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部をさらに備えたことを特徴とする付記５記載の移動経路生成装置。
前記ロボットアームを現在位置から目標位置に移動させるにあたり、現在位置から、該現在位置に最近接した第１のノードに移動させ、該第１のノードに順次接続されたノードを経由して目標位置に最近接した第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部をさらに備えたことを特徴とする付記５記載の移動経路生成装置。
（付記７）
ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成装置において、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成部と、
前記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えたことを特徴とする移動経路生成装置。
ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成装置において、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成部と、
前記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えたことを特徴とする移動経路生成装置。
（付記８）
前記ロボットアームを現在位置から目標位置に移動させるにあたり、前記有効移動経路網から、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第１のノードに移動させ、該第１のノードから前記最短移動経路を経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部をさらに備えたことを特徴とする付記７記載の移動経路生成装置。
前記ロボットアームを現在位置から目標位置に移動させるにあたり、前記有効移動経路網から、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第１のノードに移動させ、該第１のノードから前記最短移動経路を経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部をさらに備えたことを特徴とする付記７記載の移動経路生成装置。
（付記９）
プログラムを実行する演算装置で実行され、該演算装置を、ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成装置として動作させる移動経路生成プログラムであって、
前記演算装置を、
ロボットアームの移動空間を複数の第１段階のサブ空間に分割し、各第１段階のサブ空間それぞれを複数の第２段階のサブ空間に分割し、以下同様に、各第ｎ−１段階のサブ空間それぞれを複数の第ｎ段階のサブ空間に分割（但し、ｎは２以上の整数）して、該移動空間全体の代表座標である原点座標、および、各第１段階のサブ空間それぞれ、各第２段階のサブ空間それぞれ、…、各第ｎ段階のサブ空間それぞれの各代表座標を定めることにより、該原点座標に置かれたノードから、該第１段階のサブ空間の代表座標に置かれたノード、該第２段階のサブ空間の代表座標に置かれたノード、…、第ｎ段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を作成する移動経路網作成部と、
前記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えた移動経路生成装置として動作させることを特徴とする移動経路生成プログラム。
プログラムを実行する演算装置で実行され、該演算装置を、ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成装置として動作させる移動経路生成プログラムであって、
前記演算装置を、
ロボットアームの移動空間を複数の第１段階のサブ空間に分割し、各第１段階のサブ空間それぞれを複数の第２段階のサブ空間に分割し、以下同様に、各第ｎ−１段階のサブ空間それぞれを複数の第ｎ段階のサブ空間に分割（但し、ｎは２以上の整数）して、該移動空間全体の代表座標である原点座標、および、各第１段階のサブ空間それぞれ、各第２段階のサブ空間それぞれ、…、各第ｎ段階のサブ空間それぞれの各代表座標を定めることにより、該原点座標に置かれたノードから、該第１段階のサブ空間の代表座標に置かれたノード、該第２段階のサブ空間の代表座標に置かれたノード、…、第ｎ段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を作成する移動経路網作成部と、
前記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えた移動経路生成装置として動作させることを特徴とする移動経路生成プログラム。
（付記１０）
前記演算装置を、前記ロボットアームを現在位置から目標位置に移動させるにあたり、現在位置から、該現在位置に最近接した第１のノードに移動させ、該第１のノードに順次接続されたノードを経由して目標位置に最近接した第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部をさらに備えた移動経路生成装置として動作させることを特徴とする付記９記載の移動経路生成プログラム。
前記演算装置を、前記ロボットアームを現在位置から目標位置に移動させるにあたり、現在位置から、該現在位置に最近接した第１のノードに移動させ、該第１のノードに順次接続されたノードを経由して目標位置に最近接した第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部をさらに備えた移動経路生成装置として動作させることを特徴とする付記９記載の移動経路生成プログラム。
（付記１１）
プログラムを実行する演算装置内で実行され、該演算装置を、ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成として動作させる移動経路生成プログラムであって、
前記演算装置を、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成部と、
前記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えた移動経路生成装置として動作させることを特徴とする移動経路生成プログラム。
プログラムを実行する演算装置内で実行され、該演算装置を、ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成として動作させる移動経路生成プログラムであって、
前記演算装置を、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成部と、
前記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えた移動経路生成装置として動作させることを特徴とする移動経路生成プログラム。
（付記１２）
前記演算装置を、前記ロボットアームを現在位置から目標位置に移動させるにあたり、前記有効移動経路網から、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第１のノードに移動させ、該第１のノードから前記最短移動経路を経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部をさらに備えた移動経路生成装置として動作させることを特徴とする付記１１記載の移動経路生成プログラム。
前記演算装置を、前記ロボットアームを現在位置から目標位置に移動させるにあたり、前記有効移動経路網から、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第１のノードに移動させ、該第１のノードから前記最短移動経路を経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部をさらに備えた移動経路生成装置として動作させることを特徴とする付記１１記載の移動経路生成プログラム。
（付記１３）
ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置において、
ロボットアームの移動空間を複数の第１段階のサブ空間に分割し、各第１段階のサブ空間それぞれを複数の第２段階のサブ空間に分割し、以下同様に、各第ｎ−１段階のサブ空間それぞれを複数の第ｎ段階のサブ空間に分割（但し、ｎは２以上の整数）して、該移動空間全体の代表座標である原点座標、および、各第１段階のサブ空間それぞれ、各第２段階のサブ空間それぞれ、…、各第ｎ段階のサブ空間それぞれの各代表座標を定めることにより作成された、該原点座標に置かれたノードから、該第１段階のサブ空間の代表座標に置かれたノード、該第２段階のサブ空間の代表座標に置かれたノード、…、第ｎ段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行なうことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
前記有効移動経路網に基づいて、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の移動経路を求め、前記ロボットアームを、現在位置から、該第１のノードに移動させ、該第１のノードに順次接続されたノードを経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部とを備えたことを特徴とするロボットアーム制御装置。
ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置において、
ロボットアームの移動空間を複数の第１段階のサブ空間に分割し、各第１段階のサブ空間それぞれを複数の第２段階のサブ空間に分割し、以下同様に、各第ｎ−１段階のサブ空間それぞれを複数の第ｎ段階のサブ空間に分割（但し、ｎは２以上の整数）して、該移動空間全体の代表座標である原点座標、および、各第１段階のサブ空間それぞれ、各第２段階のサブ空間それぞれ、…、各第ｎ段階のサブ空間それぞれの各代表座標を定めることにより作成された、該原点座標に置かれたノードから、該第１段階のサブ空間の代表座標に置かれたノード、該第２段階のサブ空間の代表座標に置かれたノード、…、第ｎ段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行なうことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
前記有効移動経路網に基づいて、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の移動経路を求め、前記ロボットアームを、現在位置から、該第１のノードに移動させ、該第１のノードに順次接続されたノードを経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部とを備えたことを特徴とするロボットアーム制御装置。
（付記１４）
ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置において、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定めることにより作成された、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行うことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
前記有効移動経路網から、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第１のノードに移動させ、該第１のノードから前記最短移動経路を経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部とを備えたことを特徴とするロボットアーム制御装置。
ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置において、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定めることにより作成された、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行うことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
前記有効移動経路網から、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第１のノードに移動させ、該第１のノードから前記最短移動経路を経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部とを備えたことを特徴とするロボットアーム制御装置。
（付記１５）
プログラムを実行する演算装置で実行され、該演算装置を、ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置として動作させるロボットアーム制御プログラムであって、
前記演算装置を、
ロボットアームの移動空間を複数の第１段階のサブ空間に分割し、各第１段階のサブ空間それぞれを複数の第２段階のサブ空間に分割し、以下同様に、各第ｎ−１段階のサブ空間それぞれを複数の第ｎ段階のサブ空間に分割（但し、ｎは２以上の整数）して、該移動空間全体の代表座標である原点座標、および、各第１段階のサブ空間それぞれ、各第２段階のサブ空間それぞれ、…、各第ｎ段階のサブ空間それぞれの各代表座標を定めることにより作成された、該原点座標に置かれたノードから、該第１段階のサブ空間の代表座標に置かれたノード、該第２段階のサブ空間の代表座標に置かれたノード、…、第ｎ段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行なうことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
前記有効移動経路網に基づいて、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の移動経路を求め、前記ロボットアームを、現在位置から、該現在位置に最近接した第１のノードに移動させ、該第１のノードに順次接続されたノードを経由して目標位置に最近接した第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部とを備えたロボットアーム制御装置として動作させることを特徴とするロボットアーム制御プログラム。
プログラムを実行する演算装置で実行され、該演算装置を、ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置として動作させるロボットアーム制御プログラムであって、
前記演算装置を、
ロボットアームの移動空間を複数の第１段階のサブ空間に分割し、各第１段階のサブ空間それぞれを複数の第２段階のサブ空間に分割し、以下同様に、各第ｎ−１段階のサブ空間それぞれを複数の第ｎ段階のサブ空間に分割（但し、ｎは２以上の整数）して、該移動空間全体の代表座標である原点座標、および、各第１段階のサブ空間それぞれ、各第２段階のサブ空間それぞれ、…、各第ｎ段階のサブ空間それぞれの各代表座標を定めることにより作成された、該原点座標に置かれたノードから、該第１段階のサブ空間の代表座標に置かれたノード、該第２段階のサブ空間の代表座標に置かれたノード、…、第ｎ段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行なうことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
前記有効移動経路網に基づいて、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の移動経路を求め、前記ロボットアームを、現在位置から、該現在位置に最近接した第１のノードに移動させ、該第１のノードに順次接続されたノードを経由して目標位置に最近接した第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部とを備えたロボットアーム制御装置として動作させることを特徴とするロボットアーム制御プログラム。
（付記１６）
プログラムを実行する演算装置内で実行され、該演算装置を、ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置として動作させるロボットアーム制御プログラムであって、
前記演算装置を、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定めることにより作成された、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行うことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
前記有効移動経路網から、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第１のノードに移動させ、該第１のノードから前記最短移動経路を経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部とを備えたロボットアーム制御装置として動作させることを特徴とするロボットアーム制御プログラム。
プログラムを実行する演算装置内で実行され、該演算装置を、ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置として動作させるロボットアーム制御プログラムであって、
前記演算装置を、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定めることにより作成された、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行うことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
前記有効移動経路網から、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第１のノードに移動させ、該第１のノードから前記最短移動経路を経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部とを備えたロボットアーム制御装置として動作させることを特徴とするロボットアーム制御プログラム。
１０ ロボット
１１，１２ ロボットアーム
１１，１２ ロボットアーム
Claims (5)
- ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成方法において、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成ステップと、
前記移動経路網作成ステップで作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算ステップとを有することを特徴とする移動経路生成方法。 - ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成装置において、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成部と、
前記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えたことを特徴とする移動経路生成装置。 - プログラムを実行する演算装置内で実行され、該演算装置を、ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成として動作させる移動経路生成プログラムであって、
前記演算装置を、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成部と、
前記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えた移動経路生成装置として動作させることを特徴とする移動経路生成プログラム。 - ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置において、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定めることにより作成された、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行うことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
前記有効移動経路網から、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第１のノードに移動させ、該第１のノードから前記最短移動経路を経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部とを備えたことを特徴とするロボットアーム制御装置。 - プログラムを実行する演算装置内で実行され、該演算装置を、ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置として動作させるロボットアーム制御プログラムであって、
前記演算装置を、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定めることにより作成された、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行うことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
前記有効移動経路網から、現在位置に最近接した第１のノードと目標位置に最近接した第２のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第１のノードに移動させ、該第１のノードから前記最短移動経路を経由して該第２のノードに移動させ、該第２のノードから該目標位置に移動させるアーム移動制御部とを備えたロボットアーム制御装置として動作させることを特徴とするロボットアーム制御プログラム。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2012039477A JP5403086B2 (ja) | 2012-02-27 | 2012-02-27 | 移動経路生成方法、移動経路生成装置、移動経路生成プログラム、ロボットアーム制御装置、およびロボットアーム制御プログラム |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2012039477A JP5403086B2 (ja) | 2012-02-27 | 2012-02-27 | 移動経路生成方法、移動経路生成装置、移動経路生成プログラム、ロボットアーム制御装置、およびロボットアーム制御プログラム |
Related Parent Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2007226779A Division JP5061798B2 (ja) | 2007-08-31 | 2007-08-31 | 移動経路生成方法、移動経路生成装置、移動経路生成プログラム、ロボットアーム制御装置、およびロボットアーム制御プログラム |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2012106335A true JP2012106335A (ja) | 2012-06-07 |
| JP5403086B2 JP5403086B2 (ja) | 2014-01-29 |
Family
ID=46492535
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2012039477A Expired - Fee Related JP5403086B2 (ja) | 2012-02-27 | 2012-02-27 | 移動経路生成方法、移動経路生成装置、移動経路生成プログラム、ロボットアーム制御装置、およびロボットアーム制御プログラム |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP5403086B2 (ja) |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2020057313A (ja) * | 2018-10-04 | 2020-04-09 | セコム株式会社 | 経路探索装置及びプログラム |
| JP6758543B1 (ja) * | 2020-01-30 | 2020-09-23 | 三菱電機株式会社 | 原点復帰装置 |
| JP2021020266A (ja) * | 2019-07-26 | 2021-02-18 | オムロン株式会社 | ロボットの動作を決定する装置、方法およびプログラム |
Citations (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH09509513A (ja) * | 1994-11-09 | 1997-09-22 | 株式会社 アマダ | ロボットの運動を計画し制御する方法 |
-
2012
- 2012-02-27 JP JP2012039477A patent/JP5403086B2/ja not_active Expired - Fee Related
Patent Citations (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH09509513A (ja) * | 1994-11-09 | 1997-09-22 | 株式会社 アマダ | ロボットの運動を計画し制御する方法 |
Cited By (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2020057313A (ja) * | 2018-10-04 | 2020-04-09 | セコム株式会社 | 経路探索装置及びプログラム |
| JP7351609B2 (ja) | 2018-10-04 | 2023-09-27 | セコム株式会社 | 経路探索装置及びプログラム |
| JP2021020266A (ja) * | 2019-07-26 | 2021-02-18 | オムロン株式会社 | ロボットの動作を決定する装置、方法およびプログラム |
| JP7331527B2 (ja) | 2019-07-26 | 2023-08-23 | オムロン株式会社 | ロボットの動作を決定する装置、方法およびプログラム |
| JP6758543B1 (ja) * | 2020-01-30 | 2020-09-23 | 三菱電機株式会社 | 原点復帰装置 |
| WO2021152760A1 (ja) * | 2020-01-30 | 2021-08-05 | 三菱電機株式会社 | 原点復帰装置 |
| DE112020006647B4 (de) | 2020-01-30 | 2024-05-23 | Mitsubishi Electric Corporation | Ursprungsrückführvorrichtung |
Also Published As
| Publication number | Publication date |
|---|---|
| JP5403086B2 (ja) | 2014-01-29 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP5061798B2 (ja) | 移動経路生成方法、移動経路生成装置、移動経路生成プログラム、ロボットアーム制御装置、およびロボットアーム制御プログラム | |
| Bency et al. | Neural path planning: Fixed time, near-optimal path generation via oracle imitation | |
| JP5998816B2 (ja) | 経路探索方法、経路探索装置、ロボット制御装置、ロボット及びプログラム | |
| US9056394B2 (en) | Methods and systems for determining efficient robot-base position | |
| JP6378783B2 (ja) | アーム型のロボットの障害物自動回避方法及び制御装置 | |
| KR101048098B1 (ko) | 로봇의 경로계획 장치 및 방법 | |
| Sudhakara et al. | Trajectory planning of a mobile robot using enhanced A-star algorithm | |
| US11292132B2 (en) | Robot path planning method with static and dynamic collision avoidance in an uncertain environment | |
| KR20100081824A (ko) | 로봇의 경로계획장치 및 그 방법 | |
| JP2012190405A (ja) | 経路情報修正装置、軌道計画装置、及びロボット | |
| EP1335315A2 (en) | Dual Dijkstra search for planning multiple paths | |
| JP2008269021A (ja) | 経路作成方法及び経路作成装置 | |
| Talwar et al. | Particle Filter-based localization of a mobile robot by using a single LIDAR sensor under SLAM in ROS Environment | |
| JP2009053849A (ja) | 経路探索システム、経路探索方法、及び自律移動体 | |
| Alatartsev et al. | On optimizing a sequence of robotic tasks | |
| CN110162029A (zh) | 一种基于规划路径的运动控制方法及装置、机器人 | |
| US10556344B2 (en) | Method and system for determining a sequence of kinematic chains of a multiple robot | |
| CN109737980A (zh) | 一种导航方法及其对应的机器人 | |
| JP5403086B2 (ja) | 移動経路生成方法、移動経路生成装置、移動経路生成プログラム、ロボットアーム制御装置、およびロボットアーム制御プログラム | |
| US20220019939A1 (en) | Method and system for predicting motion-outcome data of a robot moving between a given pair of robotic locations | |
| Das et al. | A modified real time A* algorithm and its performance analysis for improved path planning of mobile robot | |
| KR101688302B1 (ko) | 모션 플래닝 장치 및 방법 | |
| Pal et al. | A focused wave front algorithm for mobile robot path planning | |
| JP2003029833A (ja) | 移動体の自律走行経路の生成法 | |
| JP2021169149A (ja) | 分解ベースのアセンブリ計画 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20120227 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20130326 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20130516 |
|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20131001 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20131014 |
|
| LAPS | Cancellation because of no payment of annual fees |