基於多重感測之智慧型並聯式機械手臂輪廓軌跡跟隨控制

Multisensor-Based Intelligent Control for Contour Tracking of Parallel Robots

陳昭雄(CHAIO-SHIUNG CHEN)；呂至翔(ZHI-XIANG LU)；梁世承(SHI-CHENG LIANG)

並聯式機械手臂 ； 多重感測器系統 ； 混合位置／力量控制 ； 智慧型強健控制 ； parallel robot ； multi-sensors based system ； hybrid position/force controller ； intelligent robust control

科學與工程技術期刊

19卷1期（2023 / 03 / 01）

63 - 75

繁體中文;英文

本論文主要解決並聯式機械手臂在受拘束環境下的運動控制問題，使得機械手臂除了能跟隨所要的輪廓軌跡，並且能保持與接觸面固定的接觸力。基於多重感測的應用，本文將整合機械視覺、力量感測器和各軸編碼器的感測資訊，使得並聯式機械手臂能從事與工件接觸的精密輪廓軌跡跟隨控制。首先，推導並聯式機械手臂的順向／逆向運動學、Jacobian矩陣、奇異點等幾何特性，再透過機械視覺和影像處理技術，規劃機械手臂無奇異點的運動軌跡。為了解決位置和力量混合控制時的耦合問題，將機械手臂端部與加工曲面接觸的工作空間分成兩個次空間，在機械手臂受限制的方向施以力量控制，另外在不受限制的其餘自由度施以軌跡跟隨控制。根據此解耦合的控制架構，本文發展以區間第二型類神經模糊網路系統（Interval type-2 neural fuzzy network, IT2NFN）為基礎的智慧型混合位置／力量控制器，並推導適應性法則，使能線上調整控制系統的所有參數，克服機械手臂所承受的結構性和非結構性的外部干擾，確保整個控制系統的穩定和收斂。最後，利用所建立的Delta並聯式機械手臂實驗平台，透過實驗驗證本文所提方法的有效性。

The aim of this study was to find a solution to the problem of how to control a parallel robot manipulator in a constrained environment. Parallel robot manipulators must be able to follow the contours of an unknown surface while maintaining a specified contact force. We developed a multisensing technique. We installed a camera on the ceiling of the workspace and mounted a force sensor to the end effector of the manipulator and encoders at each joint of the manipulator. Each joint had three degrees of freedom. Kinematics, the Jacobian matrix, and other geometric characteristics of the robot were derived. Machine vision and image processing techniques were used to plan the machining trajectories without creating any singular points. The vector map of the workspace was divided into two subspaces: one for controlling the contact force and one for controlling the surface motion. According to this decoupled control strategy, we developed an intelligent hybrid position/force controller for the counter trajectory tracking of parallel robots. This controller is based on an interval type-2 neural fuzzy network (IT2NFN). Weights were adjusted using the adaptive IT2NFN-based control system, which ensured that the system was stable and converged to the expected result. The effectiveness of the proposed model was validated through experimentation on a practical delta parallel robot.

