Nghiên cứu thiết kế bộ điều khiển lực cho cánh tay robot 3 bậc tự do dựa trên mô hình trở kháng
Abstract
This paper presents a contact force control approach for a three-degree-of-freedom robotic manipulator based on impedance control. The proposed method combines a PID-based position controller to achieve accurate end-effector motion with a force control strategy that uses force sensor feedback to regulate contact forces during interaction. The resulting control structure improves interaction stability and is well suited for surface processing applications such as grinding and polishing. The effectiveness of the proposed approach is evaluated through MATLAB/Simulink simulations using a three-dimensional model implemented in the Simscape environment, as well as experimental tests conducted on a physical robotic manipulator. The force control performance is assessed using the root mean square error (RMSE) between the desired and measured contact forces. Simulation results show that the RMSE is below 0.25 N, while the experimental results range from approximately 1.0 N to 1.25 N, indicating stable operation and reliable force tracking under real operating conditions.
Tóm tắt
Phương pháp điều khiển lực tiếp xúc cho cánh tay robot ba bậc tự do dựa trên mô hình trở kháng đã được đề xuất trong nghiên cứu này. Cấu trúc điều khiển kết hợp bộ điều khiển vị trí vi tích phân tỉ lệ (PID) và bộ điều khiển lực sử dụng phản hồi từ cảm biến lực nhằm đảm bảo bám quỹ đạo và điều chỉnh lực tương tác ổn định, phù hợp cho các ứng dụng gia công bề mặt như mài và đánh bóng. Hiệu quả của phương pháp được kiểm chứng thông qua mô phỏng trên MATLAB/Simulink và thí nghiệm thực tế trên cánh tay robot. Hiệu suất điều khiển lực được đánh giá bằng chỉ tiêu sai số bình phương trung bình (RMSE) giữa lực đặt và lực tiếp xúc thực tế. Kết quả mô phỏng cho thấy RMSE lực dưới 0,25 N, trong khi kết quả thực nghiệm đạt khoảng từ 1,0 N đến 1,25 N. Mặc dù sai số thực nghiệm lớn hơn so với mô phỏng, bộ điều khiển đề xuất vẫn đảm bảo tính ổn định và khả năng bám lực tốt trong điều kiện làm việc thực tế.
Article Details

