• Nie Znaleziono Wyników

Configuration and singularity analysis of a parallel hip joint simulator based on the forward kinematics

N/A
N/A
Protected

Academic year: 2021

Share "Configuration and singularity analysis of a parallel hip joint simulator based on the forward kinematics"

Copied!
12
0
0

Pełen tekst

(1)

Contents lists available at ScienceDirect

Applied

Mathematical

Modelling

journal homepage: www.elsevier.com/locate/apm

Configuration

and

singularity

analysis

of

a

parallel

hip

joint

simulator

based

on

the

forward

kinematics

Gang

Cheng

a

,

Yang

Li

a, ∗

,

Gabriel

Lodewijks

b

,

Yusong

Pang

b

,

Xianlei

Shan

a a School of Mechanical and Electrical Engineering, China University of Mining and Technology, Xuzhou, China

b Department of Maritime and Materials Engineering, Delft University of Technology, Delft, Netherlands

a

r

t

i

c

l

e

i

n

f

o

Article history:

Received 9 December 2014 Revised 10 December 2015 Accepted 9 March 2016 Available online 25 March 2016

Keywords: Parallel manipulator Forward kinematics Singularity Configuration spaces

a

b

s

t

r

a

c

t

Thesingularitiesofparallelmanipulatorsareusuallyidentifiedbygeometricalmethodsor bythekinematicprinciplesbasedontheposeparameters.Themethodshavelimitations inapplicationsthatinvolvesingularityavoidance,suchasmotionplanningfrominput pa-rameters.Toidentifyasingularityfromaninput parameterpoint ofview,whichwould makethesingularityavoidancestrategymoredirectandmoreeffectiveinpractical appli-cations,thispaperfocusesontherelationshipbetweenthesingularities,theconfiguration spaces and the inputparameters with a3SPS+1PS parallelhip joint simulatorselected toimplementthisapproach.Aunivariate-formpolynomialequationoftheforward kine-maticsisobtainedwiththeaidoftheSylvesterdialyticmethodofelimination,therefore provingthatthemanipulatorhasatmosteightconfigurationsforasingleinput.The con-figurationsarethendividedintotwotypesofspacesaccordingtotheirdistributions.Itis discoveredthatinpractice,weonlyneedconcernourselveswiththebasicconfiguration spaces,wherethesingularlocidegenerateintoasinglesurface.Finally,thesingular con-ditionisprovedtobeequivalenttothatwhentheunivariate-forminput–outputequation hasarepeatedrootintherealnumberfield.Therefore,thesingularconditionequationof theinputparametersandthesingularlociofthe inputparametersinthebasic configu-rationspacesareobtained.Thisstudyprovidesnewinsightintothesingularityavoidance ofaparallelmanipulator,especiallyforthesingularity-freedesigninthemotionplanning frominputparameters.

© 2016ElsevierInc.Allrightsreserved.

1. Introduction

A hip joint simulator using a 3SPS + 1PS spatial parallel manipulator as the core module was proposed [1]. This parallel simulator is used to replicate the kinematic and dynamic characteristics of a natural human hip joint to evaluate the friction and wear characteristics of the biomaterials in a hip joint prosthesis. While it overcomes the defects that arise in traditional serial simulators during complex motion simulations with large dynamic loading, it also introduces the inherent defect of all parallel manipulators (i.e., singularities), which results in uncontrolled motion and poor stiffness during certain poses.

The analysis of singularities in mechanisms is a very active research field. A parallel manipulator may either lose or gain one or more degrees of freedom (DOF) in a singular configuration [2], where the Jacobian matrix loses rank, and therefore, it loses the ability to counteract the external forces in certain directions. Researchers have performed a large amount of

Corresponding author. Tel.: + 86 13225232379; fax: + 86 516 83591916.

E-mail address: leeyang2012@163.com (Y. Li). http://dx.doi.org/10.1016/j.apm.2016.03.017

(2)

work on the identification and analysis of the singularities in parallel manipulators by means of the Jacobian matrix [3–6], the geometrical method [7–9], the kinematic method [10–14]and screw theory [15–17].

Gosselin [3]proposed a classical way to classify singularities according to the mathematical singularities of two Jacobian matrices, which define the relationship between the input and output velocities. Based on the cascaded expansion of the determinant of the Jacobian matrix, Li [4]presented an analytic form of the six-dimensional singularity locus of the general Gough–Stewart platform. Similar algebraic methods [5,6] would have difficulties dealing with complex mechanisms with multiple DOFs or with special mechanisms.

