Geometric Approach for Inverse Kinematics Solution: 3-PSU Parallel Kinematic Manipulator

Geometric Approach for Inverse Kinematics Solution: 3-PSU Parallel Kinematic Manipulator

Mr. Arya B Changela

P.G. Student, School of Engineering RK University, Rajkot.

Prof. Keyur P Hirpara

Assistant Professor, School of Engineering RK University, Rajkot.

Abstract

The parallel kinematic manipulators have shown their capabilities like high structural rigidity, high dynamic performance, and high positional accuracy. The main aim of this paper is to explore a simplified geometrical approach for the solution of Inverse Kinematics problem of a 3-PSU Parallel Kinematic Manipulator. The geometric data is obtained through a preliminary CAD model and the methodology of solution is verified in MATLAB to obtain solutions; with the solution data, tool- path simulation has been carried out using Pro/Mechanism.

1. Introduction

   The Parallel Kinematic Machines (or Manipulators) have attracted a lot of attention to researchers and academicians from research, academics and industrial organizations. The main reason, behind this, is the high dynamic capabilities, high structural rigidity, non- cumulative error propagation and high positional accuracies of the parallel kinematic manipulator (PKM) [1] [2] [3]. The closed loop connections of linkages establish a rigid structure of PKM. The payload to self weight ratio is also reduced because of multiple linkages support the moving link, which further results into good dynamic characteristics [4]. The PKMs generally have different theoretically possible configurations of joints and actuators, notations, different kinematic and dynamic characteristics, control schemes [5] and workspaces [6].

   The main aim of this paper focuses on to study and to verify a novel, simplified geometrical approach to solve inverse kinematic solution of 3- PUU PKM configurations using advanced CAD software and Simulation software like Pro/E mechanism and MATLAB.

2. Notations Scheme

   In literature, uniform notation scheme of mechanical link arrangement of PKM has not been defined. Because of lack in standard scheme, no sophisticated software has been designed with proper modular library facility [2]. Although, the configuration (also known as 3-PSU configuration)

   of Parallel Manipulator can be elaborated as following; 3 denotes three Degree of Freedom (DoF), P stands for actuated prismatic joint, S refers to ball & socket (spherical) joint & U means Universal joint. Many serial P-S-U links are connected in parallel manner in spatial space.

3. Degree of Freedom

   In a manipulator, a moving platform with an end- effector is moved with respect to fixed base in different manners. A platform changes its position and orientation considering fixed base co-ordinates as an origin. The total numbers of the possible motion is limited to three rotational and three translatory for any rigid link in space.

   These three translatory motions are considered along mutually orthogonal axes, and three rotary motions around these axes. Degree of Freedom (DoF) does not answer the question if the PKM is Planar or Spatial. The total numbers of variable required for actuator parameter (either prismatic or rotary) can be related with total DoF.

   For example, DoF of manipulator of Stewart platform is six [3], means all three rotational and all three translatory motions are available with this PKM. The PKM suggested by [7] has 3-DoF (actuated by three stepper motors) though, it is an example of planar robot manipulator.

   Figure 1 3-DoF Planar Robot [7]

   Depending upon the DoF the range of applications of application ranging from spatial applications like pick and place, material handling, MEMS, medical application, wire robots, CMM,

   astronomy, vibrations, sun-tracking, biomechanics, simulators, machine tools to Planar applications. [2] [5] [8] [9]

   According to [10];

   If, n = number of rigid bodies j = number of joints

   fi = DoF of the ith joint

   = 6 1 +

   =1 ..1

   = 3

4. Mathematical Modelling

   3-PSU configuration of PKM can be modeled as per figure, Where;

   AiBi = ith rail on which spherical joint moves

   (prismatic joint)

   AiPi = di = Distance of actuator from Ai Oxyz = Co-ordinate of fixed frame

   Mxyz = Co-ordinate of moving frame

   Txyz = Co-ordinate of Machine Tool PiQi =li = Length of ith link

   With the condition that two consecutive pairs are always kept parallel, resulting into 12, 34, 56.

   Mathematically; d1 = d2; d3 = d4; d5 = d6.

