Kinematic Modeling of Spherical Parallel Manipulator with VectoredThrust Function for Underwater Robot Based on Screw Theory
XU Han1, LI Jing2, CHEN Yuan1, ZHANG Rongmin1, GAO Jun1
1. School of Mechanical, Electrical & Information Engineering, Shandong University at Weihai, Weihai 264209, China;
2. Yantai Industry & Trade Technician College, Yantai 264000, China
Abstract:To design a simple-structured thruster with rotation transmission and attitude adjustment functions for underwater robots, a method of constructing an over-constrained parallel manipulator is adopted to develop a 3 degree-of-freedom (DOF) spherical parallel manipulator with vectored thrust function. Based on screw theory, topological structure model of the manipulator is constructed to analyze the motion characteristics of the mechanism and calculate the forward and inverse solutions of the manipulator pose. Jacobian matrix of the manipulator is deduced by employing the vector algebra method on the basis of closed chain constraint equations. The analytical models of the manipulator velocity and acceleration are established by decoupling the configuration of feature structure, and then corresponding numerical calculation examples are given. The forward and inverse solutions of the manipulator kinematics are calculated to obtain the reachable workspace, and the correctness of the proposed numerical calculation method is verified by Adams software. The proposed manipulator with vectored thrust function has a large deflection range.
[1] Kybeom K, Gregory L, Ryan P R, et al. A study on simultaneous design of a hall effect thruster and its low-thrust trajectory[J]. Acta Astronautica, 2016, 119(2): 34-47.
[2] Roque S P, Cecilia E, Garcia C, et al. Experiences and resultsfrom designing and developing a 6-DOF underwater parallel robot[J]. Robotics and Autonomous Systems, 2011, 56(3): 101-112.
[3] 高富东,潘存云,杨政,等.多矢量推进水下航行器6自由度非线性建模与分析[J].机械工程学报,2011,47(5):93-100.Gao F D, Pan C Y, Yang Z, et al. Nonlinear mathematics modeling and analysis of the vectored thruster autonomous underwater vehicle in 6-DOF motions[J]. Journal of Mechanical Engineering, 2011, 47(5): 93-100.
[4] Khalil I, Ahmed R, Mohamed F, et al. Development of a new 4-DOF endoscopic parallel manipulator based on screw theory for laparoscopic surgery[J]. Mechatronics, 2015, 28: 4-17.
[5] Lin X H, Guo S X. Development of a spherical underwater robot equipped with multiple vectored water-jet-based thrusters[J]. Journal of Intelligent & Robotic Systems, 2012, 67(3/4): 307-321.
[6] Wu K, Yu J J, Zong G H, et al. A family of rotational parallel manipulators with equal-diameter spherical pure rotation[J]. Journal of Mechanisms and Robotics, 2013, 6(1): 267-280.
[7] 罗二娟,牟德君,刘晓,等.耦合型3自由度并联稳定平台机构及其运动特征[J].机器人,2010,32(5):681-687.Luo E J, Mu D J, Liu X, et al. A 3-DOF coupling parallel mechanism for stabilized platform and its motion characteristics[J]. Robot, 2010, 32(5): 681-687.
[8] Delsignore M J, Krovi V N. Screw-theoretic analysis models for felid jaw mechanisms[J]. Mechanism and Machine Theory, 2008, 43(2): 147-159.
[9] Jaime G A, Agustín R A, Héctor R G, et al. Kinematics of an asymmetrical three-legged parallel manipulator by means of the screw theory[J]. Mechanism and Machine Theory, 2010, 45(7): 1013-1023.
[10] Khalil I, Ahmed R, Mohamed F, et al. Development of a new 4-DOF endoscopic parallel manipulator based on screw theory for laparoscopic surgery[J]. Mechatronics, 2015, 28: 4-17.
[11] Glazunov V. Design of decoupled parallel manipulators by means of the theory of screws[J]. Mechanism and Machine Theory, 2010, 45(2): 239-250.
[12] 郭盛,方跃法,岳聪.基于螺旋理论的单闭环多自由度过约束机构综合[J].机械工程学报,2009,45(11):38-45.Guo S, Fang Y F, Yue C. Structure synthesis of single closed-loop multi-degree of freedom of over-constrained mechanism based on screw theory[J]. Journal of Mechanical Engineering, 2009, 45(11): 38-45.
[13] Glazunov V A, Levin S V, Shalyukhin K A, et al. Development of mechanisms of parallel structure with four degrees of freedom and partial decoupling[J]. Journal of Machinery Manufacture and Reliability, 2010, 39(5): 407-411.
[14] Gallardo J, Rico J M, Frisoli A, et al. Dynamics of parallel manipulators by means of screw theory[J]. Mechanism and Machine Theory, 2003, 38(11):1113-1131.