1. Al-Mallah, M. M.,Ali, M. M.,Al-Khawaldeh, M. T.(2022).Obstacles avoidance for mobile robot using type-2 fuzzy.Robotics,11(130),1-22.
2. Bellakehal, S.,Andreff, N.,Mezouar, Y.,Tadjine, M.(2011).Vision/force control of parallel robots.Mechanism and Machine Theory,46,1376-1395.
3. Bellotto, N. L.,Hu, H. S.(2009).Multisensor-based human detection and tracking for mobile service robots.IEEE Transactions on Systems, Man, and Cybernetics-park B: Cybernetics,39(1),167-181.
4. Bonilla, I. L.,Mendoza, M. R.,Gonz´alez, E. J.,Olivares, C. C.,Flores, A. L.(2012).Path-tracking maneuvers with industrial robot manipulators using uncalibrated vision and impedance control.IEEE Transactions on Systems, Man, and Cybernetics-Part C: Applications and Reviews,42(6),1716-1729.
5. Chaudhary, H. S.,Panwar, V. K.,Sukavanam, N.,Prasad, R. D.(2014).ANFIS PD+I based hybrid force/position control of an industrial robot manipulator.International Journal of Materials, Mechanics and Manufacturing,2(2),107-112.
6. Gueaieb, W.,Karray, F. D.,Al-Sharhan, S. L.(2007).A robust hybrid intelligent position/force control scheme for cooperative manipulators.IEEE/ASME Transactions on Mechatronics,12(2),109-125.
7. Hassanzadeh, H. R.,Akbarzadeh, M. R.,Akbarzadehb, A.,Rezaeib(2014).An interval-valued fuzzy controller for complex dynamical systems with application to a 3-PSP parallel robot.Fuzzy Sets and Systems,235,83-100.
8. Hogan, N.(1985).Impedance control: An approach to manipulation: Part I theory, part II-implementation and part III-applications.ASME Journal of Dynamic Systems, Measurement and Control,107,1-24.
9. Hsu, K. S.,Karkoub, M.,Tsai, M. C.,Her, M. G.(2014).Modelling and index analysis of a Delta-type mechanism.Proceedings of the Institution of Mechanical Engineers, Part K Journal of Multi-body Dynamics,218(3),121-132.
10. Kim, S. H.,Kim, J. P.,Ryu, J. H.(2014).Adaptive energybounding approach for robustly stable interaction control of impedance-controlled industrial robot with uncertain environments.IEEE Transactions on Mechatronics,19(4),1195-1205.
11. Koch, H. K.,König, A. D.,Seitz, A. W.,Kleinmann, K.,Suchý, J.(2013).Multisensor contour following with vision, force, and acceleration sensors for an industrial robot.IEEE Transactions on Instrumentation and Measurement,62(2),268-280.
12. Kubo, R.,Ohnishi, K.(2006).Hybrid control for multiple robots in grasping and manipulation.Proceedings of 12th International Power Electronics and Motion Control Conference
13. Li, M. Y.,Liu, Z. L.,Wang, M. F.,Pang, G. B.,Zhang, H.(2022).Design of a parallel quadruped robot based on a novel intelligent control system.Applied Sciences,12(4358),1-16.
14. Li, Y. N.,Ge, S. S.,Zhang, Q.,Lee, T. H.(2013).Neural networks impedance control of robots interacting with environments.IET Control Theory and Applications,7(11),1509-1519.
15. Lin, F. J.,Chou, P. H.,Shieh, P. H.,Chen, S. Y.(2009).Robust control of an LUSM-based X–Y –θ motion control stage using an adaptive interval type-2 fuzzy neural network.IEEE Transactions on Fuzzy Systems,17(1),24-38.
16. Love, L. J.,Book, W. J.(2004).Force reflecting teleoperation with adaptive impedance control.IEEE Transactions on Systems, Man, and Cybernetics. Part B, Cybernetics,34(1),159-165.
17. Mendel, J. M.(2001).Uncertain Rule-Based Fuzzy Logic Systems: Introduction and New Directions.Englewood Cliffs, NJ:Prentice-Hall.
18. Piegl, L.,Tiller, W.(1997).The NURBS Book.Berlin:Springer.
19. Rabert, M. H.,Craig, J. J.(1981).Hybrid position/force control of robot manipulators.ASME Journal of Dynamic Systems, Measurement and Control,102,126-133.
20. Sakaino, S.,Sato, T. M.(2011).Precise position/force hybrid control with modal mass decoupling and bilateral communication between different structures.IEEE Transactions on Industrial Informatics,7(2),266-276.
21. Stock, M.,Miller, K.(2003).Optimal kinematic design of spatial parallel manipulators: Application of linear delta robot.Transactions of the ASME, Journal of Mechanical Design,125(2),292-301.
22. Xiao, D.,Ghosh, B. K.,Xi, N.,Tarn, T. J.(2000).Sensor-based hybrid position/force control of a robot manipulator in an uncalibrated environment.IEEE Transactions on Control Systems Technology,8(4),635-645.
23. Xu, Q. S.(2015).Robust impedance control of a compliant microgripper for high-speed position/force regulation.IEEE Transactions on Industrial Electronics,62(2),1201-1209.
24. Yin, Y. H.,Xu, Y.,Jiang, Z. H.,Wang, Q. R.(2012).Tracking and understanding unknown surface with high speed by force sensing and control for robot.IEEE Transactions on Sensors,12(9),2910-2916.