簡易檢索 / 詳目顯示

研究生: 嚴士翔
Shih-Hsiang Yen
論文名稱: 基於服務型應用之無感測器機械手臂與安全力量控制器開發
Development of Sensorless Robot Arm and Safety Force Controller for Service Applications
指導教授: 林其禹
Chyi-Yeu Lin
林遠球
Yuan-Chiu Lin
口試委員: 蔡清池
Ching-Chih Tsai
林顯易
Hsien-I Lin
林柏廷
Po-Ting Lin
林遠球
Yuan-Chiu Lin
林其禹
Chyi-Yeu Lin
學位類別: 博士
Doctor
系所名稱: 工程學院 - 機械工程系
Department of Mechanical Engineering
論文出版年: 2019
畢業學年度: 107
語文別: 英文
論文頁數: 106
中文關鍵詞: 無感測器機器人動態補償器即時控制虛擬力感測器安全碰撞檢測剛性控制
外文關鍵詞: sensorless robot, dynamic compensator, real-time control, virtual force sensor, safety collision detection, stiffness control
相關次數: 點閱:268下載:0
分享至:
查詢本校圖書館目錄 查詢臺灣博碩士論文知識加值系統 勘誤回報
  • 在以服務型應用為目的的機械手臂中,為考量人機互動的安全性,需降低控制增益來限制機械手臂工作時的速度與力量輸出;在成本效益上,由於服務型任務無須高精度的位置控制,可使用低解析度的感測器來降低成本,然而弱感測器也會使控制系統響應變慢,導致動態控制精度變差。因此本研究基於安全性與降低成本,提出一個低增益與無感測器的無刷馬達控制架構,僅使用霍爾感測器與單個電流感測器進行位置和扭力控制。我們在伺服控制器中加入低通濾波器,來解決感測器取樣不足與訊號干擾的問題。而為了克服伺服控制系統反應過慢,我們在電流控制器中加入動態補償器,透過簡化的機械手臂系統模型與鑑別實驗,可即時的補償運動時各軸馬達所需要的電流,加快伺服控制系統的反應與提高控制精度。
    在人機協作的安全控制上,為了減少力感測器和特殊彈性機構的成本,本文提出一種以無感測器的剛性機械手臂為基礎的虛擬力量感測器與剛性控制法,實現即時的碰撞偵測與低精度的力量控制。透過在伺服驅動器中增設一個扭力限制器,能根據外部接觸力的估測值即時調整關節扭力輸出,產生可變剛性的順應控制,並將其運用於安全保護與力量控制中。本研究以別於過去多感測器及彈性機構的方法,基於低成本與無感測器的架構,以機器手臂系統模型為基礎的控制方法產生剛性變化,增進低價機械手臂的使用安全性與力量控制。


    Robot arms used for service applications require safe human-machine interactions; therefore, the control gain of such robot arms must be minimized to limit the force output during operation. To improve cost efficiency, low-resolution sensors can be used to reduce cost. However, low-resolution sensors slow the response of closed-loop control systems, leading to low accuracy. Focusing on safety and cost reduction, this dissertation proposed a low-gain, sensorless Brushless DC motor control architecture, which performed position and torque control using only Hall-effect sensors and a current sensor. Low-pass filters were added in servo controllers to solve the sensing problems of undersampling and noise. To improve the control system’s excessively slow response, we added a dynamic force compensator in the current controllers, simplified the system model, and conducted tuning experiments to expedite the calculation of dynamic force. These approaches achieved real-time current compensation, accelerated control response and accuracy.
    To protect operators and conform to safety standards for human–machine interactions, the design of collaborative robot arms often incorporates flexible mechanisms and force sensors to detect and absorb external impact forces. However, this approach increases production costs, making the introduction of such robot arms into low-cost service applications difficult. This study proposes a low-cost, sensorless rigid robot arm design that employs a virtual force sensor and stiffness control to enable the safety collision detection and low-precision force control. Additionally, a torque saturation limiter is added to the servo drive for each axis to enable the real-time adjustment of joint torque output according to the estimated external force, regulation of system stiffness, and achievement of impedance control that can be applied in safety measures and force control. The design this study developed is a departure from the conventional multisensor flexible mechanism approach. Moreover, it is a low-cost and sensorless design that relies on model-based control for stiffness regulation, thereby improving the safety and force control in robot arm applications.

    中文摘要 Abstract 誌謝 Table of Contents Index of Tables Index of Figures Chapter 1 Introduction 1.1 Background and Motivation 1.2 Literature Review 1.2.1 Sensorless BLDC Motor Control 1.2.2 Low-Gain Closed-loop Control 1.2.3 Force Sensor and Safety Control 1.3 Dissertation Overview 1.4 Dissertation Organization Chapter 2 Dynamic Force Compensator on Motor Driver 2.1 Sensorless Control Problems 2.1.1 Low-Speed Control with Low-Pass Filter 2.1.2 Phase Delay Problem 2.2 Simplified Robot Dynamic Compensator 2.2.1 Robot Dynamic Model 2.2.2 Simplified Robot Dynamic Model 2.2.3 Simplified Dynamic Force Compensator Design 2.3 Simplified Dynamic Force Compensator Tuning 2.3.1 Simplifying the Calculations of Moment of Inertia and Gravity Torque 2.3.2 Tuning Experiment with SDFC 2.3.3 Analysis of Time-delay Compensation 2.4 Steady-State Error Compensator Chapter 3 Real-Time System Framework on Robot Controller 3.1 Development Platform 3.2 Real-Time Operating System 3.2.1 Xenomai 3.3 Real-Time Communication 3.3.1 Serial Peripheral Interface 3.3.2 Real-Time SPI Communication 3.4 Real-Time Program Architecture Chapter 4 Virtual Force Sensor for Safety Control 4.1 Contact Force Estimation 4.2 External Torque Observer Design 4.3 External Torque Observer Calibration 4.4 Verification of Contact Force Estimation Chapter 5 Safety Force Controller 5.1 Torque Saturation Design 5.2 Impedance and Force Control 5.3 Safety Collision Detection 5.4 Teaching by Hand Guided Chapter 6 Experiments and Results 6.1 Joint Position Accuracy Analysis 6.1.1 Experiment 1: Single-axis Repeatability Accuracy 6.1.2 Experiment 2: Multiple-axis Repeatable Accuracy 6.1.3 Discussion 6.2 Compensator Efficiency Analysis 6.2.1 Experiment 3: Compensator Efficiency Analysis 6.2.2 Discussion 6.3 Collision Detection and Safety Control 6.3.1 Experiment 4: Collision Detection 6.3.2 Experiment 5: External Force Detection 6.3.3 Discussion 6.4 Force Control Application 6.4.1 Experiment 6: Contact Force Control 6.4.2 Experiment 7: Wiping Motion Control 6.4.3 Discussion Chapter 7 Conclusions and Future Works 7.1 Conclusions 7.2 Future works References Appendix

    [1]"Executive Summary World Robotics 2018 Service Robots " 1 June, 2019;
    https://ifr.org/downloads/press2018/Executive_Summary_WR_Service_Robots_2018.pdf.
    [2]"The Growth of Non-Industrial Robotics Is Driving a Diversification of New Robotics Applications," 1 June, 2019;
    https://www.tractica.com/newsroom/press-releases/the-growth-of-non-industrial-robotics-is-driving-a-diversification-of-new-robotics-applications/.
    [3]L. Wood. "Service robots: The next big productivity platform," 1 June, 2019;
    http://usblogs.pwc.com/emerging-technology/service-robots-the-next-big-productivity-platform.
    [4]G. A. Pratt, and M. M. Williamson, “Series elastic actuators,” in Proceedings 1995 IEEE/RSJ International Conference on Intelligent Robots and Systems. Human Robot Interaction and Cooperative Robots, 1995, pp. 399-406.
    [5]A. Albu‐Schäffer, C. Loughlin, S. Haddadin, C. Ott, A. Stemmer, T. Wimböck, and G. Hirzinger, “The DLR lightweight robot: design and control concepts for robots in human environments,” Industrial Robot: An International Journal, vol. 34, no. 5, pp. 376-385, 2007.
    [6]"UR5 robot," 1 June, 2019; http://www.universal-robots.com/de/produkte.
    [7]"Jaco assistive robotic arm," 1 June, 2019;
    https://www.kinovarobotics.com/en/products/assistive-technologies/kinova-jaco-assistive-robotic-arm.
    [8]"TM5 robot," 1 June, 2019; https://tm-robot.com/.
    [9]"LBR iiwa," 1 June, 2019; https://www.kuka.com/en-us/products/robotics-systems/industrial-robots/lbr-iiwa.
    [10]"Sawyer," 1 June, 2019; https://www.rethinkrobotics.com/sawyer.
    [11]J. M. Knezevic, “Low-Cost Low-Resolution Sensorless Positioning of DC Motor Drives for Vehicle Auxiliary Applications,” IEEE Transactions on Vehicular Technology, vol. 62, no. 9, pp. 4328-4335, 2013.
    [12]G. Haines, and N. Ertugrul, “Wide Speed Range Sensorless Operation of Brushless Permanent-Magnet Motor Using Flux Linkage Increment,” IEEE Transactions on Industrial Electronics, vol. 63, no. 7, pp. 4052-4060, 2016.
    [13]S. Chen, X. Zhou, G. Bai, K. Wang, and L. Zhu, “Adaptive Commutation Error Compensation Strategy Based on a Flux Linkage Function for Sensorless Brushless DC Motor Drives in a Wide Speed Range,” IEEE Transactions on Power Electronics, vol. 33, no. 5, pp. 3752-3764, 2018.
    [14]X. Song, B. Han, S. Zheng, and J. Fang, “High-Precision Sensorless Drive for High-Speed BLDC Motors Based on the Virtual Third Harmonic Back-EMF,” IEEE Transactions on Power Electronics, vol. 33, no. 2, pp. 1528-1540, 2018.
    [15]B. Matthias, “ISO/TS 15066-Collaborative Robots: Present Status,” in European Robotics Forum, 2015.
    [16]J. Fryman, and B. Matthias, "Safety of industrial robots: From conventional to collaborative applications." pp. 1-5.
    [17]M. Plooij, W. Wolfslag, and M. Wisse, “The effect of the choice of feedforward controllers on the accuracy of low gain controlled robots,” in 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2015, pp. 4090-4097.
    [18]C. Gaz, F. Flacco, and A. De Luca, “Identifying the dynamic model used by the KUKA LWR: A reverse engineering approach,” in 2014 IEEE International Conference on Robotics and Automation (ICRA), 2014, pp. 1386-1392.
    [19]R. Vila Cano, “Towards a Model-Based Motion Control Design for a 7-axis Robotic Arm LWA4D by Schunk,” Umeå University, Faculty of Science and Technology, Department of Applied Physics and Electronics., 2016.
    [20]E. Magrini, F. Flacco, and A. De Luca, “Control of generalized contact motion and force in physical human-robot interaction,” in 2015 IEEE International Conference on Robotics and Automation (ICRA), 2015, pp. 2298-2304.
    [21]F. Lange, C. Jehle, M. Suppa, and G. Hirzinger, “Revised force control using a compliant sensor with a position controlled robot,” in 2012 IEEE International Conference on Robotics and Automation, 2012, pp. 1532-1537.
    [22]U. Kim, D.-H. Lee, Y. B. Kim, D.-Y. Seok, and H. R. Choi, “A Novel Six-Axis Force/Torque Sensor for Robotic Applications,” IEEE/ASME Transactions on Mechatronics, vol. 22, no. 3, pp. 1381-1391, 2017.
    [23]G. Buondonno, and A. De Luca, “Combining real and virtual sensors for measuring interaction forces and moments acting on a robot,” in 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2016, pp. 794-800.
    [24]"CR-35iA," 1 June, 2019; https://www.fanuc.eu/be/en/robots/robot-filter-page/collaborative-robots/collaborative-cr35ia.
    [25]E. Magrini, F. Flacco, and A. De Luca, “Estimation of contact forces using a virtual force sensor,” in 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems, 2014, pp. 2126-2133.
    [26]H. Cho, M. Kim, H. Lim, and D. Kim, “Cartesian sensor-less force control for industrial robots,” in 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems, 2014, pp. 4497-4502.
    [27]J. Qin, F. Leonard, and G. Abba, “Experimental external force estimation using a non-linear observer for 6 axes flexible-joint industrial manipulators,” in 2013 9th Asian Control Conference (ASCC), 2013, pp. 1-6.
    [28]A. Wahrburg, J. Bos, K. D. Listmann, F. Dai, B. Matthias, and H. Ding, “Motor-Current-Based Estimation of Cartesian Contact Forces and Torques for Robotic Manipulators and Its Application to Force Control,” IEEE Transactions on Automation Science and Engineering, vol. 15, no. 2, pp. 879-886, 2018.
    [29]S. Haddadin, A. Albu-Schaffer, A. De Luca, and G. Hirzinger, “Collision Detection and Reaction: A Contribution to Safe Physical Human-Robot Interaction,” in 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems, 2008, pp. 3356-3363.
    [30]C. L. Cham, and Z. Bin Samad, “Brushless DC Motor Electromagnetic Torque Estimation with Single-Phase Current Sensing,” Journal of Electrical Engineering & Technology, vol. 9, no. 3, pp. 866-872, May, 2014.
    [31]R. M. Pindoriya, A. K. Mishra, B. S. Rajpurohit, and R. Kumar, “Analysis of position and speed control of sensorless BLDC motor using zero crossing back-EMF technique,” in 2016 IEEE 1st International Conference on Power Electronics, Intelligent Control and Energy Systems (ICPEICES), 2016, pp. 1-6.
    [32]C. Kuang-Yao, and T. Ying-Yu, “Design of a sensorless commutation IC for BLDC motors,” IEEE Transactions on Power Electronics, vol. 18, no. 6, pp. 1365-1375, 2003.
    [33]G. Xiao, W. Tu, C. Suo, L. Tang, and K. Yang, “Research and design of speed control for high speed sensorless brushless DC motor with commutation compensation,” in 2017 20th International Conference on Electrical Machines and Systems (ICEMS), 2017, pp. 1-5.
    [34]T. Li, and J. Zhou, “High-Stability Position-Sensorless Control Method for Brushless DC Motors at Low Speed,” IEEE Transactions on Power Electronics, vol. 34, no. 5, pp. 4895-4903, 2019.
    [35]W. Khalil, and E. Dombre, Modeling, identification and control of robots, p.^pp. 191-194: Butterworth-Heinemann, 2004.
    [36]N. D. Vuong, and M. H. A. Jr., “Dynamic Model Identification for Industrial Robots,” IEEE Control Systems, vol. 27, no. 5, pp. 58-71, 2007.
    [37]S. Chitta, I. Sucan, and S. Cousins, “MoveIt! [ROS Topics],” IEEE Robotics & Automation Magazine, vol. 19, no. 1, pp. 18-19, 2012.
    [38]M. W. Spong, S. A. Hutchinson, and M. Vidyasagar, “Robot modeling and control,” IEEE Control Systems, vol. 26, no. 6, pp. 113-115, 2006.
    [39]S. Wolf, and M. Iskandar, “Extending a Dynamic Friction Model with Nonlinear Viscous and Thermal Dependency for a Motor and Harmonic Drive Gear,” in 2018 IEEE International Conference on Robotics and Automation (ICRA), 2018, pp. 783-790.
    [40]W. Verdonck, and J. Swevers, “Improving the dynamic accuracy of industrial robots by trajectory pre-compensation,” in Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292), 2002, pp. 3423-3428.
    [41]A. De Luca, D. Schroder, and M. Thummel, “An Acceleration-based State Observer for Robot Manipulators with Elastic Joints,” in Proceedings 2007 IEEE International Conference on Robotics and Automation, 2007, pp. 3817-3823.
    [42]"Raspberry Pi Model B," Raspberry Pi Foundation, 2015.
    [43]"Ubuntu MATE for the Raspberry Pi 2 and Raspberry Pi 3," 1 June, 2019;
    https://ubuntu-mate.org/raspberry-pi.
    [44]P. Gerum, “Xenomai-Implementing a RTOS emulation framework on GNU/Linux,” White Paper, Xenomai, pp. 81, 2004.
    [45]W. contributors. "Embedded Systems/Real-Time Operating Systems," 1 June, 2019; https://en.wikibooks.org/w/index.php?title=Embedded_Systems/Real-Time_Operating_Systems&oldid=3254269.
    [46]S. B. N. Meghanathan, “A survey of contemporary real-time operating systems,” Informatica, vol. 29, no. 2, 2005.
    [47]D. Hildebrand, "An Architectural Overview of QNX." pp. 113-126.
    [48]V. Yodaiken, and M. Barabanov, “Real-Time Linux Applications and Design,” Slides from Usenix presentation, vol. 14, pp. 16-17, 1997.
    [49]P. Mantegazza, E. Dozio, and S. Papacharalambous, “RTAI: Real time application interface,” Linux Journal, vol. 2000, no. 72es, pp. 10, 2000.
    [50]C. Huang, C.-H. Lin, and C.-K. Wu, "Performance evaluation of Xenomai 3."
    [51]J. Kay, and A. R. Tsouroukdissian, “Real-time control in ROS and ROS 2.0,” ROSCon15, 2015.
    [52]C. Arsenault. "Understanding Network Bandwidth vs Latency," 1 June, 2019;
    https://www.keycdn.com/blog/network-bandwidth#bandwidth-vs-latency.
    [53]H. Boterenbrood, “CANopen high-level protocol for CAN-bus,” Nikhef, Amsterdam, vol. 20, 2000.
    [54]F. O. Miesterfeld, J. M. McCambridge, R. E. Fassnacht, and J. M. Nasiadka, "Serial data bus for serial communication interface (SCI), serial peripheral interface (SPI) and buffered SPI modes of operation," Google Patents, 1988.
    [55]"De facto standard," 1 June, 2019;
    https://en.wikipedia.org/wiki/De_facto_standard.
    [56]J. Kiszka, "The real-time driver model and first applications."
    [57]M. Quigley, K. Conley, B. Gerkey, J. Faust, T. Foote, J. Leibs, R. Wheeler, and A. Y. Ng, "ROS: an open-source Robot Operating System." p. 5.
    [58]H. Bruyninckx, "Open robot control software: the OROCOS project." pp. 2523-2528.
    [59]"Bosch APAS assistant," 1 June, 2019; https://www.bosch-apas.com/en/home/.
    [60]F. Ficuciello, L. Villani, and B. Siciliano, “Variable Impedance Control of Redundant Manipulators for Intuitive Human–Robot Physical Interaction,” IEEE Transactions on Robotics, vol. 31, no. 4, pp. 850-863, 2015.
    [61]G. J. Su, and J. W. McKeever, “Low-Cost Sensorless Control of Brushless DC Motors With Improved Speed Range,” IEEE Transactions on Power Electronics, vol. 19, no. 2, pp. 296-302, 2004.
    [62]"FT 300 Force Torque Sensor," 1 June, 2019; https://robotiq.com/products/ft-300-force-torque-sensor
    [63]F. Ficuciello, A. Romano, L. Villani, and B. Siciliano, “Cartesian impedance control of redundant manipulators for human-robot co-manipulation,” in 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems, 2014, pp. 2120-2125.
    [64]C. Ott, R. Mukherjee, and Y. Nakamura, “Unified Impedance and Admittance Control,” in 2010 IEEE International Conference on Robotics and Automation, 2010, pp. 554-561.
    [65]BG/BGIA risk assessment recommendations according to machinery directive: Design of workplaces with collaborative robots, Sankt Augustin, 2009.
    [66]S. H. Yen, P. C. Tang, Y. C. Lin, and C. Y. Lin, “Development of a Virtual Force Sensor for a Low-Cost Collaborative Robot and Applications to Safety Control,” Sensors (Basel), vol. 19, no. 11, Jun 7, 2019.
    [67]S.-H. Yen, P.-C. Tang, Y.-C. Lin, and C.-Y. Lin, “A Sensorless and Low-Gain Brushless DC Motor Controller Using a Simplified Dynamic Force Compensator for Robot Arm Application,” Sensors, vol. 19, no. 14, pp. 3171, 2019.

    無法下載圖示 全文公開日期 2024/08/10 (校內網路)
    全文公開日期 2024/08/10 (校外網路)
    全文公開日期 2024/08/10 (國家圖書館:臺灣博碩士論文系統)
    QR CODE