JP2017151590A - アクチュエータの駆動制御方法およびアクチュエータの駆動制御装置 - Google Patents
アクチュエータの駆動制御方法およびアクチュエータの駆動制御装置 Download PDFInfo
- Publication number
- JP2017151590A JP2017151590A JP2016031724A JP2016031724A JP2017151590A JP 2017151590 A JP2017151590 A JP 2017151590A JP 2016031724 A JP2016031724 A JP 2016031724A JP 2016031724 A JP2016031724 A JP 2016031724A JP 2017151590 A JP2017151590 A JP 2017151590A
- Authority
- JP
- Japan
- Prior art keywords
- value
- actuator
- driven mechanism
- external force
- control signal
- 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
- 238000000034 method Methods 0.000 title claims abstract description 45
- 230000007246 mechanism Effects 0.000 claims abstract description 226
- 238000012937 correction Methods 0.000 claims description 47
- 238000004364 calculation method Methods 0.000 claims description 11
- 238000013139 quantization Methods 0.000 claims description 11
- 230000001133 acceleration Effects 0.000 claims description 6
- 238000001514 detection method Methods 0.000 claims description 4
- 238000011002 quantification Methods 0.000 abstract 1
- 239000013589 supplement Substances 0.000 abstract 1
- 239000012636 effector Substances 0.000 description 29
- 238000006073 displacement reaction Methods 0.000 description 23
- 230000033001 locomotion Effects 0.000 description 13
- 230000006870 function Effects 0.000 description 10
- 238000010276 construction Methods 0.000 description 8
- 238000005070 sampling Methods 0.000 description 8
- 230000008859 change Effects 0.000 description 7
- 230000005540 biological transmission Effects 0.000 description 6
- 238000006243 chemical reaction Methods 0.000 description 6
- 230000004044 response Effects 0.000 description 6
- 238000012546 transfer Methods 0.000 description 6
- 230000007423 decrease Effects 0.000 description 5
- 238000010586 diagram Methods 0.000 description 5
- 230000004043 responsiveness Effects 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 230000005489 elastic deformation Effects 0.000 description 3
- 230000007935 neutral effect Effects 0.000 description 3
- 238000011156 evaluation Methods 0.000 description 2
- 239000012530 fluid Substances 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 230000006872 improvement Effects 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 230000001141 propulsive effect Effects 0.000 description 2
- 238000012935 Averaging Methods 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 239000000470 constituent Substances 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 238000013016 damping Methods 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000001771 impaired effect Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000011084 recovery Methods 0.000 description 1
- 230000008439 repair process Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 230000000087 stabilizing effect Effects 0.000 description 1
- 230000001629 suppression Effects 0.000 description 1
Images
Landscapes
- Feedback Control In General (AREA)
Abstract
【解決手段】被動機構と、被動機構を駆動するアクチュエータとを備えるプラントにおいて、アクチュエータを駆動するための制御値である連続値制御信号を量子化し、離散値制御信号としてアクチュエータに入力する、アクチュエータの駆動制御方法であって、制御目標値と、前回のアクチュエータが駆動したときの被動機構の出力値とに基づいて、次回のアクチュエータの制御値である連続値制御信号を算出する連続値制御信号算出ステップと、前回のプラントの出力値に基づいて、算出された連続値制御信号を補正する補正ステップと、アクチュエータの非線形特性を補完する量子化マップに基づいて連続値制御信号を量子化し、離散値制御信号としてアクチュエータへ出力する離散値制御信号算出ステップと、を含む。
【選択図】図3
Description
[1−1.全体構成]
まず、図1に基づいて、本発明の一実施形態に係るアクチュエータの駆動制御装置の構成について説明する。図1は、本実施形態に係るアクチュエータの駆動制御装置の構成を示すブロック図である。図1に示すように、制御対象(プラント)50の駆動を制御する駆動制御装置1は、制御偏差部10と、フィードバック制御部20と、非線形特性補償型フィードバック変調器(NC−FBM:Nonlinearity Compensated type Feedback Modulator。以下、「非線形フィードバック変調器」とも称する。)30と、フィードフォワード制御部40とを含む。
本実施形態に係る駆動制御装置1は、制御対象50が例えば駆動機構およびバックラッシュ等の非線形要素を有する被動機構とからなる駆動システムである場合においても、駆動システム全体が精度よく、かつ滑らかに動作するように制御できるようにすることを目的とする。このため、本実施形態に係る駆動装置1では、非線形フィードバック変調器30を、駆動機構51や被動機構52の不感帯やヒステリシス特性に対処可能に構成する。非線形フィードバック変調器30により被動機構52の不感帯やヒステリシス特性も考慮した制御を行うことで、駆動機構51の制御のみでは駆動システム全体としての動作精度の向上に限界がある場合にも、さらに精度を向上させることができる。
以下、本実施形態に係る駆動制御装置1による駆動制御の一例を説明する。
上述の駆動機構51の駆動制御装置1による駆動制御では、制御対象50の不感帯やバックラッシュ、スティックスリップ、ガタ、弾性変形等のヒステリシス特性、すなわち非線形要素の影響が考慮される。ここで、非線形要素には、入力の増加方向と減少方向とで同一入力値に対する出力値が異なるヒステリシス特性や、入力値が小さい間は出力値の比例係数が著しく小さく、入力値が所定値を超えると入出力関係を表す曲線の係数が安定して大きくなるロストモーション等も含まれる。ここで、駆動機構と被動機構とを備えるプラント60として、外界との相互干渉を受けながら動作する具体的なモデルの一例を図3に示す。
本実施形態に係る駆動機構51の駆動制御は、まず、非線形フィードバック変調器30により、駆動機構51の非線形特性を補完する量子化マップに基づいて、連続値制御信号から離散値制御信号が生成される。離散値制御信号は、例えば駆動機構51が油圧シリンダであるとき、油量(すなわち弁開度)を表す。駆動機構51は離散値制御信号に基づき駆動され、駆動機構51の駆動によって被動機構52が駆動する。このときの駆動機構51の速度および被動機構52の速度が非線形フィードバック変調器30に入力される。
図8に、マニピュレータ型建機70への実装例を示す。図8に示すマニピュレータ型建機70は、車体71に4つの車輪72を備えて移動可能である。車体71には、効果器79を先端に保持するマニピュレータ部78が、回転部75を介して回転可能に支持されている。マニピュレータ部78は、例えば第1のリンク部78aと第2のリンク部78bとから構成される。マニピュレータ部78を回転させる駆動機構として油圧モータ73が設けられており、被動機構としてギア74が存在する。ギア74が回転することで当該ギア74と噛み合う回転部75が回転し、車体71に対してマニピュレータ部78が回転される。また、マニピュレータ部78は、第1のリンク部78aおよび第2のリンク部78bからなり、アクチュエータ77a、77bを駆動させることで、第1のリンク部78aおよび第2のリンク部78bの位置を変化させることができる。
10 制御偏差部
20 フィードバック制御部
30 非線形特性補償型フィードバック変調器(非線形フィードバック変調器)
40 フィードフォワード制御部
50 制御対象
51 駆動機構
52 被動機構
60 プラント
61 駆動源
62 駆動制御機構
63 駆動機構
64 駆動用センサ
65 支持機構
66 被動用センサ
67 効果器
Claims (10)
- 被動機構と、前記被動機構を駆動するアクチュエータとを備えるプラントにおいて、前記アクチュエータを駆動するための制御値である連続値制御信号を量子化し、離散値制御信号として前記アクチュエータに入力する、アクチュエータの駆動制御方法であって、
制御目標値と、前回の前記アクチュエータが駆動したときの前記被動機構の出力値とに基づいて、次回の前記アクチュエータの制御値である連続値制御信号を算出する連続値制御信号算出ステップと、
前回の前記プラントの出力値に基づいて、算出された前記連続値制御信号を補正する補正ステップと、
アクチュエータの非線形特性を補完する量子化マップに基づいて前記連続値制御信号を量子化し、前記離散値制御信号として前記アクチュエータへ出力する離散値制御信号算出ステップと、
を含む、アクチュエータの駆動制御方法。 - 前記補正ステップでは、前回のプラントの出力値として、前回の前記アクチュエータの出力値または前記被動機構の出力値のうち少なくともいずれか一方を用いる、請求項1に記載のアクチュエータの駆動制御方法。
- 前記離散値制御信号算出ステップでは、
外力推定部により前記被動機構に作用する外力の推定値を取得し、
非線形要素を有する前記被動機構に作用する外力と当該被動機構の目標速度との関係を表す情報である補正テーブルに基づいて、前記外力の推定値から前記被動機構に関する動作補正の出力を決定する、請求項1または2に記載のアクチュエータの駆動制御方法。 - 前記補正テーブルは、前記被動機構が非線形要素の影響を受けて動作するときは当該非線形要素を解消する位置まで前記被動機構を移動させるよう出力を補正し、非線形要素の影響が解消した後は、出力を補正しないように設定される、請求項3に記載のアクチュエータの駆動制御方法。
- 前記外力推定部は、前記被動機構の加速度および慣性質量に基づいて外力の推定値を算出する、請求項3または4に記載のアクチュエータの駆動制御方法。
- 前記外力推定部は、前記被動機構に設けられた外力検出センサの検出値を外力の推定値として取得する、請求項3または4に記載のアクチュエータの駆動制御方法。
- 前記外力推定部により取得された外力の推定値は所定の期間蓄積される、請求項3〜6のいずれか1項に記載のアクチュエータの駆動制御方法。
- 前記非線形要素は、前記被動機構のバックラッシュである、請求項3〜7のいずれか1項に記載のアクチュエータの駆動制御方法。
- 前記被動機構の出力は、実測値または外乱オブザーバによる推定値である、請求項1〜8のいずれか1項に記載のアクチュエータの駆動制御方法。
- 被動機構と、前記被動機構を駆動するアクチュエータとを備えるプラントにおいて、前記アクチュエータを駆動するための制御値である連続値制御信号を量子化し、離散値制御信号として前記アクチュエータに入力する、アクチュエータの駆動制御装置において、
制御目標値と、前回の前記アクチュエータが駆動したときの前記被動機構の出力値とに基づいて、次回の前記アクチュエータの制御値である連続値制御信号を算出する制御部と、
前回の前記プラントの出力値に基づいて、算出された前記連続値制御信号を補正し、アクチュエータの非線形特性を補完する量子化マップに基づいて前記連続値制御信号を量子化し、前記離散値制御信号として前記アクチュエータへ出力する非線形フィードバック変調器と、
を備える、アクチュエータの駆動制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016031724A JP6647562B2 (ja) | 2016-02-23 | 2016-02-23 | アクチュエータの駆動制御方法およびアクチュエータの駆動制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016031724A JP6647562B2 (ja) | 2016-02-23 | 2016-02-23 | アクチュエータの駆動制御方法およびアクチュエータの駆動制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2017151590A true JP2017151590A (ja) | 2017-08-31 |
JP6647562B2 JP6647562B2 (ja) | 2020-02-14 |
Family
ID=59741907
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2016031724A Active JP6647562B2 (ja) | 2016-02-23 | 2016-02-23 | アクチュエータの駆動制御方法およびアクチュエータの駆動制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6647562B2 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111480299A (zh) * | 2018-03-27 | 2020-07-31 | 辛纳普蒂克斯公司 | Δς调制器系统和方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07136953A (ja) * | 1993-11-18 | 1995-05-30 | Tsubakimoto Chain Co | 産業用ロボットの制御方法 |
JPH09192980A (ja) * | 1995-11-23 | 1997-07-29 | Lg Ind Syst Co Ltd | 工作機械の位置制御装置 |
JP2002178281A (ja) * | 2000-12-15 | 2002-06-25 | Kawasaki Heavy Ind Ltd | 把持力制御装置および把持力推定装置 |
JP2009217417A (ja) * | 2008-03-10 | 2009-09-24 | Kyoto Univ | 油圧駆動システムの制御方式 |
-
2016
- 2016-02-23 JP JP2016031724A patent/JP6647562B2/ja active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07136953A (ja) * | 1993-11-18 | 1995-05-30 | Tsubakimoto Chain Co | 産業用ロボットの制御方法 |
JPH09192980A (ja) * | 1995-11-23 | 1997-07-29 | Lg Ind Syst Co Ltd | 工作機械の位置制御装置 |
JP2002178281A (ja) * | 2000-12-15 | 2002-06-25 | Kawasaki Heavy Ind Ltd | 把持力制御装置および把持力推定装置 |
JP2009217417A (ja) * | 2008-03-10 | 2009-09-24 | Kyoto Univ | 油圧駆動システムの制御方式 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111480299A (zh) * | 2018-03-27 | 2020-07-31 | 辛纳普蒂克斯公司 | Δς调制器系统和方法 |
Also Published As
Publication number | Publication date |
---|---|
JP6647562B2 (ja) | 2020-02-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109927032B (zh) | 一种基于高阶滑模观测器的机械臂轨迹跟踪控制方法 | |
Kang et al. | A solution to the accuracy/robustness dilemma in impedance control | |
Lischinsky et al. | Friction compensation for an industrial hydraulic robot | |
CN110467111B (zh) | 桥式起重机的控制 | |
JP6097174B2 (ja) | ロボット制御装置 | |
Yao et al. | Adaptive robust motion control of single-rod hydraulic actuators: theory and experiments | |
Ro et al. | Robust friction compensation for submicrometer positioning and tracking for a ball-screw-driven slide system | |
US20130345877A1 (en) | Robot and robot control method | |
CN112218744A (zh) | 学习多足机器人的敏捷运动的系统和方法 | |
JP2016105686A (ja) | モータ駆動装置の制御装置、複軸モータ駆動装置の制御装置、及びモータ駆動装置の制御方法 | |
Lertpiriyasuwat et al. | Extended kalman filtering applied to a two-axis robotic arm with flexible links | |
US10591876B2 (en) | Method and system for adaptive compensation of dry friction | |
WO2013031465A1 (ja) | 制御方法及び制御装置 | |
Wells et al. | Feedforward and feedback control of a flexible robotic arm | |
CN114800522B (zh) | 无末端力传感器的液压机械臂接触作业自适应阻抗控制系统 | |
JP4453526B2 (ja) | サーボ制御装置 | |
US20210347049A1 (en) | Method and computing system for estimating parameter for robot operation | |
Garagić et al. | Adaptive friction compensation for precision machine tool drive | |
JP2010049599A (ja) | 工作機械 | |
JP6332197B2 (ja) | モータの制御装置 | |
JPH10309684A (ja) | マニピュレータのコンプライアンス制御方式 | |
JP6647562B2 (ja) | アクチュエータの駆動制御方法およびアクチュエータの駆動制御装置 | |
Cheng et al. | A PID approach to suppressing stick-slip in the positioning of transmission mechanisms | |
Sun et al. | Lever control for position control of a typical excavator in joint space using a time delay control method | |
Cruz et al. | Application of robust discontinuous control algorithm for a 5-DOF industrial robotic manipulator in real-time |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20180912 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A821 Effective date: 20180912 |
|
RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20190208 |
|
RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20190214 |
|
RD02 | Notification of acceptance of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7422 Effective date: 20190515 |
|
RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20190517 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A821 Effective date: 20190515 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20190531 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20190611 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20190726 |
|
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: 20191203 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20191224 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6647562 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 |