Merlet [7]introduced the Grassmann geometry for the singularity analysis of a parallel manipulator. The singular config- urations were solved using line geometry by looking for possible actuator-line dependencies. This new method was accepted and applied by other researchers [8,9]. However, this method relies heavily on observation, and it is also hard to find all of the singular configurations or to obtain the singularity distribution.

Huang [10]proposed a kinematic method that is based on the relationship of the velocities of any three non-collinear points on the platform. All singularities of the Stewart parallel manipulator were classified into three different linear- complex singularities using this method [11]. Extending this work, Li [12]transformed the singularity analysis into a simpler position analysis of the singularity-equivalent-mechanism and obtained a simpler singularity locus equation. Similarly, Gre- gorio [13] presented a new expression of the singularity condition for the most general mechanism based on the mixed products of vectors, and he transformed the singularity condition into a ninth-degree polynomial equation that is cubic in the platform position parameters and is a sixth-degree polynomial in the platform orientation parameters. Park [14]first in- troduced the method of Riemannian geometry for a differential geometric analysis of the kinematic singularities for closed- chain mechanisms. The singularities were classified by configuration space, actuator and end-effector types according to the first-order properties of their kinematics.

Another important tool that has served in the analysis of singularities is screw theory. Hunt [15] laid down the gen- eral framework for applying screw theory to singularity analysis, and introduced the notion of stationary and uncertainty configurations. This method is widely used by other researchers, and similar works can be found in [16,17].

Presently, few works have dealt with the relationship between the singularities, the input parameters and the configura- tion spaces. However, the multiplicity of forward kinematic solutions has been identified as the most significant reason for the singularities that occur in parallel manipulators [18].

Generally, the singularity avoidance is used under three circumstances: (1) online monitoring. In this case, the input parameters are known. However, the pose parameters rely on the detection system, so in this way the singularity avoidance methods based on the input parameters are obviously more direct; (2) motion planning for the pose of a moving platform. In this case, the singularity avoidance methods based on pose parameters are more direct. However, it should be noted that for most parallel manipulators, the inverse kinematics are very simple and have only one solution. Therefore, the input parameters could easily be obtained according to the pose parameters; (3) motion planning for the input parameters (such as returning to zero). Because the forward kinematics of parallel manipulators are extremely complex, and more importantly, the solution is non-unique, which means that the actual output pose is uncertain. This is where those methods based on the pose parameters have limitations whereas the ones based on input parameters would work.

In summary, the singularity avoidance methods that are based on the input parameters would be more direct and more effective than the traditional ones that are based on the pose parameters. Moreover, the analysis of the configuration spaces requires that all possible solutions of the forward position analysis should be found, and the analysis of the singular con- ditions based on the input parameters also relies on a closed-form model of the forward kinematics. Therefore, an analytic model of the forward kinematics is necessary to conduct the analysis of the relationship between the singularities, the configuration spaces and the input parameters.

This paper is organized as follows. In Section2, the forward kinematic model is built and verified with a single higher- degree equation obtained. In Section3, the singular loci of the pose parameters, the distribution of the configuration spaces and their singular status are presented and analyzed. Section4gives the singular condition equation for the input param- eters and its singular loci in the basic configuration spaces that are more meaningful in practice. Finally, Section 5follows with the conclusions of this paper.

2. Forwardkinematics

The 3SPS +1PS spatial parallel manipulator consists of a moving platform and a base connected by three surrounding SPS-type driving legs and one intermediate PS-type leg, as shown in Fig.1(a). The driving legs use electric cylinders to drive the moving platform. The intermediate leg is fixed on the base and connected to the center of the moving platform with a thrust bearing. It is used to install the artificial hip joint and balance the loading force of the hydraulic cylinder. The height is determined by the initial adjustments and remains unchanged during the working process. Aiand Biare the fixed points of the spherical hinges on the moving platform and the base, and they are distributed as two regular triangles, with radiuses

e and E, respectively.

The fixed coordinate system { b} is established on the base at its center point O with the line OB2 as the Y-axis and

the normal line of the base as the Z-axis. The moving coordinate system { m} is established on the moving platform at its center point o with the line oA2 as the y-axis and the normal line of the moving platform as the z-axis, as shown in

(3)

Fig. 1. Prototype and topology structure of the hip joint simulator.

