JP2006043839A - 工業用ロボット - Google Patents
工業用ロボット Download PDFInfo
- Publication number
- JP2006043839A JP2006043839A JP2004230704A JP2004230704A JP2006043839A JP 2006043839 A JP2006043839 A JP 2006043839A JP 2004230704 A JP2004230704 A JP 2004230704A JP 2004230704 A JP2004230704 A JP 2004230704A JP 2006043839 A JP2006043839 A JP 2006043839A
- Authority
- JP
- Japan
- Prior art keywords
- manipulator
- auxiliary device
- coordinate system
- orientation
- positioner
- 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
【解決手段】 制御装置13が備える平滑化手段(S9)は、ポジショナ装置経路方程式(Jp(t))により規定されるポジショナ12の位置及び姿勢Jpを限界加減速度Apを下回るように平滑化し、平滑化位置姿勢Jp_smoothを算出する。制御装置13は、平滑化位置姿勢Jp_smoothを使用して算出した関節角度Jmをマニピュレータ11に指令として出力し、平滑化位置姿勢Jp_smoothをポジショナ12に指令として出力する。
【選択図】図2
Description
W(i):特性関数
Jps(i):補助装置経路方程式により規定される補助装置の位置及び姿勢
i:1からmの整数であって、現在の制御周期から数えて第何番目の制御周期であるかを示す。
m:平均化点数
図1から図5に示す第1実施形態は、マニピュレータ11とポジショナ12を備えるPTP型の工業用ロボットに本発明を適用した例である。
ポジショナ12の限界加減速度Apを超えない範囲で、加減速に要する時間が最短となるようにするには、平均化点数mを以下のように設定すればよい。なお、限界加減速度Apの単位はrad/sec2、ポジショナ12の位置及び姿勢の変化の速度ΔJpの単位はrad/sec、制御周期Tcの単位はmsecとする。まず、ポジショナ12の位置及び姿勢Jpの最適加減速時間Taccは以下の式(9)で表される。
図6から図9に示す第2実施形態は、マニピュレータ11とスライダ22を備えるPTP型の工業用ロボットに本発明を適用した例である。
図10に示すように、マニピュレータ11とポジショナ12及びスライダ22を備えるPTP型の工業用ロボットにも本発明を適用することができる。
11a 台座
12 ポジショナ
12a テーブル
13 制御装置
14 教示装置
16 ツール
16a ツール先端
17 ワーク
18 FIFOメモリ
22 スライダ
Claims (9)
- 先端にツールを備え、かつこのツールの位置及び姿勢を三次元空間内で変化させるマニピュレータと、前記ツール及び/又は前記マニピュレータを前記三次元空間内で移動させる補助装置と、前記マニピュレータと前記補助装置を同期して同時に動作させる制御装置とを備える工業用ロボットであって、
前記制御装置は、
前記マニピュレータ自体に設定されたマニピュレータ座標系で与えられるマニピュレータの位置及び姿勢と、前記補助装置自体に設定された補助装置座標系で与えられる補助装置の位置及び姿勢として入力される教示位置から、前記ワークに設定されたワーク座標系におけるツール先端の目標位置及び姿勢を計算する第1の演算手段と、
第1の検出器で検出された前記マニピュレータ座標系における前記マニピュレータの位置及び姿勢と、第2の検出器で検出された前記補助装置座標系における前記補助装置の位置及び姿勢とである現在位置から、前記ワーク座標系における前記ツール先端の現在位置及び姿勢を計算する第2の演算手段と、
前記ワーク座標系におけるツール先端の目標位置及び姿勢と、前記ワーク座標系におけるツール先端の現在位置及び姿勢と、予め入力された前記ツール先端の移動特性とに基づいて、前記現在位置から前記目標位置までの前記ワーク座標系における前記ツール先端の位置及び姿勢の時系列変化を規定するツール経路方程式を計算する第1の経路算出手段と、
前記ツール経路方程式で規定される前記ワーク座標系における前記ツール先端の位置及び姿勢の時系列変化と同期するように、前記現在位置から前記教示位置までの前記補助装置座標系における前記補助装置の位置及び姿勢の時系列変化を規定する補助装置経路方程式を計算する第2の経路算出手段と、
前記補助装置経路方程式により規定される前記補助装置の位置及び姿勢の時系列変化を、その加減速度が限界加減速度を下回るように平滑化した平滑化位置姿勢を算出する平滑化手段と、
前記平滑化位置姿勢を使用して、前記ツール経路方程式により規定された前記ワーク座標系における前記ツール先端の位置及び姿勢を、前記マニピュレータの基部に設定され、かつ前記三次元空間に対して固定されたベース座標系におけるツール先端の位置及び姿勢に変換する座標変換処理手段と、
前記座標変換処理手段により算出された前記ベース座標系におけるツール先端の位置及び姿勢を前記マニピュレータ座標系におけるマニピュレータの位置及び姿勢に変換する逆キネマティクス処理手段と、
前記逆キネマティクス処理手段により算出された前記マニピュレータ座標系におけるマニピュレータの位置及び姿勢に基づいて、前記マニピュレータを駆動するマニピュレータ駆動手段と、
前記平滑化手段により算出された平滑化位置姿勢に基づいて、前記補助装置を駆動する補助装置駆動手段と
を備えることを特徴とする工業用ロボット。 - 前記平滑化手段は、
前記ツールが前記ツール経路方程式で規定される経路に沿って前記現在位置から前記目標位置に移動するまでに要する時間である移動時間と、
前記教示位置での前記補助装置座標系における前記補助装置の位置及び姿勢と、
前記現在位置での前記補助装置座標系における前記補助装置の位置及び姿勢と、
前記補助装置の限界加減速度と
に基づいて、前記平滑化位置姿勢を計算することを特徴とする請求項1に記載の工業用ロボット。 - 前記補助装置として、前記ワークを保持し、かつ前記ワークを単一又は複数の軸周りに回転させるポジショナを備えることを特徴とする請求項1から請求項6のいずれか1項に記載の工業用ロボット。
- 前記補助装置として、前記マニピュレータを保持し、かつ前記マニピュレータを単一又は複数の軸線方向に直進移動させるスライダを備えることを特徴とする請求項1から請求項6のいずれか1項に記載の工業用ロボット。
- 前記補助装置は、前記ワークを保持し、かつ前記ワークを単一又は複数の軸周りに回転させるポジショナと、前記マニピュレータを保持し、かつ前記マニピュレータを単一又は複数の軸線方向に直進移動させるスライダとを備えることを特徴とする請求項1から請求項6のいずれか1項に記載の工業用ロボット。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004230704A JP4528577B2 (ja) | 2004-08-06 | 2004-08-06 | 工業用ロボット |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004230704A JP4528577B2 (ja) | 2004-08-06 | 2004-08-06 | 工業用ロボット |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2006043839A true JP2006043839A (ja) | 2006-02-16 |
JP4528577B2 JP4528577B2 (ja) | 2010-08-18 |
Family
ID=36022981
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2004230704A Expired - Fee Related JP4528577B2 (ja) | 2004-08-06 | 2004-08-06 | 工業用ロボット |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4528577B2 (ja) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2013097736A (ja) * | 2011-11-04 | 2013-05-20 | Fanuc Ltd | 指令経路速度条件による速度制御を行う数値制御装置 |
JP2018175602A (ja) * | 2017-04-18 | 2018-11-15 | キヤノン株式会社 | 連続体ロボットシステムの制御装置、連続体ロボットシステムの制御方法、プログラム |
JP2019076990A (ja) * | 2017-10-24 | 2019-05-23 | ファナック株式会社 | ワーク移動装置及びロボットを協調して動作させるように制御する制御装置及び制御方法 |
JPWO2020170306A1 (ja) * | 2019-02-18 | 2021-09-30 | 三菱電機株式会社 | ロボット制御装置 |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7140508B2 (ja) * | 2018-02-26 | 2022-09-21 | Ntn株式会社 | パラレルリンク機構を用いた作業装置およびその制御方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS59114604A (ja) * | 1982-12-22 | 1984-07-02 | Yaskawa Electric Mfg Co Ltd | 産業用ロボツトの加減速制御方式 |
JPS60230207A (ja) * | 1984-04-27 | 1985-11-15 | Kobe Steel Ltd | 工業用ロボツトとポジシヨナの連動制御システム |
JPS61157910A (ja) * | 1984-12-29 | 1986-07-17 | Fanuc Ltd | 加減速制御方式 |
JPS61245209A (ja) * | 1985-04-23 | 1986-10-31 | Fanuc Ltd | 加減速制御方式 |
JPH06214634A (ja) * | 1993-01-20 | 1994-08-05 | Tokico Ltd | 工業用ロボット |
JPH06236206A (ja) * | 1993-02-09 | 1994-08-23 | Kawasaki Heavy Ind Ltd | 回転テーブルに搭載された産業用ロボットの制御方法 |
JPH06332510A (ja) * | 1993-03-24 | 1994-12-02 | Toyoda Mach Works Ltd | 数値制御装置 |
JP2000141256A (ja) * | 1998-11-04 | 2000-05-23 | Hitachi Zosen Corp | ロボット装置の制御方法 |
-
2004
- 2004-08-06 JP JP2004230704A patent/JP4528577B2/ja not_active Expired - Fee Related
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS59114604A (ja) * | 1982-12-22 | 1984-07-02 | Yaskawa Electric Mfg Co Ltd | 産業用ロボツトの加減速制御方式 |
JPS60230207A (ja) * | 1984-04-27 | 1985-11-15 | Kobe Steel Ltd | 工業用ロボツトとポジシヨナの連動制御システム |
JPS61157910A (ja) * | 1984-12-29 | 1986-07-17 | Fanuc Ltd | 加減速制御方式 |
JPS61245209A (ja) * | 1985-04-23 | 1986-10-31 | Fanuc Ltd | 加減速制御方式 |
JPH06214634A (ja) * | 1993-01-20 | 1994-08-05 | Tokico Ltd | 工業用ロボット |
JPH06236206A (ja) * | 1993-02-09 | 1994-08-23 | Kawasaki Heavy Ind Ltd | 回転テーブルに搭載された産業用ロボットの制御方法 |
JPH06332510A (ja) * | 1993-03-24 | 1994-12-02 | Toyoda Mach Works Ltd | 数値制御装置 |
JP2000141256A (ja) * | 1998-11-04 | 2000-05-23 | Hitachi Zosen Corp | ロボット装置の制御方法 |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2013097736A (ja) * | 2011-11-04 | 2013-05-20 | Fanuc Ltd | 指令経路速度条件による速度制御を行う数値制御装置 |
US9274517B2 (en) | 2011-11-04 | 2016-03-01 | Fanuc Corporation | Numerical controller for speed control according to instructed path speed condition |
JP2018175602A (ja) * | 2017-04-18 | 2018-11-15 | キヤノン株式会社 | 連続体ロボットシステムの制御装置、連続体ロボットシステムの制御方法、プログラム |
JP2019076990A (ja) * | 2017-10-24 | 2019-05-23 | ファナック株式会社 | ワーク移動装置及びロボットを協調して動作させるように制御する制御装置及び制御方法 |
US10723023B2 (en) | 2017-10-24 | 2020-07-28 | Fanuc Corporation | Control device and control method for controlling workpiece moving device and robot to operate in cooperation with each other |
DE102018125720B4 (de) * | 2017-10-24 | 2020-09-24 | Fanuc Corporation | Steuervorrichtung und Steuerverfahren zur Vornahme einer derartigen Steuerung, dass eine Werkstückbewegungsvorrichtung und ein Roboter zusammenwirkend betrieben werden |
JPWO2020170306A1 (ja) * | 2019-02-18 | 2021-09-30 | 三菱電機株式会社 | ロボット制御装置 |
Also Published As
Publication number | Publication date |
---|---|
JP4528577B2 (ja) | 2010-08-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6268819B2 (ja) | 多軸型ロボットの軌道生成方法 | |
JP6167770B2 (ja) | 多軸型ロボットの軌道生成方法及び多軸型ロボットの制御装置 | |
EP3566822B1 (en) | Robot joint space point-to-point movement trajectory planning method | |
EP2835228B1 (en) | Robot apparatus and robot controlling method | |
US20110224815A1 (en) | Industrial Robot And Path Planning Method For Controlling The Movement Of An Industrial Robot | |
JP5144035B2 (ja) | 産業用ロボットのツールの位置・姿勢制御方法及び制御システム | |
JP5283541B2 (ja) | ロボットの動作経路生成方法 | |
EP2660013B1 (en) | Method of controlling seven-shaft multi-joint robot, control program, and robot control device | |
JP6501470B2 (ja) | 軌道生成方法、軌道生成装置、ロボット装置、プログラム及び記録媒体 | |
JP3592628B2 (ja) | 数値制御方法 | |
WO2015098085A1 (ja) | 動作プログラム作成方法およびロボットの制御方法 | |
JP2012135835A (ja) | ロボットの制御装置及びロボットの姿勢補間方法 | |
JP2728399B2 (ja) | ロボツトの制御方法 | |
JP2014208400A (ja) | ロボットの制御装置及びロボットの姿勢補間方法 | |
JP2017144468A (ja) | 溶接装置及び溶接装置の制御方法 | |
JP2004094399A (ja) | 多関節マニピュレータの制御方法及びその制御プログラム、並びにその制御システム | |
JP2019104097A (ja) | ロボットシステム | |
CN110914020B (zh) | 具有机器人的操纵装置以及方法和计算机程序 | |
JP2009166164A (ja) | 工業用ロボット | |
JP5858168B2 (ja) | リアルタイムウィービングモーション制御装置およびその方法 | |
EP2345512A1 (en) | Method of finding feasible joint trajectories for an n-dof robot with rotation invariant process (N>5) | |
JP4528577B2 (ja) | 工業用ロボット | |
JP4498061B2 (ja) | 溶接ロボット制御装置 | |
JP2020110884A (ja) | ロボット制御装置、ロボット制御方法、及びロボット制御プログラム | |
CN111699079B (zh) | 协调系统、操作设备和方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20060925 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20080220 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20080226 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20080428 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20081202 |
|
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: 20100607 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130611 Year of fee payment: 3 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 4528577 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
LAPS | Cancellation because of no payment of annual fees |