1. Introduction
Parallel mechanism with actuation redundancy can reduce the driving force of each prismatic pair under specified trajectory [Reference Vieira, de Carvalho Fontes and da Silva1, Reference Cho, Cheong, Kim, Yi and Kim2]. However, the driving forces of parallel mechanism need to be allocated reasonably as a result of that unreasonable driving forces will lead to huge internal forces, damage or accidents. Moreover, driving force analysis is also the premise of trajectory planning. To analyze the driving force of the mechanism, dynamic modeling is needed. Dynamic modeling methods include Lagrange method, Newton–Euler method, virtual work principle, Kane equation method, and so on [Reference Chen, Xu, Zhang and Li3].
Newton–Euler method establishes the Newton equation and Euler equation of the analytic object separately and then solves the equation, which can calculate the force and moment between the motion pairs [Reference Arian, Danaei, Abdi and Nahavandi4]. From the view of energy analysis, Lagrange method calculates the kinetic energy and potential energy of components. Then, the system variables are differentiated and Lagrange equation is established [Reference Chen and Guo5]. The principle of virtual work establishes dynamic equation based on that sum of virtual work done by active force and moment, inertia force and moment are equal to zero [Reference Hassani, Khalilpour, Bataleblu and Taghirad6]. Kane equation method solves the unknown quantity by means of the equilibrium equation about the generalized velocity, partial velocity, active force and inertial force of the rigid body [Reference Li, Sun, Liao and Song7]. When carrying out deformation coordination analysis, it is necessary to calculate the forces between components at the spherical joint. Newton–Euler method can analyze the force between components, so Newton–Euler method is used for dynamic modeling. Therefore, the dynamic analysis of parallel posture alignment mechanism is carried out by Newton–Euler method.
Many scholars have used Newton–Euler method to study the dynamic modeling of parallel mechanisms [Reference Qiu and Dai8]. Jiao et al. [Reference Jiao, Wu, Yu and Zhao9] studied the dynamics characteristics of 2-DOF planar parallel manipulator. Jiang et al. [Reference Jiang, Li and Wang10] did similar research and the redundant driving force of parallel mechanism was optimized. Research object of the above article is a planar mechanism, whose dynamic analysis does not involve the solution of space force and moment, so it is less difficult to solve. Chen researched 4-UPS-UPU parallel mechanism and proposed corresponding dynamic model. However, the 4-UPS-UPU parallel mechanism is not a redundant drive parallel mechanism, and the dynamics modeling does not involve the supplement of constraint equation [Reference Chen, Dong and Wang11]. D–H method [Reference Bi, Zhang, Chen and Lang12] can be used to drive the kinematic and dynamic equations, but researchers need to set up the coordinate system according to the D–H rule.
For parallel mechanisms with actuation redundancy, the number of constraint equations is less than that of the unknown quantity [Reference Li, Jia and Wu13]. Therefore, it is necessary to supplement the constraint equation. Deformation compatibility analysis is required. For the parts of the mechanism, there is no infinite stiffness body and elastic deformation inevitably occurs under the function of internal forces [Reference Cao, Dolovich, Schwab, Herder and Zhang14]. For the parts used in automatic drilling and riveting system, because of the large area of aircraft panels and skin, the posture alignment mechanism has a longer span and a larger weight [Reference Yang, Wang, Kang and Chang15]. This will inevitably lead to elastic deformation of telescopic rod. Therefore, it is necessary to consider telescopic rod as a flexible body when dynamics modeling. Especially for parallel mechanism with actuation redundancy, the number of constraint equations is less than the number of unknown variables in dynamic modeling. It is necessary to increase the number of constraint equations by combining deformation compatibility equation [Reference Yang, Li, Chen and Xu16]. When dynamic simulation analysis is carried out, the deformed parts need to be designed as flexible bodies [Reference Wang, Liu, Wu and Zhang17]. Considering the influence of structural flexibility, Liu et al. conducted a dynamic modeling of active over-constrained parallel manipulator based on deformation coordination [Reference Liu, Xu, Yao, Xu, Wen and Zhao18]. By combining equilibrium and deformation coordination equations, wang et al proposed dynamic model for a 7-DOF serial-parallel hybrid humanoid robotic arm [Reference Wang, Li, Sun, Luo, Chen and Zhu19].
The purpose of this paper is to establish the analytical solution of the driving force of the parallel posture alignment mechanism with actuation redundancy and improve the efficiency and accuracy of the driving force. The driving force solved in paper refers to the force required to act on prismatic pair with servo motor installed.
The remainder of this paper is organized as follows. The Section 2 introduces the structure, degree of freedom and working principle of the automatic drilling and riveting system composed of parallel posture alignment mechanism and end actuator. In the Section 3, the kinematics analysis is presented, mainly including the inverse solution of posture, velocity and acceleration. In the Section 4, the dynamics modeling is studied, and the analytical expression of driving force is derived. The Section 5 carries out simulation analysis, and the Section 6 conducts experimental verification.
2. Bracket type parallel posture alignment mechanism
The automatic drilling and riveting system shown in Fig. 1(a) is composed of parallel posture alignment mechanism whose structural diagram is shown in Fig. 1(d) and end actuator whose structural diagram is shown in Fig. 1(e). The PS-PPS-2PPPS parallel posture alignment mechanism consists of four positioners [Reference Wen, Yu, Zhang, Zhao, Lam, Qin and Wang20] and a moving platform. As shown in Fig. 1(b), the parallel posture alignment mechanism can translate along the $z_b$ axis of the global coordinate system with distance $z^b_t$ , rotate around the $x_b$ axis and $y_b$ axis of the global coordinate system with angle $\alpha ^b_t$ and $\beta ^b_t$ , respectively. The positioner 1 is equipped with $x$ direction active prismatic pair which driven by motor. The positioner 2 is equipped with x- and z-direction active prismatic pair. The positioner 3 and 4 are equipped with $x$ , $y$ and $z$ direction prismatic pair, among which, $z$ direction prismatic pair is active prismatic pair and the other ones are follow-up prismatic pair which do not have motor installed.
Global coordinate system $O_b-x_by_bz_b$ , moving platform coordinate system $O_t-x_ty_tz_t$ , positioner coordinate system $O_i-x_iy_iz_i$ and degree of freedom of parallel posture alignment mechanism are shown in Fig. 1(b). $i$ represents the number of positioner. The direction of $x$ , $y$ and $z$ axis of the global coordinate system is from $S_2$ to $S_1$ , $S_1$ to $S_4$ and $O_b$ to $S_1$ , respectively. Coordinate axis of positioner coordinate system are parallel to the ones of global coordinate system. $O_b$ coincides with $O_1$ . $O_t$ is located at center of the upper plane of moving platform. Coordinate axis of moving platform coordinate system is parallel to the ones of global coordinate system at the beginning. When adjusting the parallel posture alignment mechanism, the moving platform firstly rotates around the $x_b$ axis and then rotates around the $y_b$ axis. $X_i$ , $Y_i$ and $Z_i$ denote prismatic pair of positioner and $S_i$ denotes spherical joint connecting positioner and moving platform. Coordinate system origin of positioner 1 $\sim$ 4 are located at $Z_1$ = 0, $X_2$ = 0, $Y_3$ = 0, $Y_4$ = 0, respectively. The moving pair of the end actuator is shown in Fig. 1(c). The design accuracy of parallel posture alignment mechanism is 0.5 mm for position error and 0.5 $^{\circ }$ for posture error.
Through offline programming, the motion path of the end effector and the parallel posture alignment mechanism is planned. Then, the pose of the parallel posture alignment mechanism and the end effector is adjusted for rough positioning. Precise positioning is carried out by laser ranging device and visual imaging device. At last, the upper end actuator is used to drilling, and then, the upper end actuator and the lower end actuator are used for riveting.
3. Kinematics analysis of low DOF parallel mechanism
Kinematic analysis is the basis of dynamic analysis, which including pose inverse solution, velocity inverse solution and acceleration inverse solution of parallel posture alignment mechanism. First of all, it is necessary to analyze the relationship between the degree of freedom and the pose parameter of the mechanism. Kutzbach–Grüble formula [Reference Qu, Zhang and Guo21] can be used to calculate the freedom of the parallel posture alignment mechanism, as shown in Eq. (1).
where M represents the degree of freedom of the mechanism and $n_m$ represents the number of parts. $g_m$ represents the number of motion pairs. $f_h$ represents the degrees of freedom of hth kinematic pair.
Therefore, only three components of the mechanism’s pose variables are independent, and the other variables should be determined according to independent variables. In other words, displacement of each prismatic pair is related to three independent variables in pose parameters ( $x^b_t$ , $y^b_t$ , $z^b_t$ , $\alpha ^b_t$ , $\beta ^b_t$ , $\gamma ^b_t)$ . The posture alignment parallel mechanism has no degree of freedom of rotation about the $z_b$ axis of the global coordinate system. What’s more, according to Eq. (2), $x^b_t$ and $y^b_t$ can be calculated by $\alpha ^b_t$ and $\beta ^b_t$ .
where l, w and h denote the distance between $O_2$ and $O_b$ , $O_2$ and $O_3$ , $S_i$ and upper plane of moving platform, respectively. Therefore, the independent variables in pose parameters are ( $z^b_t$ , $\alpha ^b_t$ , $\beta ^b_t)$ .
3.1. Inverse solution of pose
The inverse solution of pose establishes the mapping relationship between the posture parameters of moving platform and the displacement of prismatic pair in the local coordinate system. The posture transformation matrix of the parallel posture alignment mechanism is:
where the posture alignment parallel mechanism has no degree of freedom of rotation about the $z_b$ axis of the global coordinate system. As shown in Eq. (4), the displacement of each prismatic pair can be obtained by using space vector chain method:
where ${\textbf{n}}_x$ = [1, 0, 0] $^T$ , ${\textbf{n}}_y$ = [0, 1, 0] $^T$ and ${\textbf{n}}_z$ = [0, 0, 1] $^T$ . ${\textbf{n}}_x$ , ${\textbf{n}}_y$ and ${\textbf{n}}_z$ denote the direction vector. ${\textbf{P}}^b_t$ = [ $x^b_t$ , $y^b_t$ , $z^b_t$ ] $^T$ denotes the vector of moving platform coordinate system origin $O_t$ relative to global coordinate system origin $O_b$ . ${\lambda }^t_{si}$ represents the vector of $S_i$ relative to $O_t$ . It can be calculated from Eq. (5) that the displacement of each prismatic pair of the positioner driven by servo motor is:
where $d^z_i$ and $d^x_i$ represent the relative displacement of prismatic pair in z and $x$ direction, respectively.
3.2. Inverse solution of velocity
The inverse solution of pose establishes the mapping relationship between the generalized velocity of moving platform and the velocity of prismatic pair in the local coordinate system. Relative velocity of prismatic pair can be calculated as follow:
where v $^b_t$ and ${{\omega }}^b_t$ denote velocity and angular velocity of moving platform in global coordinate system, respectively. The velocity v $^b_t$ and angular velocity ${\omega }^b_t$ of moving platform can be expressed as:
Therefore, the relationship between the speed of each prismatic pair and the generalized speed of moving platform can be expressed as:
where $v^x_i$ , $v^y_i$ and $v^z_i$ represent the relative velocity of prismatic pair in x, y and z direction, respectively. ${\lambda }^b_{si}$ represents the vector of $S_i$ relative to $O_b$ which can be expressed as ${\lambda }^b_{si}$ = R $^b_{t}$ ${\lambda }^t_{si}$ .
3.3. Inverse solution of acceleration
The inverse solution of pose establishes the mapping relationship between the generalized acceleration of moving platform and the acceleration of prismatic pair in the local coordinate system. Relative acceleration of prismatic pair can be calculated according to Eq. (10):
where j represents the direction of prismatic pair and j = (x,y,z).
where A $_s$ = [ ${\ddot z}^b_t$ , ${\ddot \alpha }^b_t$ , ${\ddot \beta }^b_t$ ] $^T$ . Hr is a $6\times 3\times 3$ Hessian matrix and H $_r$ = [h $_1$ h $_2$ h $_3$ h $_4$ h $_5$ h $_6$ ] $^T$ . h $_3$ and h $_5$ are 3-order matrix whose element is zero.
4. Dynamics analytical modeling of parallel mechanism with actuation redundancy
Based on kinematics analysis, Newton–Euler method is used to establish the dynamic model of parallel posture alignment mechanism. When establishing modeling, the friction force at the spherical hinge is neglected, and the influence of the friction force between the prismatic pair of the positioner is considered. The distributed force is simplified to a concentrated force.
4.1. Establishment of dynamic equation
During dynamic modeling, force analysis of each component is required. The force analysis of the moving platform is shown in Fig. 2. $^i{\textbf{F}}^p_t$ denotes the constraint force acting on the spherical hinge relative to the global coordinate system. $^o{\textbf{F}}^p_t$ and $^o{\textbf{M}}^p_t$ represent the equivalent external force and moment acting on the moving platform relative to the global coordinate system, respectively. $m_t$ denotes the mass of the moving platform. $g$ represents the gravity acceleration relative to the global coordinate system and $\textbf{g}$ = [0, 0, −9.8 m/s $^2$ ] $^T$ . When dynamic modeling is performed, kinematic chain and joint deformation are ignored.
Newton equation and Euler equation of moving platform are established relative to the global coordinate system.
where ${\textbf{R}}^b_t$ and ${\textbf{I}}_b$ represent the posture transform matrix and inertia matrix of the moving platform relative to global coordinate system [Reference Peng, Xu, Hu, Liang and Wu22], respectively. ${\textbf{I}}_t$ denotes inertia matrix of moving platform relative to moving platform coordinate system and ${\textbf{I}}_b$ = ${\textbf{R}}^b_t$ ${\textbf{I}}_t$ $\left({\textbf{R}}^b_t\right)$ $^T$ .
The component analyzed in Figs. 3(a)–(d) is defined as component 3x, component 3y, component 3z and component 3r, respectively. $l^{Fu}_{3z}$ and $l^{Fd}_{3z}$ denote the arm of force and in Fig. 3(a), respectively. $m^z_3$ denote the mass of components 3z. Newton equation and Euler equation of each analysis object of positioner are established in the global coordinate system. Take positioner 3 as an example to analyze the force of each component, as shown in Fig. 3. Coulomb friction and elastoplastic friction between different parts are considered. According to the mass and installation position of each part, the centroid position of each part of positioner can be calculated. The dynamic equations of each component of positioner 3 are established as follows.
See Fig. 3(a) for the stress analysis of telescopic rod of positioner 3 and define ${\textbf{a}}^z_3$ = [0, 0, $a^z_3$ ] $^T$ . Then, the Newton–Euler equation of component 3z are written as:
where F $^{3z}_{3x}$ and $^s$ M $^{3z}_{3x}$ represent the force and moment of component $3x$ applied on component $3z$ , respectively. $^n$ F $^{3z}_{3x}$ and $^e$ F $^{3z}_{3x}$ represent the perpendicular and parallel components of the spatial force to the z-axis, respectively. $^d$ F $^{z}_{3}$ indicates the driving force acting on the telescopic rod, and the definitions of other driving force symbols are defined similarly. n $^{z}_{3}$ represents the direction vector of the z-direction prismatic pair of positioner 3, and the other direction vectors are defined similarly. E $_{0}$ = [0, 0, 0] $^T$ .
The force analysis of components $3x$ , $3y$ and $3r$ is shown in Figs. 3(b)–(d), whose Newton–Euler equation is given as:
where the variables in Eqs. (17)–(22) are similar to those in the previous equation.
Elastoplastic friction model [Reference Liu, Li, Zhang, Hu and Zhang23] considers the influence of elastic–plastic deformation of parts on friction, which is suitable for the calculation of friction when considering the elastic deformation of telescopic rod. On the premise that the friction calculation accuracy meets the requirements, to improve the efficiency of the algorithm, the Coulomb friction model is used to calculate the friction of telescopic rod. When the friction between prismatic pairs is taken into consideration, the friction is calculated as follows:
where $\mu _c$ represents Coulomb friction coefficient and sgn represents step function. $F_s$ denotes static friction force. $\sigma _0$ represents the stiffness coefficient. $z^x_3$ and $z^y_3$ stand for average deflection of the contacting asperities, $\sigma _1$ denotes the damping coefficient of the bristle, $\sigma _2$ is the viscous friction coefficient. $\sigma (z^x_3,v^x_3)$ and $\sigma (z^y_3,v^y_3)$ stand for the zones of the elastic and plastic deformation of asperities. $v_s$ represents the Stribeck velocity. $j_s$ denotes the Stribeck shape factor.
Newton equations and Euler equations of the other positioners can be established using similar methods. Since the number of unknowns 95 is more than the number of equations 93, there are multiple sets of solutions to the driving force, so it is difficult to accurately calculate. Therefore, it is necessary to supplement the constraint equations.
4.1.1. Mapping relationship between position uncertainty of follow-up prismatic pair and pose error of moving platform
For parallel mechanism with actuation redundancy, there are many ways to increase the number of constraint equations, for example, minimizing the position errors [Reference Jiang, Li and Wang10] and internal force regulation [Reference Liu, Yao, Li and Zhao24]. Based on the deformation compatibility equation, the paper increases the number of constraint equations. Taking the third branch chain as an example, the establishment process of the mapping relationship between the telescopic rod deformation and the pose error of the moving platform is introduced in detail.
The telescopic rod is regarded as a cantilever beam. Under the action of spatial force, the position error of $S_i$ relative to $O_t$ . $\delta {\lambda }^t_{si}$ can be expressed as [Reference Hibbeler25]:
where $L_{ii}$ denotes the length of component iz extending from component ix. $L_{iz}$ stands for the length of component iz. A, E and I represent the cross-section area, elastic modulus and polar moment of inertia of component iz, respectively.
n $^x_i$ , n $^y_i$ and n $^z_i$ represent the direction vectors of each prismatic pair, respectively. ${\lambda }^b_{\textit{oi}}$ denotes the origin of positioner i coordinate system in the global coordinate system. $d^x_i$ , $d^y_i$ and $d^z_i$ denote the displacement of each prismatic pair of the positioner. Eq. (27) can be obtained by the space vector chain method:
Considering the axial deformation and bending deformation of the telescopic rod under the action of external force and torque, Eq. (28) is established as follows:
where the elastic deformation of moving platform, x and y prismatic pair is ignored, so there is no parameter term related to $\delta$ n $^x_i$ , $\delta$ n $^y_i$ , $\delta$ n $^z_i$ , $\delta {\lambda }^t_{si}$ and $\delta {\lambda }^b_{oi}$ . z-direction prismatic pair is driven by servo motor and ball screw, so the position error is very small and can be ignored. $\delta {S}_i$ denotes the spatial variation of point $S_i$ caused by the deformation of the telescopic rod, and $\delta S_i$ = [ $\delta S^x_i$ , $\delta S^y_i$ , $\delta S^z_i$ ] $^T$ . $\delta d^x_i$ and $\delta d^y_i$ represent the positional errors of the follow-up prismatic pair of positioner i in the x direction and y direction, respectively. $\delta$ P $^b_t$ and $\delta$ R $^b_t$ represent the position error and the differential of rotation matrix of moving platform [Reference Niku26], respectively.
where $\delta x^b_t$ , $\delta y^b_t$ , $\delta z^b_t$ , $\delta \alpha ^b_t$ , $\delta \beta ^b_t$ and $\delta \gamma ^b_t$ represent pose error of moving platform. It can be obtained from Eq. (28) that:
Eq. (32) can be built by subtracting Eq. (27) from Eq. (31):
Eq. (33) is established by matrix vector multiplication:
There is the following definition,
where $\zeta_i$ = [ $\zeta ^x_i$ , $\zeta ^y_i$ , $\zeta ^z_i$ ] $^T$ ,which is a known quantity. Then, Eq. (32) can be sorted as:
where
Evidenced by the same token,
Eq. (40) can be obtained by further analysis,
where
Positioner 1 does not install prismatic pair in x and y direction, and positioner 2 has no prismatic pair in y direction. The positional error of prismatic pairs in z direction is extremely small, and the corresponding positional error is 0. So far, the mapping relationship between the deformation of the telescopic rod and the pose error of the moving platform can be established.
4.1.2. Deformation supplementary equation based on flexibility analysis
Under the internal force of the parallel posture alignment system, the elastic deformation matrix of the telescopic rod can be expressed as:
where C represents the flexibility matrix of the telescopic rod.
where $\big(^1_x F^p_t$ , $^1_y F^p_t$ , $^1_z F^p_t\big)^T$ = $^1 F^p_t$
As shown in Fig. 4(a), the follow-up prismatic pair moves under the internal force of the parallel posture alignment system and affected by the friction force of the prismatic pair. The deformation of the telescopic rod is related to the friction. The force component at the spherical hinge is similar to the friction when adjust the parallel posture alignment system with low accelerations. Therefore, the force component at the spherical hinge is used to replace the friction to calculate the deformation of telescopic rod. Then, the deformation at the top of the telescopic rod is equivalent to the position uncertainty of the follow-up prismatic pair, as shown in Fig. 4(b). In Fig. 4, the solid line represents the actual situation and the dotted line represents the ideal situation.
The dynamic supplementary equation can be obtained by simultaneous Eqs. (40) and (45),
Through deformation coordination analysis, Eq. (48) establishes the correlation equation among $\delta$ R $^b_t$ and $\delta$ P $^b_t$ , $d^x_i$ , $d^y_i$ and $d^z_i$ . 12 linearly independent constraint equations are supplemented. The spatial position of the spherical hinge in the moving platform coordinate system remains unchanged, so Eqs. (49) and (50) are established.
There are three constraint equations in Eq. (49) and one constraint equation in Eq. (50). Higher-order terms such as $\delta{S}_1 \delta{S}_2$ , $\delta{S}_2\delta{S}_3$ and $\delta{S}^2_2$ are ignored in Eq. (50). So Eq. (50) can be simplified as a first-order equation related to $\delta{S}_1$ , $\delta{S}_2$ and $\delta{S}_3$ . Eqs. (14)–(25) and Eqs. (48)–(50) contain 124 constraint equations and 124 unknowns. Therefore, the driving force can be solved.
4.2. Solution of force acting on spherical hinge
Maple [Reference Yang, Qi, Tang and Gu27] or Mathematics [Reference Martínez, Encinas, Muñoz and Dios28] can be used to solve the equations, but the equations cannot be solved in a short time. The least square method [Reference Wang, Zhou, Cheng, Ma, Chang, Miao and Chen29] and other numerical methods can be used to solve the unknown variables in the dynamic equation, which does not require complex analytical modeling. However, the accuracy of the solution is greatly affected by the initial iteration values, so it is difficult to obtain exact solutions. The unknowns in the dynamic equation can be solved by analytic analysis, that is, the mathematical expression of the unknowns can be obtained. In the analytical modeling, the driving force at the spherical hinge is first solved by taking the moving platform as the analytical object, then the force at the spherical hinge is brought into the dynamic equation of each branch and the analytical solution of the branch equation is solved.
It can be seen from Eq. (5) that the displacement of prismatic pair is only related to $z^b_t$ , $\alpha ^b_t$ and $\beta ^b_t$ . Therefore, the motion trajectory of the posture alignment mechanism is only related to $z^b_t$ , $\alpha ^b_t$ and $\beta ^b_t$ . Assuming that the trajectory of the parallel posture alignment mechanism is known, that is, $z^b_t$ , $\alpha ^b_t$ ,and $\beta ^b_t$ are known quantities. In Eqs. (14), (48), (49) and (50), the unknown is the force at the spherical hinge and the position uncertainty of the follow-up prismatic pair. The unknown number is 22 and the number of equations is 22.
In Eq. (14), only A $_f$ is the first-order function of $^1$ F $^p_t$ , $^2$ F $^p_t$ , $^3$ F $^p_t$ and $^4$ F $^p_t$ are unknowns. In Eq. (48), only the parameters and are unknown. After sorting out Eqs. (14), (48), (49) and Eqs. (50), (51) can be obtained:
where $A_f$ is the first-order function of $^1$ F $^p_t$ , $^2$ F $^p_t$ , $^3$ F $^p_t$ and $^4$ F $^p_t$ . $B_f$ is the function of $m_t \ddot q$ , $m_{dr}$ g, $^o$ F $^b_t$ , ${{I}}_b$ ${{\dot \omega }}^b_t$ , ${\omega }^b_t\times ({\textbf{I}}_b \omega ^b_t)$ and $^o$ M $^b_t$ . A $_f$ is a matrix of order 22, whose expression is known. Therefore, the force at each spherical joint can be solved,
4.3. Solution of driving force based on vector mixed product
After calculating the force at the spherical joint, take the force at the spherical joint as the intermediate variable to calculate the driving force required by each active prismatic pair. Taking the force at the spherical hinge as the intermediate variable, the driving force of the branch chain can be solved. According to the principle of mixed product of vector, multiply Eq. (15) by vector n $^z_1$ and then multiply by $l^{Fd}_{3z}$ , Eq. (53) can be obtained:
After adding Eqs. (53) to (16), Eq. (54) can be obtained:
Based on Eqs. (16), (55) can be obtained by multiplying the left cross of the vector n $^z_3$ and expanding it according to the triple product of the vector:
Substituting Eq. (54) into Eq. (55) gives:
Additionally, substituting Eq. (56) into Eq. (23) gives:
According to Eq. (15), $^d$ F $^{z}_{3}$ can be expressed as:
Substituting Eqs. (57) and (56) into Eq. (58) gives:
Based on Eqs. (17), (60) can be obtained by multiplying the left cross of the vector n $^x_3$ twice and expanding it according to the triple product of the vector:
Substituting Eqs. (57), (56) and (58) into Eq. (60) gives:
It can be seen from Eq. (17) that:
Substituting Eqs. (57) to (61) into Eq. (62) gives:
Add Eqs. (15), (17) and (19), and Eq. (64) can be obtained:
Based on Eqs. (64), (65) can be obtained by multiplying the left cross of the vector n $^y_3$ twice and expanding it according to the triple product of the vector:
$^e$ F $^{3y}_{3r}$ and $^e$ F $^{3x}_{3y}$ can be calculated by Eqs. (24), (25), (61) and (65).
The similar method can be used to calculate the driving force required by the remaining prismatic pair of positioners under the specified trajectory.
The expressions for $^d$ F $^{z}_{4}$ and $^d$ F $^{z}_{3}$ are similar. Thus, the inverse dynamics modeling of the parallel posture alignment system with actuation redundancy can be realized. To analysis efficiency and verify the validity and applicability of the dynamics model, simulation analysis and experimental verification are carried out.
5. Simulation analysis
To prove the efficiency of the algorithm, the simulation analysis of analytical modeling method proposed is carried out. The simulation analysis is mainly used to compare the driving force solution time of the proposed algorithm and other methods and calculate the difference between the proposed algorithm and ADAMS software simulation.
To demonstrate the validity and applicability of the proposed method, trajectories should be defined to include moving and turning. The independent variables in the pose parameters are $z^b_t$ , $\alpha ^b_t$ and $\beta ^b_t$ . $z^b_t$ makes the parallel posture alignment mechanism moving along the global coordinate system, $\alpha ^b_t$ and $\beta ^b_t$ make the parallel posture alignment mechanism turning around the global coordinate system axis. Therefore, the kinematic trajectory of the parallel posture alignment mechanism is defined as follows:
where the unit of $\alpha ^b_t$ and $\beta ^b_t$ is radian. The unit of $z^b_t$ is mm, and t represent simulation time whose unit is second. A = 5.5 $\times$ 103 $\text{mm}^2$ , $I = 4.0 \times 106$ $\text{mm}^4$ , E = 2.05 $\times$ 105 $\text{N/mm}^2$ , l = 4410 mm, w = 2050 mm, h = 240 mm, $m_t$ = 561 kg. The remaining parameters are shown in Table I.
5.1. Analysis of algorithm efficiency
To compare the running time of this algorithm with the existing algorithms, the driving force calculation time is analyzed, as shown in Table II. The computer configuration used for the inverse dynamics modeling is Intel Core i7-9750H CPU 2.60 GHz with 16G RAM.
It can be seen from Table II that the dynamic modeling method proposed has a shorter calculation time and high efficiency, which is 56.28% lower than Moore–Penrose [Reference Stojanović and Mosić30] and has more advantages in the design of dynamic controllers. The dynamic modeling method proposed can improve the anti-interference and anti-noise performance of the parallel posture alignment mechanism.
5.2. Analysis of validity and applicability
To demonstrate the validity and applicability of the proposed method, ADAMS software is used to calculate the difference between the algorithm proposed in this paper and the simulation value, as shown in Fig. 5(a).
where $^{ad}$ F $^z_1$ , $^{ad}$ F $^z_2$ and $^{ad}$ F $^z_3$ represent the driving force calculated by the proposed method. $^{sd}$ F $^z_1$ , $^{sd}$ F $^z_2$ and $^{sd}$ F $^z_3$ denote the driving force calculated by ADAMS.
It can be seen from Fig. 5(b) that the maximum difference between the analytical modeling method proposed in this paper and ADAMS simulation results is 16.35N, and the maximum percentage of error is 0.97% which demonstrates the validity and applicability of the proposed method.
6. Experiment verification
To verify the validity and applicability of the proposed analytical method of driving force, an experimental study is carried out. The parameters of the mechanism are identified using the method in literature [Reference Liu, Li, Zhang, Hu and Zhang23, Reference Wang, Chen, Wang, Xu and Huang31] and computer-aided design. RS-485 [Reference Castro, Martínez-Osuna, Michel, Escoto-Rodríguez, Bullock, Cueva, López-Reyes, Reimer, Salazar, Villarreal and Vargas32] converter is used to read the drive current, as shown in Fig. 6.
As shown in Fig. 6(a), a servo motor driver is installed in the control cabinet. The Comm Operator Pal can be installed on the computer, and the driver current information in the servo motor driver can be read through the RS-485 converter. The read and converted values are processed through the longitudinal redundancy check combined with the MATLAB wavelet denoising toolbox. As can be seen from Fig. 6(b), the kinematic pair of the parallel posture alignment mechanism includes prismatic pair and spherical joint pair. The control program in PC sends instructions to the driver through universal motion and automation controller, and the driver controls the motion of the servo motor. Using the laser tracker and the kinematics calibration algorithm, the structural parameters of the parallel posture alignment mechanism can be identified to increase the motion accuracy.
The z-direction prismatic pair of positioner 1, 2 and 3 adopts the position control mode [Reference Sun, Song, Dong, Lian and Liu33]. The x-direction prismatic pair of positioner 2 and the z-direction prismatic pair of positioner 4 adopt the force control mode [Reference Perrusquía, Yu and Soria34, Reference Tuan and Hieu35]. The driving force of z-direction prismatic pair of positioner 1, 2 and 3 is analyzed to verify the effectiveness of the proposed modeling method.
The driver adopts absolute value encoder: speed response 1 KHz, circuit time parameter 47 $\mu \text{s}$ , maximum input pulse frequency 500K pps. Parameters of current sensor: accuracy 0.5%, linearity 0.2%, response time ${\lt}10 \mu \text{s}$ , bandwidth DC 100 kHz, temperature drift $\leq$ 500 $PPM/^\circ \text{C}$ . The driving force data is read every 0.1 s.
The current signal of servo motor driver is collected, and the drive current is translated into the driving force of prismatic pair. Wavelet denoising and curve fitting in MATLAB are used to process the collected information, and the corresponding driving force information is shown in Figs. 7 and 8. $^{ed}$ F $^z_1$ , $^{ed}$ F $^z_2$ and $^{ed}$ F $^z_3$ represent the driving force during the experiment. $^{md}$ F $^z_1$ , $^{md}$ F $^z_2$ and $^{md}$ F $^z_3$ represent the driving force calculated in the existing literature. $^{ea}_p$ F $_{1z}^{dp}$ , $^{ea}_p$ F $_{2z}^{dp}$ and $^{ea}_p$ F $_{3z}^{dp}$ represent the deviation percentage of the proposed method. $^{ea}_p$ F $_{1z}^{dp}$ , $^{ea}_p$ F $_{2z}^{dp}$ and $^{ea}_p$ F $_{3z}^{dp}$ denote the deviation percentage in existing literature.
It can be seen from Figs. 7 to 8 that the experimental results are in good agreement with the simulation results, which proves the reliability of the analytical analysis method of driving force proposed.
-
(1) The accuracy of inverse dynamic solution algorithm proposed in this paper is slightly higher than the existing algorithm in terms of maximum difference, error percentage and the average error value.
-
(2) When using this method to design dynamic controller, the stability of the algorithm is better, which can improve the anti-interference and anti-noise performance of the system.
-
(3) There is a certain deviation between the simulation value and the experiment value, which may be caused by the external uncertainty dynamic disturbance.
Set different posture alignment paths for experiment and compare the experimental value with the model value. It can be found that the maximum error percentage is less than 1.61% which is lower than the maximum value of the error percentage 1.98% in comparative literature [Reference Stojanović and Mosić30].
7. Conclusions
An analytical modeling method of driving force of parallel posture alignment mechanism based on positioner is proposed. The following conclusions have been reached:
-
(1) Based on independent variables in kinematics parameters, dynamic equations of each component are established by Newton–Euler method. Combining with the deformation compatibility equation, the force acting on the joint of the positioner and the moving platform are analyzed analytically, and then, the driving force is solved analytically.
-
(2) The efficiency and accuracy of the algorithm is analyzed through simulation and experiment, respectively. It can be seen from the simulation and experiment results that the algorithm proposed in this paper is slightly better than the existing algorithm in the accuracy of driving force solution. The driving force solution time is reduced by 56.28% compared with the existing algorithm, which proves the validity and applicability of the modeling method.
-
(3) The novelty of this paper is based on Newton–Euler method, combining the elastoplastic friction model and deformation coordination analysis, the dynamic modeling is carried out, and the driving force is analytically calculated through vector cross-product, which improve the efficiency of solving the driving force and ensuring the calculation accuracy.
The approach can be used for other robots than the one discussed in this article.
Acknowledgements
The authors would like to acknowledge the editors and the reviewers for their insightful comments.
Author contributions
Zhihao Wang completed the article writing, simulation analysis and experimental verification. Hongbin Li provided modification suggestions and financial support for the experiment. Nina Sun was responsible for paper polishing.
Financial support
This study was funded by National Natural Science Foundation of China (Grant No. 52075036), Shandong Provincial Natural Science Foundation (Grant No. ZR2022QE219) and Scientific Research Foundation for the introduction of talent of Ludong University (Grant No. 20210108). Hongbin Li is the principal investigator the fund 52075036 in Ludong University, and Zhihao Wang is the principal investigator of fund ZR2022QE219 and fund 20210108. Ludong University is the cooperative unit of the fund 52075036.
Conflicts of interest
The authors declare that they have no conflict of interest.
Ethical approval
Not applicable.