19.07.2013 Views

Kinematic and Dynamic Analysis of Spatial Six Degree of Freedom ...

Kinematic and Dynamic Analysis of Spatial Six Degree of Freedom ...

Kinematic and Dynamic Analysis of Spatial Six Degree of Freedom ...

SHOW MORE
SHOW LESS

Create successful ePaper yourself

Turn your PDF publications into a flip-book with our unique Google optimized e-Paper software.

v v v<br />

P4 = yv<br />

N 4 − zv<br />

M 4<br />

v v v<br />

R4 = xvM<br />

4 − yv<br />

L4<br />

v v v<br />

Q5 = zv<br />

L5<br />

− xv<br />

N5<br />

v v v<br />

Q4 = zv<br />

L4<br />

− xv<br />

N4<br />

v v v<br />

P5 yv<br />

N5<br />

− zv<br />

M 5<br />

= (4.2)<br />

v v v<br />

R5 = xvM<br />

5 − yv<br />

L5<br />

To define the components <strong>of</strong> radius vector ρv(xv,yv,zv) in Cartesian coordinates, we<br />

need three equations. Solving<br />

where<br />

v v v v v<br />

L12 = M 4 N5<br />

− N4<br />

M 5<br />

x<br />

v v v<br />

Q4 P4<br />

, P5<br />

Using some <strong>of</strong> the components <strong>of</strong><br />

v<br />

=<br />

v<br />

, for xv, yv <strong>and</strong> zv we get:<br />

( )( ) 1<br />

v v v v v v v −<br />

L4P5<br />

+ M 5Q4<br />

+ N5<br />

R4<br />

L12<br />

( )( ) 1<br />

v v v v v −<br />

= M 4 P5<br />

− M 5 P4<br />

L12<br />

( )( ) 1<br />

v v v v v −<br />

= N P − N P L<br />

y (4.3)<br />

z<br />

v<br />

4<br />

5<br />

5<br />

ν<br />

E 4 <strong>and</strong><br />

4<br />

12<br />

ν<br />

E 5 in equation (4.1), one can find from<br />

(4.3) the coordinates xv, yv, zv <strong>of</strong> the six intersection points <strong>of</strong> screws, lying on the moving<br />

platform. Since we know the distances between the points, we can write the following<br />

equalities (Figure 4.2).<br />

|A 1 – A 2 | = |rb – ra| |A 3 – A 4 | = |rb – ra| |A 5 – A 6 | = |rb – ra|<br />

|A 1 – A 3 | = ra<br />

|A 2 – A 4 | = rb<br />

3 |A 3 – A 5 | = 3 ra<br />

|A 5 – A 1 | = 3 ra<br />

3 |A 4 – A 6 | = 3 rb<br />

|A 6 – A 2 | = 3 rb<br />

|A 6 – A 1 | = r a + rb<br />

+ ra<br />

rb<br />

2 2<br />

|A 4 – A 5 | = r a + rb<br />

+ ra<br />

rb<br />

2 2<br />

|A 2 – A 3 | = r a + rb<br />

+ rarb<br />

2 2<br />

(4.4)<br />

41

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!