This work is licensed under a Creative Commons Attribution-NonCommercial 4.0 International License.
Tài liệu tham khảo
Chai, T., & Draxler, R. (2014). Root mean square error (RMSE) or mean absolute error (MAE)? Geoscientific Model Development Discussions, 7, 1525.
https://doi.org/10.5194/gmdd-7-1525-2014
Fu, J., Burzo, I., Iovene, E., Zhao, J., Ferrigno, G., & De Momi, E. (2024). Optimization-based variable impedance control of robotic manipulator for medical contact tasks. IEEE Transactions on Instrumentation and Measurement, 73, 1-8. https://doi.org/10.1109/TIM.2024.3372209
Herbster, S., Behrens, R., & Elkmann, N. (2023). Modeling the Contact Force in Constrained Human–Robot Collisions. Machines, 11(10), 955. https://doi.org/10.3390/machines11100955
Hogan, N. (1984). Impedance control: An approach to manipulation. 1984 American control conference. https://doi.org/10.23919/ACC.1984.4788393
Hogan, N. (1985). Impedance control: An approach to manipulation: Part II—Implementation. Journal of dynamic systems, measurement, and control, 107(1), 8-16. https://doi.org/10.1115/1.3140713
Jung, S., & Jeong, D.-J. (2021). Admittance force tracking control schemes for robot manipulators under uncertain environment and dynamics. International Journal of Control, Automation and Systems, 19(11), 3753-3763. https://doi.org/10.1007/s12555-020-0959-7
Lahr, G. J., Soares, J. V., Garcia, H. B., Siqueira, A. A., & Caurin, G. A. (2016). Understanding the implementation of impedance control in industrial robots. 2016 XIII Latin American Robotics Symposium and IV Brazilian Robotics Symposium (LARS/SBR). https://doi.org/10.1109/LARS-SBR.2016.52
Liu, C., He, Y., Chen, X., & Cao, H. (2022). Adaptive enhanced admittance force-tracking controller design for highly dynamic interactive tasks. Industrial Robot: the international journal of robotics research and application, 49(5), 903-912. https://doi.org/10.1108/IR-10-2021-0222
Liu, J., Zhang, J., Li, J., Yang, S., Qiao, Z., Ju, C., & Zhao, X. (2023). Research on fuzzy impedance force control technology of robot-assisted abrasive cloth wheel polishing blade. The International Journal of Advanced Manufacturing Technology, 127(5), 2537-2551. https://doi.org/10.1007/s00170-023-11648-y
Mohsin, I., He, K., Li, Z., & Du, R. (2019). Path planning under force control in robotic polishing of the complex curved surfaces. Applied Sciences, 9(24), 5489. https://doi.org/10.3390/app9245489
Mu, Y., Zou, L., Wang, Z., Li, J., Jiang, L., & Wang, W. (2025). A novel model predictive dynamic adaptive impedance control for robotic force tracking on complex surfaces. Control Engineering Practice, 163, 106398. https://doi.org/10.1016/j.conengprac.2025.106398
Mukherjee, D., Gupta, K., Chang, L. H., & Najjaran, H. (2022). A survey of robot learning strategies for human-robot collaboration in industrial settings. Robotics and Computer-Integrated Manufacturing, 73, 102231. https://doi.org/10.1016/j.rcim.2021.102231
Raibert, M. H., & Craig, J. J. (1981). Hybrid position/force control of manipulators. Journal of dynamic systems, measurement, and control, 103(2), 126-133.
https://doi.org/10.1115/1.3139652
Robotics, I. F. o. (2024). Record of 4 Million Robots in Factories Worldwide. https://ifr.org/ifr-press-releases/news/record-of-4-million-robots-working-in-factories-worldwide
Sebastian, G., Li, Z., Crocher, V., Kremers, D., Tan, Y., & Oetomo, D. (2019). Interaction force estimation using extended state observers: An application to impedance-based assistive and rehabilitation robotics. IEEE Robotics and Automation Letters, 4(2), 1156-1161. https://doi.org/10.1109/LRA.2019.2894908
Song, P., Yu, Y., & Zhang, X. (2017). Impedance control of robots: an overview. 2017 2nd international conference on cybernetics, robotics and control (CRC). https://doi.org/10.1109/CRC.2017.20
Truong, H. V. A., Trinh, H. A., Tran, D. T., & Ahn, K. K. (2021). A robust observer for sensor faults estimation on n-DOF manipulator in constrained framework environment. IEEE Access, 9, 88439-88451. https://doi.org/10.1109/ACCESS.2021.3087505
Wang, X., Li, C., Cai, D., & Cui, Y. (2025). Research on Adaptive Variable Impedance Control Method Based on Adaptive Neuro-Fuzzy Inference System. Sensors, 25(10), 3055. https://doi.org/10.3390/s25103055
Widanage, K. N., Parween, R., Godaba, H., Herzig, N., Glovnea, R., & Li, Y. (2025). Force-Dependent Variable Impedance Controller for Contact-Rich Tasks Under Reference Trajectory Uncertainty. IEEE Control Systems Letters. https://doi.org/10.1109/LCSYS.2025.3597334
Yao, H., Pang, Y., Liu, X., & Qu, J. (2022). Experimental Study of the Dynamic and Static Compression Mechanical Properties of Closed-Cell PVC Foams. Polymers, 14(17), 3522. https://doi.org/10.3390/polym14173522
Zhong, R. Y., Xu, X., Klotz, E., & Newman, S. T. (2017). Intelligent manufacturing in the context of industry 4.0: a review. Engineering, 3(5), 616-630. https://doi.org/10.1016/J.ENG.2017.05.015
Zhou, Y., She, J., Liu, Z.-T., Xu, C., & Yang, Z. (2021). Implementation of impedance control for lower-limb rehabilitation robots. 2021 4th IEEE international Conference on industrial cyber-physical systems (ICPS). https://doi.org/10.1109/ICPS49255.2021.9468210