Kinematics Analysis of a Novel Five-Degree-of-Freedom Spatial Parallel Micromanipulator

A study of the inverse kinematics for a five-degree-of-freedom (DOF) spatial parallelmicromanipulator is presented here below.The objective of this paper is the introduction of a structural and geometrical model of a novel five-degree-of-freedom spatial parallel micromanipulator, analysis of the effective and useful workspace of the micromechanism, presentation of the obtained analytical solutions of the microrobot’s inverse kinematics tasks, and verification of its correctness using selected computer programs and computation environments. The mathematical model presented in this paper describes the behaviour of individual elements for the applied 2-DOF novel piezoelectric actuator, resulting from the position and orientation of the microrobot’s moving platform.


Introduction
Over the past years much attention has been devoted to the analysis of parallel micromanipulators [1,2].These mechanisms have a major advantage over serial microrobots, reflected inter alia in their accuracy, repeatability, and speed, with which the desired position can be achieved [3][4][5].On the other hand, the parallel manipulators have a relatively smaller workspace, limited by the maximum arms lengths, angle values at the joints, and their dimensions.
Moreover, the main difficulty with parallel manipulators (both in micro-and macroscale) is the complexity of controlling their movement.Kinematic structures of various types of parallel mechanisms may contain serial, parallel, or serial-parallel (hybrid) types of linkages, mounted to the platforms by universal joints [6][7][8][9][10].The desired position and orientation of the moving platform are achieved by combining the linear and angular lengths of the robot's arms, transformed by their degrees of freedom into three positional and orientational ones for the operating member [11][12][13].The problem of inverse kinematics task for spatial parallel manipulators can be defined as finding the linkage's lengths needed to position the moving platform along a specified geometric path, aligned accordingly with the desired orientation [14][15][16][17].The solution to this problem can sometimes be indeed very complex and less suitable for realtime computing.However, the computation of length for each arm can be carried out independently, which can additionally speed up the process [18].This procedure is used to guide the moving platform in controlling its movement [16,19].Quoted features constitute the greatest importance when it comes to designing and constructing parallel platforms, operating in micro-or nanometric scales [20][21][22][23].Thus far, several attempts have been made to adapt the parallel mechanisms to build a spatial parallel micropositioning platforms, with various effects, shown in [4,10,[24][25][26][27][28][29][30][31][32][33].
Another problem is the precision of a micromanipulator, which is determined not only by the deformations of the structure, caused by external forces, but also by the strain derived from changes in ambient temperature [34].To compensate those deformations, occurring under certain conditions of environment, the proposed project solution is to equip a standard spatial three-axes parallel microrobot (tripod) with additional two rotational degrees of freedom, which-through the control system-will result in decreasing inaccuracies resulting from thermal expansion of the micromechanism's components [35].Additional degrees of freedom, in comparison to previous versions of micromanipulators, constructed in the Department of Robotics and Mechatronics at the AGH University of Science and Technology, were obtained by introducing a rotary movement to the microrobot's arms [36].It has been achieved by using completely new, specifically design movement transmission system based on three novel type piezoelectric actuators with two degrees of freedom, generating both linear and rotational movement [37,38].The movement control of the spatial parallel micromanipulator is restricted mainly to inverse kinematics, resulting from the complexity of the forward kinematics relations.

Geometric Structure of 5-DOF Parallel Micromanipulator
The structure of the proposed 5-degree-of-freedom spatial parallel micromanipulator is shown in Figure 1.The presented mechanism consists of a fixed platform, hereinafter referred to as the base 0, and has three piezoelectric actuators with two degrees of freedom.Each actuator combining linear and rotational movement, acting like a pair of prismatic () and revolute () joints, can generate independent linear l i and angular   displacements along its main (symmetry) axis.The orientation of the base plain x-y will be referred to as horizontal.The actuators are placed on passive (nonactuated) rotary (R) joints F, whose axis of rotation is perpendicular to the actuator symmetry axis and parallel to the horizontal base plane.They link them with the base and will be hereinafter referred to as the supports G, which are placed on the base, on R radius circle and relative angles, 90 ∘ , 210 ∘ , and 360 ∘ , respectively, to the -axis (between the first and the following drive).The supports are placed on the base by passive rotary (R) joints H, whose axis of rotation is perpendicular to the basis - plane.The stator E of the used piezoactuators is mounted on bearings in the supports by means of specially mounted rotary (R) nonactuated clamps.The shafts of all the drives D are attached to the moving platform unit A using properly designed passive revolute () joints C, equipped with rotary bearings B with rotary axis always parallel to the moving platform A. The moving platform A consists of three specially designed revolute joints () which has one common axis of rotation coinciding with the main axis of the platform.Thus, the base is attached to the moving platform by three identical R-R-(-)-R-R (or in other notation R-R--R-R) linkages, as shown in Figure 1.
The most important feature of the presented micromechanism is the implementation of additional rotational () movement of the arms around their own axis of symmetry, in addition, giving the spatial parallel micromanipulator up to five degrees of freedom (three translational and two angular movements of moving platform).Moreover, an asset of the considered structure is that the actuators are mounted very closely to the base, without any offsets relative to the moving platform.It simplifies the geometry and the mechanical design, reduces the overall inertia of the mechanism, and increases its mobility payload capabilities, which is an especially important feature in many micro-/nanoapplications required to avoid inducing vibrations of the structure.The view of the 5-DOF spatial parallel micromanipulator is shown in Figure 2.
The constructions overall complexity arrangements have a great impact on their development process, Błąd: Nie znaleziono źródła odwołania.The connections between working elements must be specially designed, most often due to particular conditions in which the drives selected for the manipulator work, but also depending on mathematical models describing geometric, kinematic, and dynamic parameters, characterized by a high degree of complexity.It is usually in opposition to the sophistication level of the mechanical solutions.The simpler the mechanical design is, the more difficult the mathematical model becomes.Vice versa the more the transparent computational model is being used, the more challenging the mechanical design is.In some cases, hardly obtained mathematical model is so difficult to implement that it can complicate the designing and building process of the control system.It may be impossible to control a spatial parallel microrobot in real time.On the other hand, adjustments aimed at possible simplifications in the calculation model can lead to a significant deterioration of important parameters, characterizing micromanipulators.Interdisciplinary nature, involved when Pp i (x Ppi , y Ppi , z Ppi ) P(x, y, z) designing microrobots, makes it necessary to deal with problems of computing, simulation, control, and numerous physical phenomena.

The Inverse Kinematics Problem
The inverse kinematics determines the displacements of the linkages (arms) with respect to the known position and orientation of the end effector of the spatial parallel micromanipulator [14][15][16][17].By using a linear-rotary piezoelectric drives, it is possible to independently control the orientation of the moving platform and position in the Cartesian system.The design of the micromechanism presented in this paper has a unique geometry [9].Points that are being determined through the axes of the rotating joints of individual linkages form a closed parallelogram, as shown in Figure 3 [6].This means that, at any position, the moving platform linking together all the arms of the microrobot can be treated as a spherical joint [7].Considering technical aspects of presented construction, it should be noted that this situation exists only if no rotational movement is made, which means only when the main axis of moving platform is perpendicular to the base.The length of the respective sides of thus formed parallelogram determines directly the distance measure from the base of the micromanipulator to the moving platform [8].This is a valuable feature, which is essential in determining the inverse kinematics of the presented 5-DOF spatial parallel microrobot.
First step in geometric model calculations is to determine proper vector representation.The coordinates axes of the micromanipulator's base (the inertial frame) are denoted by OXYZ, while those of the moving platform are denoted by         , as shown in Figures 3 and 4. To simplify the presented kinematic model, the -axis of the inertial frame is aligned with one of the piezoelectric actuators supports, linking them with the base structure in points marked as A i by means of a passive revolute joint, being the first of the R-R-(-)-R-R linkage.The ends of the individual supports are pointing towards the second passive revolute joint of the R-R-(-)-R-R linkage, of which rotational axis positions will be referred to as B i .The and -axis lie in the plane of the fixed platform (the horizontal plane of the base), while the -axis is defined as normal to this plane (the vertical plane of the base), pointing upwards, thereby forming the right-handed orthogonal frame.The origin of this frame is located at the circle center (  ,   ,   ) of the base.The     -plane of the mobile frame is aligned and fixed with the moving platform, with the origin (  ,   ,   ) at its centre, through which the rotational axis of the individual revolute joints of the platform coincides with each other.The   -axis points towards one of the passive revolute attachment joints, located in point C i .The   -axis completes the right-handed coordinate system and points upward when the upper platform is in its initial position.
According to designations presented in Figures 3, 4, 5, 6, and 7, the following vectors and geometric parameters are determined: (i) p = [  ,   ,   ]  is the vector from point (0, 0, 0), the origin of the fixed platform (the base    The length of the micromanipulator's th arm is labeled as l AiCi (drawn in Figure 3).It corresponds to the following lengths of all three struts  11 ,  22 , and  33 .Its measurement starts from point   (  ,   ,   ) being the place of attachment of the selected arm to the fixed platform and point   (  ,   ,   ) which forms the geometric center of the rotary joint connecting the moving platform unit ring with a selected robot arm.In the presented system the linear extension l i of the th piezoelectric actuators is measured.
Taking into consideration all the geometrical dependencies shown in Figures 3 and 4, as a result, the extension of the th piezoelectric actuator l i has been obtained: where , , . (2) z-axis y-axis x-axis To find the angular   , by which the th piezoelectric actuator has to move to overcome the deviations of the moving platform, the analytic geometry analyses were used.It was necessary to appoint two vectors, P   normal to the main axis of symmetry of the actuator's shaft and P  tangent to the platform at the point of joining with the right arm of the micromanipulator, and then determine the angle between them (Figure 5).This angle corresponds to the actual rotational   displacement of the rotor, relative to its initial position, resulting from the perfectly leveled microrobot's moving platform in horizontal position.Given all the geometrical dependencies and the distribution of the linkages, the angular displacement of the piezoelectric actuator's shaft   has been received: ) ) ) ) arccos ( ( ( ) ) ) ) where  = sin () , =cos () ,  = sin () ,  = cos () ,  = sin () , =cos () , ) , )) , ) , )) ,

Theoretical and Useful Workspace
The theoretical workspace of the micromanipulator has been determined using Wolfram Mathematica computational software program.The volume has been estimated at 60346 [mm 3 ], with an error of 39 [mm 3 ], representing approximately 0,6% of the specified result.Figure 8 presents the resulting workspace shown as part of all joined together

Verification of the Mathematical Model
In order to verify the obtained mathematical relations between the position of the moving platform and the extension of the piezoelectric drives, a virtual prototype of the manipulator has been used.For this purpose, a rigid-body model of the mechanism was built in Visual Nastran 4D and a computational model developed in MATLAB/Simulink.Both models are presented in Figures 9 and 10, respectively.The aim of the simulation was to determine the expected maximum stroke (extension) of each used actuator and specify the correctness of the mathematical model of the manipulator's inverse kinematics.
A test of the correctness of the calculations model was performed by making the moving platform of the virtual 3D model follow two different trajectories, obtained by combining three sine waves in all three directions of a Cartesian system, but with different frequencies.Mathematical  model calculations were performed for different levels of discretization.Graphical representation of the selected path of the microrobot's head is shown in Figure 11.Figures 12, 13, and 14 present volumes of received errors.Both types of computational software, used as simulation environments, arbitrarily set the point of precision in performed calculations, which may differ.The lesser the step of discretization is, the more accurate the result can be obtained.Thus errors arise directly from the approximations and rounding used by cosimulation of MATLAB/Simulink with Visual Nastran 4D.In addition, assembly tolerances and the bond between the elements of the rigid-body model must be taken into consideration.
In order to verify the mathematical model of the manipulator, describing angular displacement of 2DOF piezoelectric actuators, symbolic-numerical software Wolfram Mathematica and solid geometry software Cabri Geometry 3D was used.Correctness of the obtained final relations, describing the extension and rotation of the piezoelectric actuator, in symbolic and then numerical form, was confirmed by Wolfram Mathematica computational program, as shown in Figure 15.Cabri Geometry 3D software was used to create a  simplified geometric model of the micromanipulator in order to study changes in angular displacement of the individual piezoelectric drives of the microrobot, resulting from a change in position and orientation of the moving platform movement, as shown in Figure 16.The reference solutions of the inverse kinematic were obtained from Wolfram Mathematica.
The correctness of the results, gained by using this computational environment, has been confirmed by the analysis of the boundary points, for which error value tends to be zero.The obtained results are shown in Table 1, which presents the errors resulting from the approximations used by Cabri Geometry 3D.
The resulting angular displacement of  1 ,  2 , and  3 is characterized by an average error weight at 0,16%.The maximal error values, recorded for the maximal angular tilts of the moving platform in and -axis - = 15 ∘ and  = 15 ∘ , are equal to 7,04%, while when  = 1 ∘ and  = 1 ∘ , the error is negligibly low.

Conclusions
The objective of this work was to introduce a structural and geometrical model of a novel 5-degree-of-freedom spatial parallel micromanipulator.Analytical solutions of the microrobot's inverse kinematics tasks as well as analysis of the effective and useful workspace of the micromechanism were presented.Finally verification of the geometric model correctness using a multibody analysis program Visual Nastran 4D, interactive geometry software Cabri Geometry 3D, computation environment MATLAB/Simulink, and a computational software program Wolfram Mathematica was made.Mathematical model of microrobot's structure was provided by using analytic geometry problems, infinitesimal calculus, and vector calculus.
The greatest achievement presented in this study was to determine a detailed solution of the inverse kinematics task for the micromanipulator in an analytical form, which can be used for control and trajectory generator.The received mathematical model describes the behaviour of individual elements for the applied 2-DOF piezoelectric actuator, resulting from the translation and orientation of the microrobot's platform.The model is highly complex and contains a number of elements generating errors either on the computational engine side (numerical errors resulting from approximations) or possibly used simplifications for easier implementation for the control system and trajectory generator.It is possible to increase the accuracy of the model by performing equations with feedback from the obtained results, thus establishing the error calculations and the iterative reduction to a satisfactory level [18].Nevertheless, the verification methods of the obtained computational model showed that the analytical equations have been derived correctly.Errors generated during the virtual prototype test result from the capabilities and accuracy of computing environments and also form simplifications in the models used by the programs for numerical computation.It should be noted that (in the authors' opinion) the received errors are minor and acceptable for the project.

Figure 5 :
Figure 5: Cabri 3D geometrical model of micromanipulator with vector  connected in point  with the moving platform.

Figure 7 :
Figure 7: Cabri 3D geometric model of micromanipulator with indicated angular translation  of piezoelectric drive.

Figure 8 :
Figure 8: Shape and size of the microrobot's workspace.

Figure 11 :Figure 12 :
Figure 11: Theoretical movement path of the moving platform.

Figure 14 :
Figure 14: Error generated by computational model in -axis.

Figure 15 :
Figure 15: Mathematical model of the inverse kinematics implemented in Wolfram Mathematica computational program.
,     ,     ]  is the vector from point   to point   , through which the axis of the second revolute joint of the th linkage goes; it should be noted that |A i B i | =     is the constant distance for each arm; (vi) l i = [  ,   ,   ]  is the vector from point   of the th lower attachment point of the actuator's stator (revolute joint) to point   of the th upper attachment point of its shaft (revolute joint); it should be noted that |l i | =   represents various displacement of the th 2-DOF piezoelectric actuator;    ,     ,     ]  is the vector from point   to the origin of the moving platform ; it should be noted that |A i P| =   represents various lengths for each linkage; (xi)   and    are geometrical points of intersection th support revolute joint axis with, respectively, the symmetry axis of the th actuators shaft and horizontal plane set at the level   , determined by three centre points of the revolute joints   ; (xii) P pi A i = [    ,     ,     ]  is the vector from point   to   of the micromanipulator's th arm; (xiii) P pi C i = [    ,     ,     ]  is the vector from point   to   of the micromanipulator's th arm;   defines the th actuator's tilt relative to the base's horizontal plane,   represents the rotation of the moving platform's th revolute joint, and  and  determine the yaw and pitch of the moving frame.
Figure 6: Cabri 3D geometric model of micromanipulator with vectors indicates angular translation .ofmicromanipulator), to point  = (  ,   ,   ), the origin of the moving platform; (ii) p n = [   ,   ,    ] and p  = [   ,    ,    ] represent vectors normal and tangent to the moving platform; (iii) R is the radius of the circle on which the supports of the piezoelectric actuators are placed (position of the first revolute joints of the th linkage); (iv) O i A i = [    ,     ,     ]  is the vector from the support attachment point   to the construction point   of the th linkage; it should be noted that |O i A i | =     is the constant distance for each arm; (v) A i B i = [ (vii) P i C i = [    ,     ,     ]  is the vector from point   of the th upper attachment point of the actuator's shaft (revolute joint) to the origin of the moving platform   ; it should be noticed that |P i C i | =  is the constant distance for each arm; (viii)  is an auxiliary length, defined in -plane, between point   of the th support position on the base and point   of the th upper attachment point of the actuator's shaft (revolute joint); (ix) A i C i = [    ,     ,     ]  is the vector from point   to point   of the th upper attachment point of its shaft (revolute joint); it should be noted that |A i C i | =   represents various lengths for each linkage; (x) A i P = [

Table 1 :
Example results of the inverse kinematics for rotational movement of the piezoelectric actuators.