JP2006155559A - 経路計画装置 - Google Patents
経路計画装置 Download PDFInfo
- Publication number
- JP2006155559A JP2006155559A JP2005141661A JP2005141661A JP2006155559A JP 2006155559 A JP2006155559 A JP 2006155559A JP 2005141661 A JP2005141661 A JP 2005141661A JP 2005141661 A JP2005141661 A JP 2005141661A JP 2006155559 A JP2006155559 A JP 2006155559A
- Authority
- JP
- Japan
- Prior art keywords
- route
- posture
- constraint
- constraint condition
- path
- 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
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
【解決手段】 経路作成手段1は、拘束中間姿勢作成部10を有している。拘束中間姿勢作成部10では、関節角度空間に拘束曲面を定義する。また、経路作成手段1では、関節角度空間に確率的に中間姿勢を生成する。拘束中間姿勢作成部10では、確率的に生成された中間姿勢を拘束曲面に射影して射影中間姿勢を生成する。この射影中間姿勢を連結し、作業空間において障害物(環境物体)と干渉しない経路を作成する。
【選択図】 図1
Description
Randomized Kinodynamic Planning : S.M.LaValle and J.J.Kuffner,Jr. : Proc of IEEE Int. Conf. on Robotics and Automation, 1999 ロボティクス−機構・力学・制御−(第7章)、John J.Craig 著、三浦宏文・下山勲 訳、共立出版株式会社、109641号公報
このRTEによって、ハンド39の位置ベクトルrが決まり、1T7が関節変換ベクトルの関数であることから、リンクパラメータの値を与えることにより、7自由度アームの関節変換ベクトルとベース座標系からみた手先位置のベクトルrとの関係式r=f(q)を求めることができる。
h2(q)≡<Rey,e3>=0 ・・・(4)
ここで、<,>はユークリッド内積を表している。
さらに、ベクトル値関数h(q)を、下記(6)式のように定義する。
(6)式において、Tは転置を表している。
所定の射影中間姿勢をqk∈R7とし、qkでのh(q)のグラフの接空間は、下記(8)式で表される。
ここで、記号「・」は、行列の積を表す。この(8)式を変形して、(9)式を得ることができる。
ここで、行列(∂h/∂q)†(qk)は、行列(∂h/∂q)(qk)の一般逆行列を表す。具体的には、下記(10)式で表される。
この射影中間姿勢qkを更新姿勢(点)と考え、射影中間姿勢qkに対する次の射影中間姿勢qk+1を下記(11)式により更新する。
この(11)式がニュートン法における更新公式となる。このようにして、中間姿勢q1,q2,…を拘束曲面Vに射影し、射影中間姿勢qkを得ることができる。
qkと同様の処理を行い、枝をさらに生成する。また、射影中間姿勢qkと最終姿勢qGとが枝で接続されたと判断した場合には、射影中間姿勢qkと最終姿勢側qGとの間の処理を、射影中間姿勢qkと初期姿勢qS側との間で行い、射影中間姿勢qkと初期姿勢qSとを枝で結ぶ処理を行う(S20)。
いま、図3に示すアームの各リンクでの座標系において、3つのベクトルの組(xi,yi,zi)で決まる座標系をΣiと表記する。ここで、ΣEはハンド位置姿勢座標系を表し、ΣRは台座座標系を表す。また、ハンド39の位置姿勢は、上記第一の実施形態で示した(1)式で表される。この(1)式で求められるRTEによって、ハンド39の手首位置ベクトルpが下記(20)式で表される。
ここで、1T7が関節変数ベクトルqの関数であるので、リンクパラメータの値が与えられれば、7自由度アームの関節変数ベクトルqとベース座標系から見た手首位置のベクトルpとの関係式が下記(21)式として決まる。
ここでL=(L1,L2,L3,L4,L5,L6,L7)Tである。
このとき、x,y,zは、それぞれ下記(23−1)式〜(23−3)式で表すことができる。
y=f2(q,L) ・・・(23−2)
z=f3(q,L) ・・・(23−3)
ここで、作業空間においては、下記(24−1)式〜(24−m)式で表される手首位置ベクトルpの拘束条件があるとする。
ただし、h(q)=(g1(p(q)),・・・,gm(p(q)))Tである。
ここで、dq=q−q0であり、Jは関数hのヤコビ行列である。
行列JTJを対角化する直列行列をUとすると、(27)式は、下記(28)式のように表現することができる。
Claims (10)
- 移動対象体を初期位置から最終位置まで移動させるにあたり、前記初期位置と前記最終位置との間に中間点を確率的に生成させ、前記中間点を用いて前記初期位置から前記最終位置までの間の経路を計画する経路計画装置において、
前記移動対象体が存在する作業空間における前記移動対象体のとりうる姿勢を制約するための拘束条件を前記移動体の自由度に基づいて定義される可動空間の中に設定する拘束条件設定手段と、
前記拘束条件に基づいて、拘束中間点を生成する中間点生成手段と、
前記拘束中間点を用いて、前記初期位置と前記最終位置とを接続する経路を生成する経路生成手段と、
を備えることを特徴とする経路計画装置。 - 前記拘束条件に基づいて、生成した経路を補正する経路補正手段をさらに備える請求項1に記載の経路計画装置。
- 前記拘束条件設定手段は、前記移動対象体の姿勢を決定する前記移動対象体の自由度に基づいて定義される可動空間の中に、前記拘束条件に基づいて前記拘束条件を満たす拘束部分空間を設定する請求項1または請求項2に記載の経路計画装置。
- 前記中間点生成手段は、前記可動空間において確率的に生成された中間点を前記拘束部分空間に射影することにより、前記拘束中間点を生成する請求項3に記載の経路計画装置。
- 前記拘束条件設定手段は、前記移動対象体の姿勢を決定する前記移動対象体の自由度に基づいて定義される可動空間において、前記拘束条件を満たす任意の位置とその近傍点とを満たす拘束楕円体を設定する請求項1または請求項2に記載の経路計画装置。
- 前記中間点生成手段は、前記拘束楕円体を定義する半正定値対称行列の主成分に対応する部分空間上に定義した確率分布に基づいて、前記可動空間における中間点を生成する請求項5に記載の経路計画装置。
- 前記拘束条件に基づいて、生成した経路を補正する経路補正手段を、さらに備え、
前記拘束条件設定手段は、前記拘束条件として、前記可動空間において前記拘束条件を満たす拘束部分空間を定義し、
前記経路補正手段は、前記経路生成手段で生成された経路を前記拘束部分空間に射影することにより、前記経路を補正する請求項1に記載の経路計画装置。 - 前記経路補正手段は、前記経路生成手段で生成された経路と拘束曲面との距離が所定値以上の場合に、前記拘束曲面への射影を行って、前記経路を補正する請求項7に記載の経路計画装置。
- 前記経路補正手段は、前記経路生成手段で生成された経路における所定間隔ごとに、前記射影を行う請求項7または請求項8に記載の経路計画装置。
- 前記拘束条件設定手段は、前記可動空間の変数を前記作業空間へ写像したベクトルと、前記作業空間の基底ベクトルとの内積が定める方程式に基づいて、前記拘束条件を設定する請求項1〜請求項9のうちのいずれか1項に記載の経路計画装置
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005141661A JP4304512B2 (ja) | 2004-11-05 | 2005-05-13 | 経路計画装置 |
US11/815,111 US8055383B2 (en) | 2005-05-13 | 2006-05-01 | Path planning device |
EP06746246A EP1862876B1 (en) | 2005-05-13 | 2006-05-01 | Path planning device |
PCT/JP2006/309436 WO2006121091A1 (ja) | 2005-05-13 | 2006-05-01 | 経路計画装置 |
DE602006012943T DE602006012943D1 (de) | 2005-05-13 | 2006-05-01 | Bahnplanungsvorrichtung |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004322660 | 2004-11-05 | ||
JP2005141661A JP4304512B2 (ja) | 2004-11-05 | 2005-05-13 | 経路計画装置 |
Publications (3)
Publication Number | Publication Date |
---|---|
JP2006155559A true JP2006155559A (ja) | 2006-06-15 |
JP2006155559A5 JP2006155559A5 (ja) | 2006-10-19 |
JP4304512B2 JP4304512B2 (ja) | 2009-07-29 |
Family
ID=36633732
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2005141661A Expired - Fee Related JP4304512B2 (ja) | 2004-11-05 | 2005-05-13 | 経路計画装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4304512B2 (ja) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008269021A (ja) * | 2007-04-16 | 2008-11-06 | Toyota Motor Corp | 経路作成方法及び経路作成装置 |
WO2019009350A1 (ja) | 2017-07-05 | 2019-01-10 | オムロン株式会社 | 経路出力方法、経路出力システム及び経路出力プログラム |
JP2019084649A (ja) * | 2017-11-09 | 2019-06-06 | オムロン株式会社 | 干渉判定方法、干渉判定システム及びコンピュータプログラム |
CN112214906A (zh) * | 2020-10-22 | 2021-01-12 | 华中科技大学 | 一种基于主成分分析的填充轨迹规划方法 |
-
2005
- 2005-05-13 JP JP2005141661A patent/JP4304512B2/ja not_active Expired - Fee Related
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008269021A (ja) * | 2007-04-16 | 2008-11-06 | Toyota Motor Corp | 経路作成方法及び経路作成装置 |
US8290620B2 (en) | 2007-04-16 | 2012-10-16 | Toyota Jidosha Kabushiki Kaisha | Route creation method and route creation device |
WO2019009350A1 (ja) | 2017-07-05 | 2019-01-10 | オムロン株式会社 | 経路出力方法、経路出力システム及び経路出力プログラム |
CN110914024A (zh) * | 2017-07-05 | 2020-03-24 | 欧姆龙株式会社 | 路径输出方法、路径输出***和路径输出程序 |
JPWO2019009350A1 (ja) * | 2017-07-05 | 2020-04-02 | オムロン株式会社 | 経路出力方法、経路出力システム及び経路出力プログラム |
EP3650181A4 (en) * | 2017-07-05 | 2020-09-09 | Omron Corporation | ROUTE OUTPUT METHOD, ROUTE OUTPUT SYSTEM AND ROUTE OUTPUT PROGRAM |
JP2019084649A (ja) * | 2017-11-09 | 2019-06-06 | オムロン株式会社 | 干渉判定方法、干渉判定システム及びコンピュータプログラム |
CN112214906A (zh) * | 2020-10-22 | 2021-01-12 | 华中科技大学 | 一种基于主成分分析的填充轨迹规划方法 |
Also Published As
Publication number | Publication date |
---|---|
JP4304512B2 (ja) | 2009-07-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8055383B2 (en) | Path planning device | |
Lagneau et al. | Automatic shape control of deformable wires based on model-free visual servoing | |
US8290620B2 (en) | Route creation method and route creation device | |
JP5750657B2 (ja) | 強化学習装置、制御装置、および強化学習方法 | |
US11292132B2 (en) | Robot path planning method with static and dynamic collision avoidance in an uncertain environment | |
JP5044991B2 (ja) | 経路作成装置及び経路作成方法 | |
KR102300752B1 (ko) | 주어진 엔드-이펙터 경로를 정확하게 따라가기 위한 리던던트 매니퓰레이터의 충돌 없는 궤적 최적화 방법 및 장치 | |
EP4157589A1 (en) | A robot path planning method with static and dynamic collision avoidance in an uncertain environment | |
JP4667764B2 (ja) | 経路設定方法 | |
JP2009134352A (ja) | ロボットの動作経路作成装置及びロボットの動作経路作成方法 | |
JP4760732B2 (ja) | 経路作成装置 | |
JP4304512B2 (ja) | 経路計画装置 | |
CN112947403A (zh) | 用于障碍物规避的确定性机器人路径规划 | |
CN114932549A (zh) | 空间冗余机械臂的运动规划方法与装置 | |
JPWO2020179798A1 (ja) | 加工プログラム変換装置、数値制御装置、加工プログラム変換方法および機械学習装置 | |
JP6815571B1 (ja) | ロボット制御装置、ロボット制御方法及び学習モデル生成装置 | |
JP2009274180A (ja) | ロボット動作計画方法及び装置 | |
JP5447811B2 (ja) | 経路計画生成装置および該方法ならびにロボット制御装置およびロボットシステム | |
JP7088318B2 (ja) | 制御装置 | |
US20230195843A1 (en) | Machine learning device, machine learning method, and computer program product | |
JP7399357B1 (ja) | 軌道生成装置 | |
Brooks et al. | Assistance in Teleoperation of Redundant Robots through Predictive Joint Maneuvering | |
KR102520793B1 (ko) | 로봇의 모션 경로 블렌딩 방법 및 그 장치 | |
Reiser et al. | Non-linear Model Predictive Control Based Motion Planning Among People | |
US20220134545A1 (en) | Information processing device, information processing method, and computer program product |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20060904 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20060904 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20081118 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20081128 |
|
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: 20090401 |
|
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: 20090414 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 4304512 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120515 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120515 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130515 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130515 Year of fee payment: 4 |
|
LAPS | Cancellation because of no payment of annual fees |