5. Inverse Kinematic Solution

   Inverse Kinematic solution for 3-PSU PKM focuses to establish the relation between (x,y,z) variables of vector Txyz and actuator lengths (d1,d3,d5). A single link shown in figure 2 is to be considered for analysis of inverse kinematic solution.

   A transformation of vector from Txyz to Mxyz is found out first. Because of symmetric arrangement of linkages parallelepiped construction is made and no rotational component exists for Mxyz. Further, from Mxyz, different coordinates for Qi (i=1 to 6) is obtained. Due to Spherical Joint(S), Qi (xq, yq, zq) will be a centre of sphere and radius will be equal

   to P Q (=l ). P (x , y , z ) is a point on sphere as

   Figure 2 Modelling of 3-PSU configuration

   Figure 3 A Single link analysis of 3-PSU

   xp = xa + m xp xa ..2

   yp = ya + m(yp ya ) ..3

   zp = za + m(zp za) ..4

   For sphere,

   x x 2 + y y 2 + z z 2 = 2

   i i i

   i p p p

   p q p q

   p q

   well as on line AiBi both, so it satisfies the equations as following. Line AiBi is represented by,

   for ith link and m [0,1].

   xa + m xp xa xq

   ..5

   a

   a

   2 + y + m(y

   p

   y ) y 2 + z

   + m(z z ) z 2 = 2

   a q a

   p a q

   ..6

   Which on expansion forms a quadratic equation of m, by solving it two values of m will be obtained, among them only one value would belong to [0,1]. This value of valid m is used to solve the P(xp, yp, zp) from equations 2,3 & 4.

   2 2 2

   2 2 2

   From

   2 = xp xa + yp ya + zp za

   ..7

   a set of di is achieved among them d1=d2; d3=d4; d5=d6 only three values (d1,d3,d5) is used to operate prismatic actuator.

6. Simulation

   The Inverse Kinematic solution of 3-PSU PKM as per the geometric approach discussed above is solved with the use of software MATLAB.

   Figure 4 Flow of Inverse Kinematic Solution

   The obtained data of (d1,d3,,d5) are sent to Pro/E mechanism for preliminary CAD model developed in Pro/E.

   Figure 5 Preliminary CAD model in Pro/E

   For the following line segment motor data for simulation were found.

   Start point:

   [27.788946, End point:	-136.043956,	11.930000]
   [04.511992,	-122.605000,	22.140000]

   Figure 6 Motor data w.r.t time

7. Conclusion

   For 3- PSU Configuration PKM, a simplified geometric approach to solve Inverse Kinematic solution has been done with the help of MATLAB software.

   The simulation for the solved data has been carried out in Pro/ E mechanism with preliminary CAD model. Same method can be used with prototype to find actuator data.

8. References

   1. D. CHABLAT and P. WENGER, "A NEW THREE-DOF PARALLEL MECHANISM: MILLING MACHINE APPLICATIONS,".

   2. J. -P. Merlet, "arallel Robots," in Parallel Robots. INRIA, Sophia-Antipolis, France: Springer, 2006, ch. 1, p. 12.

   3. Bhaskar Dasgupta and T. S. Mruthyunjaya, "The Stewart platform manipulator : a review," Mechanism and Machine Theory, vol. 35, pp. 15-40, Jan 1998.

   4. Irene Fassi, "Maultiaxis Machining: PKMs and Traditional Machining Centers," Journal of Manufacturing Processes, vol. 2, no. 1, 2000.

   5. Daniel Kannan, Philippe Wenger, and Damien Chablat, "Workspace Analysis of the Parallel Module of the VERNE Machine," Problems of Applied Mechanics,IFToMM, November 2006.

   6. A. B. Koteswara Rao, S. K. Saha, and P. V.

      M. Rao, "Dynamics Modelling of Hexaslides using the Decoupled Natural Orthogonal Complement Matrices," Multibody System Dynamics, vol. 15, pp. 159-180, Sep 2006.

   7. Dr. Eng Sergiu-Dan Stan, "What is Parallel Robot," Department of Mechanisms, Precision Mechanics and Mechatronics, Cluj-Napoca, Romania, EU, Lecture Note.

   8. Dan Verdes and Sergiu-Dan Stan, "Kinematics analysis, Workspace, Design and Control of 3- RPS and TRIGLIDE medical parallel robots," in IEEE, Catania, Italy, 2009.

   9. robot-welding. [Online]. http://www.robot- welding.com/

   10. J. A. Carretero, R. P. Podhorodeski , and M.A. Nahon , "Kinematic Analysis and optimization of a new three degree-of-freedom spatial parallel manipulator," Journal of Mechanical

Design, vol. 122, no. 1, pp. 17-24, March

2000.