研究生: |
鄭人豪 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.
[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.