JP5061798B2 - 移動経路生成方法、移動経路生成装置、移動経路生成プログラム、ロボットアーム制御装置、およびロボットアーム制御プログラム - Google Patents
移動経路生成方法、移動経路生成装置、移動経路生成プログラム、ロボットアーム制御装置、およびロボットアーム制御プログラム Download PDFInfo
- Publication number
- JP5061798B2 JP5061798B2 JP2007226779A JP2007226779A JP5061798B2 JP 5061798 B2 JP5061798 B2 JP 5061798B2 JP 2007226779 A JP2007226779 A JP 2007226779A JP 2007226779 A JP2007226779 A JP 2007226779A JP 5061798 B2 JP5061798 B2 JP 5061798B2
- Authority
- JP
- Japan
- Prior art keywords
- stage
- movement path
- robot arm
- node
- movement
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Description
ロボットアームの移動空間を複数の第1段階のサブ空間に分割し、各第1段階のサブ空間それぞれを複数の第2段階のサブ空間に分割し、以下同様に、各第n−1段階のサブ空間それぞれを複数の第n段階のサブ空間に分割(但し、nは2以上の整数)して、該移動空間全体の代表座標である原点座標、および、各第1段階のサブ空間それぞれ、各第2段階のサブ空間それぞれ、…、各第n段階のサブ空間それぞれの各代表座標を定めることにより、該原点座標に置かれたノードから、該第1段階のサブ空間の代表座標に置かれたノード、該第2段階のサブ空間の代表座標に置かれたノード、…、第n段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を作成する移動経路網作成ステップと、
移動経路網作成ステップで作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算ステップとを有する。
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成ステップと、
移動経路網作成ステップで作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算ステップとを有することを特徴とする。
ロボットアームの移動空間を複数の第1段階のサブ空間に分割し、各第1段階のサブ空間それぞれを複数の第2段階のサブ空間に分割し、以下同様に、各第n−1段階のサブ空間それぞれを複数の第n段階のサブ空間に分割(但し、nは2以上の整数)して、該移動空間全体の代表座標である原点座標、および、各第1段階のサブ空間それぞれ、各第2段階のサブ空間それぞれ、…、各第n段階のサブ空間それぞれの各代表座標を定めることにより、該原点座標に置かれたノードから、該第1段階のサブ空間の代表座標に置かれたノード、該第2段階のサブ空間の代表座標に置かれたノード、…、第n段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を作成する移動経路網作成部と、
前記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えたことを特徴とする。
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成部と、
上記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えたことを特徴とする。
前記演算装置を、
ロボットアームの移動空間を複数の第1段階のサブ空間に分割し、各第1段階のサブ空間それぞれを複数の第2段階のサブ空間に分割し、以下同様に、各第n−1段階のサブ空間それぞれを複数の第n段階のサブ空間に分割(但し、nは2以上の整数)して、該移動空間全体の代表座標である原点座標、および、各第1段階のサブ空間それぞれ、各第2段階のサブ空間それぞれ、…、各第n段階のサブ空間それぞれの各代表座標を定めることにより、該原点座標に置かれたノードから、該第1段階のサブ空間の代表座標に置かれたノード、該第2段階のサブ空間の代表座標に置かれたノード、…、第n段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を作成する移動経路網作成部と、
上記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えた移動経路生成装置として動作させることを特徴とする。
前記演算装置を、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成部と、
上記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えた移動経路生成装置として動作させることを特徴とする。
ロボットアームの移動空間を複数の第1段階のサブ空間に分割し、各第1段階のサブ空間それぞれを複数の第2段階のサブ空間に分割し、以下同様に、各第n−1段階のサブ空間それぞれを複数の第n段階のサブ空間に分割(但し、nは2以上の整数)して、該移動空間全体の代表座標である原点座標、および、各第1段階のサブ空間それぞれ、各第2段階のサブ空間それぞれ、…、各第n段階のサブ空間それぞれの各代表座標を定めることにより作成された、該原点座標に置かれたノードから、該第1段階のサブ空間の代表座標に置かれたノード、該第2段階のサブ空間の代表座標に置かれたノード、…、第n段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行なうことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
上記有効移動経路網に基づいて、現在位置に最近接した第1のノードと目標位置に最近接した第2のノードとの間の移動経路を求め、上記ロボットアームを、現在位置から、該第1のノードに移動させ、該第1のノードに順次接続されたノードを経由して該第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動制御部とを備えたことを特徴とする。
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定めることにより作成された、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行うことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
上記有効移動経路網から、現在位置に最近接した第1のノードと目標位置に最近接した第2のノードとの間の最短移動経路を求め、上記ロボットアームを、該現在位置から該第1のノードに移動させ、該第1のノードから前記最短移動経路を経由して該第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動制御部とを備えたことを特徴とする。
上記演算装置を、
ロボットアームの移動空間を複数の第1段階のサブ空間に分割し、各第1段階のサブ空間それぞれを複数の第2段階のサブ空間に分割し、以下同様に、各第n−1段階のサブ空間それぞれを複数の第n段階のサブ空間に分割(但し、nは2以上の整数)して、該移動空間全体の代表座標である原点座標、および、各第1段階のサブ空間それぞれ、各第2段階のサブ空間それぞれ、…、各第n段階のサブ空間それぞれの各代表座標を定めることにより作成された、該原点座標に置かれたノードから、該第1段階のサブ空間の代表座標に置かれたノード、該第2段階のサブ空間の代表座標に置かれたノード、…、第n段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行なうことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
上記有効移動経路網に基づいて、現在位置に最近接した第1のノードと目標位置に最近接した第2のノードとの間の移動経路を求め、上記ロボットアームを、現在位置から、該第1のノードに移動させ、該第1のノードに順次接続されたノードを経由して該第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動制御部とを備えたロボットアーム制御装置として動作させることを特徴とする。
上記演算装置を、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定めることにより作成された、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行うことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
上記有効移動経路網から、現在位置に最近接した第1のノードと目標位置に最近接した第2のノードとの間の最短移動経路を求め、上記ロボットアームを、該現在位置から該第1のノードに移動させ、該第1のノードから上記最短移動経路を経由して該第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動制御部とを備えたロボットアーム制御装置として動作させることを特徴とする。
ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成方法において、
ロボットアームの移動空間を複数の第1段階のサブ空間に分割し、各第1段階のサブ空間それぞれを複数の第2段階のサブ空間に分割し、以下同様に、各第n−1段階のサブ空間それぞれを複数の第n段階のサブ空間に分割(但し、nは2以上の整数)して、該移動空間全体の代表座標である原点座標、および、各第1段階のサブ空間それぞれ、各第2段階のサブ空間それぞれ、…、各第n段階のサブ空間それぞれの各代表座標を定めることにより、該原点座標に置かれたノードから、該第1段階のサブ空間の代表座標に置かれたノード、該第2段階のサブ空間の代表座標に置かれたノード、…、第n段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を作成する移動経路網作成ステップと、
前記移動経路網作成ステップで作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算ステップとを有することを特徴とする移動経路生成方法。
前記ロボットアームを現在位置から目標位置に移動させるにあたり、現在位置から、該現在位置に最近接した第1のノードに移動させ、該第1のノードに順次接続されたノードを経由して目標位置に最近接した第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動ステップをさらに有することを特徴とする付記1記載の移動経路生成方法。
ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成方法において、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成ステップと、
前記移動経路網作成ステップで作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算ステップとを有することを特徴とする移動経路生成方法。
前記ロボットアームを現在位置から目標位置に移動させるにあたり、前記有効移動経路網から、現在位置に最近接した第1のノードと目標位置に最近接した第2のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第1のノードに移動させ、該第1のノードから前記最短移動経路を経由して該第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動ステップをさらに有することを特徴とする付記3記載の移動経路生成方法。
ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成装置において、
ロボットアームの移動空間を複数の第1段階のサブ空間に分割し、各第1段階のサブ空間それぞれを複数の第2段階のサブ空間に分割し、以下同様に、各第n−1段階のサブ空間それぞれを複数の第n段階のサブ空間に分割(但し、nは2以上の整数)して、該移動空間全体の代表座標である原点座標、および、各第1段階のサブ空間それぞれ、各第2段階のサブ空間それぞれ、…、各第n段階のサブ空間それぞれの各代表座標を定めることにより、該原点座標に置かれたノードから、該第1段階のサブ空間の代表座標に置かれたノード、該第2段階のサブ空間の代表座標に置かれたノード、…、第n段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を作成する移動経路網作成部と、
前記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えたことを特徴とする移動経路生成装置。
前記ロボットアームを現在位置から目標位置に移動させるにあたり、現在位置から、該現在位置に最近接した第1のノードに移動させ、該第1のノードに順次接続されたノードを経由して目標位置に最近接した第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動制御部をさらに備えたことを特徴とする付記5記載の移動経路生成装置。
ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成装置において、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成部と、
前記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えたことを特徴とする移動経路生成装置。
前記ロボットアームを現在位置から目標位置に移動させるにあたり、前記有効移動経路網から、現在位置に最近接した第1のノードと目標位置に最近接した第2のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第1のノードに移動させ、該第1のノードから前記最短移動経路を経由して該第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動制御部をさらに備えたことを特徴とする付記7記載の移動経路生成装置。
プログラムを実行する演算装置で実行され、該演算装置を、ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成装置として動作させる移動経路生成プログラムであって、
前記演算装置を、
ロボットアームの移動空間を複数の第1段階のサブ空間に分割し、各第1段階のサブ空間それぞれを複数の第2段階のサブ空間に分割し、以下同様に、各第n−1段階のサブ空間それぞれを複数の第n段階のサブ空間に分割(但し、nは2以上の整数)して、該移動空間全体の代表座標である原点座標、および、各第1段階のサブ空間それぞれ、各第2段階のサブ空間それぞれ、…、各第n段階のサブ空間それぞれの各代表座標を定めることにより、該原点座標に置かれたノードから、該第1段階のサブ空間の代表座標に置かれたノード、該第2段階のサブ空間の代表座標に置かれたノード、…、第n段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を作成する移動経路網作成部と、
前記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えた移動経路生成装置として動作させることを特徴とする移動経路生成プログラム。
前記演算装置を、前記ロボットアームを現在位置から目標位置に移動させるにあたり、現在位置から、該現在位置に最近接した第1のノードに移動させ、該第1のノードに順次接続されたノードを経由して目標位置に最近接した第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動制御部をさらに備えた移動経路生成装置として動作させることを特徴とする付記9記載の移動経路生成プログラム。
プログラムを実行する演算装置内で実行され、該演算装置を、ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成として動作させる移動経路生成プログラムであって、
前記演算装置を、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成部と、
前記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部とを備えた移動経路生成装置として動作させることを特徴とする移動経路生成プログラム。
前記演算装置を、前記ロボットアームを現在位置から目標位置に移動させるにあたり、前記有効移動経路網から、現在位置に最近接した第1のノードと目標位置に最近接した第2のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第1のノードに移動させ、該第1のノードから前記最短移動経路を経由して該第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動制御部をさらに備えた移動経路生成装置として動作させることを特徴とする付記11記載の移動経路生成プログラム。
ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置において、
ロボットアームの移動空間を複数の第1段階のサブ空間に分割し、各第1段階のサブ空間それぞれを複数の第2段階のサブ空間に分割し、以下同様に、各第n−1段階のサブ空間それぞれを複数の第n段階のサブ空間に分割(但し、nは2以上の整数)して、該移動空間全体の代表座標である原点座標、および、各第1段階のサブ空間それぞれ、各第2段階のサブ空間それぞれ、…、各第n段階のサブ空間それぞれの各代表座標を定めることにより作成された、該原点座標に置かれたノードから、該第1段階のサブ空間の代表座標に置かれたノード、該第2段階のサブ空間の代表座標に置かれたノード、…、第n段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行なうことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
前記有効移動経路網に基づいて、現在位置に最近接した第1のノードと目標位置に最近接した第2のノードとの間の移動経路を求め、前記ロボットアームを、現在位置から、該第1のノードに移動させ、該第1のノードに順次接続されたノードを経由して該第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動制御部とを備えたことを特徴とするロボットアーム制御装置。
ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置において、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定めることにより作成された、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行うことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
前記有効移動経路網から、現在位置に最近接した第1のノードと目標位置に最近接した第2のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第1のノードに移動させ、該第1のノードから前記最短移動経路を経由して該第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動制御部とを備えたことを特徴とするロボットアーム制御装置。
プログラムを実行する演算装置で実行され、該演算装置を、ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置として動作させるロボットアーム制御プログラムであって、
前記演算装置を、
ロボットアームの移動空間を複数の第1段階のサブ空間に分割し、各第1段階のサブ空間それぞれを複数の第2段階のサブ空間に分割し、以下同様に、各第n−1段階のサブ空間それぞれを複数の第n段階のサブ空間に分割(但し、nは2以上の整数)して、該移動空間全体の代表座標である原点座標、および、各第1段階のサブ空間それぞれ、各第2段階のサブ空間それぞれ、…、各第n段階のサブ空間それぞれの各代表座標を定めることにより作成された、該原点座標に置かれたノードから、該第1段階のサブ空間の代表座標に置かれたノード、該第2段階のサブ空間の代表座標に置かれたノード、…、第n段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行なうことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
前記有効移動経路網に基づいて、現在位置に最近接した第1のノードと目標位置に最近接した第2のノードとの間の移動経路を求め、前記ロボットアームを、現在位置から、該現在位置に最近接した第1のノードに移動させ、該第1のノードに順次接続されたノードを経由して目標位置に最近接した第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動制御部とを備えたロボットアーム制御装置として動作させることを特徴とするロボットアーム制御プログラム。
プログラムを実行する演算装置内で実行され、該演算装置を、ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置として動作させるロボットアーム制御プログラムであって、
前記演算装置を、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定めることにより作成された、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行うことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
前記有効移動経路網から、現在位置に最近接した第1のノードと目標位置に最近接した第2のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第1のノードに移動させ、該第1のノードから前記最短移動経路を経由して該第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動制御部とを備えたロボットアーム制御装置として動作させることを特徴とするロボットアーム制御プログラム。
11,12 ロボットアーム
Claims (5)
- ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成方法において、
ロボットアームの移動空間を複数の第1段階のサブ空間に分割し、各第1段階のサブ空間それぞれを複数の第2段階のサブ空間に分割し、以下同様に、各第n−1段階のサブ空間それぞれを複数の第n段階のサブ空間に分割(但し、nは2以上の整数)して、該移動空間全体の代表座標である原点座標、および、各第1段階のサブ空間それぞれ、各第2段階のサブ空間それぞれ、…、各第n段階のサブ空間それぞれの各代表座標を定めることにより、該原点座標に置かれたノードから、該第1段階のサブ空間の代表座標に置かれたノード、該第2段階のサブ空間の代表座標に置かれたノード、…、第n段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を作成する移動経路網作成ステップと、
前記移動経路網作成ステップで作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算ステップと、
前記ロボットアームを現在位置から目標位置に移動させるにあたり、現在位置から、該現在位置に最近接した第1のノードに移動させ、該第1のノードに順次接続されたノードを経由して目標位置に最近接した第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動ステップとを有することを特徴とする移動経路生成方法。 - ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成装置において、
ロボットアームの移動空間を複数の第1段階のサブ空間に分割し、各第1段階のサブ空間それぞれを複数の第2段階のサブ空間に分割し、以下同様に、各第n−1段階のサブ空間それぞれを複数の第n段階のサブ空間に分割(但し、nは2以上の整数)して、該移動空間全体の代表座標である原点座標、および、各第1段階のサブ空間それぞれ、各第2段階のサブ空間それぞれ、…、各第n段階のサブ空間それぞれの各代表座標を定めることにより、該原点座標に置かれたノードから、該第1段階のサブ空間の代表座標に置かれたノード、該第2段階のサブ空間の代表座標に置かれたノード、…、第n段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を作成する移動経路網作成部と、
前記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部と、
前記ロボットアームを現在位置から目標位置に移動させるにあたり、現在位置から、該現在位置に最近接した第1のノードに移動させ、該第1のノードに順次接続されたノードを経由して目標位置に最近接した第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動制御部とを備えたことを特徴とする移動経路生成装置。 - プログラムを実行する演算装置で実行され、該演算装置を、ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成装置として動作させる移動経路生成プログラムであって、
前記演算装置を、
ロボットアームの移動空間を複数の第1段階のサブ空間に分割し、各第1段階のサブ空間それぞれを複数の第2段階のサブ空間に分割し、以下同様に、各第n−1段階のサブ空間それぞれを複数の第n段階のサブ空間に分割(但し、nは2以上の整数)して、該移動空間全体の代表座標である原点座標、および、各第1段階のサブ空間それぞれ、各第2段階のサブ空間それぞれ、…、各第n段階のサブ空間それぞれの各代表座標を定めることにより、該原点座標に置かれたノードから、該第1段階のサブ空間の代表座標に置かれたノード、該第2段階のサブ空間の代表座標に置かれたノード、…、第n段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を作成する移動経路網作成部と、
前記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部と、
前記ロボットアームを現在位置から目標位置に移動させるにあたり、現在位置から、該現在位置に最近接した第1のノードに移動させ、該第1のノードに順次接続されたノードを経由して目標位置に最近接した第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動制御部とを備えた移動経路生成装置として動作させることを特徴とする移動経路生成プログラム。 - ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置において、
ロボットアームの移動空間を複数の第1段階のサブ空間に分割し、各第1段階のサブ空間それぞれを複数の第2段階のサブ空間に分割し、以下同様に、各第n−1段階のサブ空間それぞれを複数の第n段階のサブ空間に分割(但し、nは2以上の整数)して、該移動空間全体の代表座標である原点座標、および、各第1段階のサブ空間それぞれ、各第2段階のサブ空間それぞれ、…、各第n段階のサブ空間それぞれの各代表座標を定めることにより作成された、該原点座標に置かれたノードから、該第1段階のサブ空間の代表座標に置かれたノード、該第2段階のサブ空間の代表座標に置かれたノード、…、第n段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行なうことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
前記有効移動経路網に基づいて、現在位置に最近接した第1のノードと目標位置に最近接した第2のノードとの間の移動経路を求め、前記ロボットアームを、現在位置から、該第1のノードに移動させ、該第1のノードに順次接続されたノードを経由して該第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動制御部とを備えたことを特徴とするロボットアーム制御装置。 - プログラムを実行する演算装置で実行され、該演算装置を、ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置として動作させるロボットアーム制御プログラムであって、
前記演算装置を、
ロボットアームの移動空間を複数の第1段階のサブ空間に分割し、各第1段階のサブ空間それぞれを複数の第2段階のサブ空間に分割し、以下同様に、各第n−1段階のサブ空間それぞれを複数の第n段階のサブ空間に分割(但し、nは2以上の整数)して、該移動空間全体の代表座標である原点座標、および、各第1段階のサブ空間それぞれ、各第2段階のサブ空間それぞれ、…、各第n段階のサブ空間それぞれの各代表座標を定めることにより作成された、該原点座標に置かれたノードから、該第1段階のサブ空間の代表座標に置かれたノード、該第2段階のサブ空間の代表座標に置かれたノード、…、第n段階のサブ空間の代表座標に置かれたノードへと順次繋がる移動経路からなるツリー構造の移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行なうことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
前記有効移動経路網に基づいて、現在位置に最近接した第1のノードと目標位置に最近接した第2のノードとの間の移動経路を求め、前記ロボットアームを、現在位置から、該現在位置に最近接した第1のノードに移動させ、該第1のノードに順次接続されたノードを経由して目標位置に最近接した第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動制御部とを備えたロボットアーム制御装置として動作させることを特徴とするロボットアーム制御プログラム。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007226779A JP5061798B2 (ja) | 2007-08-31 | 2007-08-31 | 移動経路生成方法、移動経路生成装置、移動経路生成プログラム、ロボットアーム制御装置、およびロボットアーム制御プログラム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007226779A JP5061798B2 (ja) | 2007-08-31 | 2007-08-31 | 移動経路生成方法、移動経路生成装置、移動経路生成プログラム、ロボットアーム制御装置、およびロボットアーム制御プログラム |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2012039477A Division JP5403086B2 (ja) | 2012-02-27 | 2012-02-27 | 移動経路生成方法、移動経路生成装置、移動経路生成プログラム、ロボットアーム制御装置、およびロボットアーム制御プログラム |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2009056554A JP2009056554A (ja) | 2009-03-19 |
JP5061798B2 true JP5061798B2 (ja) | 2012-10-31 |
Family
ID=40552777
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2007226779A Expired - Fee Related JP5061798B2 (ja) | 2007-08-31 | 2007-08-31 | 移動経路生成方法、移動経路生成装置、移動経路生成プログラム、ロボットアーム制御装置、およびロボットアーム制御プログラム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5061798B2 (ja) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5269737B2 (ja) * | 2009-10-08 | 2013-08-21 | 株式会社東芝 | 干渉チェック方法、干渉チェック装置、及び干渉チェックプログラム |
JP5531874B2 (ja) * | 2010-09-10 | 2014-06-25 | 株式会社エクォス・リサーチ | 走行制御装置 |
JP5531873B2 (ja) * | 2010-09-10 | 2014-06-25 | 株式会社エクォス・リサーチ | 走行制御装置 |
CN107443373B (zh) * | 2017-07-20 | 2018-09-28 | 广东工业大学 | 基于关节臂机器人的避碰轨迹规划方法和装置 |
JP7299097B2 (ja) * | 2019-08-02 | 2023-06-27 | 国立大学法人信州大学 | 軌道生成装置 |
CN112372632A (zh) * | 2020-10-12 | 2021-02-19 | 达闼机器人有限公司 | 一种机械臂动作控制方法、设备及计算机可读存储介质 |
KR102545587B1 (ko) * | 2021-12-29 | 2023-06-20 | 한국로봇융합연구원 | 구조 로봇 시스템 |
CN114393581A (zh) * | 2022-01-17 | 2022-04-26 | 成都工业学院 | 一种基于ros的一体化智能机械臂控制方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05228860A (ja) * | 1991-06-25 | 1993-09-07 | Sanyo Electric Co Ltd | ロボットマニピュレータの制御方法 |
JPH05250023A (ja) * | 1991-10-23 | 1993-09-28 | Sanyo Electric Co Ltd | ロボットマニピュレータの経路自動生成法 |
-
2007
- 2007-08-31 JP JP2007226779A patent/JP5061798B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2009056554A (ja) | 2009-03-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5061798B2 (ja) | 移動経路生成方法、移動経路生成装置、移動経路生成プログラム、ロボットアーム制御装置、およびロボットアーム制御プログラム | |
Zhang et al. | Path planning of industrial robot based on improved RRT algorithm in complex environments | |
Bency et al. | Neural path planning: Fixed time, near-optimal path generation via oracle imitation | |
JP5998816B2 (ja) | 経路探索方法、経路探索装置、ロボット制御装置、ロボット及びプログラム | |
US8666548B2 (en) | Path planning apparatus of robot and method thereof | |
US9411335B2 (en) | Method and apparatus to plan motion path of robot | |
US9056394B2 (en) | Methods and systems for determining efficient robot-base position | |
JP4941068B2 (ja) | 経路作成方法及び経路作成装置 | |
US11292132B2 (en) | Robot path planning method with static and dynamic collision avoidance in an uncertain environment | |
EP1335315A2 (en) | Dual Dijkstra search for planning multiple paths | |
EP3627250B1 (en) | Method and system for free space detection in a cluttered environment | |
CN106625666A (zh) | 冗余机械臂的控制方法及装置 | |
JP2012190405A (ja) | 経路情報修正装置、軌道計画装置、及びロボット | |
CN109760040B (zh) | 干扰判定方法、干扰判定***以及存储介质 | |
JP2009053849A (ja) | 経路探索システム、経路探索方法、及び自律移動体 | |
JP2007316942A (ja) | 経路作成装置及び経路作成方法 | |
EP4157589A1 (en) | A robot path planning method with static and dynamic collision avoidance in an uncertain environment | |
Xidias et al. | Time-optimal task scheduling for articulated manipulators in environments cluttered with obstacles | |
JP2009134352A (ja) | ロボットの動作経路作成装置及びロボットの動作経路作成方法 | |
JP4760732B2 (ja) | 経路作成装置 | |
JP5403086B2 (ja) | 移動経路生成方法、移動経路生成装置、移動経路生成プログラム、ロボットアーム制御装置、およびロボットアーム制御プログラム | |
Khanmirza et al. | A comparative study of deterministic and probabilistic mobile robot path planning algorithms | |
CN117124335B (zh) | 一种基于路径标记回溯策略的改进式rrt路径规划方法 | |
Pal et al. | A focused wave front algorithm for mobile robot path planning | |
JP2003029833A (ja) | 移動体の自律走行経路の生成法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20100517 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20111124 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20111227 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20120227 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20120710 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20120723 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20150817 Year of fee payment: 3 |
|
LAPS | Cancellation because of no payment of annual fees |