Modeling and Control of a 3PRS Robot Using Lagrange Method

Authors

1 Assistant prof., Mechanical Engineering Department, Faculty of Engineering, Kharazmi University, Tehran, Iran.

2 M.Sc., Mechanical Engineering Department, Faculty of Engineering, Kharazmi University, Tehran, Iran.

Abstract

Kinematic and Kinetic Modeling of a 3PRS mechanism is performed in this paper and its related controller is designed according to Computed Torque Method (CTM). This mechanism is a kind of spatial parallel robot with 6 DOFs, which is controlled using three active prismatic joints and three passive revolute joints and thus the system is categorized as constrained mechanism. Kinematic modeling of the robot is performed using Homogenous transformation matrix and its related Jacobian matrix is exracted. Therefore the position and velocity relation between the joint space and workspace are provided both in its direct and inverse modes. Dynamic equation of the system is also derived using Lagrange equation in the joint space of the robot and considering Lagrange multipliers in order to engage the related constraints of the system. Thus both of forward and inverse kinetic of the system are solved for the presented system. Finally, by the aid of the extracted dynamic equation, the robot is controlled using Computed Torque Method (CTM) equipped by a PD controller for compensatingthe uncertainties and disturbances. All of the modeling are verified by simulating the equations in MATLAB and comparing the direct and inverse modes. It is shown that using the extracted modeling and the designed controller for this parallel robot, the desired path can be easily tracked within the workspace of the robot.

Keywords

Main Subjects

References

[1]  Altuzarra O, Gomez FC, Roldan-Paraponiaris C, Pinto C (2015) Dynamic simulation of a tripod based in boltzmann-hamel equations. Paper presented at the ASME 2015 International Design Engineering Technical Conferences and Computers and Information in Engineering Conference.
[2]  Herrero S, Pinto C, Altuzarra O, Roldan-Paraponiaris C (2014). Analysis and design of the 2pru-1prs manipulator for vibration testing. Paper presented at the ASME 2014 International Mechanical Engineering Congress and Exposition.
[3]  Jazar RN (2011) Advanced dynamics: Rigid body, multibody, and aerospace applications: John Wiley & Sons.
[4]  Lee KM, Shah DK (1988) Dynamic analysis of a three-degrees-of-freedom in-parallel actuated manipulator. J-RA 4(3) : 361-367.
[5]  Li Q, Chen Z, Chen Q, Wu C, Hu X             (2011) Parasitic motion comparison of 3-prs parallel mechanism with different limb arrangements. Robot Cim-Int Manuf 27(2): 389-396.
[6]  Li Y, Staicu S (2012) Inverse dynamics of a 3-prc parallel kinematic machine. Nonlinear Dynam 67(2): 1031-1041.
[7]  Li Y, Xu Q (2005) Kinematics and inverse dynamics analysis for a general 3-prs            spatial parallel mechanism. Robotica 23(02): 219-229.
[8]  Li YG, Xu LX, Wang H (2014) Dimensional synthesis of 3prs parallel mechanism based on a dimensionally homogeneous analytical jacobian. Appl Mech Mater.
[9]  Liang C, Lance GM (1987) A differentiable     null space method for constrained dynamic analysis. J Mech Transm-T ASME 109(3): 405-411.
[10] Liping W, Huayang X, Liwen G, Yu Z (2016) A novel 3-puu parallel mechanism and its kinematic issues. Robot Cim-Int Manuf 42: 86-102.
[11] Malvezzi F, Coelho TAH (2015) Singularity and workspace analyses of a 3-dof parallel mechanism for vehicle suspensions. Mech Mach Sci 311-319.
[12] Paccot F, Andreff N, Martinet P (2009) A review on the dynamic control of parallel kinematic machines: Theory and experiments. Int J Robot Res 28(3): 395-416.
[13] Pendar H, Vakil M, Zohoor H (2004) Efficient dynamic equations of 3-rps parallel mechanism through lagrange method. Paper presented at the Robotics, Automation and Mechatronics, 2004 IEEE Conference on.
[14] Pond G, Carretero JA (2009) Architecture optimisation of three 3-rs variants for parallel kinematic machining. Robot Cim-Int Manuf 25(1): 64-72.
[15] Ruiz A, Campa F, Roldán-Paraponiaris C, Altuzarra O (2017) Dynamic model of a compliant 3prs parallel mechanism for micromilling. Mech Mach Sci 153-164.
[16] Ruiz A, Campa F, Roldán-Paraponiaris C, Altuzarra O, Pinto C (2016) Experimental validation of the kinematic design of 3-prs compliant parallel mechanisms. Mechatronics 39: 77-88.
[17] Spong MW, Hutchinson S, Vidyasagar M (2005) Robot modeling and control. Jon Wiley & Sons. Inc, ISBN-100-471-649.
[18] Staicu S (2012) Matrix modeling of inverse dynamics of spatial and planar parallel robots. Multibody Syst Dyn 27(2): 239-265.
[19] Stewart D (1965) A platform with six degrees of freedom. P I Mech Eng 180(1): 371-386.
[20] Tsai MS, Yuan WH (2010) Inverse dynamics analysis for a 3-prs parallel mechanism based on a special decomposition of the reaction forces. Mech Mach Theory 45(11): 1491-1508.
[21] Tsai MS, Yuan WH (2011) Dynamic modeling and decentralized control of a 3 prs parallel mechanism based on constrained robotic analysis. J Intell Robot Syst: 63(3-4): 525-545.
[22] Yuan WH, Tsai MS (2014) A novel approach for forward dynamic analysis of 3-prs parallel manipulator with consideration of friction effect. Robot Cim-Int Manuf 30(3): 315-325.
 
[23] Zheng G, Haynes L, Lee J, Carroll R (1992) On the dynamic model and kinematic analysis of a class of stewart platform. Robot Auton Syst 9(4): 237-254.
[24] تیکنی و، شهبازی ح (2018) طراحی الگوریتم‌های کنترلی انتگرال-مشتق گیر- تناسبی مرتبه کسری و معمولی همراه با بررسی تجربی عملکرد آن برای کنترل موقعیت زاویه‌ای کوادروتور. مجله مکانیک سازه­ها و شاره­ها 50-37 :(2)8.
Journal of Solid and Fluid Mechanics
Volume 9, Issue 3
October 2019
Pages 25-38

Files

Share

How to cite

Statistics