JP2006116631A - 多関節型ロボットの制御方法 - Google Patents
多関節型ロボットの制御方法 Download PDFInfo
- Publication number
- JP2006116631A JP2006116631A JP2004305491A JP2004305491A JP2006116631A JP 2006116631 A JP2006116631 A JP 2006116631A JP 2004305491 A JP2004305491 A JP 2004305491A JP 2004305491 A JP2004305491 A JP 2004305491A JP 2006116631 A JP2006116631 A JP 2006116631A
- Authority
- JP
- Japan
- Prior art keywords
- state
- load
- motor
- arm
- observer
- 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
【解決手段】 アームに取り付けられる複数の負荷に対応して予め調整されたパラメータを持つ複数の状態オブザーバ並びに状態FBの演算を同時に行い、アームに取り付けられる負荷情報に基づいて、それぞれの状態FB値のモータ電流指令への加算量を調整する手段を備えることにより、リアルタイムで負荷イナーシャ、状態オブザーバ、状態FBのパラメータ演算を行う必要はなく、十分な振動抑制効果が得られる状態で、演算時間を削減することができる。
【選択図】 図1
Description
本発明は、上記課題を解決するものであり、従来のオブザーバ制御演算装置法が有していた、負荷イナーシャ、状態オブザーバ、状態FBのパラメータ演算に要する時間を、十分な振動抑制効果が得られる状態で、削減することができるロボットの制御方法の提供を目的とする。
以下、本発明の実施の形態について、図1〜3及び図7〜8を用いて説明する。
図7(a)において、(101)は水平面で回転する第1軸、(102)は第1軸に取り付けられ垂直面で回転する第2軸、(103)は第2軸に取り付けられ垂直面で回転する第3軸である。(104)は第1軸の角速度ωL1、(105)は第2軸の角速度ωL2、(106)は第3軸の角速度ωL3である。
図7(b)は(数8)の式(10)が最大となる姿勢を示している。ただし、第3軸は回転中心軸とアーム先端までの距離は手首軸を無視すれば、姿勢によらず一定である。
本発明の説明では、2種類のアームに取り付けられる負荷に対応した場合を説明したが、3種類以上でも同様の手法を用いることが出来るのは言うまでもない。
2 モータ
3 減速機
4 ベアリング
5 モータ内ロータ
6 減速機1次側
7 減速機2次側
8 減速機バネ
9 負荷(アーム2)
10 モータ回転軸
11 モータ回転速度 ωM
12 負荷回転速度 ωL
13 モータ電流指令 icom
14 モータトルク定数 Kt
15 減速比逆数
16 減速比逆数
17 モータ伝達関数
18 負荷伝達関数
19 バネ定数 Ks
20 減速機ねじれ角 θs
21 積分要素
22 負荷(アーム2)に加わる外力 Td
23 モータ位置指令 θcom
24 モータ位置FB θM
25 積分要素
26 位置比例ゲイン KPP
27 位置制御ブロック
28 モータ速度指令 ωcom
29 速度比例ゲイン KP
30 速度積分ゲイン KI
31 速度ループブロック
32 電流指令(速度ループブロック出力) icom0
33 状態オブザーバブロック
34 モータ回転速度推定値 ωMO
35 減速機ねじれ角推定値 θso
36 状態FBゲイン1 Kf1
37 状態FBゲイン2 Kf2
38 状態FBゲイン3 Kf3
39 状態FBブロック
40 状態FB量 SFB
41 状態オブザーバブロック1
42 モータ回転速度推定値 ωMO1
43 減速機ねじれ角推定値 θso1
44 状態FBゲイン1 Kf11
45 状態FBゲイン2 Kf21
46 状態FBゲイン3 Kf31
47 状態FBブロック1
48 状態FB比率ゲイン1
49 状態FB量 SFB1
51 状態オブザーバブロック2
52 モータ回転速度推定値 ωMO2
53 減速機ねじれ角推定値 θso2
54 状態FBゲイン1 Kf12
55 状態FBゲイン2 Kf22
56 状態FBゲイン3 Kf32
57 状態FBブロック2
58 状態FB比率ゲイン2
59 状態FB量 SFB2
61〜70 状態オブザーバパラメータ
Claims (2)
- モータで駆動する回転軸を中心に回転し、負荷の装着と離脱が可能なアームを複数有し、アームへの負荷の装着と離脱の動作を含む予め記憶された動作プログラムによって動作し、前記モータの電流、および回転位置情報を元に前記モータのフィードバック制御ループを構成し、状態オブザーバで推定した前記モータに接続する前記アームの速度およびねじれ量の推定量を前記フィードバック制御ループに付加させる状態フィードバックブロックを負荷に応じて複数個備えた前記モータの動作を制御する多関節型ロボットの制御方法であって、前記プログラムによる動作中に前記アームへの負荷の装着または離脱が実行されて負荷変動が発生する負荷変動発生時に、負荷に応じて状態フィードバックブロックを切り替えることを特徴とする多関節型ロボットの制御方法。
- 複数個の状態フィードバックブロックから得られた状態フィードバック量に変更可能な乗算係数を乗算し、前記モータのフィードバック制御ループに付加させる状態フィードバック量を決定する請求項1記載の多関節型ロボットの制御方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004305491A JP4289275B2 (ja) | 2004-10-20 | 2004-10-20 | 多関節型ロボットの制御方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004305491A JP4289275B2 (ja) | 2004-10-20 | 2004-10-20 | 多関節型ロボットの制御方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2006116631A true JP2006116631A (ja) | 2006-05-11 |
JP4289275B2 JP4289275B2 (ja) | 2009-07-01 |
Family
ID=36534999
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2004305491A Expired - Lifetime JP4289275B2 (ja) | 2004-10-20 | 2004-10-20 | 多関節型ロボットの制御方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4289275B2 (ja) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2835227A1 (en) * | 2013-08-05 | 2015-02-11 | Kabushiki Kaisha Toshiba | Robot control device |
US9242374B2 (en) | 2012-08-10 | 2016-01-26 | Kabushiki Kaisha Toshiba | Robotic control apparatus |
JP2016083713A (ja) * | 2014-10-24 | 2016-05-19 | キヤノン株式会社 | ロボット制御方法、ロボット装置、プログラム、記録媒体及び組立部品の製造方法 |
CN109108964A (zh) * | 2018-07-25 | 2019-01-01 | 西北工业大学 | 一种基于自适应动态规划Nash博弈的空间机械臂协调控制方法 |
-
2004
- 2004-10-20 JP JP2004305491A patent/JP4289275B2/ja not_active Expired - Lifetime
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9242374B2 (en) | 2012-08-10 | 2016-01-26 | Kabushiki Kaisha Toshiba | Robotic control apparatus |
EP2835227A1 (en) * | 2013-08-05 | 2015-02-11 | Kabushiki Kaisha Toshiba | Robot control device |
US9156166B2 (en) | 2013-08-05 | 2015-10-13 | Kabushiki Kaisha Toshiba | Robot control device |
JP2016083713A (ja) * | 2014-10-24 | 2016-05-19 | キヤノン株式会社 | ロボット制御方法、ロボット装置、プログラム、記録媒体及び組立部品の製造方法 |
CN109108964A (zh) * | 2018-07-25 | 2019-01-01 | 西北工业大学 | 一种基于自适应动态规划Nash博弈的空间机械臂协调控制方法 |
CN109108964B (zh) * | 2018-07-25 | 2021-06-08 | 西北工业大学 | 一种基于自适应动态规划Nash博弈的空间机械臂协调控制方法 |
Also Published As
Publication number | Publication date |
---|---|
JP4289275B2 (ja) | 2009-07-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4478584B2 (ja) | 位置制御装置、測定装置および加工装置 | |
JP2016105686A (ja) | モータ駆動装置の制御装置、複軸モータ駆動装置の制御装置、及びモータ駆動装置の制御方法 | |
JP4148189B2 (ja) | 柔軟関節ロボットアームの制御装置 | |
JP6575200B2 (ja) | ロボット、制御装置およびロボットシステム | |
WO2005009692A1 (ja) | ロボットアームの制御方法および制御装置 | |
KR20060127233A (ko) | 전동기 제어 장치 | |
JP5916583B2 (ja) | 多関節ロボットのウィービング制御装置 | |
EP1505463A2 (en) | Position control device and position control method for machine tools | |
KR100537325B1 (ko) | 로봇 제어방법 및 제어장치 | |
JPH10275003A (ja) | 2慣性共振系を制御する方法及びその装置 | |
JP3933158B2 (ja) | ロボットの衝突検出方法 | |
JP3239789B2 (ja) | 制御装置および制御方法 | |
JP4860277B2 (ja) | 多慣性共振系の振動抑制制御方法及び装置 | |
KR19980083174A (ko) | 공진계의 진동억제 제어방법 및 제어장치 | |
JP4289275B2 (ja) | 多関節型ロボットの制御方法 | |
JP4389980B2 (ja) | 多関節型ロボットの制御方法 | |
JP5441944B2 (ja) | モータ制御装置 | |
JPH09212203A (ja) | ロボット制御装置 | |
Caporali | Iterative method for controlling the sway of a payload on tower (slewing) cranes using a command profile approach | |
CN115580184B (zh) | 驱控一体式步进电机的控制方法、点胶设备 | |
JP6237039B2 (ja) | ロボット制御装置およびロボット制御方法 | |
JP2010045957A (ja) | モータ制御装置とバックラッシ同定方法 | |
JPH08278821A (ja) | サーボ制御系の制振方法 | |
JP4730538B2 (ja) | 機械定数同定装置を備えたモータ制御装置 | |
JP2008061470A (ja) | 振動検出装置およびそれを備えたモータ制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20070315 |
|
RD01 | Notification of change of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7421 Effective date: 20070412 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20081120 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20081216 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20090120 |
|
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: 20090310 |
|
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: 20090323 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 4289275 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: 20120410 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130410 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130410 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140410 Year of fee payment: 5 |