研究生: |
林益頤 Yi-Yi, Lin |
---|---|
論文名稱: |
雙軸機械手臂之平順控制 Smooth Control of a Two-Link Robot Manipulator |
指導教授: |
呂有勝
Lu, Yu-Sheng |
學位類別: |
碩士 Master |
系所名稱: |
機電工程學系 Department of Mechatronic Engineering |
論文出版年: | 2014 |
畢業學年度: | 102 |
語文別: | 中文 |
論文頁數: | 86 |
中文關鍵詞: | 計算力矩控制 、機械手臂 、急動度限制下時間最佳化控制 、痙攣度限制下時間最佳化控制 |
英文關鍵詞: | computed torque control, robot manipulator, jerk-constrained time-optimal control, snap-constrained time-optimal control |
論文種類: | 學術論文 |
相關次數: | 點閱:196 下載:0 |
分享至: |
查詢本校圖書館目錄 查詢臺灣博碩士論文知識加值系統 勘誤回報 |
本論文研究主旨為將各種平順控制方法應用於雙軸機械手臂之定位。雙軸機械手臂為耦合的非線性系統,在此我們使用計算力矩控制(Computed Torque Control)方法將其解耦為線性系統之後,再設計各種時間最佳化平順控制器。
研究動機是因為機械系統中若急動度(即,加速度對時間的微分量)太大常常會對系統造成不好的影響。基於此點,本論文限制雙軸機械手臂的最大急動度,設計急動度限制下時間最佳化控制(Jerk-Constrained Time-Optimal Control, JCTOC);此外,更進一步限制痙攣度,其為急動度的再一次微分量,設計痙攣度限制下時間最佳化控制(Snap-Constrained Time-Optimal Control, SCTOC)。
在實作上,本研究將平順控制法則實現於雙軸機械手臂,使用的實驗平台核心控制器為DSP搭配具可程式陣列閘(FPGA)之實驗室自製擴充子板,FPGA方面使用VHDL規劃週邊界面,而DSP方面使用C語言實現各種控制法則。實驗結果顯示,藉由限制住受控體輸出之高階微分量,雙軸機械手臂在定位時能擁有平順的響應,且相較於傳統的線性控制器能達到更短的安定時間。
This paper presents two smooth control methods for the positioning of a two-link robot manipulator. The two-link robot manipulator is a coupled nonlinear system, and the so-called computed torque control method is employed to obtain a linear model. Then, the linear model is used to develop the smooth control methods.
In mechanical systems, if jerk (i.e., the time derivative of acceleration) is too high, it may have adverse effects on the systems and even cause system instability. To avoid the problems with high jerk, jerk-constrained time-optimal control (JCTOC) method is proposed, which constrains the maximum admissible jerk and uses the time-optimal control (TOC) method to produce smooth but fast responses. Furthermore, snap-constrained time-optimal control (SCTOC) method is proposed to constrain the snap, which is the time derivative of jerk, for even smoother responses.
In the experimental system, the control kernel is a DSP/FPGA system, and the C language and the VHDL are utilized as development tools for the control system. Experiments of the smooth control methods have been conducted and results show that the proposed smooth control methods are able to yield smoother and also faster responses than the conventional linear approach.
[1] 盧世元,機械技術雜誌:機械手臂揮灑出自動化的願景,2009。
[2] 黃沛天,馬善鈞,從傳統力學到當今猝變動力學,大學物理,第25卷第1期。
[3] W. Fan, X. S. Gao, W. Yan, and C. M. Yuan, “Interpolation of parametric CNC machining path under confined jounce,” International Journal of Advanced Manufacturing Technology, vol. 62, no. 5–8, pp. 719–739, 2012.
[4] Y. S. Lu and R. Shieh, “A jerk-constrained time-optimal servo with disturbance compensation,” Control Engineering Practice, vol. 28, pp. 49–57, Jul. 2014.
[5] M. Kaylon, “Design of continuous time controllers having almost minimum time response,” Journal of Dynamic Systems, Measurement, and control, vol. 124, no. 2, pp. 252–260, 2002.
[6] E. P. Ryan, “Time-optimal feedback control of certain fourth-order systems,” International Journal of Control, vol.26, no. 5, pp. 675–688, 1977.
[7] 呂有勝、江其錄、謝立文,「伺服馬達平順速度控制方法的研究」,2012中華民國力學學會第三十六屆全國力學會議,台灣桃園,2012年11 月。
[8] 謝立文,“急動度限制下之定位伺服及其干擾補償”,國立臺灣師範大學機電科技學系碩士論文,2013。
[9] M. Iwasaki and N. Matsui, “Robust Speed Control of IM with torque feedforward control,” IEEE Trans. Industrial Electronics, vol. 40, no. 6, Dec. 1993.
[10] J. Y. Lin, Y. S. Lu, and J. S. Chen, “A global sliding-mode control scheme with adjustable robustness for a linear variable reluctance motor,” JSME Int. J. Series C, vol. 45, no. 1, pp. 215–225, 2002.
[11] 鄭百恩,雙軸機械手臂之適應性神經網路滑動模式控制,國立臺灣師範大學機電科技學系碩士論文,2013。
[12] 陳慶潼,雙軸機械手臂之負載週期性擾動抑制,國立雲林科技大學機械工程學系碩士論文,2007。
[13] Y. S. Lu and C. T. Chen, “Near time-optimal control with smooth mode-switching for uncertain time-varying systems,” International Journal of Electrical Engineering, vol. 12, no.3, pp. 269–278, Aug. 2005.
[14] 江其錄,痙攣度限制下之伺服馬達時間最佳化控制,國立臺灣師範大學機電科技學系碩士論文,2013。
[15] P. M. Thompson, “Snap, crackle, and pop,” in Proc. Aerospace Technology and Systems Conference, Santa Ana, CA, 2011.