簡易檢索 / 詳目顯示

研究生: 鄭人豪
Jen-Hao Cheng
論文名稱: 基於滑動估測器之力量估測與雙向控制系統研究
Force Estimation and Bilateral Control of a Teleoperation System Using Sliding Observer
指導教授: 林紀穎
Chi-Ying Lin
口試委員: 黃安橋
An-Chyau Huang
徐勝均
Sheng-Dong Xu
學位類別: 碩士
Master
系所名稱: 工程學院 - 機械工程系
Department of Mechanical Engineering
論文出版年: 2016
畢業學年度: 104
語文別: 中文
論文頁數: 83
中文關鍵詞: 主從遙控裝置滑動估測器模態分解法四頻道控制架構
外文關鍵詞: Master-slave Teleoperation, Sliding Observer, Modal Decomposition, Four Channel Control Architecture
相關次數: 點閱:198下載:2
分享至:
查詢本校圖書館目錄 查詢臺灣博碩士論文知識加值系統 勘誤回報

因應近年來各領域應用的需要,主從機器人必須於更狹小、惡劣的環境下回傳遠端環境資訊以便執行任務。然而受限於機構尺寸限制、量測有效範圍有限等原因,於從端架設力量感測器將造成系統架設困難。為了避免此問題,本研究使用滑動估測器取代力量感測器進行遠端操控系統力量估測並實現雙邊控制律。相較其他力量估測方法,此法能在具系統模型不確定性下,同時達到狀態與力量的估測。傳統上滑動估測器是以符號函數作為修正項以達到修正模型不確定性之效果。然而卻也易使狀態估測結果產生高頻顫振不利系統穩定度。本研究提出採用飽和函數做為估測器修正項,且利用Lyapunov穩定度理論證實滑動估測器可以指數收斂至邊界層。為了方便設計雙向系統控制律,本論文以模態分解法將主從端的系統模型投影至差模與共模空間;分別於差模空間設計位置控制器使主從端達到位置追跡,且於共模空間設計力量控制器以達到主從端力量追跡,再將其還原至原系統空間得到四頻道控制器。最後將此雙邊位置/力量控制律實現於一自製的手指力回饋主從遙控系統,實驗結果證實採用飽和函數確可獲得較佳之估測結果,所設計之雙邊四頻道控制器亦能有效進行主從位置/力量追跡控制。


Master-slave teleoperation systems must be operated at compact and harsh environments. However, using force sensor for feedback may not be feasible for real applications due to mechanism and measurement range constraints. To deal with this problem, a sliding observer is adopted to provide state and force estimation which also consider model uncertainties. Different from the sign function used in conventional sliding observer design, a saturation function is applied to alleviate the chattering phenomenon for robust term adjustment. Lyapunov theory is employed to confirm the stability of the proposed sliding observer design. For bilateral control design, this study applies modal decomposition concept to separately design position and force controller in two subsystems, which are referred to as differential mode and common mode. The experiments demonstrate that applying saturation function for sliding observer design provides better force estimation and the applied four channel control architecture can reach desired position/force master-slave tracking control performance.

摘要 I Abstract II 致謝 III 目錄 IV 圖目錄 VI 表目錄 IX 符號表 X 1 緒論 1 2 系統模型與系統架設 6 2.1 雙向控制系統模型 6 2.2 系統架設 7 3 控制演算法 11 3.1 滑動估測器 11 3.2 雙向控制系統運作原理 12 3.3 四頻道控制器 13 3.3.1 位置控制器設計 14 3.3.2 力量控制器設計 14 3.3.3 找出um與us 15 4 實驗結果 16 4.1 符號函數與飽和函數差異比較 17 4.1.1 符號函數之位置─位置控制 18 4.1.2 飽和函數之位置─位置控制 23 4.1.3 頻域分析與小結 28 4.2 四頻道控制器中介阻抗實驗結果 30 4.2.1 硬物件:軟木塞 31 4.2.2 軟物件:保麗龍 36 4.3 實驗結果討論 40 5 結論與未來方向 41 附錄A 滑動估測器 43 A.1 Shearing Effect and Sliding Patch 43 A.2 滑動估測器設計 47 A.3 滑動估測器─平滑化(Smoothing) 50 A.4 模擬結果 53 附錄B 力量感測器校正 61 附錄C 荷重元裝置方法 64 參考文獻 66

