levelsets in workspace analysis. f(x,y,z) = s1(z). s2(x,y,z) = 0 s2: algebraic surface of degree 12

31
Levelsets in Workspace Analysis

Upload: alden-clover

Post on 02-Apr-2015

218 views

Category:

Documents


2 download

TRANSCRIPT

Page 1: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Levelsets in Workspace Analysis

Page 2: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Levelsets in Workspace Analysis

22 rX zY

F(X,Y,Z) = S1(Z) . S2(X,Y,Z) = 0

S2: algebraic surface of degree 12

Page 3: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Posture change without passing through a singularity

Page 4: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Singularities of parallel manipulators

Page 5: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

rational parametrization

M. Noether

Page 6: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Architecture SingularitySelfmotion

Definition: a parallel manipulator is called architecture singular if it is singular in every position and orientation.

Det(J) ≡ 0

H. and Karger, A., 2001

Karger, A., 1998

Page 7: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Architecture SingularitySelfmotion

System of equations describing the kinematical constraints has to be

redundant affine variety is no longer zero dimensional

Planar case: only one possibility parallel bar mechanism

Parallel Manipulator performs a self motion when it moves with locked actuators

Page 8: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Architecture SingularitySelfmotion

H. , Zsombor-Murray, P., 1994, ''A Special Type of Singular Stewart Gough Platform''

Blaschke‘s movable octahedron

Topic is closely related to an old theorem of Cauchy (1813):„Every convex polyhedron is rigid“

Page 9: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Architecture SingularitySelfmotion

• Self motions of 3-3-platforms are well known since more than 100 years (Bricard 1897)

• Self motions of platform mani-pulators are closely related to motions with spherical paths

• Motions with spherical paths were the topic of the 1904 Prix Vaillant of the French Academy of Science

• E. Borel and R. Bricard won the prestigeous competition and gave many examples

• All architecture singular manipulators have self motion

• Still many open questions

Page 10: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Architecture SingularitySelfmotion

• Bricard‘s octahedron• Griffis-Duffy platform

Griffis, M., Duffy, J., 1993, "Method and Apparatus for Controlling Geometrically Simple Parallel Mechanisms with Distinctive Connections", US Patent # 5,179, 525, 1993.

Page 11: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

GD-platforms

Page 12: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

6-AS-mechanisms

Inverse kinematics of concatenations of AS-joints

4 AS-mechanism: dimension of the problem 48

6 AS-mechanism: dimension of the problem ?????

Page 13: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Analysis and Synthesis of Serial Chains

Lee and Liang (1988)

Raghavan and Roth(1990)

Wampler ,………….

Inverse Kinematics of general 6R-chains

Synthesis of Bennett mechanism

Veldkamp, Roth, Tsai,

McCarthy, Perez,…..

Page 14: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Discussion of the Inverse Kinematics of General 6R-Manipulators

Page 15: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Constraint manifolds of 3R-chains

Page 16: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Constraint manifolds of 3R-chains

Page 17: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Constraint manifolds of 3R-chains

Page 18: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Constraint manifolds of 3R-chains

Page 19: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Constraint manifolds of 3R-chains

H. et. al. (2007), Pfurner (2006)

Page 20: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Example Puma

Page 21: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Example Puma

Page 22: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Example Puma

Page 23: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Exceptional 6R-chains (overconstrained chains)

Page 24: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Exceptional 6R-chains (overconstrained chains)

Page 25: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Exceptional 6R-chains (overconstrained chains)

Page 26: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Synthesis of Bennett mechanims

Previous work:

Veldkamp (1967) instantaneous case: 10 quadratic equations elimination yields univariate cubic polynomial with one real solution

Suh and Radcliffe (1978) same result for finite caseTsai and Roth (1973) cubic polynomialMcCarthy and Perez (2000) finite displacement screws

Page 27: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Synthesis of Bennett mechanims

intersection of two three-spaces L13, L2

3 in a seven dimensional space P7 can be:

• dim(L13Å L2

3)= -1, ) intersection is empty,• dim(L1

3Å L23)= 0, ) intersection is one point,

• dim(L13Å L2

3)= 1, ) intersection is a line,• dim(L1

3Å L23)= 2, ) intersection is a two-plane

• dim(L13Å L2

3)= 3 ) L13 and L2

3 coincide.

Linear 3-space

Page 28: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Synthesis of Bennett mechanims

3 Conclusions:

• The kinematic image of the Bennett motion is the intersection of a two-plane with the Study-quadric S6

2.

• Bennett motions are represented by planar sections of the Study-quadric and vice versa.

• Bennett linkages are the only movable 4R-chains.

Page 29: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Synthesis Algorithm

1. Given three poses of a frame 1, 2, 3 compute the Study

parameters ! A,B,C (three points on S62)

2. Compute the conic f(s) passing through A,B,C

3. Apply inverse kinematic mapping (-1): Substitute the parametric representation of f into transformation matrix ! parametric representation M(s) of Bennett motion.

4. Compute the axes of the motion

– Following Bottema-Roth (1990)

– Computing planar paths

– Using the fact that the points of four planes have rational represenations with elevated degree

Page 30: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Synthesis Algorithm (example)

Computing the torsionfree paths to obtain the axes leads to four cubic surfaces having six lines in common.

Page 31: Levelsets in Workspace Analysis. F(X,Y,Z) = S1(Z). S2(X,Y,Z) = 0 S2: algebraic surface of degree 12

Conclusion

• Mechanisms can be represented with sets of algebraic equations.

• Constraints map to algebraic varieties in the image space.

• Geometric preprocessing and symbolic computation allow to solve kinematic problems

• The algebraic constraint equations are highly sparse.