mechanics and control in robotics

570
www.mohandesyar.com

Upload: mohammad-safaeipour

Post on 16-Feb-2018

234 views

Category:

Documents


0 download

TRANSCRIPT

  • 7/23/2019 Mechanics and Control in Robotics

    1/569

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    2/569

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    3/569

    )

    Jjse{iKo

    1o

    .$\g:

    ."foQ

    Grl'tno

    ,*

    ffc

    Aor;

    ,.Jtf.l;"

    o}

    li

    Ur',\.i,.

    *f.i

    *

    otff.ils

    -.L

    \3l.;tii,l

    L-9.

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    4/569

    Introduction

    to Robotics

    Mechanics and

    Control

    (Second Edition)

    John

    J. Craig

    Addison-Wesley,

    1989

    .+1"

    ill)Liitl'at-,,t

    9"

    .4.i

    G;t;'o

    oKiilc

    $lu2'>

    J}'-{i

    '4lK,.

    3---5ot? .-cJ'ir

    g)F-t

    ojU

    c6;;tJL

    * 4;

    L;l;il

    tj-;"t^-.,.'.u\1J

    |t,g

    ce-rr--:

    ,*

    olK-;jl.,r"l"

    ..lbt-:.jl

    'r*,3-

    \fAO:fr

    Vb

    iooo: tfJL-i

    JU-Jfqooo

    lt.6,

    ?q

    J*"

    ful;",q

    :;v,-e

    r

    ?q

    ..:*,1

    LtU," i-t''

    ISBN 964-6379-29-X

    12f-tfvq-Yq-X

    .it-i

    Craig,

    fohn. J.

    -\ loo

    r.tia rci-f

    ;i:.o

    o\3.:.itr'.b\r+

    --.*l-\rcr*

    i \i rg.f.ri.

    J*,--;

    \

  • 7/23/2019 Mechanics and Control in Robotics

    5/569

    A)

    oriI

    o+:-

    \

    \

    f

    \2

    Y\

    Y\

    Y\

    YV

    rr

    fo

    r\

    fr

    Y7

    7Y

    ?Y

    e)l

    ,>*)l

    *Ul

    ,.."{

    9JtI"

    c.,;.Jlt

    .r

    -

    L-?

    ^

    u*..tt;l*4*,

    LlJli

    '^td

    ,t

    ,gj:;'K.Z,a,

    .;JVrKi:*

    {.Jir

    \

    &--j \- \

    -'"t

    uSlS,

    ,.st"rrtr

    J.J:

    .SJli

    f

    -

    \

    6rljf)Lr

    f-

    \

    ,r5.*L"i

    g;t{lJr..l

    t

    14

    i

    Y

    a..li-

    \-Y

    h-rtrh

    ),t+-;r4.,t+t(,

    :tgi,.-; Y-Y

    -&-t

    ,--/4i

    +

    Ln3'.r$

    ;t

    \;*-;

    srlr.,-i;

    ,t{IK

    f-Y

    ,166t$-+

    r

    ,l+Lrt

    ,tdh:;l

    rterfu^r f-Y

    Llrr+

    i.-)E

    0- Y

    "5

    'l

    +

    I

    nbL-t

    't&

    ?-Y

    f[,--u

    s;t^dJrL

    V-

    Y

    6;+

    u,iti

    i.r .rr

    ,rt *JA

    A-Y

    rbT

    6tArl.ry

    ,,[.l";

    1-f

    ,Jl.-,t

    .,.

    crUi-),

    \.

    -Y

    ,at,

    ,rd;lS,

    g[nlt?

    .SJl.r,-, f

    +.;L \-f

    L.1.,

    -;*;

    Y-r

    VV

    VV

    VV

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    6/569

    A\

    Ar

    c\\

    10

    \7

    \"

    t

    \\Y

    \\Y

    \YO

    \YO

    \YO

    \TY

    \rf

    \F"

    \TY

    If0

    \OP

    \04

    \04

    \AT

    \tq

    \t1

    \21

    \VT

    \VP

    \Ar

    \AY

    \AA

    \t\

    \tf

    \1V

    hl.,

    Jl--;l

    -\-;

    f-f

    L+hl

    +

    t+ata3

    JLdl

    6 11

    rl:-2 a

    f-f

    ,ot

    ,rStS,.

    ,sto.u

    .SJt^+ 0-r

    A16,

    g;L;i

    2,j-d.

    g;L;i

    .g;;l.sl25G[;i

    7-Y

    ,P; :,,

    9:

    &L'.::,,

    ,t+Jti

    V-f

    slsLl

    ,rtj.[

    t

    ,sl+-rrt.6a

    A-f

    sc*175r l

    1-f

    GQI*,

    c.,tl--)L

    \"- "

    ,at

    .r$lS"

    .sla-r;tl

    4ub

    .iJt-.-,

    f

    a..tir

    \-f

    ,r:r

    r-t

    J*

    Y-f

    n

    1

    ? .:JL

    -r);^L

    uSJts,

    ,,s511

    61;j2;

    ctrljft[ f-f

    u-,JlA

    J-'b

    .Jrb.,t

    .s-*

    J-. ,

    f-f

    6laL-.1u,-

    {

    "},--tr

    ,t-}

    jl

    cs-*

    J-' ,

    0-f

    ,,t.i.;

    .5'-

    rt

    *b

    tp

    t*'

    ,slt

    -e-\

    ,F

    'ia

    ?-f

    ,at

    ,rs,;K.

    .-Etol

    irrb.tnl^.=-;l

    .r-ttJL

    V-f

    :rllt:-l

    (J;h-r?.r[+t

    A-f

    /t

    .-(;t5.,

    ,-rt"rt:

    cr[

    SOLVD

    Llr;r,-;;l ,rtc-l

    t-f

    ,sy-i,rl$5,tjr

    \"-f

    jt*t^..

    c,th--)L

    \

    \-f

    .,5aih-l

    1rblp.l

    kryW:f[

    0

    a,.li,

    \

    -0

    ;L;

    ;t-

    ,s;ri-r

    iL(,

    slr

    ,s.rljfr*

    Y-O

    ,-J*

    f

    t--*l

    GLst

    t

    ;Lt

    t>cr*

    f-0

    g'l*-3li

    ,--c- i.rl*-r:

    -Q;tL

    f -A

    crlr:,'

    GW

    8)o

    0-0

    -&-t

    kl.,

    +

    &.t;l

    c,.c-

    aicblu

    ,5"&

    ?-A

    Li*tlj

    Y-0

    c"S6tCL

    A-0

    ,"L

    ,_$t5.

    tst"ri ;r

    f;b-l

    ut"ri

    t-0

    si

    i:r.,,

    h*-f

    lj

    \

    .

    -0

    ,h

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    7/569

    \tr

    Y"t

    Y. t

    Y\"

    r\Y

    Y

    \V

    Y\1

    rYr

    Yrf

    YYA

    Yr"

    Yr0

    rrA

    Yf"

    YT\

    Y6A

    Y00

    YOP

    YOV

    rYF

    YYA

    rA\

    rAr

    YAr

    YA0

    Yrr

    Ylr

    YTF

    YTV

    l'"

    l'

    ",$l-l

    sb-rr*

    s

    W-

    ar6,

    ;l.s

    \ \-6

    jt,

    ,15.,;15..,

    g[arib

    .dpQr

    f

    a..tir

    \-P

    vJ-

    p...-

    ,-lL:

    Y-?

    ilt

    ei-i

    Y-?

    ,L;l

    iJ:L

    -Ui

    iJ:L

    f

    -?

    -Arl-

    ui

    d$,rS"L.,-t

    d,t-t^".

    o-?

    d-:

    Jf-

    ,"

    U;t^aJrL

    s

    6tl$ u;tlrJrL

    ?-7

    {*i

    .ts#ti-r

    u;laalrL;l

    ;M

    Y-?

    ,nt

    "$lt

    tstt'r

    ,,fuQr

    U;tadJrU,

    JL;L

    h-7

    ,rSrtS,

    cstr-rrtr

    uS-tt-)

    gtralrl..

    brtT

    c^..,)a

    I

    j$^t

    ')a

    \-?

    ar6t

    c;t-oi

    ;r

    ptS.

    cstlr;

    ,rS"rli-r

    1-5;balrh.

    irll

    c^-.,)dr

    \

    "

    -P

    dp*

    g,ilr;l

    &J\\-2

    .,S.,q)

    6iLal

    \

    Y-P

    cttt-t^,.

    c.,tl'-)L

    \

    f-2

    .,*

    4i

    e..li.

    \

    -Y

    -.-

    $; 3

    ,J=.-;

    trtur

    ,rl ;tl-)t

    Y-V

    ;l*L

    6[-ai

    al+::,'

    f-Y

    .rr5t

    6Vi

    sWa

    f-V

    ,-116,

    ,s6_*

    .,...[,a

    &)[t-i

    0-V

    ts

    -

    S

    L\

    csll

    f

    fu

    .rt

    ,.-.-

    s);

    ?-Y

    ; -r,,

    Ga-1a.l.r;

    r ;

    ti

    r*

    ryt

    V-V

    ,ri,ti-r

    J.u;l

    orlc-l

    \

    -*

    ,sj.f-h

    A-V

    \*t

    )l

    qG

    u;[+i..- Ls]-f]

    t-V

    ,at

    ,rS,jlS"

    s:;

    fjJtfu

    ,f*

    A

    cr -r,,

    ;l

    oli

    t*lfcrt=Lc

    L-1,

    t

    fr

    ):l

    ,#Lr.-

    6+J:i,

    f-A

    615

    6L,bi

    alehL.

    ui5

    15t6Jt',

    f-A

    ;i

    (_r

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    8/569

    r.A

    r\\

    r\r

    rY.

    rY\

    rrr

    rrr

    rrr

    YY?

    rfr

    rrv

    rrl

    r0.

    r0r

    r0F

    rt\

    rtl

    rPl

    rv.

    rv0

    rv0

    rYV

    rAr

    rA0

    rt.

    r10

    f.6

    F.0

    1"7

    1.."

    ?

    &.r

    r

    x-l;

    6a;i

    ut^.;L

    0-A

    u;lilr6

    cWy

    7-h

    ,P

    Jgr-td

    :

    rfu

    Y-A

    ;t^L

    ,".-

    A-A

    ti

    U*

    t-A

    ,aU

    ptS,

    s[a.ut?

    ,rb

    $rS

    1

    a,.ti- \-1

    (4+i)

    "ul.,'--.

    s

    4

    tlv

    J-J

    Y-'\

    1:r

    i>.,r:

    ,li

    6L+;

    .

    ,

    f-'\

    p)

    1"J)

    s['.

    =

    '

    J,"S

    f-1

    #5

    i;b

    F

    0-1

    .*,

    ,*i.r-

    J.;S

    ?-\

    ;t

    ;-,

    I

    gi:

    Y-1

    eir)

    {*.jrtti

    )

    LE

    r-t|:

    J}

    A-1

    t{:;

    J-"t

    .5.-

    JFI

    ,.sjLJ-

    t-t

    ,p

    c,t:r.r

    .5"-

    ;-r:5$5;L;L

    \'-t

    ,rt,

    ,rS;15,

    rsb./\

    &-*

    Jt:t\

    "

    +.-li,

    \-\'

    ;b -,P),F*15lc-:'Y-\"

    Lt)f

    Ji>45:se

    r+

    JF

    tJlC

    ''

    :

    f-

    \'

    ,"t,

    "$tS,

    ,-st^:,ilr

    JFf

    -

    \'

    ,rLs

    drE-)L

    0-

    \'

    6btl

    ,p

    st+ r,,

    J;5

    ,st

    I

    '

    "

    P-

    \

    "

    iiy.U

    cE-rl*1,

    JJ^,-

    V- \.

    ,;5:

    ;L.a:;...

    t 'P

    l;:561+;

    "=-"

    A-\'

    'j=h

    Jr=51-

    \

    "

    ,lt,

    .r$tS,

    g[al :r.U,

    Jt

    t\

    \

    ar,ti,

    \-

    \ \

    jE_f

    ;tJ^c

    J5

    L;':r

    cst+trr,r

    sttS

    Y- \ \

    G?

    t):

    {i

    ;t=Ls

    t'

    J-J JL'l

    =*rV

    f-\

    \

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    9/569

    r\r

    r\r

    r\A

    fYr

    frr

    rrr

    rrf

    rrv

    rrr

    rrr

    r0\

    f61

    F0r

    r?Y

    r?Y

    rvt

    rAY

    rAV

    rAr

    F1r

    F10

    a't

    0Yl

    0fv

    :r-itS,

    '#;

    J15'al:*

    F-

    \ \

    t'1r

    fr-u:x

    J.JA-\\

    r*-itL

    '#;

    J/

    ,jaP-\

    \

    ,c-f

    dt-,st+ :, JF

    ,slf

    ',aV-\

    \

    e -r,,

    6J1bU1

    gt+ ;

    j

    le

    s .,.

    u \

    y

    a.-Li. \-\Y

    ; l

    csa-1ulr;

    iF

    -

    Y-

    \ Y

    dr

    u'ttt5f-

    \ Y

    ; :.,

    rst-tu\t

    l\t oU. p)

    l- r: f-\

    f

    ;rtrf,'

    LSal+,Lr1; ;

    a-

    a

    4f

    15:j-l60-\

    Y

    ; :,,

    ts1_1uti

    .st+t

    ;

    t)

    o;;-s

    Jtrt...

    t-

    \

    Y

    J+

    6:b

    tsJfebr,lt5lf

    ;,:"u

    \t'

    a..-ti.

    \-\f

    OLP

    g;t1:=.

    1;;_-t dtLy-\r

    Cim

    't3;*-l

    f-

    \

    f

    OLP

    13;t+;*-

    -t5

    ,t't;LJ^.c

    ;r*Usl

    f -

    \

    f

    ;hL;:;

    l-121

    'a-c2-a-

    ,slJ

    dqVJ

    ....=1

    6tr:1r.2 f

    f

    +ur3.1

    ,:.,1:4-t+

    L.l:,

    &t

    C

    turr*

    t+n;

    jl

    cft

    t

    fL'

    )

    c*,3,*r

    ulkfu-rl.i

    a,.Ur;13

    u-JV=sJkl

    a.Lo3l5

    L..ll

    c*r+

    C^4.A

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    10/569

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    11/569

    ;)L,.PJt:.irfuf

    L-;,r -l-rr.,[

    g;;;6 ,a.S".t:,-:9

    &;l ;,

    .:.S;Lyr

    Lrr),\fPV

    JL;* r,

    'K;-U;T

    jT

    Jtt,

    a

    s

    ,'6l.tl.A-;

    ,p

    063;1,

    lJtS,

    Lf

    +

    r.r5..iil:_2:

    c*i.j

    fr-,-

    ,

    jW

    ,t3-:-L;T

    U-l

    ,rJ;

    JL

    r,

    .s

    ,*'b

    orS,.j.jl:

    ,t-l

    tr

    .Soti-x

    r

    lolr:.,

    4rr

    6,,

    L)

    Ma\'.

    "

    "

    s

    ,lu:7rT

    t-1..

    ,slt

    ,stl:i

    L)t

    ,j*

    L)

    MaY

    "

    o

    .

    i,

    J)

    6-J

    )

    ,i::t,S;r$.u,u.+L

    cf-L=i

    ,st+-..=-

    ,(.-r:.r,r1

    I

    ,* -J

    r-ti.

    ,sD.

    ,stl:T

    .,>*l

    br*U-;l

    ,sD

    pl,'(,

    6taatft-:

    -15a1

    crL)tt

    .al

    ,i,

    i-r.;.1)

    ,c*l

    ,;b;t=*r

    6la:-.i

    L

    y"5

    y.Srtr:,

    .5

    ta;i-;l

    osli-l

    ,fJli

    JrL;l

    atS,l

    .r-

    b,:rl.e,.

    cl-l-r).,qlor;

    alty,DlSr

    vlS

    rlll:

    r;i1

    +

    +V;rr;

    ;LI

    ,sla.t;lt;r.,6"

    ,r*-6;l

    .st",;l:

    ."r

    rhU

    ,I

    ,-fG

    Ll

    ,o.u

    trl:'

    'l

    .slJ.E

    s,?l

    'Jd

    dtil

    vlkl

    \ g5r1u

    LL,3l5

    vt5rL-t.r,

    ,,r-Jll

    .-st".;lr

    t+JL

    J--L

    a-t:,y-l .c*l

    '.uT

    (r)

    (>-r-;)t

    7lS

    ex-f,6t+_r-

    t

    6*ti

    ,;[ra,.,.ll:

    .:-;ll

    :.9-.1

    ;J.l.:[]f.rr

    9

    c*l

    c*;j

    fi-r-

    L-;.s=r-t

    r,

    ,t.tt

    t-t-tJj

    :ly

    ,Jt.f, j. L-r;#

    c^fi.r,

    trilr

    r;t-J:L

    6rtrr,

    .7[5

    u6sb;

    utorlr.

    .-,

    .): $li

    b4-,-

    j(::-l

    ,il**

    ojbaj,iae

    ,),s.

    rl^

    \-t'_;

    '+-

    oll-Ljl:

    \ f Vf

    ot,i.e.-l

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    12/569

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    13/569

    Introduction to

    Robotics: Mechanics and

    Control

    John

    J.

    Craig

    Preface

    to the Persian Edition

    It

    was

    with

    great

    pleasure

    that

    I

    learned

    that

    this text

    book would

    be

    translated

    into

    the

    Persian la.nguage.

    The book

    is now

    available in

    En-

    glish,

    Japanese,

    Korean, Polish, Italian, Chinese,

    and

    Persian.

    I hope

    that

    readers of the Persian la,nguage

    find my

    efforts

    in

    writing

    this

    book

    were

    worthwhile.

    My

    thanks

    to

    Prof. Ali

    Meghdari

    and his

    students

    for

    this translation.

    John

    J.

    Craig

    August, 1992

    California,

    USA

    lr r, tt

    J-;S

    s.#1fu

    '&f

    d

    'it?

    &ri

    L_f)li,'/h;J

    urJhii+

    rlSu-l

    .pJ

    b-;rt-l

    ,.ld.rrp u>j

    Llrli

    rlr;

    t

    =5u-l

    f-u,.tJi

    S

    o,ts$

    s-?;1t

    u-ii

    )

    h,d-Ub-l

    ,,iL-6J

    ,clof

    ,,;,li

    ,u1kl

    ,st+ .;

    a

    r-;

    JL.r,

    ; J*:,-

    .+Q.

    ,t:ul

    t,

    ,.-,-Ut

    u-l

    r::t

    i

    l..g;t{-i)b

    i\t1.5-18,

    ul3xl;

    3

    pl:+-l.c*l

    .pl;

    6,,,-.li

    a---.r;

    U-l

    ,slt;t-r4:tre

    6-ll$.

    uk,Fu,q

    I

    :.9r

    4td

    it"

    \

    11

    Y

    ,c,jl

    ts,_r.l

    , ;J5

    o)jL_

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    14/569

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    15/569

    ,-dy.rhj(.;,,,

    .;bh

    1;Ul)13-

    ;l

    gslo^>

    i.r r,

    ,;[:;UIL

    f

    t+jl

    3 8'l

    u-L.-liJG

    ;trr.;tt

    e*ttL

    1t.s:Sun

    otaL

    b

    LVj

    y-l

    a-a,;[;l.u;1,aLL-i;le,;U.l(,-;j

    .x:-rTg

    .jUU..'+,,

    u-l

    ,r.

    LVj,(*^-:,9

    ,ft-^,6tat

    :l

    ,fll5

    c;U-:

    ,.,tr).Sr ,

    o.ti-,

    ' :.;

    t

    l+-

    6

    ,g*

    .iy;

    r

    .Snl

    :,

    ra::?ra

    .c-l

    ,J

    .Job

    rl.*

    , [-Jl 5f

    s

    i,:-r

    t

    +L:

    ..l5.f o:ti-l

    (-p)

    4;

    g'0.

    U

    L/+;l

    ,r

    p;

    r[5.:

    -2r

    ,x:s,r,

    .c*l

    c;L :,; ii:

    ?

    b

    ,stQ

    uc-'"t

    ,a-l

    af

    Ut ;l)r

    l,:

    i[;l

    L-;

    ,.u

    ,,t+l

    ulor5

    il

    ,A

    4;

    a

    ualJ,,l,-L;

    t, ,.Snt

    r,

    'a,J/.l-,.

    c-l

    ,,

    --ls

    ,6

    ,t-1.:ylr

    .5.-:y LVtl t"r-t*.5r ,tgl.l r5,tra-L.-

    ,l+1";tS.;l o:tj;-l

    .-r-21:;

    i;E;

    aJ-.*,)t5r

    6tac,.i-2;l

    (J;r&:,

    olh

    +

    6

    lf\f

    ,s .+.i

    il,-..tt,

    L-;'(;|

    ,

    c,tij;.jJ:;

    ,ql

    ,-u

    ,r-b;

    JLrr

    y

    U-ljl

    .r:

    Ll,-.,.So r,

    *:.f

    t

    6

    tf

    l+,

    .srl

    ll-i,ei*.ry-i,,r,

    ,,ta"l

    'c':u

    tV +

    I.S*tr-u

    ;.tljcl

    >rt'

    $^,.c-l

    '.,r.i

    F.-

    rft

    c6et

    +

    +'u

    U-l

    .r/

    F.J

    ,fi*,

    'i*

    :

    xst.*6'r[:

    ,cSr-:

    Jbl

    ,.,SJK.

    J|-cl

    ,Cl

    t*1

    ,;21dt-.

    .r.9.3

    ,g

    g*

    uSJtS,

    Jtrl ,-x1,

    :

    fr ,-ft *t,vl:5

    cr-lrr

    ,.5=;lS.

    l4i1r

    U-A-I

    6 :f

    u.

    cit_

    .jJ:;.

    .S-)[t

    :+;

    cr_.l;3

    yr

    p[1.,

    ,rcj

    ,c,l.iL-r

    r

    .Srrti

    L/+;l

    al+lrr

    A

    b

    \

    st+I,.-i

    .c*l

    1.;-5

    f*:,J-5'1--b

    b;-*6

    f*t;lL

    \rr

    \Y

    (., 'tcJ"ai

    :,J-J'r--bt

    GG-t-y

    \\ b

    t

    (JLcr.-i

    .rtrL,.lt

    3

    ,C-l

    rt:

    +5'U

    ,

    ,W,,JII-,.

    '*

    t

    *t:f

    u-|.1:

    ,03)lr t ..rrSg

    y.;

    ";J

    k1r

    jf-t-,

    Jtt-.

    e15

    rl;15

    ,ss,.,JlorJc.^.,

    .SJIS, tr -rr,;-+

    a5cit{l,-i

    .C-l oli

    c.S=1- g

    2.61^.,t6.D

    g,-,.2Ji

    u .2

    o:[',."l

    tt-f

    .,-iS6t+Lilr:L-

    6-u,

    ]t5,=lJ.rl

    ;l

    ,S

    e*1.-15i.^r

    J:l

    ,r-lt:J,\tAO

    JL

    b

    \tAf

    JLit, :l tt*Ll

    ot3;;lrrt

    ,r-A-:ls

    .c-l

    c.\^i

    ,.t-,-.2-$.&-,

    .rkftfu;|, u.lt.-:9

    :,rib-l;r \1AA

    b

    \1AP

    JL

    orl;-

    .l

    JtL

    d;L :+.s

    e

    6b.1-#

    e-lt:,-t-trJ

    jl

    ,j-;

    rr.*

    jl

    2b;

    ,J1l

    pl.tnt

    r,

    s

    6la.tL,r-2lr;,1

    ,-

    u ,--.;

    JLd,ruiL-l

    ot-fu.;|t.2:.c*l or-3

    ly

    lt

    9

    2cir\,

    u-si

    5,cSs- r

    JUi:;l

    ,g2:--at

    J*:,ftt

    f;

    p

    s;a2,-,lS

    d-t+

    'Fe

    sbl

    olF

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    16/569

    ;;Jl

    '-l;;16

    irer

    Jrl

    JL

    t_

    .rfr6

    ir3,

    prtq

    JL

    l,

    ,r-t,

    csD

    =6

    "t-i

    5

    ,u,EJi?

    ,6r.U,-r

    ,.S-;L-,|

    qsl{-tr

    ,'7":;lr

    c*l

    ;;a,JtL

    6t

    ,Sll.c*l

    .-li

    ,,

    6l+.sL

    qtt

    isbjf

    ,,5)lr

    1

    .r:

    ,;l,l.,S

    I

    It1

    +-

    ,st+t',;

    J

    ,t-

    a;

    u--ia.l1

    u-l

    st+.u

    J

    ,J1-.c^-J

    qs*

    Ul

    ,rJ.up

    SJ

    oGt;y.,.+

    6,

    *

    ,J-S

    L--b

    .SJ[S,

    Lr+

    jleJtL

    :l

    ,aQ,

    \

    -51..-lp#

    .,t

    b

    r

    o:L

    ;t,;

    t

    eJtL

    tutl

    ,'b5

    :l

    ,aQ,,rrfb-l

    otJi;lrr).st:

    .(it.(,

    t-r4,xjlF

    c^-J

    (J;i

    tl

    ,slot)

    ai3

    ..[lorl:

    ,

    ya.'.],-]u

    o:$-."'l

    ,.],1ti

    ,

    =6

    t-\,;Ul5:L-,

    s,-t:-S

    ilrzti.,Jr

    iL.r4,

    l-id

    4:,j 156"

    rlS

    ,7\u

    15F

    3

    6a

    J.S,r,L.uX,

    6la.c^*X

    Ltl

    tt,=l:f,y-l

    ,srlz,;tr)t l

    *-i

    i;

    .x1b

    162r-.Snt',r.,

    l.G,-rn+

    os

    rs-&-t

    tltl

    rsb

    Ll

    ,c*l or"i

    V,T

    .,191

    oa-

    t,

    ,s.r-

    E

    6t-rS

    6la1lall)

    ilaatu

    S

    tj

    aLa

    .r.2el,r,

    eV

    b

    JU,

    .l-

    J)

    ,c*,-

    i

    lJlJ

    ,S:-

    Ltt,:.,

    J.J:

    lJtS"

    t,

    Lny-*-,

    3

    6tlttl,JlL--a

    .-u.it,

    ,u-:l:

    ,raKT

    u:

    ,-r-l

    t5,.:t5

    u-l

    \A

    sl--'d

    lr.i--,'r..JtL.c-l

    o-ui

    ,|5-

    J-i

    \l-;l

    ,-t5y-l

    1::

    ,y-A-:

    -rr

    t

    ,.r.iL

    6l,r:i.r

    \ Y

    pr.5---1r

    .:t5.r--rs

    trll

    Jtt-l,Jlu-,--ri,.Jrb

    .flt

    6lc'i.r

    ;tl;.tr

    b

    u-:6

    i=S

    *iye.r^

    t

    Ul

    .li

    .iL

    t+,[.ai;l g;:l.u;

    '*ib

    u'i"':

    *

    ,,

    ,ili

    j

    ,c*l

    o.t..i

    aty

    aJ'

    ,

    ir-|l

    ,vt:J

    cr-l

    .r)

    .tf

    6tt

    '*

    ,*+.-J..

    gr-l

    .,p:

    UJV

    3

    c.*l

    ,+-f

    oJl-,-9

    .t-j.,g:l+',"tr,'

    Jbt.-

    ,F

    ,S\,,,:,'

    .i-

    ta-

    Qt;;-,

    #t

    U-l6\

    citt

    i5+,r-r,,

    .i-

    )S

    jL.,cr-ts,rt

    Jyu

    ;;1.;

    qglla -U

    q ."r

    L

    q,t{:l

    ,.x-fct'

    Lt,

    utts,.

    csta:,i

    i'JtL

    1l=;:-...

    aic*l

    6JAll

    oru-""|

    2c.4g

    oJi"?.r,..3-.

    &sj,csbt--,.i;

    il

    r;*.,4t,J,ti

    d,c-l

    o.ul

    G-/

    U-\,\

    Jt--i

    ':.*e;

    l=; r,'

    af

    r.2lr

    o,sj-*t

    ?--prr

    6-

    ,,r--

    .ra

    .c*l il)

    aL'

    dL6'--.r"

    ,JLi

    I

    o[-1,.r,

    ?--p.c*l

    oJi.,i

    d:-ij

    ctr

    6Jt^-i,

    jl

    ,r,

    ^,L-U\

    :

    e:J

    rf- :

    -2:

    o.1t-i

    c42-aa

    3J,-rll..r

    [0.]r,uLI:

    osL

    g;1i

    6r:^il-r

    ["

    "].r5.f

    r=i;

    10"]

    tr'["Jcx

    qlft

    ;l.5-.jJ;;*,

    itfu;lF

    -bt

    t+r-;

    .5t;:

    qVs

    a:Jl

    .,:*lo.l:;

    J'-

    ;U'i;

    'lu

    ,JL

    /

    r)

    ..r.rt=r

    ,)S

    ,lr3

    b

    ,al*t

    ?-j4

    36r;l;

    ,?t

    t-E

    r[J:

    o.^a

    4

    e

    rc.*;

    .rt

    ,s.l-il k

    -;

    ,al-*t

    b

    o-u

    ;;;

    , l

    t)

    a5

    c*l

    o.*

    u;+.ufu,

    cf-tull

    tlr.S.,-

    ,JLi

    ,^

    at-t,

    -2:

    ,y-l

    .2

    0.9)r

    ,6

    *.

    ,J-L

    a-

    l.

    6lai-o.r"t

    ,,.(*;tS,

    qltq

    *i-

    |t.f

    tt

    1.,

    ,P

    iT

    ..JU"

    3a-:;l:

    ufufS.,storr

    Jrl'*Sq-.{.5c....l,;lll

    ;T

    {,,.(=;tS"

    ,sA\

    u-l

    J*,

    t},C

    ,,f,-t-l..

    Lj-rt.;S;rr,[5*:,rt*.,[L

    t

    ra:lr

    d;Ti:+,1ljf

    ,r-LJ

    q

    I

    ,-rl"rlf

    l

    :l

    cllcltSra;b

    ,or)

    6t+51-2:

    .5.t-t"

    b

    .r5.,,

    |.5

    l-,

    U

    ut*---'-

    .c..ilr

    -uprt

    ;l-2r

    I

    ptS,

    tster;ti

    or-2|-tr;

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    17/569

    ct-l

    t5

    0.r.3

    ci.,r-i,

    6rljfrl.';

    ,+l

    dtL

    aS,c-l

    .(ot

    l

    4:

    t

    6lr..ri,

    \

    Ji"i

    .ri1-1,

    j.*

    ,

    .l-l

    Ut+L-i

    JtL

    ),s-Ll

    i-J-

    *

    ,.r15

    .:;ly,,u.6Jrl

    a-

    g;Lai

    .rtqgr*:a-r ,tS.

    J:4j

    cb,$t$+;L;[-.rt

    Y

    Jr.-i

    ,c,t'lri)

    f

    t--"1

    cSy,r.t

    ,f;ti.

    ur.r t)

    s,-i

    t\A-:,r.1lr

    c-^.rlrl=-,

    J; U-l

    .Jrb

    :

    rrL

    s;l

    |'.:,

    tlrl

    +,ksJ-

    y_l

    J=--;

    cb

    .>-*,g

    iL.

    lli-r,

    (r.i

    )r

    lb.rlil

    .Frb;U

    J.r,

    (4-l.j

    tt-l

    ts s

    ;.i,l

    d-'u

    JrU

    u(=;tt

    .stori

    L.r:.r

    6r -r,

    ,f

    I

    I

    gt$.oi;r

    i.s_r;i4.1

    .st^ri

    a +i

    jr*

    cir

    iJtL)

    lJt+

    f

    b

    *

    .SllS,

    ,-+;l

    6le

    t-;

    .:JL

    g

    Lii'

    ,r"t

    .-$tS.

    .st"r,i

    l"-t^:.-

    ,J-i

    r,

    .r-l

    tt

    .f

    ,g

    j*

    I

    (il

    .r.l

    $F

    (frJ

    .,s.iL-l

    .t--J.g ,$

    ,,)13

    .,S=y-tt-l

    ..st^rr,',

    9

    turt

    l

    .S=i-L+

    d^r,.,

    ,O

    .,[..oi.2r

    ,rt

    ,S-;tS,

    15t

    .i-

    6?

    ulr

    pI

    ,-rt"F

    r

    br*

    ,1.

    ;rr*;

    ,sb

    ,?

    J.oi

    I

    .c*l

    .F

    Er"t

    ,-J..;tS,

    .-st"-tit

    S.,t--l

    y:

    .r-Ll

    iL..- .t2-u.

    pL.

    .4lsr,.u.

    L;i

    -1r

    4T

    ,*

    nll

    t fL

    uSJtS.

    .sl"r,il.:

    tSr J:6i

    a,

    V

    ,l--i

    W:l.r;

    a-

    dr-l

    ,|=;

    jl

    ,tU

    u tS,

    .st^r,i

    ,rSiti

    ,rl)

    ",rt-.

    ,A

    ,l--i

    -2r

    -rr

    j_[r

    ^;r\

    4i

    ,s.Srt;

    *t

    s

    t-r:.l

    U

    +:l

    +

    tei.-t

    y_l

    :c*l

    ple.i

    ]

    6\

    .:-i,g

    AJJ

    t-.;.

    E;J

    -b

    ld,;r*S\*rL,13

    ..)rrt

    r$tS,

    .gtti.S,

    J--JrslI1,:r,\o

    e

    16$-oi.2:

    ,uL;

    J-;5,sll.t

    t

    Ji;r

    .r-i

    up

    tgJJ,L'I_r)

    -h

    tr-r

    -*

    ,Et v$ 6lJ.

    .t_iC

    dtL F*

    JA

    :$

    *

    t*-:,,

    a,,_l

    -;

    \

    "

    ,l-oi

    yr.e

    JIS

    ,5";-

    ;1.2:

    .5

    ,t-J,s

    t

    f

    b

    Jtu

    tsi

    JF

    r-+

    I;

    +j

    \

    \

    Ji

    L='..

    t,

    rrt.1

    ,rk

    f

    t3 ^

    , ,J-;S

    Gu u-l

    .:-f

    ,g

    c.fst

    ,y\

    tsy-,;l

    o.ui

    llr

    utrx

    .:;l:

    c^--ll

    ,$./

    ,rll--*l

    el-l

    1l

    orau,,

    j'-

    '.

    ,slla\

    ^S

    v.l(;-e'>L,

    ,ii

    .Jrl}.l

    6a-1a.Nt

    e

    I

    ts

    3

    'S.EI

    oj-s

    *,t+ -r,

    rSy1ul2.

    ,sLyy

    6.r l)

    \

    Y

    ,L-i

    -2:

    .t-j.,g

    t-.2,,'

    ,r;t>

    t-st+tr:,,

    tS1-1uL"

    +

    L1.,. S,1.-:

    rl*.f

    ,.rijlr

    q7l

    JLy

    ;r

    l.lr.L2L

    t

    U_-pT

    $,rt_j

    6a1uN, ut*...-

    )

    Lt

    eV

    ,s:L

    '. \l

    ,l^oi.2r

    .'-;.e

    j*,.l.::_A

    ; r

    ;t;l

    JLL

    r6:L

    .*td

    Jl"

    lrr+Jl5

    ,di

    jV

    ,it,

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    18/569

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    19/569

    I

    do$"0

    A;:oj

    \

    -

    \

    .r,

    .tW[

    t

    er

    c,LJ

    t+lr, I

    1r,t

    ,-i^r,r,-tao-2e:

    I

    ,;';-

    ;rs*l;l

    g]

    ,g-1-V1'l

    i-p

    .tt

    ,*i;

    g9ll,o,15:

    y-l

    af ;.*t,l

    -h

    +

    .c*l

    atJ

    J12-a

    J:*

    ,sW:t

    .up

    gll1l

    or$-.-"1

    .r.i[ +,,,=..r. E:^r

    u,t{"

    rL :;l

    l ,&t

    }-L;:

    t>Lc t1yo*.

    u[--""=*' ra

    q.l-:

    c;ti

    :,r

    t

    t'

    r,r"tK:*,

    ;tl;,r,+15)>L..

    \tt"

    br.2:

    a5

    U.fT

    S

    ,s-S-t

    rlK

    +te

    ;*-

    ;r-'-,l-1,,l,t+-;rl;S;

    i/-1.[\]

    c*l

    +lr

    tt-l;,

    I,t-L;l

    g;tur;1,

    )Sv.

    c^-l.u

    ,c-l

    ,.lJo,,|.;;j"

    ;l;l;laq

    ,( \- \

    JS-:)

    c*l

    ai

    ui^6

    \

    14.

    br

    lel,rLCL

    a*,_G,-2r .(jt

    :rrb

    s,

    +

    Jl

    ,*

    lt

    rr

    .y-|.\l

    if:t

    ;.1,^

    *,-st+t

    :r

    1l

    o:1,'-*,1

    ,o.t..-i1l+l

    15k;*ui.1,

    ,*

    ,ll

    ..rt+ J,

    aJc*l

    J)1,,d

    U-

    +t

    .rid

    J6.,*+

    t#or+,

    irr_l

    ag-l

    J-bu*

    )Su.

    .ir sli

    ,6xl'

    s:;-.a-2r

    ,,,[5J

    ]

    7

    s

    JL

    r"

    1t

    tu]d-.a

    r[;

    ..:j:

    CU-,

    ^S.ql$e

    orL

    iu.rt"r6-2r

    "-lcl

    ,p

    gt+t::,,

    ;l

    o;2r"1

    ,rL

    ii

    ',slor6ft4l

    \tA.

    b:

    tr

    6,

    c"Jb

    i/-l

    Y-\

    Jtfu

    .r-*,g o:h-l ,-r::*l

    u,i.-t-j

    ,c-l

    6rL ^:il

    t+|,r,

    ^b:+6;6*i,+

    J

    ,,,^iti;

    ,: "

    JE:l

    ,t+JL

    ;l

    c.Jlr"

    xL'

    .st+ r,

    ,qrr>L,

    \ 11.

    irr

    .2:

    6

    8,g

    ,A,,_b,

    ,li

    ,-l''

    .tt

    tl:\

    ;r$rj_-L...$rc/

    'e

    -b:le

    Ji-21:

    iV;*

    c^ira,

    ,:U;r

    r.;L

    .,,-tar5

    tr

    ivlia 6laJ^ ,p

    iJ

    xalr-.2[ orLi;-l

    tt-f

    "#

    rrLr,

    ,;16,.,t

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    20/569

    500

    J'

    -.:--\

    -\

    400

    a

    -J'

    J,

    J

    300

    J.

    \

    ;t

    zoo

    v

    100

    83 84 85 86

    87

    88 89 90 91

    92

    ut)l=- JL

    e):

    ;rd..

    -r

    Jl;,

    ,s$,,i.1:

    5111.1 t,

    \-

    \

    Jfu

    o=-L

    il

    *ly

    : ,

    Jti:;l

    (c,.-t-

    ;l

    c.Jly

    Vl

    gl'L::

    U.r6..:r-

    "ttsJl

    s-l6*:r'

    lr*u.

    qtS

    &t

    u.t5n-st

    'cstslJ

    c,tJi;b;r.

    'J".lFll

    ;br.

    ;u^r

    J-:

  • 7/23/2019 Mechanics and Control in Robotics

    21/569

    r

    +rj

    ;_*,1

    ,A'fu.

    'P,st+t

    :,

    6la

    6

    r;,r)-a.-\:Sri;

    .r-J,t

    rS+L

    t+l

    a5

    v.-lb

    A

    r-

    tl-

    *

    cf

    itf-uSr:l:-

    .l

    JJ.,e J5;ta-.r

    ,c-l

    eiJJ6.,(J':Lo:il

    c*

    r

    LgUt/

    \1V"

    .rl:

    -ul5,l'

    treL

    tLtt,tlrT.-st+t,:,

    ct

    ^".1.:-1

    y-;i*

    Ll

    ,.tL.up

    6$b.

    L;-s-

    ,L?t>

    c,trl;l

    Jf-

    U_r+

    J/

    :

    .StlS,

    ,,

    b

    5r a-..1i ,.-t:f

    y-l

    .r-rg

    d-:r,,

    rrl-....>'Wt

    ;r-;trl

    &-l-

    lVlit

    JSv..',Jt*.raL,

    ptst,

    -r|.;

    t ,P

    ,-st+ :,

    sn 4

    ,t-ic/ o-t-r f-

    \

    Jifu

    tr

    a+T

    r.L;

    Ct+

    t(;t

    .Jt3,f

    .4,b

    .iu-o

    ; l't

    .r,,(NC)

    sr&

    J.J

    ,sblt:t15[C'=.'L

    &i

    JL

    .;l,,,,l

    ,sl.2

    ;tl*I

    ,-J"ti

    ,sl4*:

    Jt

    .t*Wi

    6r,-t,^.1.

    dJ".

    jlp

    tr,ot-(;*r

    r:

    ct-l

    c,rt

    ;

    .rr

    $l:i

    (p

    ; -u

    .i-

    &r

    ;l':*-t

    ,$

    ,slt+,Et

    ,t'_F_rt-,

    Jtrl

    f

    till

    (c4U

    ;sjr-'la'ill iLt'

    c^rd

    ,J.li

    ut

    o,a1s

    u-V

    JKft+il

    ,51,

    *.5s,t6at(:-,

    ;l

    6l'53

    /il.,t.5.rl6la,-[

    Jrt-.

    ,.r15

    tt-l

    tt

    ilJ

    eh.

    JtL *.

    .,x;,g

    ,eJr

    l*'=;L

    lL

    s

    ,P; :r

    Jj

    t+i,-l.1.r,r r

    iri^a

    t

    ).r).td

    16a,.1t,+.[.,1

    1510'.iL

    ..t.i

    J"bri

    tgrJ

    reJ

    cr-y

    , lr

    r"t

    ,;rtt

    ,.st^:;tr

    JA:

    JJIS,

    i^JU,

    )

    urrr

    ,$t

    t'

    6a

    6;151j5

    6rU-

    .1

    u.lr.

    ut;L;t':-L

    r.

    ,

    5l

    rJ;

    1l:t,e

    4*

    pU

    cs**

    ilrl

    'lr'

    lrl

    c,ly'

    c *

    lV;-'

    6tb

    '>Vt>.

    ;)l;;U

    crs;rsJl

    ;lr

    ;l;gn-

    QLy)r

    t-:i

    b.b

    J.

    I

    j-

    ,ilAa;

    J"-t

    0 5

    l0

    15 20 25

    30

    35

    40

    45

    50

    55

    ,o.rii;:

    qr.i

    .jJ:;

    CL

    q

    aLy

    ;5rt

    tors

    f- \

    JSJ

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    22/569

    {.Ji.. f

    LrlSJr.

    r)

    d5,u-:;

    n

    P

    "F

    'vv2

    ;rr$..

    G*,i-r.rL

    ptS-

    61;L

    f

    -

    \

    Jfu

    .:,21:

    : ;

    )ttS

    6l,L;r

    c/-h3Ll,.-fuLL

    cf+

    .c*l.S-y5u;t^r:*.;

    J

    d-$

    ,J)G;l

    ,51^-"3'-,,.b*

    oil

    6lJ

    t

    ct-\li)

    ',\-bl).J.su.

    ,Jtl

    u(..b-:

    3

    ,5-;L-l

    .-rt+JL

    yr

    [4:--:L

    iJtL

    6D

    lr

    JL,

    J.5

    L--b .tttir-t

    dli

    ,.rrt

    u(-ti

    ,sU\

    o.lr

    tL

    s

    u;1.5;5r

    Je;

    .r:Tct'

    pl,,

    vb

    rslr-(r

    t

    t"rx

    Sltyb-

    t

    s:trg,__r-fi|

    oL-,irlr,gV,sltl",

    rrJ,,

    u^,i-r'

    t-Ettt:-u

    6\t

    lt(i;.

    F:

    taa-L-.-

    V.,lt:,

    ,at,g4

    i-tt

    ,.h r.,-yJKlL+jl

    #,

    q,t+

    y-l

    6a-1+,1r1 61r,.1;lu,:6;;,--rr,5

    {

    s,trsTu,

    .:11: o-rXcy

    l,

    rAl'.0

    "5rt5"

    .-rlait;

    J;;S

    r

    t(itfu

    Y-

    \

    cr-l

    r.:

    '-^J,

    Ab-

    c^-L

    il

    .i-

    .p

    s

    1.tig

    J-S:;L)l,t--l

    ,;t,o-u,-l

    6l.x^1i-

    -7:

    ..r.:

    J"lF

    o:l:

    p*i

    a.o)L

    .r-br.,-[5

    ,s;4a

    J

    ,ll'("

    'i--a;

    ,al

    .f"-tl:

    -162'-

    g;J+

    1-

    qglji

    rr

    ,,1-.-l

    6;+

    r

    ul5,

    .,;:",

    ,.So-t,:,

    .*JtL

    -2r

    I

    -Cir.i..rti

    lvltl".r".

    ?i6

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    23/569

    d

    ,lt

    .,(Jt(r,-sbr:l*

    JF

    t.f;K,

    Ll

    .1lrl

    '",L1r,,,t-..-l

    irl

    .st,r,,tr-rK

    L*t> 5fy

    fL*ly_L

    t-e,:yl:

    ,Ss-

    Lr-i

    i-

    3'**y'h*t

    .6;+J

    jt(,

    ,.r.r,t

    f=i

    ta;,-Lt:,

    tr

    Le,cr-.alJ,

    c,t=Lc

    r)

    :

    Fr)c/

    jtJ

    t+J

    cr_l

    il

    ;tL

    rJ

    c*l

    ,iu,r-

    Gb

    _&_t

    *

    t

    :l

    'f-Jd

    161

    u'ol-t

    L-

    ;,t----.

    o6 -,

    4'rl:-

    ,L:i.2:

    f--"

    JA

    6;+:

    utS.

    ,-)':--j

    ::b:.

    n

    u-l

    ,s;+:

    ,tS,

    -r,

    r

    *

    r*

    .e^{.r.l

    P (e

    ;.-J-

    Jua*L

    vX:V

    .(+=l

    7

    0-\

    Ji:)

    .:.-lr.r1

    F+l.1'-

    g-r.,>l.-'J",,

    otft-r

    a,

    r;--j

    *-n.rV

    r,.rlS.

    utn,s r

    g-.r

    oL(;r

    iJ;ir,

    iljLl

    .lFtr

    ,>lut*.

    oK;,

    j

    6

    t+l;l

    atS-)

    p...-

    c;ba.-i.:-.

    -o:

    i

    .,*;

    U_

    . _:;

    a,

    .rlai)tc

    UG

    ,r,

    1S*.

    ,a

    6;+

    trlr

    p).\tly;-rtr-r:,Y

    r[^oiJr.F;-..a

    -&-t

    *-nrh

    t

    -.r,rtq.i_;l

    fu.rJ:a-

    3

    al.-:;

    ggtaatS*-,

    o

    c*j

    t#-J

    ;r,-l

    ^,.

    Lg.-r"

    ,-,Vl-J

    5

    tlgr;3:.-6>

    r

    ,.rt(,

    J: j

    .:-ig

    c"r.,

    i;E;

    ,aU

    ljK,

    ,-sta-uti

    f+r*.

    -(tLt

    *.,

    &JtL

    ,'uT

    rrrrT

    5:.s\,-slor,o

    dJ.h_rr

    j:{

    b

    4r

    5,>*l

    6f

    *

    -{Jt

    *

    6z

    Z

    A

    #J{

    ,,p,L=*r,

    1,

    L

    f

    t-.1

    :

    *L,,51[S.

    6rr\

    a

    h-rrkt

    c,ta-;..6t9nt3:-, 0-

    \JfJ

    '5r'l

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    24/569

    ..ri.

    7

    dt5.

    .slt;rjliq

    '--r.

    rs i'.i,,

    i53,.-[:-i

    t&e2u, ti,6Jt^+

    rtt

    J5'rJ

    .-t'

    ,rSrl5.

    qgtrrl1

    .SJl+--

    i'JtL

    y

    it-l:l

    .t-J.,g

    (frr.,(.&,

    .p

    I

    t-

    iL;

    a1

    c-.;)

    .s-*C

    Lt-n

    cS7

    GU:

    :

    u-,r:^

    u6i;

    s.l;1

    ,J^U

    ,4\f-L

    '^-1s+

    E

    s-.:.a

    #*5

    ,*

    U.-,

    *l ,)->,

    g-ti

    c-*

    ^1

    ^S

    ,i1l

    cXtV J*i

    L

    .(P-

    \

    JSj)

    d't

    g.=-i

    ,r-2lr

    Jtil

    $\

    -5r+-

    *

    .c-l

    f;;*

    .-iJk

    -,

    'l

    ,r"t

    ,-J:tS,

    ,st"r;tl

    i'.ltL.l:,r-Ll.1l="

    :

    6lali.-'

    g-r;lr

    cf-t+

    (s-p

    ,s;:4a

    r

    ,tl,

    "*lt-

    utL-L.,-l'r

    ik"-

    tlr

    .1t

    'dc"u

    y-l

    ils-

    ,13[

    o-u.i

    o:l:

    ,rL:L

    L-51;

    a-,:.S"-

    .itit

    ]-i.i:

    t]

    +.c*l

    ,tt

    ,'f$tS.r

    =;6ry6

    a,

    r*i

    .rl12l

    =-nr9.'

    6;J4-r

    ,[S.

    '+*6:l

    c*l crrfr

    ,d:..-

    .SJt-i,-

    LsL,^ai

    ,,1

    ,stat'

    6bit

    :l

    tU

    r,5=;t5..

    15ljq iK.

    ;-l;

    -J

    ., ds-.-

    y-l

    ,r.rtf

    .t-t,

    .*u

    $li

    ,j:S

    f

    J--i

    r:

    ale...,

    y-l

    i.1 .2:

    t.p5.f

    -#

    G$:

    ,aU

    ,rfut.(e

    ,star;

    .lr,,lr

    .$t

    r.-

    Cb

    *

    4k-

    u-l

    .c-t;

    f+lf

    -b

    tt

    l,

    issls.iJl-:.-,

    'd,-

    'fJh

    J'";

    t>

    t5

    ,r:L,

    or-t

    orlr

    ,nt

    ,;=;tS,

    sr,it:

    cl+

    6*

    ,s;+:

    ,l(,

    ^iq

    :5-j.

    ,l

    utS-

    t,"t

    ,,f";tS,

    tsr;tr

    ;JL1s

    rJl-i,g

    3

    tt

    dS--

    J-L.st-lr;

    6l-a^s2,u

    )rr

    4-

    ;

    r-+

    g

    ,.5r$a-;

    ,))r r;

    .LE,g;

    ,rr\l-c

    tsL:l

    Gr\S

    sL:i

    t;.,1

    ,C6.r;ir.

    rrlr

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    25/569

    V

    .lt

    .,$tf..

    abr,i

    J.J:.iJK.

    ,s6ri;-:l

    ,*E

    J22et.

    q

    -.

    ;n;qe

    e,

    .:-i

    b

    jrl

    v-nt

    Lte

    Jjt+.-

    c,I:h-

    t-

    \

    Jfu

    )56.

    \3?-j

    ,;l-L

    61de,,,.

    o,-l

    .(+..{

    V-\

    JS.:)

    +5+-t-,

    ;}rV

    ork-l

    ,-f

    ftf

    ,9r.3:-a-

    2

    >-l

    2 ,rt=;t5,

    rstrr;

    ],-c.

    s2$f

    s-*l

    .f.9t

    +

    U;bdJrU,

    ig

    .c^-;

    F

    -,

    -$l^+

    Jtl

    + iyls.SJt-+

    iJs--.

    E

    \tly

    cft

    t>3

    ,rrlJ

    ;t5.l

    JrL

    + \l-f

    -{l

    I

    4

    ;'t-tp{

    t+TJ-

    ,sluh;

    ;

    ..:*l

    .l-r;

    \-f

    i

    wlf

    +

    t- .5'- r1,-.9

    ..:*l

    #.-,

    .i

    .up

    wbr^t.-JjtS-

    6$\t

    tstS

    dL'1,,rS,-;L;,

    ,

    J-

    ,r.r

    le

    L-

    rrr:

    =b

    6;+

    r

    utL

    r.

    rljcr

    r^t

    ,,S=;tS..

    15tt:

    d

    c-l;.

    t,'-x.

    vlr

    jl.rii

    .rJ

    .c-l ,.li.i

    il,

    qS

    6l;i

    ;l

    g1V

    I

    ltj,.lL- c-.r

    c"tJ

    Lw

    ,.,.(Jb-l

    t-stel*

    ,Wr-

    r

    .,t5,

    f

    )L

    .,SjlS.

    ,st^ritt

    ,;jt-l

    rl.i,Ll

    +,

    Lt-r

    JtL-,

    i-rb,

    d-.^.,

    ,,

    ,3)lr

    UU

    .FiJ]';

    i

    cSr

    JL

    r, b

    tU

    .,ItS.

    .-Et^r;t

    lr,g

    ,u3p

    6;+

    ,t

    ,J;tS.

    c::\

    s:$D

    ,nlV

    S

    b

    ,-e-jt

    .ritS.

    ,Ler-

    J"L;

    612

    c-*l;a.

    trL:i

    t.

    u[n

    6':i

    ;l

    .lq--

    il

    .iJ6:i e-f

    l:

    e-tL

    .tf

    ;,4,:3-3,rr

    o][

    ..tsv.r=i.-JttS-

    srrtr s.li

    *,.J

    L

    .c-:L*

    u_l

    u?L.(A-\

    Jf-i)

    c-l

    ;6s

    .**

    u_l

    J.1r..:*ly-+L

    ir,,b

    ,f*\r.t'

    OJ{

    LW I,

    t+T

    d ,,p .tUuy:. l*

    6,-l

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    26/569

    ,jrb

    ljlr:-;l

    .rl.i

    .l

    L.

    ;.,lj,g

    ,rll

    ?)ar[

    ,es*

    6;+

    -r

    ,tS-

    ,s

    V-

    \

    Jfu

    .t-S

    ^-L*

    \

    ;LL6t#i

    ,g-fl:

    {

    ^;.s-:..)L

    l,,,,2t+

    ts-rryur

    J

    [L-L

    ,slr-s\titr,}

    Lf.l:-l

    ih ,

    A-\JSJ

    .>-rr-f

    '

    '^,

    t

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    27/569

    1

    lt,

    uSlitt5..

    ,rtr.r,iLr

    J.J

    t.SJti

    .r-11:

    c--.rl ,r^b,rSJtS..st^r; ;l

    ;615 )l:'.,1

    :

    AVI* csb,

    J6&.Li

    L

    c*l

    g,;),116lil,,r5;

    cSr,

    L:irr

    r..-Ar^t

    u5-;ti

    gtlri

    g

    'lk'-..'

    Ct

    c,

    l:-. -[

    ,.rb

    ",.$t-l

    q7

    jT

    J

    )

    rS

    l+,

    ,,,t;

    15JK

    Ct-

    ti

    ,tr"-l

    tslr

    L).a;. ,rb.;,l

    rl*

    +

    yb

    sts.

    u*l;

    -9

    ,

    s-*

    jst frL.

    t

    ,f ; ab

    .drr

    ablt,efl:

    e-tU

    o.rt:l)

    Ft,i,-l

    ,,

    g:1.:

    f[,s .r

    t:;.i.rlri-rt' rr:.

    1+T

    .{rQr

    dlL

    tt-r

    cir

    i-sr5T

    J,_-r,

    6t-r2r1

    ;l

    lt

    rS

    c*l

    j;tS-

    ;l

    ,s;3

    u;la-t-:

    *{re:

    6p

    1,,t-ljl

    .,ti

    t

    ;F JL;l

    IrlU,rSJtS.

    crtq.t_

    rS:,-l

    slr

    .s-JCrlt

    ,-,[s t,

    I

    ;T

    lFl :

    ,g&

    1:ls

    ct+

    ts.,ry

    '4V

    ,>o-

    \

    ,tt

    ".lt

    ;ri

    ,Sf ,fisb,

    6b;llt5

    ^U:+

    b

    6DlS

    Clj;l

    g;lc.r.a-,

    'ar-r-*,

    t

    ,g,,.rrl,

    ;,5.- JL

    I

    rJi:-r5

    61.ea-.;.-L

    t

    d-rb

    $ i

    iV

    st-r

    ;lsl5

    ,51:-S

    Cly

    .;;,

    Jfu

    .f_J

    JLrl

    \J"-L

    ,t

    ,t+hl

    ,t.t

    ,rlr t

    d{,c*l

    ,l$

    6-p'".s+

    r}.,i

    o:J--.l

    -r*

    cil:

    s

    s;Lbi

    -r"t

    ,r tt

    ,aiL

    J;5

    csL$uil

    .r -

    .:rlr

    Ji

    ?'.iyqJr-aLy:

    JtS -ol ,rL

    ,JAt

    ufutS,

    ca\

    cSr

    ,r5-,t-r

    crbalrL

    ;l

    ,:[r-

    I

    2h

    tr-r

    :#

    t)

    cSls|

    .c*l;l-ul

    LS

    DI'

    ,r-tL

    L_,[.

    o

    o

    t]

    l*.r

    -rT.b

    rf

    ; )

    urlS.,.li.

    c,lj*cr

    (]4-/,)

    .[Y]

    ,:-r5*

    (c*J

    nrrb-rl

    ,c*l

    ;i ar,1

    i6^o

    ,ij*,

    aS

    6rL;

    aJ

    *

    jr*

    (\A-Y)

    r.;L

    .,,trdrL

    IJG

    ,.11.*L

    or_-ri

    tts-oL;IrL

    ,tsj

    6ly

    jsa.st+t-+

    \

    Jld+J-.y

    .1*_t,C

    tl^:i'-

    i;J

    =*

    6b,-,t.t-U-l.rr

    U:

    ljy,g

    osr;15r,.

    64XS

    LN2g'l-,

    Ut

    c{a*

    }t

    +^t-t-l,L*rn

    u:"-t-j

    U

    ,:,r-l:l

    ,rlt\.c.i-r

    $l:;

    -r.lr

    {

    -rl.-l

    .-;: t{.

    .s-,'.l.,g

    o:t

    '

    .l

    ji6ts:,,t4i;:-r.elr,.p5-2:

    l.ralrL

    i/,_l

    iFLrr

    ,f-tS

    o:lr',"

    1

    6;+

    ;$

    u-;;,

    clt

    ib-:

    ,st+-_r[

    )l

    S

    i-$aL"

    #Jr

    \

    Jl

    d+J

    \i

    .y_tt6+

    ,-,.

    -trh

    ;rlr,Jl-:i

    ,sDb

    (ofu

    L-,.)

    ,,st+I,+

    -,l1.,/

    kr,-rttt

    Li:zj

    ,sltb

    t+i

    tl,g-r/

    j*

    t6-tK;

    it-.i1tt

    #-*,-st+t-+

    ;.,.1;l

    ,,:.:,

    .up

    orlr;Li

    AT

    '.,-r-{

    t,4}

    {

    #

    {B}

    vnrtp-,";=

    ;..r

    f+lF

    $+-,:

    ..L.,

    Y-Y

    Jbr

    r

    2

    u* Jr

    b.tt

    \'.

    i;llla,

    {A}

    =x]-6.

    t

    c^*;

    Sl,

    {B}

    --rtrh

    A-y

    Jtfu,

    ;t-l

    ,c-l

    dj[

    Jti:l

    i'a

    6Lby)

    r>

    b

    O

    ,

    X

    A

    ,sV-Lr)

    blr \.

    e;l.r;lr

    s

    *;]

    iLs>

    .B P

    =1Y1"

    Yt"

    .

    t")T

    ^Supt'

    -)r,Ap

    +L*

    c*l ,_,.

    rlL.Ja:.r..

    c*l

    a.a

    {B}

    -3-'/a;;-;

    |

    "

    tA??

    ar

    -l''0""

    L"':

    "

    "

    -or0oo

    olooo

    \"f".l

    "/A??

    olooo

    dt"

    I

    o'oooo

    t'l

    "1"

    I

    \J

    (Y\-Y)

    2_;

    J9:,

    ^;

    B

    P

    ylry

    o:-i,lr

    L

    ll'1

    BP

    -

    (

    Y

    Y-

    Y

    )

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    52/569

    ,#,*$

    utdl.ry

    st4itag

    ff

    or/

    /

    oP"o^"

    .{B}

    tit

    ;sl:s:sJlxl

    ,-frlf

    A-YJfu

    f*-:

    t-l

    :

    d,g

    orlq'--'l

    .l'-+

    .-S-

    J12"oa

    {B)

    ';-p

    ;l

    AP-fTBP-

    (

    Yr-Y)

    I'i;:ll

    ,rS.rL*+

    t

    ,$lrsr

    ,Lgtl.iil

    :tAr

  • 7/23/2019 Mechanics and Control in Robotics

    53/569

    f0

    .,[,.et*"yr,t+ l,l{llljl,bJLt

    .?

    &*;

    -rl:ra

    .5--

    d.f

    fu :c-l

    rrL

    Jt-,

    ,,(JS.,_.;l

    crl=.;

    gr_l

    arl:

    ...^,-

    .:.11r.,

    +,

    b

    v*tV

    ,Sf L-

    ,uJro

    +

    b it1^

    cS2-

    lljct

    ,S,J

    Ef

    nJ-u

    q

    .rr,-rt{t

    L2'))

    ;r'-l

    il

    V

    +r

    t+-

    5

    ,,b);t-..(,-

    cJL

    rr

    -,,r

    p

    nbL-1

    ;)q

    .c;-S

    -b

    .tt

    nr--ir;

    .2r

    .J.r:6

    ;b

    ,nQ

    ,lt-r

    il=

    r{

    ,A

    P1

    jt2

    Jtiil

    .F&

    t-Y Jfu'

    .Sc

    -J

    .1lr

    2

    -1:

    I

    JE:;l pl+l

    r-r r

    jV

    't-r;l')ttl

    AQ

    )ltrI4L-l

    ;-*cl

    a*1..-,

    l)

    tUpa'

    aJ.:*l

    'Pt

    "-t_+

    jry

    .J,s.

    U_l J-S

    oPr--oPr+nQ

    dg.:tr'-.ly-j

    rL;

    :1

    ,,e-tU

    J,Lt

    *t13.,a6

    Jti:;l

    J^r

    U_|

    ,;;j

    clt

    oPr=Dek)oP,

    (Yr-Y)

    (Y0-Y)

    It

    De

    J,;t.c*l

    Q

    .rltt

    cLb

    I

    $J.b

    "

    Dq(q)

    -

    Jtxl

    (ur.-

    t_

    .*

    .;-)b

    )

    1l.tl

    q

    ;.;T

    ,t

    ,S

    .r(^"

    .J,-+.f-

    -il

    ,eV

    e

    o:L

    JL

    q

    ;;lt,l

    [\

    o o

    q,1

    l"

    \

    o

    q,

    I

    l'

    .

    \

    ;,1

    (Yt-Y)

    L.

    o

    o

    \l

    /:

    {A}

    /

    //or,

    ^P,

    /

    /

    /

    //r'

    .Ju:lFr

    1-

    Yjtu

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    54/569

    "5Cg

    ,.rkllrr

    r\ir.-i

    Y?

    7_)t:

    r::..r

    Q

    Jd-Ji4,6ll'j'17 Qz

    ),Qv

    ,e,

    ,iT

    r5

    S

    ,[5*:

    -1:

    Jt

    S

    +5o.

    j .c*l

    ttrr6*

    ,-rgf

    c,l=;L-.,,

    (yf-y):

    (1-y)

    6bJrL

    _1r

    #,-.S"-

    ,,q:-7

    rrlrrF

    (1-Y)

    il" .,r

    ,c15

    \a-f;

    (^

    Psone

    uh

    q)

    |

    B

    Pasa6

    ,f-Y

    ea

    j)|:;lFt*,c^..)tc

    ,t-

    oll

    .f_tj,g

    o.rlL:.

    (yf-f):

    (t-y)

    .L'.l,,,:1

    d^,>{.c

    dJ

    (:.-..,.;

    {B}

    iti

    i-f;..:*l

    a.-icl

    7

    al.o*^.

    o6 -,

    .Sf,

    -b

    613.r

    rL;

    I

    oI3

    o:lr

    o

    P,

    --

    RKQ)

    A

    P\

    (Y^-Y)

    6;l-lla,

    Ii

    Jt

    -.rt* ,

    JrL

    Gb:t

    aJc*l

    Gb:t,slJ*

    aftr(0)r,6rljl:L;

    ct-ltJ

    alS.7l:r1

    c*i S

    j1a

    " -+.S,-

    .rJr,eu.

    ll-iglr.S-G,;r-l

    .-u:,r,

    1el

    +1r

    0

    2

    u*

    Jr

    .r r,

    3

    6jJ*.,(\

    \-Y)

    il"t

    ,s

    6.,,lKL

    ,)l:,

    .L>:j

    *>*l

    j,-

    ;rI

    qI+qJ+q

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    55/569

    rv

    "5.rt*+.1,t+Ll

    ,l+Jbt

    'trJLr

    r,l

    lrp

    cdra

    ,;5u.

    U-*

    lr 0 ;3lsl*

    -sind

    o

    ol

    cosd

    .

    "l

    o \

    "l

    o o

    \l

    (Y1-Y)

    ,f*

    "l-+

    q

    Lt-n

    I

    x

    I

    iby,y-tL

    c-^-i

    J

    n11l;e,;t5,-21:r1.p

    ,r rr

    .s x

    qJl

    -bl

    f

    x

    f

    L-

    f

    x

    f

    un-,-jL

    J15^oa

    ll-i,g

    f

    nRrl

    rL;,r r

    ir:-r

    1.{rrUi:-l

    altt'

    ,sb

    GLs'

    ,r-tL

    ilid

    43.1

    3

    'J

    F"F

    :i*r.ry

    c1,r,

    i+

    -o;J

    ,*,t

    K

    -u;L

    'p:

    rstf

    Jf

    l-Y

    Jllr

    r

    tr

    Jr

    jtra

    y-l..rl.,rt

    jl

    6l61lsa

    lr,g.$rc/

    iLJ

    t

    AP1

    j;r;

    \'-Y

    JSJ'

    .+/q

    AP,

    b

    *J+.rl:-r

    .C

    +A

    ;p,l

    Jt-t

    a.-r: \'o

    t;l.rla;2

    ,r-tU

    l,:

    c*l

    )t

    ,r ru.

    2

    Jf

    -1,

    1""

    ;;l.lh

    ,

    tarl:.,1

    6

    Gbtt

    ,r-tl

    Rz(,,

    _[T,

    ^1

    X1

    .c-l

    ,.t r,-

    2

    Jf

    r-.rr

    t'"

    ;;lJlo

    SAPl

    2lt1

    \.-YJSi

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    56/569

    e>.

    ?-ftrht

    t

    c*;

    b

    Z

    Jf

    o,.r:

    1"" 6;l.ula, r-D oJLir,-

    -.

    r,rh

    .S-

    d

    Gbst

    i^:;:':X'r

    $'/

    j:''

    Rz(Y"t")=l.rO'o

    otA??

    otoool

    tf"-Y)

    ll

    L.r"ro

    olooo

    \1.""J

    +1.-f

    C-.r/c

    lj

    Jt-tuv.

    =

    l-

    lt;;;l

    L

    ";"..1

    ,_F

    ,ebi.rt*ll.rr

    t\i*rt

    fA

    A

    P1

    jsr1tsl,

    t

    o

    P,

    =

    Rz(Y'

    t")

    o

    P,

    (r

    \-Y)

    A

    P1

    js2

    (rY-r)

    I

    ,rht)

    It

    iR-St

    S

    +5-.r

    ..rulJrL

    u-l-r

    -btJ;l

    (YV-Y):

    (tr-Y)

    6balrt,,

    u-l

    .*,g

    it-L;

    (YV-

    Y)

    'r\b

    I

    R

    ials

    ot3;T

    ,,'-rr1 ,:f

    ,-n-v

    (

    \ f- Y)

    '&b

    I

    (A

    R

    .src/

    iL.l;

  • 7/23/2019 Mechanics and Control in Robotics

    57/569

    f

    l

    .r5.st+ .y

    r,t+Ll,t{Jti::l'bJ,Lt

    y3.?J\1

    d,J--

    .

    c.*\

    JsL.

    .rsr.

    $i:;\

    I

    i .-5r".

    r

    ,iLr:

    R'A*5r,.

    d

    J--

    .J,Su..

    q:-j

    t?t

    yj?r\t

    ..L-.-,1

    Q\)r..

    cit-

    JUi;\

    5

    .R'rI-)r,.

    ..ul

    r:\s

    ;15:

    ,'5itS,

    ,lrts

    ib.;,r-l,L

    c*i1r;l

    ,[5

    ,rS'u

    r].F

    arrr,)5.^.

    r1,-u

    '.*,t

    sJ

    -b

    "

    f-Y

    JEr

    r

    un

    Jf

    a?-r:

    l'"

    l;l.r;h,,

    brlt,,^

    U-l

    ,.^l,lf,g.src/

    itJ

    L

    AP1

    j11

    \\-Y

    J.fu,

    +t+.f^,

    Jl;:lYe

    cL -,,r

    bl:

    6:

    Xn,sE-b-r)

    bl:

    \"

    a;lllr,

    s,ibst

    Z

    .+lri d-rlr

    b

    o

    P,,

    ,A

    P1

    =

    lY

    t"

    Y

    t"

    "

    ,"fr

    c*l

    6"1;

    rJar,rr

    f

    t";l

    t

    Jti:;l

    r

    if:,

    d

    f

    JJ-'

    T_

    L";:."

    -

    o70oo olooo

    "1h?7

    olooo

    o

    lo

    o o

    \7o

    o

    o

    1"]

    (rr-Y)

    /'

    /

    /

    /

    APz

    /

    #p,

    /

    .c-l

    o.r.l

    .l+

    "&

    4

    Jtiil

    s

    bb1o

    \

    AP,,ltt

    \ \-YJKJ

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    58/569

    ,-{

    oM;,rtr .^y

    tLi?ai'

    Fo

    oPr

    =

    t.rlr.f

    (r0-

    Y

    )

    V-i,c

    t

    #'l

    orLt-l

    jJ-t

    )',;',

    *

    T

    il

    oPr=ToP,

    (rP-Y)

    Y-Y

    Jti

    s;

    i;.i5

    15)r'

    k:l

    JE

    ,,r-l

    a5rjl.'

    a:--il:

    o.e;

    .:_1

    l:

    tAJiri

    i..-)'

    0-

    Y

    .5'-

    Jr

    i r,

    sScJL

    P;;5,j'o

    t:b*'+,jr-a

    Jti:l

    ;rLrr,r-.+U,

    it5ti

    c*J

    csj .Jbl:., :r"5tJt

    ,fJkr,

    .F1,#

    j-o

    f

    ,,Li;;lJU:t

    )^Li

    .Jl,r,.5

    cJL

    ,h

    -,:

    4T

    lt-:

    ,1-ilst

    iy

    .r ::

    r

    i..

    Jti:l;.:L

    .-JL

    .e:

    ,"

    .f-l,r/

    j*

    k-rt-rt.33

    u:"-l

    cslt

    Ct'

    ,stlil

    il';.

    t

    ,:-1lr

    ,r*-tJ 4lrl

    t;

    gi

    a-,r(^"

    ,l-+

    Cr-l

    .s ,

    ia;

    {1}

    *

    c,*;

    1.,

    {B }

    *aL6;

    fT

    .c*l

    *51r\t

    .1,-

    -n,

    -;

    ,,.},-rn

    Cr-l

    .

    \

    t

    {B}

    ;I-l

    csot.tn

    15b-|,

    .5.u--.n

    151,&-

    qita-/l:J,:

    AR

    rs\r

    oi-5^;.tSu.

    .src/

    iLJ

    b {B}

    ;L--...

    o6 -,

    1rr,

    iti

    t

    o

    P"o^c

    :

    ;cJ.u.

    j*

    .$)./

    cd)de

    A

    P

    ,s:t

    L

    "

    P

    zF

    fT

    .c*l

    *,K

    .i-

    ,,- -ri

    i/-l

    .Y

    .$rc,/

    dryr4

    b

    o

    Pr

    r

    tSrt

    k

    o

    Pt

    css.t

    T

    .c*l"\,-ri

    Ft^r

    .5.,-,rl

    rJ

    i/-l

    .f

    .i-

    ;r)lrq

    slS,

    -71:11

    .i-

    .sti.

    {

    rr:a

    (.- -{

    D

    5

    r{.73a1\3

    r

    ,st".-;b

    ,tr.

    Lt-l

    jl

    UU

    ,. -+

    jl

    s

    u

    z=

    ^.i

    il

    c,,-,u

    f

    fu

    c

    ,,v:tr\,.1

    r;l

    .c.i-1 .r:.rp

    jS^,,

    6rr3;a--

    c,JL.#

    J-+

    ;;l.e

    ai-l

    ,+t

    t,,;r:.,*.r

    .s-.'J.e,:lc*"|

    .r3,1^t

    t-

    -:t*

    fttr^-

    a

    l,

    (i*

    Jbl

    t-)

    \r

    ; r,

    r+F

    Jl

    ,u)rq ,,-Jd

    t

    t,

    L

    ij

    ;rlrr'r Jbl

    ,,5

    .tj

    '^lrlr

    orlr-

    .l

    "1,-+;;b

    jl

    UG

    ,C;

    [;']

    :['ii::i]

    ;:Li;,

    )"6

    6r-;

    Ll

    ,c*l

    I

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    59/569

    f

    \

    ,.F

    ,l*

    e

    p\,

    crga

    ,s

  • 7/23/2019 Mechanics and Control in Robotics

    60/569

    tT

    arV

    rolj,l.#

    r^l'rL

    I

    c,t'-l-,,

    e-tt

    il,il-r"r''ff:

    r,

    p+,

    "i-lr

    ti

    rt:e+

    ,{C}

    :

    {B}

    c\xtV

    J

    fh

    c$-;

    *t b

    I AnEn

    'i1,R"Pcone+nP"o^"]

    Aq_l I I

    tr\-y)

    r

    l-----

    -i----

    -----l

    L'oo;

    \J

    .,Lrr

    Jrf

    isul:

    6li.

    t

    ,r-l)

    ;.-r31

    -b

    .tt,.;-l

    ,,rl',

    {A}

    *X.tkA

    q

    &*;

    d

    ,

    {

    B}

    vXtV

    ,{A}

    1r-:*;

    {a},;r-;

    b

    FJ

    iyl:b.1,-+

    cr-l

    dU

    "16.(c-l

    AT

    rlri..,::-;lr

    ..;*l

    f

    x

    f

    #-j,-+

    ;:rlr

    '.-l^.

    y6u-l

    yll

    ,sb..:L

    ,'jl,

    .4i .:*r"

    "of

    *-

    ;l;,rL ,-it :l

    ali,r,iT

    i:,,lr

    i-t^,

    ,slt

    S

    c*l

    61143r,

    J-+

    ,r-;L

    y-l-2h;L

    .:J,rU-

    .l

    Jt-,'

    ;,

    c*){,

    n

    Pnone

    :

    AR:l

    --i

    +

    b

    "

    Pnonc

    :

    "nn-r-rL

    +tt

    ,3f

    '+A

    ,sh

    F-ljd,il,,:),-sl.f-,--rL

    3.r1,:.r)

    ,-E

    rjf

    JtL

    a

    +i

    L:

    l+l

    .f-tT

    "on

    -

    An'

    (rY-Y)

    CC

    J:ai

    i,.+

    {B}

    *-njy--;lb^Pnone

    ,(\Y-Y)

    iJrL;l

    ,:1.'-...1

    t

    ,.'-

    u

    (n

    P"o*r)

    =

    "nn

    o

    Pnonc

    *

    B

    P,aone

    (rr-r)

    *\-b

    +

    (rr-r)

    .J.1t

    *

    s 3n

    "

    Poo^o

    =

    -|R

    n

    Pnonc

    =

    -f

    nr

    ^

    Paonc

    (rr-Y)

    L:j

    tj

    a.t-re+b

    uo?.

    ijd,(FF-Y)

    r

    (f

    Y-Y)

    ,st^.h r;l

    orl.L-l I

    I

    A*'

    i,-ARr

    a

    Pnoncf

    'or-[.t,;i t

    ]

    uoT

    -

    aT-,

    'L

    u;.,lir)L;

    "J

    t

    6

    +S

    +i

    .c*l

    ;^^

    ,1,-+

    .,r

    iyl:'*6

    cla

    ,t:-t-rl=*

    r

    ,{

    ;l1tt

    (f

    O-f

    1

    iJrL

    (

    ro-

    r)

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    61/569

    f

    f

    ,-F

    , -*,>

    ,;\1c, r.r

    0-Y

    Jb

    r

    o.2.r

    l'o i;l.lh

    {A}

    v*tl.36

    r

    c*;

    e5.u:r,

    itJ

    I

    {B}

    v*jq

    \f-Y

    Jfu'

    i/- rfl ...:*l

    d:jt-

    Jtiil

    r-b

    f

    tf ;J+tn,

    *o.-st^l-

    1t,ct1$;-,b:t

    Z

    t.tn

    Jf

    .

    .+t=:

    , Nf

    .,:*l

    ,4^*

    ff

    t-.-J.4

    r-o'-;';

    &+

    {B}

    =*.,V

    Artl

    _

    Br

    Brn

    _

    ar

    l'

    tA??

    I"rd''

    L"''"

    -r

    t\?l

    -'70tA

    o

    /o

    \

    "

    th?7

    -

    o

    r0o

    o

    o

    'o

    oo

    o

    -"rA"o

    olooo

    fr"l

    .1A?7

    ofooo

    fr"l

    o

    ,ooo

    o

    trl

    .1"

    I

    \J

    (ff-Y)

    o/0o

    o o

    lo

    o o

    "1[?7

    olooo

    o

    lo

    o

    o

    \7o

    o o

    t-ig

    a.*,; ,(f0-T)

    i.t ;l

    ,:ti-

    .l

    L

    (rv-Y)

    .{A}

    +.-,.'{B} *nr[

    \f-YJSI

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    62/569

    ,.F rl|'^e;

    at+l:.rr

    2\\.ai

    f f

    ,L*

    6lo+lstr"

    V- Y

    ;l

    ':tl

    .l

    \

    ;rli,g

    b

    {D}

    *akt

    .,i

    -/,

    .tsrc/ jts

    2 ,p:

    \f-r

    Jfu,

    J12,.at'

    C-a.J

    .rJ

    it"

    drfk bg,o

    Jr

    {

    ,t+ -+

    V;rkL

    'oT

    =

    ir

    Ar

    (

    r^-

    r)

    (rr-Y)

    r

    -

    flr

    B"r

    $r

    r,T .up

    c*)de

    tj

    ut_tpt

    , .t.j

    iJlt

    ,

    ,'oT

    jl

    \):

    j;,

    ,l_l

    ,Jrl:-/lri

    ,srt-

    Xr Ar

    -

    Yr 3r

    ""r

    (0.

    -Y)

    .J:r)s-.

    J=.5;;

    dl-

    .S: dtd+

    ;l

    6l^se.--

    \f

    -YJKJ

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    63/569

    f

    0

    .L+

    silrdrt,

    ,f,-.r;

    iJrL

    n

    5

    )2p..Jr-+

    t d.ffu

    ,t$-rn

    '.*l-..,s|,.;tl-irl,. r.,

    6trrJrL;l

    .1r

    ,.11,,5L,

    ""f

    n $+

    '.:S

    6

    uJ[-

    ,slt

    b

    (0"-Y)

    tL.lr.tj

    o:l.r-*"1

    ,r;l

    4-3.

    bli.-r.

    b

    J:*., -ri

    ,r,

    .f:-rlr

    J*j,-+

    .S,-

    r

    .J,-+

    iJrt^.

    .f-

    ?-,

    I

    .r--&,

    -b

    ,.25T

    c-r.,

    ,-lLT*

    3r

    -

    Yr-'

    ir

    Ar

    "or-'

    (0

    \-Y)

    .c*l o.ui orlr;ti;

    u-&-t

    rLi

    c--r";l

    ,\0-Y

    rfS-i.1r

    4

    i+,

    f

    ;tQ

    il-:t

    ,.$\J

    ,t12eL

    haL6;

    ,t+Ifu

    i15.r)

    d

    +{

    -.y

    src/

    it:;

    ;t

    c4-

    ..slo.u

    .rlr

    ,ril;

    ,J:1u,

    ,kt-&-t

    -.

    r,r[43'i+.

    +

    -.

    .1>,kt

    a,

    c*.i

    {D}

    =nj{-,\f-Y

    J"fu,

    t>zsFdi-t;

    u-S-t

    a,

    l:*i

    -.f,rl1a

    llJSrs

    ."[u il:L

    51;l

    6li;

    \ 0-

    Y

    JSJ

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    64/569

    J-f;

    D}

    +s*;

    {A}

    ,-,rt,.

    ,\O-Y

    Jfu,r,

    Oj:-j:jTt

    r'^'t

    c*l

    ,jK

    ,s-Je

    ,V

    pr

    r;.:",

    t+t5s

    3u.13;^l.r,

    hr,.rt'6,;

    4;

    ,sb

    .tf

    ,g

    c1-

    t

    .jJH.

    ,k.slrlr,rt

    ^it+

    .fisT

    c-)d,r

    lr

    rlQ,,sLd,.+

    ,-*k;

    ;l

    0S-

    J: j;r

    \0-r

    Jfu,

    l.{g

    t*l^.

    lr;rT

    ;.,t,1:

    l.ril

    ,.tu:L ,ratr,

    ,rtd.rr

    ;l

    .ulc.,-,Lc

    {C}

    rrrt-rkt

    Zr

    -ir

    ir-'

    3r

    Urn Urn Brn

    Cl=BACI

    (0r-Y)

    )

    (or-Y)

    C

    +A1.,'1TL

    tli,-r,(or-Y)r

    (OY-r)

    t5bAf

    ;rl:; ri 62L.-,

    tri

    t+:,-l-r,

    xr

    =

    Hr 8r

    Br-,

    2r

    (

    or-

    Y)

    9-l

    Jt:t

    t

    u;gL

    ;b-i3Jl

    t

    eb,{"}

    .r,rkt

    Ft

    t,

    .5,\P-Y

    Ji.fu,

    tt

    FT

    ,}-+;

    +S

    *t

    I {S}

    *rtV,3T

    "1,-+

    ro:r.r.r .r.r

    frL

    ,c*l

    {B}

    r;t

    i_t .

    c^-.i

    ,r5jtS,

    tU

    -* u,

    3

    rf*

    it^(.

    J:5.,,

    J"ci

    {B}

    1-t,

    d,

    c----i

    ,.:*l

    .}.oi

    $ -*

    +

    I

    6a;L

    ,*,:

    ds

    r*;

    Ex

    ui*+r

    utS,

    ,TT

    .t-rrf

    Lra;^*

    8f

    ., -+

    '&s+;

    r-11:

    .+5

    +-l-.,

    b

    ,fV

    ,r5jl5,

    ll-i,l

    ,lu-;;

    Jr,

    t,

    c-l

    .ul;

    r)

    .rti

    u-l-r:

    o-rJ.,kil

    qlStV

    ,sA6r.\

    tj

    +L+:-j

    J.t.t-Ar

    cdr

    -.-,f,rh

    {

    +

    l,

    6r,

    *nr[

    TT =

    +T-'

    Bsf

    ZT

    (oo-

    Y)

    Ls;+

    u,Qti

    6tU.tr.&r;G"

    A-Y

    Ji-t,-u

    c-l,:

    66t**.,+-lorlr;LJ

    r

    x

    l; 3r

    ,r-tl

    "b:+,t+-

    f

    ,lr*.F

    jj5u

    b

    tU

    t4l

    ;-;l.ll

    3

    ,\,4

    p^;:

    r:t:,

    t+i

    .st+r*

    15.J

    c*l

    ;i

    jlrr

    utr*,-rL

    c*l

    ;T

    (oJ'd))

    ;l 1,b>.&L.r

    -*

    o.t

    rrtr:..t

    6t{.-Jit,

    L;tlt:s,st+*,-y[.c-l

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    65/569

    f

    V

    ,rr*{"

    4l;

    i; -yr r

    .,,JU,

    "6

    *

    6)t.tt

    6*

    4

    t .r.l.:

    4,;; JL.,:1t

    ,5;t5"

    6t

    \t-

    YJ'f'J

    J.lj.

    GVj:

    cr;Ull

    .uL,:.t5.-

    tst+-,_;t)

    r.2l:

    f

    \

    r

    6rrr

    tlb

    ,r_tL

    1l:=

    i:

    a5

    .(srl:

    -

    \ L

    Jej;:-rc

    t

    jl;S

    ;ly.r

    b

    6;;+-.5--

    t_T

    S t-J.e

    dL

    Jly

    cr_l

    ,r

    t

    ,r-

    nttl t

    6U.,[f]

    ut;

    t*

    tr

    rrtsrtf,1

    6t+-Jit,

    ,Jh

    t,,'-1,5

    Jyt

    ,*t.d

    t_

    ,t'

    ^S

    6ltJ^',tf

    *--*

    aa7[ir:Ll

    ,r-tL.f..,-

    ily.f

    ,or--utritS--

    R=(Ir-S)-'(/r*^S)

    (or-

    Y)

    e-JU

    tr

    6,(5 =

    -l'

    cr--)

    .r-rh:rrL,

    .r-yL ..:*l

    I

    x

    I

    i5.,-,r-;,

    I7

    ;.1

    I

    3

    +lcf

    dd)dJ

    ;;;

    (s',.eur

    sz

    ); rU,

    at

    c.*2,c*l

    \"

    x

    \"

    '

    -

    ltt,

    ;:"

    ti"l

    l.

    Cayley

    (oY- Y

    )

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    66/569

    ,-{

    eLa;

    at+.t1.rr

    t\i4.ai

    fA

    a.-

    t6;'.b:t

    llj,C

    f

    x

    l; rr

    ,r-tL

    j.S

    sy,t..u';

    'L

    =t'**,

    (6P-Y)

    'll',,tJ

    .$

    "r;-:-;-bL,

    .*U--

    ,b

    R

    e-tt .uj

    ;3u1,

    iJ:L.

    ,-,*

    ;ri

    ,sl.z.rl

    u.

    ;rl-irl .R

    irbs,

    ,r-tU

    ,-i-S

    -b

    t5

    j-fuu

    L

    ,,5)-

    Lf_;t,

    Al-;.,f

    ,,r_rlr

    ;t:;

    l.x,lr:

    *=[* ? 2]

    (a^-

    Y

    )

    -J

    aJ

    -r::-..e

    ,SnrV

    &-

    6l-y3,..

    tl:

    _r,

    jt,r1-

    y_l

    ,,*.r,_r Y- Y

    ,14

    ,t

    &t?

    ,J:.e--c

    t':r:{r,

    b:

    J::--a &-Ll

    l.rrlrri

    U-l

    i*.,:-l

    oli *j

    Fr-.

    -rtrt*?

    ,:

    $lF

    jll

    ,r--tV

    ,;s

    t

    :,Jr

    tt

    t)

    +p

    "r*

    li1

    -r

    lvl

    -\

    121

    -t

    *.Y-"

    *.2_.

    Y.2-"

    (01-

    Y)

    :l:

    .r:"_L;

    ;-.lrl,

    a-

    '^1"-51

    ll-i,g

    )

    6;Jl-.1

    l

    T

    (v*

    Jl

    t".up *

    U-lJ.q

    .i;--15r,

    f+li

    l,{i-tJ

    ;r,_l

    ;l

    a;;

    r* j*

    t

    .u4

    g,-l;:

    .a; L

    ts

    -,.\ir,-l

    Ul

    ,:j

    4

    ,jtL+ ;)l-i,f

    L

    e

    t

    l-t'

    t2n

    -

    6Lby:

    Jti;l

    ,[-c

    a-

    6l

    :l-1:

    t+-f,(+-

    iej

    tr)b

    &

    t

    jL;l

    iLi-,.l::..c^-J

    c-J)

    ilt's

    s,y

    ,Jrl.u,-*ttlLr

    c-^"--E'1--.

    t+Lr,

    dc*l

    ;T

    ,ttf

    tp-l;r;)tL:.

    J,-{-.c*l

    cri,i

    .c*.r

    jL

    3R fR\

    AR

    3R

    A-

    Y-Y

    JEr

    r

    -b

    tt

    r4>..1) t""

    ;;l-tla,

    X

    Jr

    u-&-tj

    ,d>.-2) \""

    ;;l.tla,

    2

    Jr,F-

    , ,

    tj

    ibss

    s:

    '"'t=32

    -o70o

    o

    "

    1477

    o

    lo

    o

    o

    l"

    rlrr

    |"ro"'

    l'r"

    "'

    f

    ::]

    Rz(Y'

    )

    -

    (r" -Y)

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    67/569

    f

    \

    ,r,.ts{e

    ,-*-Q

    i:\tt,S,

    ,rJb

    Jr

    t+-_-rU

    I

    .:rll

    .,1[r,L

    c_*--t--

    "5.JL

    6;+

    e$

    ep;

    er-t',

    t:,3,1,*

    rt-f*

    e

    jljLl

    t+ r,

    ^Sl4I

    J

    ui"_t-i

    .F",

    ,i_L;

    i;U;

    tsit:na

    trlst

    c.*1t

    ,

    t+l

    d

    c^-l

    ,u,.J

    ,-iJ

    -h

    ,,

    -,,

    5

    ,>-l

    5liJ+

    4i

    e-rl

    j1'e

    lr,-;

    **l

    J:-.rr

    JJ-t

    Js..aa,

    jl::

    uLe,-rL

    \4at

    clt

    ib:t

    6t+-_/t

    Ll.-r:a:,r,

    f

    t il,

    ..lfj:

    rl-.t

    el:r1

    *S_.,:

    s.r--i

    =-e

    f

    tt"

    ,y

    Ls-&+

    ,ilu.^..ulf

    cf

    I

    tyS

    J+;

    6,L.-a:-.-r::-+

    .*t-.

    jl.r:1

    ,s;:4-

    g.4-r*\

    ar-:-

    i

    ,-*-:U

    jrjr.,,l,

    ffuy)

    rJaI

    t*.6

    a;1.r,.1.21

    ,*:61

    T

    .;:,rylr

    )Jr

    4-

    tt-

    t

    jt";

    du^,_l

    :),r|

    t

    ir:.^

    t.:$l

    .ulr-

    c-,-.>;

    a.,,-r.L:rt5-_

    r+lr-

    i-*

    d--f

    aJ

    u-l)l

    dr

    r-- ,or--i

    .rl.6.:.4r).,,1

    -up

    ;*u-rt=-:t+--l

    t;

    ,.:-,U

    X-Y-Z

    sgJt_lg

    :;-l 64

    {IJ}

    -gr$

    6;14-

    \;a:--j

    ts9.Jstjl

    .,

    l+l

    b

    {B} +5

    Urt--t

    "+-

    {A}

    f}*

    )

    er

    *-*rV

    r

    6

    rt-;.rka;l

    .r.a:

    .rLr)

    o

    ;11.r;lr,

    2o

    Jr

    (Ql-

    e

    ,11

    t;ltl*

    ?o

    Jr

    ctr

    ,-l

    i;lJlo

    *

    n

    Jr

    t-Jr-l

    urf

    {rl}

    C:y

    J

    ,*U

    =*rV

    jl

    ct-r Jri|s,

    u

    ,J-l;l

    .t-

    l

    .*[

    +

    i^JS.r-"[,r..

    c+ti X-Y-Z glil,

    t

    ,s;4-

    ;r:]

    u^;.*:lr.2lri

    gr,_l

    .t^tJ.(\v-Y

    Js'i)

    )s15",.,1:l ,xrSu'

    rhl

    ;i

    clo*

    Jr

    t+ :,

    6

    6.-nrf

    irt

    [\r""

    o

    olooo

    "/oool

    Rx(r")=

    1.r.."

    "1A??

    -.ro""l

    (p\-y)

    L"r"'o

    oTooo orh??)

    i34

    ,J,drtl

    ,r,_l:tt+

    c

    _---t-

    ..,br:

    l)

    ,?_l

    S

    ty,g

    olal..i.,

    ['r,fV

    -'tYY

    'rtO-l

    Rz(Y.)

    Rr(f')

    =

    l"rO"

    "zVO

    -.rftl

    L'r'"

    o/Ao

    "rAVJ

    (PY-Y)

    f'rrtv

    -'/d"

    'r'"-l

    *

    R*(Y")

    Rz(\'"

    )

    =

    l"rff

    .rVO

    -.r0"

    I

    l"rYO "tlY

    "rAYJ

    --e

    s,s-7J.

    ,l

    o:ll-

    .l

    ,r_jU_rl

    t+f;,

    ,'n:

    -i

    tSU.lt:,:rls

    uA*

    g,_l

    1

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    68/569

    ,#

    ut|;i,rt+Jg*y

    t$to;

    0o

    .c-ti

    6tarrr,-,

    Jf

    ufl

    )

    ,6

    .Jr.,l

    \V-

    YJifu

    l[u_l

    .r:-1t61

    .,rLl

    ,1i,/

    rL-tt-l J,t61,tJrrSUr;llrl:-7lri,,[[,:l1f y-l;l

    .r.2lr

    :.r,-26

    i: .9-t

    6Lr:1r.2 ,i

    .rt

    ltj

    ,:f

    ],s.

    lti-l

    tr

    +tt

    lr-:

    ;j,g

    .tt'

    J'a

    +

    ARxvz(t,

    g,,o)

    J:t^. iby

    *-jL

    ;r;el

    c-rdJ

    x-ig

    pt+l

    1-..,,

    *r,lt+t

    clt.tr Jf

    dS*,

    t+b,

    ',)* t*

    Jr

    ,r :'roll

    '\

    .i6,*

    Jr JL::

    yarv

    .l

    AR"rz(1',0,a)=

    Rz@)

    Rv(A)

    Rxo\

    =

    [::

    -ll

    :l

    l':

    i

    'i]

    [r

    ;,

    -;]

    L

    "

    '

    'l

    l_-,0

    ,p)

    L"

    ,;

    ,;)

    (Pr-Y)

    -r6q

    ,Jt+lrr:

    u*;r; c^-b.l

    .c*l . . .

    .1

    ,sin

    a t;;;-

    so

    rcos

    a

    .;,i;-

    co

    ;i

    t,

    d

    4J

    ,j-l

    r.

    ,d

    ,?j

    ,sJ.^t

    ,-,rfr

    l

    l+1,,r,

    Jl

    .trlt

    c-*^al

    rt-.-:

    (Pf-Y)

    ;,

    &-r

    t+--;t

    ;ttf

    --,-\.Rt(") f\lr

    s,Ry(p)

    r,Rx(f

    )

    l+l

    'r/.r-"li

    J^'

    tre

    a';.;

    (21-Y)rr

    lcac1l

    cosljs^1

    -

    sac1

    cas13c11

    so's7l

    AR*rr3,0,a)

    =

    lror0

    soslsl

    I

    cacl

    sa-sBc1-

    co.sJ

    I

    ttt-tl

    l-''n

    c|s^r

    c{tc'1

    J

    'L*

    t

    t*

    Jr; .1r

    Pitch

    'Y

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    69/569

    0

    \

    ,r.6*,{e

    ,}.2V

    i}.;,&,

    ,rJtL,

    k-

    (f

    f-Y)

    iJ:b,

    .:jLcf

    Li^L

    I

    tCfrr,*,;,tail-2r

    r-\.'3

    clrl

    i-;

    ^f

    +5o.y

    3,8

    1lslt,tn

    Jr,1

    t;lsl+

    X,q

    Jr:r.71:.21-l

    n

    -.;t+.-u

    lt+jl

    tslb:s

    cD.

    .o

    i;l.tla,

    2n

    Jr

    ,_t-;JU;l

    I

    Jrt'.

    c,:t'X-Y-Z

    6l_ly c;,,-

    ,F+r

    l4l

    L rk

    u_l

    byl'd-U

    UU

    'CJ-

    \Qs-*rr)

    Jk

    6Lrd:L

    ;l

    jcr-^..r,-

    yrl..

    rr-*

    .p-.rrT

    a-rr

    ; er

    t{J

    d+T.r

    cs- a

    rJrL 1,.-*

    tll-h:-1.5r,rfr)

    'r--rv

    tr,srL-

    bVr-v).+h

    3

    aJ:L

    t-

    u,i,-,1:,r;l:

    t5a5

    u ,4 Ar.i;,alrL

    1

    y-l_2r

    .r93.Jj;lr

    Jrar-

    a-

    AR*rt?Y,0,a)

    =

    ?"r

    r

    ,

    Yr

    Trr

    (r0-Y)

    il-;,rr\

    J

    rrr

    -tn-r.

    L*tlt

    +t--.

    t

    ,5rr.f

    o$t-L

    (Pf-Y)

    L.tJ

    a*l^-,cos

    B

    t

    -?'rr

    d-*;

    _;l

    c;$b

    -5rI ,fJ

    \

    0

    +.:l:

    tr.r.2el

    .*:

    ^.,

    I

    cos

    p

    ,rvlcA

    t

    rrr

    lrg,^,.

    ,-;l

    c;l;b

    6i,jiJ\1,

    "

    ili,r.cp

    #

    "

    SGV:t.r-;.,g

    .r.2.el

    c-:a,

    rrrlc0

    a

    rnlcg

    c+;l

    c;l;b

    .5rT

    uJ\1,

    I

    :

    ;-i

    ol-ict

    o-o)ti

    ,*+

    0

    =

    Atany(-rr,,,

    ffl

    +

    r;.,y

    a

    =

    AtanY(rrl

    lrl3

    ,

    rrrlc0)

    7

    =

    Atan

    Y

    (rrl

    lcp

    ,

    rrr

    lc0)

    \.c*l

    6la-t:-

    .1:

    c.,;l;;L-

    JrT

    Atan

    Y (A,

    r)

    ,rT./,

    at

    '^kbl

    Jti-r

    tsl

    c-i

    c-)lr

    FJ.h.2.:

    L

    Ll ,:.71r:;-;

    2

    ,-/s,

    vl9.

    \

    Jl

    ,.*t:.

    da

    UU

    ,r-l

    .,-:-:lr

    f+b;

    -1oo

    j

    .

    ;=-;

    ;

    -S_t Gt_*7

    iliL/

    l,

    {B}

    -,.

    .;-;t+t

    2s

    Jr

    l+l

    {B}

    .+5

    er,.

    -t,r-h-

    {n}

    f-J,-

    v-rrf ,

    6

    ,s.-nrf:l

    .i-r:

    oLr)

    7

    i;ltla;

    *n

    Jf

    (fl-

    r,p'ollsl^,?"

    Jf

    ,s=-,a;;l-ulr

    f

    t

    il ,{1}

    cntj

    Fr.

    o;r,{

    B}

    S-*

    oK;,

    jl

    cstr.

    Jr ib:t},,rs.t

    ,-r_lt>

    c52p

    Jr

    .,tr,

    g

    aS

    +J

    o+y

    .LU.f

    *sl

    ts\lu

    t

    .,1:,

    u

    ,j-l

    b*

    t.J,-r

    Jr

    iL::,,-,J-l

    d:"1

    *

    o-.-?

    .:.71r

    f-

    "-F,st+ :r

    t,-rT

    jtS..

    d

    t-Jr-r,-,12.-o

    .fEe

    Z-Y-)I-

    *-i

    "s -l_st,

    ,#;+-,j.,-l

    U-l

    ,t-rLt'

    {;l

    *

    ,

    ,Y

    ,2

    csr,"t:n

    i-;l.r;la".1f-e:..ra:,r,

    ul_t^j

    ),;lL-51;

    jlts>-p:l

    e.t

    {B}

    rstot:^,

    \A-Y

    Jifu,

    ,..,f:r

    *

  • 7/23/2019 Mechanics and Control in Robotics

    71/569

    6f

    ,rr*{e

    oZ.;

    i1\i

    J1,,rJt ,

    Z6

    Ys

    ?o

    f;R

    -

    fr,R. E",R

    Bo"

    R

    (tl-Y)

    .c-l eJ.-3

    i

    Z-Y-X.tr-:l

    st-l:,

    Jt-tn\,c- c*

    g;t+bst

    tl.f-,'l

    ai

    -2:

    .5

    +T.f

    c*rde

    tj

    rt-t'1

    {A}

    du

    c^.-.i

    {f

    }

    a_t+

    ,s;r4-

    f

    R2,y,*s,

    -

    Rz(a)

    R,(0)

    ftx(r)

    f."

    -sd"l

    lrO

    'P'l

    ft

    . .l

    =

    [:

    ':

    ,]

    l_,,

    '

    ;l

    ["

    ::

    ;i]

    (v._y)

    kS

    +l3'.,J"-S"--,r

    t+--rL

    =-e

    tr....1,so

    =

    sin

    e. tce

    =

    coso;ir: af

    t-*,-l

    lcacg

    casBsl

    -

    sc.cl

    cosBcl

    *

    sasTl

    f

    Rs,y,1s,(o,,

    A,l)

    =

    lsac/

    saspsl

    *

    cacl

    sasBcl

    -

    ro"7

    |

    l-tB

    c/s^t

    c|c^t

    J(V\-Y)

    ,54-t*

    Jf

    .r r,

    ad

    o.Ja

    ,Slt

    6 c*l

    6laa=l

    \

    )t

    'E.i,

    ,.iy

    'a4*

    AS

    +5

    otf

    t\t

    E,}.t.JL

    1s

    or[:--

    -*

    c)a

    b

    ra.=;

    ;r1l

    t:;u.

    J-;

    ,-"-fu,.*;/-

    [

    c.,ti

    c*l

    aJ--,.iti

    6t.l.7-9,^,.

    Jf ib*,*

    pt+l;l

    ,-,

    o.LI

    cryrrJ

    .,,-t4

    6fa-:c*l

    .Z-Y-X

    -$l

    ,st

    lr;

    \

    A-

    Y

    JSJ

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    72/569

    cl,.t-tn

    Jr

    '**

    4;t,.r ::

    &

    j,,

    I

    f+

    I

    ;

    I

    -:j::;

    T:,

    .Svz

    *-;;$

    bstsT

    cryr.r

    (J;

    b.JrU.

    y-l

    r.t^.

    J-

    +,c-l

    JrL

    (Pf-Y)

    lr

    (Vt-Y).j+L

    i:t

    ,slt

    ;tlj,a

    b

    Vf

    -Y)

    it1

    ,F-r

    ort.ct

    .c^-J

    jU

    ,rLr,

    ,r-tl

    ;l

    Z-Y-Xy'-:l

    .st-h;

    .r-r

    -r6t

    ,;

    ,frr-

    iLs:.

    ,y-tL

    t

    ,lt:i

    Z-Y-X

    -f,-:l

    ,sL-lU,J:-,;T

    c*:r

    ,tf;i,sinB+"Jl

    Z-Y-Z

    *:l

    (Jltilt

    :c*l

    s;

    {B}

    v*rla;;l

    u-&-'

    J:

    t

    ;;r's

    ra'

    t

    "

    t:

    :,,1,1?rff"

    oil

    y,'I--,:;Y;;r*

    f*:i

    u-l

    ,sfi,t

    J:

    j

    {n)

    S-*

    -.

    r.rltr3

    q--..;

    t+ r,

    u-l

    ;t-n

    6

    .45

    r-.

    j;

    plh,l

    2

    r,Y

    ,2

    Lsl^1t^-

    Jr,r :r

    -

    i).rf,.rj.up

    -*-:lL-:l:

    il=-rt

    ,kl

    .E,l Z-Y-2.{-ll

    crUl

    L

    0t

    "i-[

    ,,i1;

    ,c-l

    or.i,

    r.T .up

    c-)4

    g;3

    Jrt

    jbss

    ,r-tt

    ,Jl^;

    e

    ,bb;L"

    i# Jt"r

    lcacPcl

    -

    sasT

    -cacBsl

    -

    sacl

    cosg]

    f

    Rs,y,s,(o,,9,^t)

    -

    lsacBcl

    I

    co.s1

    -sacpsl

    coc1 sosp

    I

    tvr-rt

    |

    -"/rt

    slsj

    c0

    J

    :c*l

    r.uT

    tj tt,if:r ,r-tl

    Cpl:

    I

    Z-Y-Z

    ,L-21

    6l-11;'+A

    ,b

    c*l

    g=:q

    ibs:

    ,r_tV

    ftrr

    rrr

    rrrl

    fiRs,y,,,(o,

    A,l)

    =

    l"rr

    rrr ,rr

    l

    (Vr-Y)

    tt

    Ltt'r

    ?nrr

    TrrJ

    (Yr-r)

    AtanY(f4,

    +

    4,,

    r.rr)

    Atan

    I

    (rs

    f

    sB,

    rvl

    sA)

    Ata,n

    Y (r1

    f

    sB,

    -

    rrt

    I

    -s0)

    B_

    a-

    t-

    It

    vlr

    o.2l9

    .r ,P

    Ulr-1r

    c-,:..

    ,L

    ,>tJ

    -b

    tt

    I

    Ll ,r,-i,r,.

    c-).

    =h

    tt

    \

    Jl

    ,p

    =

    \Ao/oo

    \0

    =

    "1'

    $"Syel.Cga*l-."to

    1P

    -l

    t:,

    ef+ef+e[+e[-\

    (r.

    -Y)

    ,[1;

    ,f

    .rr

    blr

    Lf t

    ,slr-S

    .h)

    J

    .l'l,.Li

    tt12ea

    bli.-r.

    b

    c;Jp t

    U-Ug.

    JtLl

    .A-

    lrirt I

    x

    \

    rlrr.i-

    it1:euy'-jl

    u;LAr:.,f1,;bel

    ,-16.tf

    ,.-.+

    rr.r+

    l

    alfrt+t

    l,

    t+l

    ,r1,;6a1 f

    x

    \

    -21:r,

    ,f5;

    +

    t"r 1.

    U-l

    Jl

    .s-;'g

    dJ

    _h

    ,,

    tFg

    dLtj)

    0:+

    ,c^-l

    ,L_51

    ,56.n

    fr-r.;-y.l

    R,=

    lf(.,ey{eye1)

    lr(ers

    -

    y1)

    'eU.r

    \\;l

    6las2.^.

    JtL

    ^5,R,

    bbst

    ,r-tL

    Y(e1e1

    -

    r(r)

    Y(.,e1'

    +

    eref)l

    \

    -

    Ye

    {

    -

    Y.l

    Y(e

    1e;

    -

    .,,.r)

    I

    (1\-y)

    Y(eyes*erer) \

    -

    Y.l

    - r.ll

    f,F

    tL:'

    ,r-;u

    Jl

    Trr

    -

    Ttr

    c,

    -

    -

    '

    fet

    ?.rr

    -

    frr

    Y

    -

    _

    '

    fet

    ,l\

    -

    ,

    \r

    C?--

    '

    fet

    \_

    et=iy'\+rrr*rrt*rrr

    rSt-ttu

    Jr

    \A"o

    .rl,rlr.i_,J.l:

    jb1o,r-tL

    6Gr-r-r:

    (ly-y)

    ila ,

    d+t.t-r

    Ul

    .&iJ.up

    ip

    c*

    .

    {

    r,.-,,.}

    tt_ltt

    -;,v-il:.ulp.j t^.

    rrr6,U

    t

    i .2r

    ..uiLr,

    c/lr

    4b,

    i

    cJL

    u-l

    ,sD

    (lf-Y)

    .st".lq

    ef

    rlr

    lf

    ;jtg

    ..lL

    r,.rp./t

    t-\,

    \l

    ;-; -2r

    o.,l.e-e

    tre;.5

    c--l;;y,(At-y).st++r.

    ++,

    -rrlo.r.i

    ^t

    :ti

    S

    er_1e

    ,b

    :l d Ck ;-p

    c, r.r

    tr

    jl

    rrl.r-

    ,l

    \

    ;rl-i,l

    lrl+-;r+-r

    t+&

  • 7/23/2019 Mechanics and Control in Robotics

    80/569

    bbst,r-

    tL,t2

    2,e

    t

    J-i d r.T iLi

    ,lJl-,

    cr

    tr

    :.r

    ::

    :::::":',

    ilt-.3,

    L-

    i+,

    ,,.g-1.jit:-lrJ::f

    rrll'

    -l,,.;*

    &rs.r*n;.f,l

    .L*.&-t

    G.rf

    L-

    ,J-1lr

    I

    c,lrr.r

    rr

    il-:q

    t+r,r["33

    ,.):ylcrblj

    S

    u.\u

    ttl+-,

    ,

    "

    ,u_D\.rrl.r

    $T

    .rrlJd

    'DrT/; -u

    6

    ,J,4P'jvo'

    tog)tr

    ,le

    ' "

    u-t

    c-lui-,

    ..t1,-,.

    5,tJ..rl,

    :

    ,tJ

    .r:..i,t

    c-:l:

    ;;

    (s">

    cs

    *l

    L-

    aO*-1,

    c*

    tD

    J:-;L

    r-\-i

    sjr,-.;,

    'h,

    jl

    ,s;J+"

    ,slt,lW

    t,-t&

    U_lJI,JLro.,:.c*l

    orL

    aL;l

    a;lra*>l.o;^>

    Cr-l

    tr

    i#

    ..u

    Joli

    fJer,r

    -rl=*

    ,-

    "=-

    ,J:.,

    16{

    6;+

    '*j

    rli

    sta;lr;

    ,Lrr

    1-Y

    ya

    3

    ur-

    q5te-1lrr1 ..rii

    15LCl--i

    y:

    .6-ll:

    -rSs-,rt(,

    dt^_rl:,

    .lo

    ,JL.oi

    r;l;r

    ..llc,;ti,

    U

    ,l

    ,4tr.1lrra

    4T

    lt-:,c-l

    c,eLt

    l-o.2b2

    i/-l

    ,.1,-{

    .#r+tr ,rtt

    -o

    b

    t

    aL;1\:r,.5:

    .f-Frl;16

    olti,'larlr;

    (,r;-rlr")

    ,(:*"

    :6tb,g-

    &tS..2r

    Lp;

    c*l

    gS-.

    r. .

    ,lrr,

    j:

    .r-i[.

    ;L-S,-b{

    .-e

    5.0;\s\.;r..-,L_:

    {

    sr.\r.f,-S"-

    .+-5..

    -b

    I I

    Y \

    -

    Y

    J"fu,

    .2r

    oJ-1,

    orlr

    lt

    l;

    ,Jtr

    lltra

    ^-

    >{:,

    .*

    ^*B

    d)l;,

    ;l

    J,_S"_

    t

    ;_r.

    tL.

    ,r,,.trlr

    ;L*

    -{a

    r

    ,rl,

    ;;lsl

    ,)t

    j'.L-:

    yl:r1

    u

    ,}-l

    .it

    v2

    vJ

    ///

    .1112

    c,-c-

    6tr.2l:r1

    Y

    \

    -

    Y

    JS,J

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    81/569

    ?Y

    gl

    g;b.1ly

    upe,.,

    ,.?.;t+

    ,,;,,,-lrq .rJ\K

    qsE

    -r.

    dt-S,-

    j\

    .u.;jr

    ur\:.

    r:

    rS

    s\S;-..-r

    ,r,L11\sr,

    5r

    JLr:r..

    d-:a,

    u,;Ll_

    ia;

    jsr,

    .-.

    f

    ,-I-iL

    r-\.i r)F,

    cit.-

    JL^,

    ,Y \-Y

    ufS;.2.r

    ,[.r-11:2

    u-l

    ,f-A-bt

    ay

    i-"Je;l

    7trjb.,V

    JlUt.rL3 ...-r

    ,t-r

    ,s-lt,

    s

    t

    j,6

    'fu,t+T

    jrr .t{.--

    e

    [.r-11:r1

    ,y.

    L.L

    ,U)'q..ff

    i .L..-

    ,bt.;.

    tb,

    s:+s

    ;t5-

    Jll

    ,soV

    yly.,r

    c-I

    OS^,i

    r:-+

    -rlrS,r,-t-1lrr4.r-2l:.l3.:bcl,t=-

    );rlS

    6)

    t

    ,Jr.i

    ib

    Ji.rr5,-

    c-l

    OS-,

    ^S

    ,,g\4;tstrgJ

    ;l

    u-ll

    U

    st

    i-,;

    I

    tj

    tt

    :c^-lrr

    f+lf

    -)l

    b

    t

    ,c^t?

    e

    ,;l.ll

    2

    .3)r

    2b

    t

    -r

    .tQ

    i

    3i

    ;l

    S

    c,-l

    6rlsr;

    u ;

    rtry

    ,1lr

    p-,

    jT

    Ul

    e

    U-t

    .;l

    E

    a.5y

    rlrt

    /.st"jl

    UG

    .-ut,

    a:-,:l:

    ,r(:-,

    E

    tlr;-

    .c*l

    "rL;

    1.

    .r,-l

    ++

    6.J

    aT

    f*r-r

    o5,;T

    ;.1.r,

    a,

    d*^i

    B

    N

    Dl'

  • 7/23/2019 Mechanics and Control in Robotics

    82/569

    ,-{

    eV;,-rkrr.ry

    t\L.j

    ?l

    .lrvr

    "1,-.tr

    YY-YJSJ

    ./ -,tt"

    crtg-)'.

    \"-Y

    Ll

    ,c*l

    c.:,b

    Jti

    "5

    5"-

    y

    t*.t-i-2.1r ,;tful

    "sQt-..

    ;rs

    it1.

    d;d>

    Jt

    .x-iL

    ,u-il:

    ,r*1..

    ,:-; ;t-t".

    -t-t

    ,G\tr

    6[nt(*t

    el]-rr

    t'

    j-*

    C+

    ,sl.eylil,.1-.-l'cl-2:

    Ll ,c*,1

    J:-.rr JU,

    6t

    rslt

    6,L.

    ,j-1-

    \ Jl

    2l-rrr--

    is{

    --e

    ,slt

    csl-:

    ilj

    at:u

    "r-l

    t,

    D:,r-J.

    ,C

    ort

    -

    'l

    td+il

    ii+.-,

    (fO-Y)r

    (f

    t-Y).st".l+ -2: o.,r-l

    o:lr

    l^i.i

    JS-

    t'1r-.

    d,t-t^.

    .trdr$

    tt+i-

    .l-.4,g

    cir-rlrr,.

    f

    x

    f

    q5L+--rL

    it;

    b)lt

    t

    n:-,

    wt';l

    3;lu.

    1.q;,1

    Jt*ut+ r,

    ,'Jc.

    .r1lSu.

    ilrlt;U

    i,t-t-..

    f

    J,,,I,-ri

    .sL+--rL

    v-e

    4j

    t'-r31

    -b

    tt

    tj

    ut-t-l

    b rlt;^

    4

    (4.1r.a)

    op=AR

    in

    $n

    op

    (

    1o- Y)

    rtV

    I

    #R

    ,e-tV

    b

    rJ

    +-*J,.rS"-r:

    b

    .r[:

    sl.t--r[

    lt:.,|

    a5c*l

    ;T

    ,-ir,'

    .5.,-

    L_i

    ,--tn.rr-1

    op=iR

    op

    (tt-Y)

    .up

    3i

    ,k

    Y?

    ),-'r,>

    J^t

    Of

    q;

    ,;l6r.e:

    Jg-

    a-

    6,

    illR.lr.2eic-ra,

    ?

    s

    u-J

    J'^t

    t

    1.1

    :-

    3

    $?-Y)

    ;rl=s

    t5

    itt i

    e-tV

    v-e1t+l

    ..-1,

    www.mohandesyar.com

  • 7/23/2019 Mechanics and Control in Robotics

    83/569

    ?6

    e.V

    F,Lc

    YY

    2,r2.b

    ,j*

    rY

    il*

    r.rr.

    d,q-b-,

    ,[5:l.r--

    ,d1,;--r,

    .c*l

    g.a

    .,|.s

    .a:*l

    t+,-,-;U

    9

    ,rrtj'

    ,l

    cful:l'rt-r.

    +,

    ,b-,.

    ,j-+ ,tt.

    jl

    ,,;,-rt

    ,tlt

    ,s4*

    Jt

    t

    l

    ,f-,d

    :.1

    l3

    c,f-L^..

    .rt,F-" -

    op

    =AR

    op=AR