The driving leg length liand the intermediate leg height h can completely determine the pose of the moving platform,

which is denoted as X= ( h, q). The orientation of the moving platform is q(

α

,

β

,

γ

) and is described by RPY-type Euler Angles and is defined as follows: initially { m} has the same orientation as { b}, then { m} rotates around the X-axis, the

Y-axis and the Z-axis of { b} in turn with the rotation angles

α

,

β

and

γ

, respectively.

2.1. Solutionofthemotionconstraintequation

The traditional way to build the kinematics model of a parallel manipulator is based on the position and orientation parameters of a moving platform, which is a direct and simple method for building the model. However, the solution for this type of model would be too difficult due to the massive trigonometric operations. Therefore, the coordinates of the hinge points on the moving platform are used instead. Though the number of variables is increased, a more constructed equation set, which is easy for elimination, can be achieved. The procedures are as follows:

According to the geometry and motion constrains of the manipulator, we can obtain:

G1= 3  i=1 → oAi=0, G2=

|

oAi

|

− e=0, G3=

|

AiBi

|

− li=0. i=1,2,3, (1)

We substitute with the coordinates in { b} of each point and eliminate x3, y3, and z3 from G1. We then eliminate the

quadratic terms in G3from G3−G2 and make the variable substitution as follows:

m1=z1− h, m2=z2− h, n=h2+e2+E2. (2)

Then, Eq.(1)can be simplified to a quadratic equation set with only 6 variables:

f1=x21+y12+m21− e2=0, f2=x22+y22+m22− e2=0, f3=

(

x1+x2

)

2+

(

y1+y2

)

2+

(

m1+m2

)

2− e2=0, f4=− √ 3Ex1+Ey1+2hm1− l21+n=0, f5=−2Ey2+2hm2− l22+n=0, f6= √ 3E

(

x1+x2

)

+E

(

y1+y2

)

+2h

(

m1+m2

)

+l23− n=0. (3)

Notice that f4, f5and f6are linear equations, so they can be written in the matrix form:

(4)

where,

μ

=[ x1, x2, y2] T; T is a 3 ×3 matrix whose elements are the scale parameters and

υ

is a 3 ×1 vector of { y1, m1, m2}.

Therefore, we can obtain

μ

in terms of { y1, m1, m2} and substitute it into f1, f2 and f3 to achieve a quadratic equation set

about { y1, m1, m2}. It should be noted that through f1 and f4 it can be discovered that, after the substitution of

μ

, f1 does

not contain m2, and thus f1, f2and f3could be written as:

f1=a1y21+b1y1+c1=0, (5)

f2=a2m22+b2m2+c2=0, (6)

f3=a3m22+b3m2+c3=0, (7)

where, ai,biand ci are the coefficients of corresponding variables, and these coefficients are also functions of { y1, m1}. In

particular, a1, b1and c1only concern the variable m1. We then eliminate m2 from Eqs.(6)and ( 7):

(

a2c3− a3c2

)

2−

(

a2b3− a3b2

)(

b2c3− b3c2

)

=0. (8)

It can be shown from Eqs.(6)and ( 7) that aionly contains the scale parameters, and cionly contains quadratic variables.

Therefore, Eq.(8)is a quartic equation about { y1, m1} and can be rewritten as:

k1y41+k2y31+k3y21+k4y1+k5=0, (9)

where ki is a quartic function about m1. It is noted that now Eq. (9)and Eq.(5) are functions about y1. Therefore, the

Sylvester dialytic could be used here. We multiply Eq.(9)by y1, and multiply Eq.(5) by y1, y21 and y31 to obtain 4 extra

equations. We rewrite these 4 equations, Eq.(5)and Eq.(9)in matrix form:

0 k1 k2 k3 k4 k5 k1 k2 k3 k4 k5 0 a1 b1 c1 0 0 0 0 a1 b1 c1 0 0 0 0 a1 b1 c1 0 0 0 0 a1 b1 c1

y51 y4 1 y3 1 y2 1 y1 1

=0. (10) Because

{

y5 1,y41,y31,y21,y1,1

}

T 

=0, the sufficient and necessary condition for this homogeneous function set to have nonzero solutions is that the determinant of the coefficient matric equals 0. By denoting the coefficient matrix as C, we achieve a high degree equation of m1:

det

(

C

)

=0. (11)

The equation above can be expanded and calculated in detail with the help of Matlab. It is proved to be an eight- degree equation of m1, and all its solutions could be solved by scientific computing software. Thus far, the motion constraint

equations are simplified to a single input–output equation.

After m1 is solved, each element of C can be determined. Then, y1can be uniquely determined by:

y1=









0 k1 k2 k3 −k5 k1 k2 k3 k4 0 a1 b1 c1 0 0 0 a1 b1 c1 0 0 0 a1 b1 0



















0 k1 k2 k3 k4 k1 k2 k3 k4 k5 a1 b1 c1 0 0 0 a1 b1 c1 0 0 0 a1 b1 c1









. (12)

Then, ai,biand cican all be calculated, and m2can be uniquely determined from Eqs.(6)and ( 7),

μ

=[ x1, x2, y2] T by Eq.

(4)and { x3, y3, z3} by G1. At this point, the motion constraint equations constructed by the coordinates of the hinge points

are solved completely. Therefore, it can be concluded that for a set of input parameters, the moving platform has at most 8 configurations.

2.2. Attitudeanglesofamovingplatform

We use superscript m and b to distinguish the coordinates in { m} and { b} for the same point. According to the Euler Transformation,

Ab

i=bRmAmi +ob, (13)

where bR

mis the rotation matrix for transformation from { m} to { b}:

Rm=

C

β

C

γ

S

α

S

β

S

γ

− C

α

S

γ

C

α

S

β

C

γ

+S

α

S

γ

C

β

S

γ

S

α

S

β

S

γ

+C

α

C

γ

C

α

S

β

S

γ

− S

α

C

γ

−S

β

S

α

C

β

C

α

C

β

=[u

v

w]b, (14)

(5)

Table 1

Results of numerical example.

No. x 1 (mm) y1 (mm) z1 (mm) x2 (mm) y2 (mm) z2 (mm) α( °) β( °) γ( °) 1 −119.71 39.36 620.31 119.19 80.09 679.27 −174.6488 37.0024 127.1249 2 −112.66 −73.36 638.41 −5.08 143.70 697.71 176.6758 22.5038 −179.2502 3 −71.18 −120.37 655.64 140.23 11.91 659.51 −13.3415 23.4394 −90.5340 4 80.43 115.49 659.51 −139.83 −1.46 655.64 −14.9656 22.4724 84.7648 5 121.91 −76.25 697.71 −119.86 −60.89 638.41 −158.7722 8.3361 −59.8465 6 128.95 63.18 679.27 −025.76 −123.35 620.31 −148.6721 21.4338 0.7424

7 4.62 + 164.02i −222.00 + 3.31i 689.40 + 40.69i −189.95–84.87i 115.01–140.39i 689.40–40.69i – – – 8 4.62–164.02i −222.00–3.31i 689.40–40.69i −189.95 + 84.87i 115.01 + 140.39i 689.40 + 40.69i – – –

where S represents sin and C represents cos. In addition, bR

mis an orthogonal matrix, and therefore:

w=u×

v

. (15)

By substituting Ab

1, Ab2 as solved in Section2.1, and the known parameters A1m, Am2 and ob into Eq.(13)and combining

the result with Eqs.(14)and ( 15), bR

m can be obtained. According to Eq.(14), the attitude angles of the moving platform

can be determined by

β

=Atan2

(

−u3,



u2 1+u22

)

,

α

=Atan2

(

v

3/C

β

,w3/C

β

)

,

γ

=Atan2

(

u2/C

β

,u1/C

β

)

, (16)

where A tan 2 is an arctan-function determined by two parameters. Eq.(16)limits

β

to the range of [ −90°, 90 °] to ensure that the Euler angles describing the poses of the moving platform have a one-to-one correspondence to the actual poses.

2.3.Verificationofanumericalexample

In this section, a specific numerical example is used to verify the model proposed above. The scale parameters of the manipulator are given as follows: e=144 mm, E=200 mm and h=690 mm. The input parameters are set as l1=700 mm,

l2= 700 mm and l3= 790 mm. According to the methods described above, the solutions and results are obtained and listed in

Table1.

Table1shows all eight forward kinematic solutions, of which two are plural and have no physical meaning. Therefore, only six effective configurations exist. We use each of these six groups of Euler angles and the given scale parameters to analyze the inverse kinematics. The results show that all of the obtained input parameters coincide with the setting parameters, which proves the forward kinematics method proposed above to be correct.

3. Singularityandconfigurationanalysis

3.1. Singularlociofposeparameters

In mechanism theory, a simple and effective way to identify a singularity is the Jacobian matrix, which is the generalized transmission ratio of input and output velocities. In singular positions, the transmission performance deteriorates sharply due to rank reduction in the Jacobian matrix.

The velocity constraint of the hinge points on the moving platform is:

(

vo+

ω

×−→oAi

)

· −−→ BiAi





−−→BiAi





=l˙i,i=1,2,3, (17)

where, vo is the linear velocity of o. Because the height of the moving platform is determined by the initial adjustments

and remains unchanged during the working process, vo=0. Therefore, the Jacobian matrix derived would be dimensionally

homogeneous. The angular velocity of the moving platform (i.e., the output velocity) is

ω

, and the telescopic velocity of the driving leg (i.e., the input velocity) is l˙ i. Therefore, the Jacobian matrix of the manipulator is:

J=

oA→1× → B1A1





B1→A1





oA2× → B2A2





B2→A2





oA3× → B3A3





B3→A3





T 3×3 , (18)

where the coordinates of o and Biare only concerned with the scale parameters, and the coordinates of Aiare determined

by Eq.(13). Therefore, the pose parameters q(

α

,

β

,

γ

) can completely determine J. The singular condition is:

(6)

Fig. 2. Singular loci of pose parameters.

Fig. 3. Singular loci of small attitude angles. The singular loci of the pose parameters described in Eq.(19)are visualized in Fig.2.

Fig.2shows that the singular loci of the pose parameters are extremely complicated, especially when the attitude angles are large (i.e., when near the singular loci), and the singular surfaces have a prominent stacking phenomenon. This means that when the moving platform simulates motions that have large attitude angles, there is a high possibility for the system to fall into singular space.

However, it should be noted that Fig.2(b) also shows that there are no stacking phenomena of the singular surfaces in the area around the center. For a better observation, a portion of the singular loci, which concern the small attitude angles, is given in Fig.3.

Fig. 3shows that when the attitude angles fall into the range of [ −50°, 50 °], the singular loci degenerate to a single surface. In particular, when

α

and

β

fall into the range of [ −25 °, 25 °], the corresponding singular locus for

γ

is near 0 °. This means that in the motion design of the manipulator, if the required attitude angles are small (which is a very common requirement in practice), it is feasible to avoid the singularity if the attitude angles are designed according to

(7)

Fig. 4. Distribution of configuration numbers.

Fig.3. Furthermore, if the required

α

and

β

fall into the range of [ −25°, 25 °], and

γ

has no values near 0 °, then the design will be singularity-free.

3.2.Singularityanalysisbasedoninputparameters

Based on the forward kinematics proposed above, this section aims to obtain the positional relationships among the different configuration spaces and to further analyze how they affect the singularities. To access the purpose and make the results intuitional and conducive for analysis, we hold the length of one driving leg constant while allowing the other two to vary in their operational ranges. Without loss of universality, we select the driving leg A1B1 to have a constant length.

According to the motion range that the electric cylinder can reach in practice, l2and l3vary in the range [650 mm, 800 mm],

and l1 is chosen to have a constant intermediate value of 700 mm. After solving all of the solutions in this 2-D net area of

input parameters according to the forward kinematics proposed above, the distribution of the configuration numbers is given in Fig.4.

Fig.4shows that while l2and l3 are both small (i.e., <725 mm), the manipulator could not be assembled, and in the rest

area, at least two configurations exist. For the largest range of input parameters, only two configurations exist. If we define the set of the adjacent configurations that correspond with the adjacent input parameters as the configuration space, then these two configurations, which have an extensive correspondence to the input parameter spaces, could be defined as the basic configuration spaces. In the small zonal area of the input parameter space, there are some complicated configuration spaces, which are therefore defined as the special configuration spaces. The superposition of the basic and special configu- ration spaces results in the distribution shown in Fig.4. It should be noted that all of the configuration numbers are even, which means that in the mapping from the input parameter spaces to the configuration spaces, the latter always appear in pairs.

3.2.1. Basicconfigurationspaces

Fig.5shows the distributions of

γ

and

α

in the basic configuration spaces.

Fig.5shows that in the 2 basic configuration spaces, the values of

α

are basically equal to each other while the values of

γ

are almost the opposite of each other. The values of

β

are also basically equal to each other, though they are not shown in Fig.5. This means that the 2 basic configuration spaces have a similar pattern of assembly configuration in which only the directions of the rotation around the intermediate leg are opposite. In addition, the values of

α

and

β

fall into the range of [ −40 °, 40 °], and therefore most configurations in this space can be realized in practice. Moreover, in Fig.5, it also can be determined that there is an intersection of the configuration surfaces when l2and l3 are both small and that there is a

trend of intersection when l2 and l3are both large. In other words, in the 2 boundaries of the input parameter spaces, there

is an overlap of the configurations or at least a trend to overlap.

For the basic configuration spaces, their singular status, which is measured by the reciprocal of the condition number of the Jacobian matrix (i.e., cond( J) −1), is shown in Fig.6.

When a mechanism has a singular status, the condition number of its Jacobian matrix will be infinite, and therefore the reciprocal of the condition will intuitively reflect its singular status. The smaller this value is, the worse the transmission performance will be. When the mechanism reaches a singular position, this value will be infinitely close to 0. Fig.6shows that the 2 basic configuration spaces have similar singular statuses. The manipulator has a stable transmission performance for most positions in these 2 spaces. The singularity appears in the same places where the overlap of configurations or their trend occurs in Fig.5. This proves that all of the singularities in the basic configuration spaces are forward singularities, which are caused by the overlaps produced by the forward kinematics.

(8)

Fig. 5. Basic configuration spaces.

3.2.2. Specialconfigurationspaces

Fig.7 shows the distribution of

α

in the special configuration spaces. It is represented with a scatterplot because the curved configuration surfaces are too concentrated and complicated, and the detailed analysis is unnecessary.

From Fig.7, it can be determined that in the special configuration spaces, both the input and output parameters have highly limited variation ranges, which means that the manipulator will have many kinematical boundaries and result in a substantially reduced motion ability. It also should be noted that in particular, all the values of

α

fall outside the range of [ −100 °, 100 °], which means that the configurations in these spaces would be impossible to achieve in practice due to the interference of the limbs or the motion limits of the spherical hinges.

Fig.8shows the singular status of the special configuration spaces.

Fig. 8 directly shows that the special configuration spaces consist of intensively distributed surfaces of configuration. However, all of the values of cond( J) −1 in these surfaces are smaller than 0.8, which has a significant distance from the values in the basic singular spaces. This means that the manipulator has a much worse transmission performance in the special configuration spaces. This result coincides with Fig.2in that when the manipulator simulates the motions that have large attitude angles, it has a high potential to fall into singularity and be damaged.

In summation, in practice we only need to concern ourselves with the basic configuration spaces, where the singular status is substantially simplified. This would make singularity avoidance more practical and effective.

4. Singularconditionsbasedoninputparameters

Fig. 6shows that all of the singularities in the basic configuration spaces are forward singularities, which are caused by the overlaps in the forward kinematics solutions. To analyze whether this applies to all of the configuration spaces, the singular conditions of the manipulator based on Gosselin’s classification [2]are discussed below.

(9)

Fig. 6. Singular status of basic configuration spaces.

Fig. 7. Distribution of αin special configuration spaces.

(10)

The motion constraint equation of the manipulator is



Ab i− Bbi



T



Ab i− Bbi



− li2=0,i=1,2,3. (20)

Eq.(20)is also the constraint relationship of the output parameters q(

α

,

β

,

γ

) and the input parameters p( l1, l2, l3). We

can rewrite Eq.(20)as:

F

(

p,q

)

=

(

g1,g2,g3

)

T=0, (21)

where gi is the motion constraint equation of the corresponding leg. Differentiating Eq.(21)with respect to time obtains

the following:

Jpp˙=Jq ·

q, (22)

where p· and q· are the input and output velocities, respectively, and

Jp=

F

p, Jq=

F

q. (23)

According to Gosselin’s classification, the manipulator would have a singularity when either Jpor Jq becomes singular. It could be determined that for the manipulator considered in this paper:

Jp=

−2l1 0 0 0 −2l2 0 0 0 −2l3

. (24)

Therefore, the manipulator does not have either inverse singularities or composite singularities. The only possibility is a forward singularity, which is noted to be caused by the occurrence of a repeated solution in the forward position analysis [2].

It is noted that in Section 2.1, the analytic model of the forward kinematics was converted into a univariate-form poly- nomial equation (i.e., Eq.(11)). This provides the ability to mathematically express the singular condition of the input pa- rameters. The singular condition can therefore be equivalent to when the input–output Eq.(11) has a repeated root in the real number field. By denoting Eq.(11)as

λ

( m1), the singular condition of the manipulator can be written as:

(

m1

)

=

λ

8m81+

λ

7m17+...+

λ

1m1+

λ

0=0,

λ



(

m1

)

=8

λ8

m7

1+7

λ7

m61+...+

λ1

=0,

(25) where

λ

i only contains the scale parameters and the input parameters. Similar to the elimination method in the forward

kinematics, the Sylvester dialytic method is applied to Eq. (25): By multiplying Eq.(25)by m6

1, m51, m41, m31, m21, and m1,

and then multiplying

λ

( m1) by m71, 13 extra equations are obtained. These extra equations combined with Eq.(25)can be

written as:

λ8

λ7

· · ·

λ2

λ1

λ0

.. . ... ... ... ...

λ

8

λ

7 · · ·

λ

0 8

λ

8 7

λ

7 · · ·

λ

1 .. . ... ... 8

λ8

7

λ7

· · ·

λ1

15×15

m14 1 m13 1 . . . m2 1 m1 1

=0. (26)

Similarly, the sufficient and necessary condition for Eq. (26)to have nonzero solutions is that the determinant of the coefficient matrix is equals to 0. By denoting the coefficient matrix as D, then the singular condition equation for the input parameters is expressed as:

det

(

D

)

=0. (27)

By detecting and controlling the input parameters according to Eq.(27)in the actual operation phase, the manipulator could avoid falling into singularities in a more direct and effective way. In motion planning from the input parameters, Eq.(27)can be applied to singularity-free path design.

Eq.(27)would be overly complex after expansion because it contains the singularities of all of the configuration spaces. However, in practice, the manipulator usually only operates in the basic configuration spaces, and therefore, the singular conditions of the input parameters in the basic configuration spaces are more meaningful. Fig.3 shows the singular loci of the attitude angles in the interval of [ −50 °, 50 °], which almost includes all of the general attitude simulation angles. Therefore, it is feasible to obtain the singular loci of the input parameters in the basic configuration spaces by the inverse kinematics of each point in Fig.3. The results are shown in Fig.9.

(11)

Fig. 9. Singular loci of input parameters in basic configuration spaces.

Compared with Eq.(27), the singular loci of the input parameters given in Fig.9are much simpler and more effective in practice.

5. Conclusion

This paper focused on the forward kinematics, the configuration spaces, and the singularities of a 3SPS +1PS parallel hip joint simulator. This work is constructive as a new method for singularity avoidance in parallel manipulators based on the input parameters. First, the forward kinematic model is built with a single input–output equation of a higher degree. The singular loci of the pose parameters are obtained according to the rank reduction of the Jacobian matrix. It is determined that when the attitude angles are larger than certain values, the singular loci are extremely complex. As the attitude angles become smaller, the singular loci degenerate into a single surface. Then, the positional relationships among the different configuration spaces and how they will affect the singularities are analyzed. The configurations are divided into two types of spaces according to their distributions, and it is determined that in practice we only need to concern ourselves with the basic configuration spaces. Finally, the singular condition of the manipulator is proved to be equivalent to when the univariate-form input–output equation contains a repeated root in the real number field. Therefore, the singular condition equation of the input parameters and the singular loci of the input parameters in the basic configuration spaces are obtained. Overall, the method proposed is applicable to other types of mechanisms if the mechanism could be proved to only possess forward singularities and if the analytic model of the forward kinematics could be converted into a univariate-form polynomial equation. This work provides a new method for singularity avoidance in a parallel manipulator, especially for the singularity-free design in motion planning from the input parameters.

Acknowledgment

Financial support for this work, provided by the National Natural Science Foundation of China (Grant no. 51275512), the Foundation Research Project of Jiangsu Province (Natural Science Foundation) (BK20141128), the Priority Academic Pro- gram Development of Jiangsu Higher Education Institutions and the Fundamental Research Funds for the Central Universities (Grant no. 2013RC07), are gratefully acknowledged.

References

[1] G. Cheng , X.L. Shan , Dynamics analysis of a parallel hip joint simulator with four degree of freedoms (3r1t), Nonlinear Dyn. 70 (4) (2012) 2475–2486 . [2] R.A. Srivatsan , S. Bandyopadhyay , A. Ghosal , Analysis of the degrees-of-freedom of spatial parallel manipulators in regular and singular configurations,

Mech. Mach. Theory 69 (2013) 127–141 .

[3] C. Gosselin , J. Angeles , Singularity analysis of closed-loop kinematic chains, IEEE Rob. Autom. 6 (3) (1990) 281–290 .

[4] H. Li , C.M. Gosselin , M.J. Richard , B.M. St-Onge , Analytic form of the six-dimensional singularity locus of the general gough-stewart platform, J. Mech. Des. 128 (1) (2006) 279–287 .

[5] H.B. Choi , J. Ryu , Singularity analysis of a four degree-of-freedom parallel manipulator based on an expanded 6 × 6 Jacobian matrix, Mech. Mach. Theory 57 (2012) 51–61 .

[6] J. Schadlbauer , D. Walter , M. Husty , The 3-Rps parallel manipulator from an algebraic viewpoint, Mech. Mach. Theory 75 (2014) 161–176 . [7] J.P. Merlet , Singular configurations of parallel manipulators and Grassmann geometry, Int. J. Rob. Res. 8 (5) (1989) 45–56 .

[8] G. Cheng , W. Gu , S.L. Jiang , Singularity analysis of a parallel hip joint simulator based on Grassmann line geometry, Chin. J. Mech. Eng. 48 (17) (2012) 29–37 .

[9] S. Amine , M. Tale Masouleh , S. Caro , P. Wenger , C. Gosselin , Singularity analysis of 3t2r parallel mechanisms using Grassmann–Cayley algebra and Grassmann geometry, Mech. Mach. Theory 52 (2012) 326–340 .

[10] Z. Huang , Y. Zhao , J. Wang , J. Yu , Kinematic principle and geometrical condition of general-linear-complex special configuration of parallel manipula- tors, Mech. Mach. Theory 34 (8) (1999) 1171–1186 .

[11] Z. Huang , L. Chen , Y. Li , The singularity principle and property of stewart parallel manipulator, J. Rob. Syst. 20 (4) (2003) 163–176 .

[12] B. Li , Y. Cao , Q. Zhang , Z. Huang , Position-singularity analysis of a special class of the stewart parallel mechanisms with two dissimilar semi-symmet- rical hexagons, Robotica 31 (01) (2013) 123–136 .

(12)

[14] F. Park , J.W. Kim , Singularity analysis of closed kinematic chains, J. Mech. Des. 121 (1) (1999) 32–38 . [15] K.H. Hunt , Kinematic Geometry of Mechanisms, Clarendon Press, Oxford, 1990 .

[16] J. Gallardo-Alvarado , J.M. Rico-Martínez , G. Alici , Kinematics and singularity analyses of a 4-Dof parallel manipulator using screw theory, Mech. Mach. Theory 41 (9) (2006) 1048–1061 .

[17] H. Fang , Y. Fang , K. Zhang , Reciprocal screw theory based singularity analysis of a novel 3-Dof parallel manipulator, Chin. J. Mech. Eng. 25 (4) (2012) 647–653 .

[18] Y.X. Wang , Y.T. Li , Disturbed configuration bifurcation characteristics of gough–stewart parallel manipulators at singular points, J. Mech. Des. 130 (2) (2008) 022304 .

Cytaty

Powiązane dokumenty

Mówimy tu o medialnoĤci dominujĈcej takie kategorie, jak: jakoĤciowo nowa charakterystyka odbiorcy edukacji ery cyfrowej, trendy i urzĈdzenia techniczne

Instead, the paper of Avalos, Lasiecka (2002a) provides a proof that the optimal rate of singularity for the associated minimal energy is O(T − 5 2 ), which is in agreement with

It ensures that the trajectory of manipulator will be continuous even in singularities because the solution is constrained (in this method there are not singularities, the

Po szkicu ogólnego tła historycznego' porusza sprawy bibliografii i jej potrzeb, zastanawia się obszerniej nad historią książki na tym te­ renie, wreszcie wysuwa

This new limit analysis theory is based on an older, forgotten, Airy stress function, and shows e.g., by the new approach and application to wood, that there is no

Zaszczycona propozycją Senatu Uniwersytetu Śląskiego w  Katowicach do­ tyczącą przyjęcia funkcji recenzenta dorobku Doktor Jolanty Wadowskiej­Król w związku

He insists that the confirmed correlations of mind and body, as well as the influence of bodily states on the I-field or the internal states of the I-substance “does not imply that

In this paper we give a version of the theorem on local integral invariants of systems of ordinary differential equations1. We give, as an immediate conclusion of this theorem,