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.

Preleminary function definitions<br />

Initial values<br />

θ 2<br />

δ 1<br />

( )<br />

pcss , , r,<br />

α3, α4, a5 :=<br />

δ 2<br />

:= 1.42929552<br />

:=<br />

:=<br />

θ 1<br />

δ 2<br />

( )<br />

Q:= 3⋅r1 θ 4<br />

δ 3<br />

:=<br />

:=<br />

θ 3<br />

δ 4<br />

⎛<br />

⎜<br />

⎜<br />

⎜<br />

⎝<br />

Fixed construction parameters<br />

⎛<br />

⎝<br />

⎞<br />

⎠<br />

θ 6<br />

δ 5<br />

:=<br />

( )<br />

B:= r2−r1 :=<br />

Objective function definitions<br />

θ 5<br />

δ 6<br />

( )<br />

( )<br />

φ i<br />

δ 4<br />

π<br />

:=<br />

2<br />

( )<br />

C:= 3⋅r2 ( )<br />

( )<br />

( ) sin( α4) := 1<br />

( )<br />

( )<br />

ss ⋅ cos α3 ⋅ sin α4 ⋅ a5 + c ⋅ cos α4 ⋅ a5 + r⋅c −c ⋅ cos α3 ⋅ sin α4 ⋅ a5 + ss ⋅ cos α4 ⋅ a5 + r⋅ss sin α 3<br />

π<br />

π<br />

c1 := cos⎜ 90 ⋅<br />

s<br />

180<br />

1 := sin⎜ 90 ⋅<br />

180<br />

⎡<br />

⎣<br />

⎤<br />

⎦<br />

⎛<br />

⎝<br />

⎞<br />

⎠<br />

⋅ ⋅ a5 π<br />

π<br />

c2 := cos⎢( 90 + 120)<br />

⋅ ⎥ s<br />

180<br />

2 := sin⎢( 90 + 120)<br />

⋅<br />

180<br />

⎡<br />

⎣<br />

⎤<br />

⎦<br />

π<br />

π<br />

c3 := cos⎢( 90 + 240)<br />

⋅ ⎥ s<br />

180<br />

3 := sin⎢( 90 + 240)<br />

⋅<br />

180<br />

i:= 1.. 6 r1 := 1 r2 := 1.5<br />

Input Coordinates<br />

θ 1<br />

⎡<br />

⎣<br />

⎡<br />

⎣<br />

⎤<br />

⎥<br />

⎦<br />

⎤<br />

⎥<br />

⎦<br />

r 2 should be greater then r1<br />

π<br />

π<br />

π<br />

:= ( 105)<br />

⋅<br />

θ 3 := ( 87)<br />

⋅<br />

θ 5 :=<br />

( 112.61986495)<br />

⋅<br />

180<br />

180<br />

180<br />

2 2<br />

D:= r1+ r2 + r1 ⋅ r2 δ 6<br />

⎞<br />

⎟<br />

⎠<br />

:= 1.42929552<br />

83

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

Saved successfully!

Ooh no, something went wrong!