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 ...
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