JP5681470B2 - サーボアンプの制御ループゲイン調整方法、プログラム及びロボット制御装置 - Google Patents
サーボアンプの制御ループゲイン調整方法、プログラム及びロボット制御装置 Download PDFInfo
- Publication number
- JP5681470B2 JP5681470B2 JP2010276687A JP2010276687A JP5681470B2 JP 5681470 B2 JP5681470 B2 JP 5681470B2 JP 2010276687 A JP2010276687 A JP 2010276687A JP 2010276687 A JP2010276687 A JP 2010276687A JP 5681470 B2 JP5681470 B2 JP 5681470B2
- Authority
- JP
- Japan
- Prior art keywords
- control loop
- control
- power supply
- gain
- loop gain
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims description 26
- 230000008859 change Effects 0.000 claims description 11
- 230000007423 decrease Effects 0.000 claims description 5
- 238000001914 filtration Methods 0.000 claims description 2
- 230000001172 regenerating effect Effects 0.000 description 28
- 239000003990 capacitor Substances 0.000 description 9
- 238000009499 grossing Methods 0.000 description 9
- 238000007599 discharging Methods 0.000 description 8
- 210000000707 wrist Anatomy 0.000 description 7
- 238000010586 diagram Methods 0.000 description 6
- 230000008569 process Effects 0.000 description 6
- 238000012545 processing Methods 0.000 description 4
- 230000002123 temporal effect Effects 0.000 description 3
- 230000007704 transition Effects 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000002093 peripheral effect Effects 0.000 description 2
- 230000008929 regeneration Effects 0.000 description 2
- 238000011069 regeneration method Methods 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 238000012546 transfer Methods 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
- 238000000691 measurement method Methods 0.000 description 1
- 230000000087 stabilizing effect Effects 0.000 description 1
Images
Landscapes
- Manipulator (AREA)
- Control Of Electric Motors In General (AREA)
Description
上記目的を達成するために、その他の本発明に係るサーボアンプの制御ループゲイン調整プログラムは、ロボットの各関節に設けられたサーボモータに対して外部からの制御指令に応じた該サーボモータの制御量を帰還させて制御ループを形成する、サーボアンプの制御ループゲイン調整プログラムであって、コンピュータに、前記制御ループゲインのデフォルト値及び前記サーボアンプの電源電圧のデフォルト値に基づいて、前記制御ループを形成するとともに前記サーボモータの駆動を開始する工程と、前記サーボアンプの電源電圧を検出する工程と、検出した前記サーボアンプの電源電圧の変化に対して逆方向に変化するように前記制御ループゲインを調整する工程と、を遂行させ、前記制御ループは、前記サーボモータの電流を帰還させて形成される電流ループを含み、前記制御ループゲインを調整する工程は、前記電流ループ全体のゲインである電流ループゲインに含まれる比例ゲインを調整するものである。
図1は、本発明の実施の形態に係るサーボアンプを含むロボット制御システムの全体構成を示した図である。
図2は、図1に示すロボット制御装置の詳細な構成を示した図である。なお、同図に示す参照符号M及びEは、図1に示す各軸A1〜A6のサーボモータM1〜M6及び位置検出器E1〜E6のうちのいずれか一つを表している。駆動部230及び制御部240は、各軸A1〜A6それぞれに設けられるものである。また、同図に示す太線は、電流サーボ系の電流ループを表している。
図4は、図1、図2に示すロボット制御装置の電流ループゲインの調整動作を説明するフローチャートである。
(式1)はPN間電圧PNvoltageと電流ループゲインKCPとの間には反比例の関係が成立することを表している。
KCP_MIN=(PNVOLT_DEF[V]/PNVOLT_MAX[V])*KCP_default ・・・(式3)
つぎに、ゲイン調整部246は、バッファに書き込まれた電流ループゲインKCPの変数値に対してローパスフィルタ処理を実行し(ステップS405)、上限値KCP_MAXから下限値KCP_MINの範囲内に収まるようにリミット処理を実行する(ステップS406)。電流ループゲインKCPの急激な変化に伴う電流サーボ制御の不安定性をさらに抑止するためである。
PN間電圧PNvoltageのレベルに応じて可変させる電流制御ループゲインは、電流制御部243の比例ゲインKCP及び積分ゲインKCIの両方であってもよい。また、電流制御部243はPID制御を行うように構成されてもよく、この場合、PN間電圧PNvoltageのレベルに応じて可変させる電流制御ループゲインは、比例ゲイン、比例ゲイン+積分ゲイン、比例ゲイン+微分ゲイン、又は比例ゲイン+積分ゲイン+微分ゲインのうちのいずれか一つとしてもよい。
電流ループゲインKCPに対して実行したローパスフィルタ処理は、電圧検出器255から取得したPN間電圧PNvoltageに対して実行してもよい。
電流ループゲインKCPに対して実行したローパスフィルタ処理は、バンドパスフィルタ処理などの他のフィルタ処理であってもよい。
M1〜M6…サーボモータ
E1〜E6…位置検出器
A1〜A6…回転軸
JT1〜JT6…関節
2…基台
3…旋回台
4〜7…アーム部材
9…アタッチメント
10…手首装置
11…ツール部材
200…ロボット制御装置
210…サーボアンプ
220…商用電源
230…駆動部
231…電流検出器
T1…ソーストランジスタ
T2…シンクトランジスタ
D1、D2…回生ダイオード
240…制御部
241…位置制御部
242…速度制御部
243…電流制御部
244…パルス幅変調部
245…回生制御部
246…ゲイン調整部
247…比例要素
248…積分要素
250…電源部
251…全波整流器
252…平滑コンデンサ
253…回生抵抗
254…回生電力放電用トランジスタ
255…電圧検出器
Claims (6)
- ロボットの各関節に設けられたサーボモータに対して外部からの制御指令に応じた該サーボモータの制御量を帰還させて制御ループを形成する、サーボアンプの制御ループゲイン調整方法であって、
前記制御ループゲインのデフォルト値及び前記サーボアンプの電源電圧のデフォルト値に基づいて、前記制御ループを形成するとともに前記サーボモータの駆動を開始する工程と、
前記サーボアンプの電源電圧を検出する工程と、
検出した前記サーボアンプの電源電圧の変化に対して逆方向に変化するように前記制御ループゲインを調整する工程と、
を備え、
前記制御ループは、前記サーボモータの電流を帰還させて形成される電流ループを含み、
前記制御ループゲインを調整する工程は、前記電流ループ全体のゲインである電流ループゲインに含まれる比例ゲインを調整する、サーボアンプの制御ループゲイン調整方法。 - 検出した前記サーボアンプの電源電圧を上限値から下限値までの範囲内にリミット処理する工程を備える、請求項1に記載のサーボアンプの制御ループゲイン調整方法
- 調整した前記制御ループゲインを上限値から下限値までの範囲内にリミット処理する工程を備える、請求項1に記載のサーボアンプの制御ループゲイン調整方法。
- 検出した前記サーボアンプの電源電圧又は調整した前記制御ループゲインをフィルタ処理する工程を備える、請求項1に記載のサーボアンプの制御ループゲイン調整方法。
- ロボットの各関節に設けられたサーボモータに対して外部からの制御指令に応じた該サーボモータの制御量を帰還させて制御ループを形成する、サーボアンプの制御ループゲイン調整プログラムであって、
コンピュータに、
前記制御ループゲインのデフォルト値及び前記サーボアンプの電源電圧のデフォルト値に基づいて、前記制御ループを形成するとともに前記サーボモータの駆動を開始する工程と、
前記サーボアンプの電源電圧を検出する工程と、
検出した前記サーボアンプの電源電圧の変化に対して逆方向に変化するように前記制御ループゲインを調整する工程と、
を遂行させ、
前記制御ループは、前記サーボモータの電流を帰還させて形成される電流ループを含み、
前記制御ループゲインを調整する工程は、前記電流ループ全体のゲインである電流ループゲインに含まれる比例ゲインを調整する、サーボアンプの制御ループゲイン調整プログラム。 - ロボットの各関節に設けられたサーボモータに対して、外部からの制御指令に応じた該サーボモータの制御量を帰還させて制御ループを形成するサーボアンプを備えたロボット制御装置において、
前記サーボアンプは、
前記サーボモータを駆動する駆動部と、
前記サーボアンプ全体の制御を司る制御部と、
商用電源を整流して得られる直流の電源電圧を前記制御部に供給する電源部と、を備え、
前記制御部は、
前記制御ループの制御ループゲインのデフォルト値及び前記電源部の前記電源電圧のデフォルト値に基づいて、前記制御ループを形成するとともに、前記駆動部による前記サーボモータの駆動を開始する手段と、
前記電源部の前記電源電圧を検出する手段と、
検出した前記電源電圧が上昇する場合には減少させ、前記の電源電圧が下降する場合には増大させるように前記制御ループゲインを調整する手段と、
を備え、
前記制御ループは、前記サーボモータの電流を帰還させて形成される電流ループを含み、
前記制御ループゲインを調整する手段は、前記電流ループ全体のゲインである電流ループゲインに含まれる比例ゲインを調整する、ロボット制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010276687A JP5681470B2 (ja) | 2010-12-13 | 2010-12-13 | サーボアンプの制御ループゲイン調整方法、プログラム及びロボット制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010276687A JP5681470B2 (ja) | 2010-12-13 | 2010-12-13 | サーボアンプの制御ループゲイン調整方法、プログラム及びロボット制御装置 |
Publications (3)
Publication Number | Publication Date |
---|---|
JP2012125844A JP2012125844A (ja) | 2012-07-05 |
JP2012125844A5 JP2012125844A5 (ja) | 2014-03-13 |
JP5681470B2 true JP5681470B2 (ja) | 2015-03-11 |
Family
ID=46643495
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2010276687A Active JP5681470B2 (ja) | 2010-12-13 | 2010-12-13 | サーボアンプの制御ループゲイン調整方法、プログラム及びロボット制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5681470B2 (ja) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5940406B2 (ja) * | 2012-07-30 | 2016-06-29 | 株式会社ダイヘン | ロボット制御装置 |
JP6009298B2 (ja) * | 2012-09-26 | 2016-10-19 | 株式会社ケーヒン | 電子制御装置 |
JP2015174207A (ja) * | 2014-03-18 | 2015-10-05 | セイコーエプソン株式会社 | ロボット |
KR102275302B1 (ko) * | 2019-02-11 | 2021-07-08 | 동의대학교 산학협력단 | 입력 포화를 가지는 불확실한 전기 구동 로봇 시스템에 대해 pso를 이용한 rbfnn 기반 분산 적응 추종 시스템 |
JP2022050079A (ja) * | 2020-09-17 | 2022-03-30 | オムロン株式会社 | サーボdc給電システム、モータ制御装置、及びサーボモータの制御方法 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63107486A (ja) * | 1986-10-22 | 1988-05-12 | Fanuc Ltd | サーボモータ制御方式 |
JP2873689B2 (ja) * | 1988-01-29 | 1999-03-24 | ファナック株式会社 | 速度制御装置 |
JPH01255015A (ja) * | 1988-04-05 | 1989-10-11 | Mitsubishi Electric Corp | ロボットの制御装置 |
JP2910129B2 (ja) * | 1990-03-14 | 1999-06-23 | 松下電器産業株式会社 | サーボモータの制御装置 |
JPH05137367A (ja) * | 1991-11-12 | 1993-06-01 | Mitsubishi Electric Corp | モータ制御装置 |
JPH08205569A (ja) * | 1995-01-18 | 1996-08-09 | Fanuc Ltd | サーボアンプの入力電圧測定方法及び制御ゲイン設定方法 |
JP2747804B2 (ja) * | 1995-03-10 | 1998-05-06 | 川崎重工業株式会社 | プレイバック式装置の電源装置 |
JP2000222004A (ja) * | 1999-02-01 | 2000-08-11 | Toshiba Mach Co Ltd | ロボット制御装置 |
JP2010161854A (ja) * | 2009-01-07 | 2010-07-22 | Yaskawa Electric Corp | モータ制御装置 |
-
2010
- 2010-12-13 JP JP2010276687A patent/JP5681470B2/ja active Active
Also Published As
Publication number | Publication date |
---|---|
JP2012125844A (ja) | 2012-07-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5681470B2 (ja) | サーボアンプの制御ループゲイン調整方法、プログラム及びロボット制御装置 | |
JP6170150B2 (ja) | 溶接型電力を提供するための方法及び装置 | |
CN105531922B (zh) | 用于在可调速驱动中控制再生能量的系统以及方法 | |
JP5650814B1 (ja) | フィードフォワード制御を備えたモータ制御装置 | |
EP3215297B1 (en) | Method and apparatus including a balanced dc bus for providing power in an arc welder | |
CN102201777A (zh) | 感应电动机的控制装置和控制方法 | |
US11353830B2 (en) | Servo control method | |
WO2014034207A1 (ja) | コンバータ制御装置、方法、プログラム及び空気調和機 | |
WO2006114843A1 (ja) | サーボモータの制御装置 | |
WO2016164572A1 (en) | System and method for adjusting end-effector actuation based on relative position with respect to gravitational force | |
TWI559670B (zh) | 定位控制裝置 | |
CN112236270B (zh) | 机器人的力调节 | |
JPWO2008093486A1 (ja) | 慣性モーメント同定装置とその同定方法、ならびにその同定装置を備えたモータ制御装置 | |
JP2017011841A (ja) | 駆動制御装置 | |
JP2016005296A (ja) | モータ駆動装置の制御方法、モータ駆動装置及びロボット装置 | |
JPS62210866A (ja) | Pwm電力変換器の制御装置 | |
JP2014087874A (ja) | 産業用ロボット | |
JP5857845B2 (ja) | ロボットシステム | |
US11863105B2 (en) | Method and control system for controlling an electric motor | |
JP2014039419A (ja) | 駆動装置、駆動方法、ロボットハンドおよびロボット | |
US20230318507A1 (en) | Control Apparatus And Robot System | |
CN107866811B (zh) | 超步自调整方法、运动控制部件、机器人 | |
JP2004187379A (ja) | 電動機の制御装置 | |
JP2015116074A (ja) | モータ制御方法、モータ装置及びロボット | |
Urrea et al. | Design, Analysis, and Comparison of Control Strategies for an Industrial Robotic Arm Driven by a Multi-Level Inverter. Symmetry 2021, 13, 86 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20131209 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20140128 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20140910 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20140930 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20141028 |
|
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: 20141216 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20150109 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5681470 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |