JP5403086B2 - 移動経路生成方法、移動経路生成装置、移動経路生成プログラム、ロボットアーム制御装置、およびロボットアーム制御プログラム - Google Patents
移動経路生成方法、移動経路生成装置、移動経路生成プログラム、ロボットアーム制御装置、およびロボットアーム制御プログラム Download PDFInfo
- Publication number
- JP5403086B2 JP5403086B2 JP2012039477A JP2012039477A JP5403086B2 JP 5403086 B2 JP5403086 B2 JP 5403086B2 JP 2012039477 A JP2012039477 A JP 2012039477A JP 2012039477 A JP2012039477 A JP 2012039477A JP 5403086 B2 JP5403086 B2 JP 5403086B2
- Authority
- JP
- Japan
- Prior art keywords
- movement path
- robot arm
- node
- movement
- current position
- 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
- 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のノードと目標位置に最近接した第2のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第1のノードに移動させ、該第1のノードから前記最短移動経路を経由して該第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動ステップとを有することを特徴とする移動経路生成方法。 - ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成装置において、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成部と、
前記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部と、
前記ロボットアームを現在位置から目標位置に移動させるにあたり、現在位置から、該現在位置に最近接した第1のノードに移動させ、該第1のノードに順次接続されたノードを経由して目標位置に最近接した第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動制御部とを備えたことを特徴とする移動経路生成装置。 - プログラムを実行する演算装置内で実行され、該演算装置を、ロボットアームの、現在位置から目標位置への移動経路を生成する移動経路生成として動作させる移動経路生成プログラムであって、
前記演算装置を、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定め、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を作成する移動経路網作成部と、
前記移動経路網作成部で作成された移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行ない、該移動経路網から干渉を免れた有効な移動経路のみを抽出した有効移動経路網を作成する干渉演算部と、
前記演算装置を、前記ロボットアームを現在位置から目標位置に移動させるにあたり、前記有効移動経路網から、現在位置に最近接した第1のノードと目標位置に最近接した第2のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第1のノードに移動させ、該第1のノードから前記最短移動経路を経由して該第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動制御部とを備えた移動経路生成装置として動作させることを特徴とする移動経路生成プログラム。 - ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置において、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定めることにより作成された、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行うことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
前記有効移動経路網から、現在位置に最近接した第1のノードと目標位置に最近接した第2のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第1のノードに移動させ、該第1のノードから前記最短移動経路を経由して該第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動制御部とを備えたことを特徴とするロボットアーム制御装置。 - プログラムを実行する演算装置内で実行され、該演算装置を、ロボットアームの、現在位置から目標位置への移動を制御するロボットアーム制御装置として動作させるロボットアーム制御プログラムであって、
前記演算装置を、
ロボットアームの移動空間を複数のサブ空間に分割したときの各サブ空間の代表座標を定めることにより作成された、各代表座標に置かれた各ノードどうしを結ぶ移動経路からなる移動経路網を構成する各移動経路について、ロボットアームと、該ロボットアームの移動の障害となる障害物との間の干渉チェックを行うことにより、該移動経路網から干渉を免れた有効な移動経路のみが抽出された有効移動経路網を記憶する記憶部と、
前記有効移動経路網から、現在位置に最近接した第1のノードと目標位置に最近接した第2のノードとの間の最短移動経路を求め、前記ロボットアームを、該現在位置から該第1のノードに移動させ、該第1のノードから前記最短移動経路を経由して該第2のノードに移動させ、該第2のノードから該目標位置に移動させるアーム移動制御部とを備えたロボットアーム制御装置として動作させることを特徴とするロボットアーム制御プログラム。
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 JP2012106335A (ja) | 2012-06-07 |
JP5403086B2 true 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) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7351609B2 (ja) * | 2018-10-04 | 2023-09-27 | セコム株式会社 | 経路探索装置及びプログラム |
JP7331527B2 (ja) * | 2019-07-26 | 2023-08-23 | オムロン株式会社 | ロボットの動作を決定する装置、方法およびプログラム |
WO2021152760A1 (ja) * | 2020-01-30 | 2021-08-05 | 三菱電機株式会社 | 原点復帰装置 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5835684A (en) * | 1994-11-09 | 1998-11-10 | Amada Company, Ltd. | Method for planning/controlling robot motion |
-
2012
- 2012-02-27 JP JP2012039477A patent/JP5403086B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2012106335A (ja) | 2012-06-07 |
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) | アーム型のロボットの障害物自動回避方法及び制御装置 | |
US11292132B2 (en) | Robot path planning method with static and dynamic collision avoidance in an uncertain environment | |
KR20100081824A (ko) | 로봇의 경로계획장치 및 그 방법 | |
EP1335315A2 (en) | Dual Dijkstra search for planning multiple paths | |
EP4157589A1 (en) | A robot path planning method with static and dynamic collision avoidance in an uncertain environment | |
JP2008269021A (ja) | 経路作成方法及び経路作成装置 | |
CN109760040B (zh) | 干扰判定方法、干扰判定系统以及存储介质 | |
JP2009053849A (ja) | 経路探索システム、経路探索方法、及び自律移動体 | |
Talwar et al. | Particle Filter-based localization of a mobile robot by using a single LIDAR sensor under SLAM in ROS Environment | |
KR101688302B1 (ko) | 모션 플래닝 장치 및 방법 | |
US20190344443A1 (en) | Method and system for determining a sequence of kinematic chains of a multiple robot | |
JP5403086B2 (ja) | 移動経路生成方法、移動経路生成装置、移動経路生成プログラム、ロボットアーム制御装置、およびロボットアーム制御プログラム | |
Khanmirza et al. | A comparative study of deterministic and probabilistic mobile robot path planning algorithms | |
JP4760732B2 (ja) | 経路作成装置 | |
Gentilini et al. | Cycle time based multi-goal path optimization for redundant robotic systems | |
Das et al. | A modified real time A* algorithm and its performance analysis for improved path planning of mobile robot | |
CN117124335B (zh) | 一种基于路径标记回溯策略的改进式rrt路径规划方法 | |
Pal et al. | A focused wave front algorithm for mobile robot path planning | |
JP2003029833A (ja) | 移動体の自律走行経路の生成法 | |
JP2021169149A (ja) | 分解ベースのアセンブリ計画 | |
Kim et al. | Digital twin for autonomous collaborative robot by using synthetic data and reinforcement learning |
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 |