[1] “Hazbot: Ground Emergency Response Vehicle,” http://www-robotics.jpl.nasa.gov/tasks/showBrowseImage.cfm?TaskID=119&tdaID=800002
[2] R. W. Daniel, and P. R. McAree, “Fundamental limits of performance for force reflecting teleoperation,” Int. J. Rob. Res., vol. 17, no. 8, pp.811-830, Aug. 1998.
[3] “Da Vinci Surgical Robot,” http://intuitivesurgical.com/company/media/images/davinci_s_images.html
[4] T. B. Sheridan, “Space teleoperation through time delay: review and prognosis,” IEEE Trans. Rob. Autom., vol. 9, no. 5, pp.592-606, Oct. 1993.
[5] G. S. Gupta, S. C. Mukhopadhyay, C. H. Messom, S. N. Demidenko, “Master–slave control of a teleoperated anthropomorphic robotic arm with gripping force sensing,” IEEE Trans. Instrum. Meas., vol. 55, no. 6, pp.2136–2145, Dec. 2006.
[6] D. A. Lawrence, “Stability and transparency in bilateral teleoperation,” IEEE Trans. Rob. Autom., vol. 9, no. 5, pp.624-637, Oct. 1993.
[7] I. Aliaga, A. Rubio, and E. Sanchez, “Experimental quantitative comparison of different control architectures for master-slave teleoperation,” IEEE Trans. Control Syst. Technol., vol. 12, no. 1, pp.2-11, Jan. 2004.
[8] G. J. Raju, G. C. Verghese, and T. B. Sheridan, “Design issues in 2-port network models of bilateral remote manipulation,” in Proc. IEEE Int. Conf. Rob. Autom., 1989, pp.1317-1321.
[9] B. Hannaford, “A design framework for teleoperators with kinesthetic feedback,” IEEE Trans. Rob. Autom., vol. 5, no. 4, pp.426-434, Aug. 1989.
[10] Y. Yokokohji, and T. Yoshikawa, “Bilateral control of master-slave manipulators for ideal kinesthetic coupling–formulation and experiment,” IEEE Trans. Rob. Autom., vol. 10, no. 5, pp.605-620, Oct. 1994.
[11] W. Iida, and K. Ohnishi, “Reproducibility and operationality in bilateral teleoperation,” in Proc. 8th IEEE Int. Workshop AMC, Kawasaki, Japan, Mar. 25-28, 2004, pp.217-222.
[12] Y. Matsumoto, S. Katsura, and K. Ohnishi, “An analysis and design of bilateral control based on disturbance observer,” in Proc. 10th IEEE Int. Conf. Ind. Technol., Dec. 2003, pp.802–807.
[13] T. Tsuji, K. Natori, H. Nishi, and K. Ohnishi, “A controller design method of bilateral control system,” Eur. Power Electron. Drives J., vol. 16, no. 2, pp.22-28, May 2006.
[14] A. L. Trejos, R. V. Patel, and M. D. Naish, “Force sensing and its application in minimally invasive surgery and therapy: a survey,” Proc. Inst. Mech. Eng. C J. Mech. Eng. Sci., vol. 224, no. 7, pp.1435-1454, Jul. 2010.
[15] K. Ohishi, K. Ohnishi, and K. Miyachi, “Torque-speed regulation of DC motor based on load torque estimation method,” in Proc. IEEJ IPEC, Tokyo, Japan, Mar. 1983, pp.1209-1218.
[16] C. Mitsantisuk, K. Ohishi, and S. Katsura, “Estimation of action/reaction forces for the bilateral control using Kalman filter,” IEEE Trans. Ind. Electron., vol. 59, no. 11, pp.4383-4393, Nov. 2012.
[17] J. M. Daly, and D. W. L. Wang, “Bilateral teleoperation using unknown input observers for force estimation,” in Proc. Am. Control Conf., St. Louis, MO, Jun. 10-12, 2009, pp.89-95.
[18] M. Motamedi, et al., “Adaptive sliding mode control of a piezo-actuated bilateral teleoperated micromanipulation system,” Precis. Eng., vol. 35, no. 2, pp. 309-317, 2011.
[19] W. J. Kim, S. M. Yoon, and M. C. Lee, “Bilateral control for surgical robot using sliding perturbation observer,” in Proc. SICE Annu. Conf., Nagoya, Japan, Sep. 14-17, 2013, pp.2699-2704.
[20] S. M. Yoon, et al., “Bilateral control for haptic laparoscopic surgery robot,” in Int. Symp. Rob., Soul, Oct. 2013, pp.1-5.
[21] S. M. Yoon, W. J. Kim, and M. C. Lee, “Design of bilateral control for force feedback in surgical robot,” Int. J. Control Autom. Syst., vol. 13, no. 4, pp.916-925, 2015.
[22] S. Chi, and L. Xu, “Position sensorless control of PMSM based on a novel sliding mode observer over wide speed range,” IPEMC, Shanghai, vol. 3, Aug. 14-16, 2006, pp.1-7.
[23] J. J. E. Slotine, J. K. Hedrick, and E. A. Misawa, “On sliding observer for nonlinear systems,” J. Dyn. Syst. Meas. Control, vol. 109, no. 3, pp.245-252, Sep. 1987.
[24] S. Drakunov, and V. Utkin, “Sliding mode observer. Tutorial,” in Proc. 34th Conf. Decis. Control, New Orleans, LA, Dec. 13-15, 1995, pp.3376-3379.
[25] J. P. Barbot, T. Boukhobza, and M. Djemai, “Sliding mode observer for triangular input form,” in Proc. 35th Conf. Decis. Control, Kobe, Japan, Dec. 11-13, 1996, pp.1489-1490.
[26] W. Perruquetti, and J. P. Barbot, “Sliding mode control in engineering,” CRC Press, 2002.
[27] V. Utkin, J. Guldner, and J. Shi, “Sliding mode control in electro-mechanical systems,” CRC Press, 2009.
[28] J. J. E. Slotine, and W. Li, “Applied nonlinear control,” Prentice Hall, 2005.
[29] S. D. Eppinger, and W. P. Seering, “On dynamic models of robot force control,” in Proc. IEEE Conf. Rob. Autom., 1986, pp.29-34.
[30] M. P. Jacobsen, and T. C. Tsao, “Optimal velocity estimation of slowly moving systems with quantized position output,” in Proc. ASME Dyn. Syst. Control Div., 1998, pp.479-486.
[31] R. H. Brown, S. C. Schneider, and M. G. Mulligan, “Analysis of algorithms for velocity estimation from discrete position versus time data,” IEEE Trans. Ind. Electron., vol. 39, no. 1, pp.11-19, Feb. 1992.
[32] P. R. Belanger, “Estimation of angular velocity and acceleration from shaft encoder measurements,” in Proc. IEEE Int. Conf. Rob. Autom., Nice, May 12-14, 1992, pp.585-592.
[33] M. Lemkin, et al., “Velocity estimation from widely spaced encoder pulses,” in Proc. Am. Control Conf., Seattle, Washington, Jun 21-23, 1995, pp.998-1002.
[34] 張凱富, “適用於微創手術訓練之二軸觸覺鉗系統開發與夾持力重現探討”, 國立台灣科技大學機械工程學系所碩士論文, 2015.
[35] NI 6259 Device Specifications, National Instruments Co., Austin, TX, 2015.
[36] ESCON 50/5 Servo Controller Hardware Reference, Maxon Motor Ag., Sachseln, 2014.
[37] FlexiForce Sensor User Manual, Tekscan Inc., South Boston, MA, 2008.
[38] Model SGA Strain Gauge Transducer Amplifier, Interface Inc., Scottsdale, AZ, 2007.
[39] PCI-QUAD04 User’s Guide, Measurment Computing Co., Norton, MA, 2011.

QR CODE