JP2012226620A - 波動歯車装置を備えたアクチュエータの位置決め装置 - Google Patents
波動歯車装置を備えたアクチュエータの位置決め装置 Download PDFInfo
- Publication number
- JP2012226620A JP2012226620A JP2011094508A JP2011094508A JP2012226620A JP 2012226620 A JP2012226620 A JP 2012226620A JP 2011094508 A JP2011094508 A JP 2011094508A JP 2011094508 A JP2011094508 A JP 2011094508A JP 2012226620 A JP2012226620 A JP 2012226620A
- Authority
- JP
- Japan
- Prior art keywords
- term
- equation
- actuator
- motor
- sliding mode
- 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
- 238000013461 design Methods 0.000 claims abstract description 12
- 244000145845 chattering Species 0.000 claims description 19
- 230000003068 static effect Effects 0.000 claims description 15
- 230000001629 suppression Effects 0.000 claims description 14
- 239000011159 matrix material Substances 0.000 claims description 10
- 230000009467 reduction Effects 0.000 claims description 3
- 230000004044 response Effects 0.000 description 16
- 230000005540 biological transmission Effects 0.000 description 14
- 238000005259 measurement Methods 0.000 description 11
- 238000000034 method Methods 0.000 description 9
- 230000001052 transient effect Effects 0.000 description 5
- 230000001360 synchronised effect Effects 0.000 description 4
- 239000003638 chemical reducing agent Substances 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 239000002184 metal Substances 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 230000006866 deterioration Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000005489 elastic deformation Effects 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 230000006872 improvement Effects 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 230000015556 catabolic process Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000001186 cumulative effect Effects 0.000 description 1
- 238000006731 degradation reaction Methods 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 230000002068 genetic effect Effects 0.000 description 1
- 238000003754 machining Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000010183 spectrum analysis Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/041—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a variable is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Software Systems (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Health & Medical Sciences (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
- Retarders (AREA)
- Control Of Position Or Direction (AREA)
Abstract
【解決手段】位置決め装置のスライディングモード制御器は、位置指令θl *、制御対象を表す状態変数xを入力として制御対象への制御入力uを生成する。制御対象は次式で規定する。
スライディングモード制御系の切換面は設計変数Sで規定する。
制御入力uは、σを切換関数、kを切換ゲイン、として、線形状態フィードバック制御項ulと非線形制御入力項unlの和である。
【選択図】なし
Description
まず、図2は本発明の制御対象となる実験装置の概略構成例を示す説明図であり、その諸元を表1に示してある。本発明では、モータ1に波動歯車装置2を減速機として含むアクチュエータ3を制御対象としている。波動歯車装置2の出力端側の負荷軸4には負荷円盤5および負荷軸エンコーダ6を付加し、モータ軸7に取り付けられているモータ軸エンコーダ8からのモータ軸角度情報および負荷軸エンコーダ6からの負荷軸角度情報をフィードバックして負荷軸4の制御を行うフルクローズドループ制御系を構成している。なお、負荷軸4と負荷軸エンコーダ6の間を十分に剛性の高いカップリング9で締結して軸ねじれ振動を防止している。
波動歯車装置の非線形特性である、摩擦、非線形ばね要素、角度伝達誤差のモデル化を行う。
本モデリングでは、摩擦特性を動作静止時に動作再開を妨げる静止摩擦、回転方向に一定の摩擦を生ずるクーロン摩擦、速度依存性を有する粘性摩擦に分類する。ここでは、一定速度試験を行うことで測定およびモデル化する。図3に摩擦特性の測定結果およびモデル化結果を示す。摩擦特性モデルτfricは数式(1)のクーロン摩擦力と粘性摩擦力との和で表す。
ここで、τc:クーロン摩擦係数
D:粘性摩擦係数
ωm:モータ軸速度
なお、静止摩擦力はモータ軸静止時に徐々に電流指令値を増加させ、モータが回転した際の電流指令値により同定した。
FSは柔軟な金属を用いているため、位置決め応答中にヒステリシスを有する非線形なばね特性として振る舞い、制御性能を劣化させる。本特性を測定するために、モータ軸をサーボロックし、負荷端に一定トルクを印加することで、整定時のねじれ角度θtwを測定する。ここで、ねじれ角度θtwを数式(2)で表す。
角度伝達誤差θTEは、モータ軸角度θmから計算される負荷軸角度と実際の負荷軸角度θlとの差であり、次の数式(3)で表す。
スライディングモード制御は、可変構造制御の一つであり、所望の特性を切換面として設計することで、全状態量が希望の特性に拘束される結果、非線形特性や不確かな系に対してロバストな制御系を構築できる(非特許文献7参照)。
Jm:モータ軸慣性
Dm:モータ軸粘性摩擦係数
N:減速比
Kg:ばね特性
Dg:ギア粘性摩擦係数
Jl:負荷軸慣性
Dl:負荷軸粘性摩擦係数
Kt:トルク定数
(1)切換面の設計
(2)スライディングモード制御系の設計
(3)チャタリング抑制項の設定
切換面はシステムのダイナミクスを決定するものであり、その設計は基本的に線形制御理論を適用できる(非特許文献8参照)。本発明では、システムの零点を利用するために、数式(7)に示すリカッチ方程式より導出される行列Pを用い、数式(8)で示す行列(設計変数)Sを決定する。
上記のように設定した切換面に状態量を常に拘束させるため、スライディングモード制御系を最終スライディングモード制御法で設計する。最終スライディングモード制御法では、システムの状態が任意な初期値から出発し、スライディングモード領域S0に至るまでスライディングモードを発生させず、S0領域に到達した後にスライディングモードへと移行させる(非特許文献8参照)。制御入力uは、線形状態フィードバック制御項ulと非線形制御入力項unlの和であり、次の数式(12)で表すことができる。
例えば、数式(13)を満足する値としてk=1800と設定した。
上記の非線形制御入力ulの切換周波数は無限としているため、状態量が切換面の近傍で高周波振動(チャタリング)する(非特許文献7、8参照)。そこで、次の数式(14)で示すような非線形制御入力を生成することで、チャタリングを抑制して入力を平滑化する。
図8には、今まで説明したスライディングモード制御系によってモータ軸の5回転分の位置決めを行った応答例を示してある。なお、チャタリング抑制項ηは、非線形要素の影響やばね特性のモデル化誤差が大きくなる過渡中で、チャタリングを発生させない値に設定した。図8の上段はモータ軸応答、下段の実線は制御入力u、破線は線形制御入力ul、点線は非線形制御入力unlをそれぞれ示す。図8下段の水平一点鎖線は±0.07A、垂直点線は0.4805sを示す。
本発明の制御系の有効性を比較検証するために、P−PI制御系を別途構築し、送り角度36load degの連続一方向位置決め動作(送り回数240回、インターバル2s)を行った。なお、P−PI制御系には静止摩擦補償として、Bang−Bang補償を静止摩擦として用いた。
2 波動歯車装置
3 アクチュエータ
4 負荷軸
6 負荷軸エンコーダ
7 モータ軸
8 モータ軸エンコーダ
CS サーキュラスプライン
FS フレクスプライン
WG ウェーブ・ジェネレータ
Claims (4)
- モータの回転を波動歯車装置によって減速して負荷軸から出力するアクチュエータにおける前記負荷軸の角度位置のフィードバック値θlとモータのモータ軸の角度位置のフィードバック値θmに基づき、負荷軸の角度位置が位置指令θl *による角度位置となるようにモータを駆動制御する波動歯車装置を備えたアクチュエータの位置決め装置において、
位置指令θl *および制御対象のアクチュエータを表す状態変数xを入力とし、モータに対する制御入力uを生成して出力するスライディングモード制御器を有しており、
制御対象のアクチュエータは、モータ、ばね、負荷からなる2慣性系モデルと見做して、数式(A)で表される状態方程式で規定されており、
ωl:負荷軸速度
ωm:モータ軸速度
Jm:モータ軸慣性
Dm:モータイ軸粘性摩擦係数
N:波動歯車装置の減速比
Kg:ばね特性
Dg:歯車粘性摩擦係数
Jl:負荷軸慣性
Dl:負荷軸粘性摩擦係数
Kt:トルク定数
スライディングモード制御器における切換面は、数式(B)で規定するリカッチ方程式により導出される行列Pを用いて、数式(C)で表される行列(設計変数)Sで規定されており、
ε:重み係数
Q:重み行列
スライディングモード制御器は、σを切換関数、kを切換ゲインとして、数式(D)で規定される制御則に従って、線形状態フィードバック制御項ulと非線形制御入力項unlの和である前記制御入力uを生成することを特徴とする波動歯車装置を備えたアクチュエータの位置決め装置。
- 請求項1において、
非線形制御入力項unlは、ηをチャタリング抑制項として、数式(E)で規定されることを特徴とする波動歯車装置を備えたアクチュエータの位置決め装置。
- 請求項1において、
非線形制御入力項unlは、ねじれ角度θtwの関数であるチャタリング抑制項η(θtw)を用いて、数式(F)で規定されることを特徴とする波動歯車装置を備えたアクチュエータの位置決め装置。
- 請求項3において、
チャタリング抑制項η(θtw)は、ηνを定数、θtw_maxを最大ねじれ角度、ηoffsetをチャタリング抑制定常項として、数式(G)で規定され、
チャタリング抑制定常項ηoffsetは、θstaticを動作静止時の負荷軸角度、Istaticを動作静止時の静止摩擦力に対応する電流値、Tmoveを動作再開時間として、数式(H)で規定されることを特徴とする波動歯車装置を備えたアクチュエータの位置決め装置。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2011094508A JP5656193B2 (ja) | 2011-04-20 | 2011-04-20 | 波動歯車装置を備えたアクチュエータの位置決め装置 |
US13/449,051 US9008843B2 (en) | 2011-04-20 | 2012-04-17 | Positioning apparatus for actuator with wave gear device |
DE201210206501 DE102012206501A1 (de) | 2011-04-20 | 2012-04-19 | Positionierungsvorrichtung für einen Aktuator mit einem Wellgetriebe |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2011094508A JP5656193B2 (ja) | 2011-04-20 | 2011-04-20 | 波動歯車装置を備えたアクチュエータの位置決め装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2012226620A true JP2012226620A (ja) | 2012-11-15 |
JP5656193B2 JP5656193B2 (ja) | 2015-01-21 |
Family
ID=46967559
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2011094508A Active JP5656193B2 (ja) | 2011-04-20 | 2011-04-20 | 波動歯車装置を備えたアクチュエータの位置決め装置 |
Country Status (3)
Country | Link |
---|---|
US (1) | US9008843B2 (ja) |
JP (1) | JP5656193B2 (ja) |
DE (1) | DE102012206501A1 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2014128835A (ja) * | 2012-12-27 | 2014-07-10 | Honda Motor Co Ltd | 動力伝達装置の制御装置 |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5839510B2 (ja) * | 2011-10-24 | 2016-01-06 | 株式会社ハーモニック・ドライブ・システムズ | 波動歯車装置を備えたアクチュエータの位置決め制御システム |
CN105137759A (zh) * | 2015-09-15 | 2015-12-09 | 上海电力学院 | 基于滑模变结构的核反应堆功率复合控制器设计方法 |
US10365628B2 (en) | 2016-09-27 | 2019-07-30 | Harmonic Drive Systems Inc. | Positioning control device of actuator provided with strain wave gearing using H-∞ control |
WO2018061097A1 (ja) * | 2016-09-27 | 2018-04-05 | 株式会社ハーモニック・ドライブ・システムズ | 状態オブザーバ併用型フルクローズド制御による波動歯車装置を備えたアクチュエータの位置決め制御装置 |
CN107944174B (zh) * | 2017-12-06 | 2020-07-07 | 清华大学 | 一种圆柱齿轮齿向载荷分布系数获取方法 |
JP7338960B2 (ja) * | 2018-09-27 | 2023-09-05 | ニデックインスツルメンツ株式会社 | サーボ制御装置及びサーボ制御方法 |
WO2020203876A1 (ja) * | 2019-03-29 | 2020-10-08 | 株式会社小松製作所 | 産業機械、制御装置、制御補正装置、および制御方法 |
JP7365923B2 (ja) * | 2020-02-12 | 2023-10-20 | 東京エレクトロン株式会社 | 温度制御装置、温度制御方法、および検査装置 |
CN112491314B (zh) * | 2020-12-28 | 2022-09-20 | 南京理工大学 | 基于特征模型的伺服系统离散自适应鲁棒滑模控制方法 |
CN114321319B (zh) * | 2021-12-27 | 2024-07-16 | 北京航空航天大学杭州创新研究院 | 一种基于相位优化的谐波减速器输出力矩强抗扰控制方法 |
KR102610608B1 (ko) * | 2022-10-11 | 2023-12-06 | 한국해양과학기술원 | 고조파 억제용 인버터의 출력 제어 시스템 및 방법 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2010116607A1 (ja) * | 2009-04-07 | 2010-10-14 | 株式会社ハーモニック・ドライブ・システムズ | 波動歯車装置の角度伝達誤差補償方法 |
JP2010242914A (ja) * | 2009-04-08 | 2010-10-28 | Sony Corp | 除振システム、除振方法及びプログラム |
JP2011043156A (ja) * | 2009-08-24 | 2011-03-03 | Daihatsu Motor Co Ltd | 制御装置 |
JP2011220459A (ja) * | 2010-04-09 | 2011-11-04 | Harmonic Drive Systems Inc | 波動歯車装置を備えたアクチュエータの位置決め制御方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4920612B2 (ja) | 2008-02-07 | 2012-04-18 | 株式会社ハーモニック・ドライブ・システムズ | アクチュエータの角度伝達誤差補償方法 |
JP2010112306A (ja) * | 2008-11-07 | 2010-05-20 | Daihatsu Motor Co Ltd | 制御装置 |
-
2011
- 2011-04-20 JP JP2011094508A patent/JP5656193B2/ja active Active
-
2012
- 2012-04-17 US US13/449,051 patent/US9008843B2/en active Active
- 2012-04-19 DE DE201210206501 patent/DE102012206501A1/de active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2010116607A1 (ja) * | 2009-04-07 | 2010-10-14 | 株式会社ハーモニック・ドライブ・システムズ | 波動歯車装置の角度伝達誤差補償方法 |
JP2010244343A (ja) * | 2009-04-07 | 2010-10-28 | Harmonic Drive Syst Ind Co Ltd | 波動歯車装置の角度伝達誤差補償方法 |
JP2010242914A (ja) * | 2009-04-08 | 2010-10-28 | Sony Corp | 除振システム、除振方法及びプログラム |
JP2011043156A (ja) * | 2009-08-24 | 2011-03-03 | Daihatsu Motor Co Ltd | 制御装置 |
JP2011220459A (ja) * | 2010-04-09 | 2011-11-04 | Harmonic Drive Systems Inc | 波動歯車装置を備えたアクチュエータの位置決め制御方法 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2014128835A (ja) * | 2012-12-27 | 2014-07-10 | Honda Motor Co Ltd | 動力伝達装置の制御装置 |
Also Published As
Publication number | Publication date |
---|---|
JP5656193B2 (ja) | 2015-01-21 |
US9008843B2 (en) | 2015-04-14 |
DE102012206501A1 (de) | 2012-10-25 |
US20120271459A1 (en) | 2012-10-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5656193B2 (ja) | 波動歯車装置を備えたアクチュエータの位置決め装置 | |
CN104260107B (zh) | 一种实现空间机械臂柔性关节齿隙补偿的方法 | |
Yan et al. | Theory and application of a combined feedback–feedforward control and disturbance observer in linear motor drive wire-EDM machines | |
De Bruin et al. | Control of mechanical motion systems with non-collocation of actuation and friction: A Popov criterion approach for input-to-state stability and set-valued nonlinearities | |
Yamada et al. | Joint torque control for two-inertia system with encoders on drive and load sides | |
Kamalzadeh et al. | Accurate tracking controller design for high-speed drives | |
Wang et al. | Iterative super-twisting sliding mode control for tray indexing system with unknown dynamics | |
WO2007105527A1 (ja) | 位置決め機構の制御方法および制御装置 | |
CN109358510A (zh) | 一种克服间隙非线性的自抗扰控制器的设计方法 | |
Yamamoto et al. | Compensation for synchronous component of angular transmission errors in harmonic drive gearings | |
Yao et al. | Output feedback robust control of direct current motors with nonlinear friction compensation and disturbance rejection | |
JP2011220459A (ja) | 波動歯車装置を備えたアクチュエータの位置決め制御方法 | |
CN110955192B (zh) | 伺服控制装置、机器人及伺服控制方法 | |
JP7044440B2 (ja) | ブラシレス電気モータを制御するための方法およびシステム | |
JP4789067B2 (ja) | システム同定装置およびそれを備えたモータ制御装置 | |
Kong et al. | Output saturation in electric motor systems: identification and controller design | |
JP6502634B2 (ja) | 制御装置 | |
Hauschild et al. | Control of harmonic drive motor actuated flexible linkages | |
JP5780783B2 (ja) | 干渉力補償制御装置 | |
Hosseinkhani | Control methods for improving tracking accuracy and disturbance rejection in ball screw feed drives | |
Tjahjowidodo et al. | Positioning controller for mechanical systems with a mini harmonic drive servo actuator | |
Chen et al. | Link position control of a compliant actuator with unknown transmission friction torque | |
Yokoyama et al. | Sliding mode-based design of unified force and position control for series elastic actuator | |
Yoo et al. | Identification of mechanical parameters for position-controlled servo systems using sinusoidal commands | |
Kawahara et al. | Vibration suppression feedback control on angular transmission error of cycloid gear for industrial robot |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20140205 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A821 Effective date: 20140205 |
|
TRDD | Decision of grant or rejection written | ||
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20141105 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20141111 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20141118 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5656193 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |