nonlinear motion equation

Upload: tomcat14d

Post on 05-Apr-2018

214 views

Category:

Documents


0 download

TRANSCRIPT

  • 7/31/2019 Nonlinear Motion Equation

    1/5

    Nonlinear Motion Equation for Tilting Duct Vehicle in Considering Rotation of Ducts

    1 Convention (Right-handed)

    2 Notations

    2.1 Parameters(MKS system of units)

    Tilting angle

    m Mass

    T d PWM duty ratio(DR)

    xxf J Moment of inertia of a fan

    Atmospheric density

    DxC Drag Coefficient about x -direction

    G COM of the vehicle

    Gd COM of a duct assembly

    xS Cross-sectional area of the vehicle about x -axis

    K Motor torque to DR(Duty Ratio) coefficient

    eK Back-EMF Constant

    T C Fan thrust to2 ratio

    QC Fan torque to2

    f ratio

    p Position vector, [ ]T x y z

    +

    k d k b

    i b jb

    k b

    jb r

  • 7/31/2019 Nonlinear Motion Equation

    2/5

    v Velocity vector, [ ]Tu v w r Position vector

    / bb i

    Angular velocity of a vehicle w.r.t. the inertia frame, [ ]T p q r

    / bb i

    Cross-Product Matrix,

    0

    0

    0

    r q

    r p

    q p

    - - -

    , / / / / i bb i i b b i b i= C C

    Euler-angle vector, [ ]T f

    Angular velocity of a fan

    C Rotation Matrix

    F Force

    G Gravity

    J Inertia Tensor

    M Moment

    Q Torque

    T Thrust

    2.2 Indices

    i Inertial reference frame

    b Vehicle body frame

    d Duct f Fan

    act Actuator

    ad Aerodynamic drag

    / A Bp Position vector of point A with respect to point B

    / A iv Velocity of point A in frame i

    / b c

    A iv Components in coordinate system c of the derivative in frame b

    / b aC Matrix that transforms the components from system a to b .C are orthogonal matrices 1 / / /

    T b a b a a b

    -= =C C C

  • 7/31/2019 Nonlinear Motion Equation

    3/5

    3 Euler Angles, NED Navigation System, and Duct Tilting Angle

    3.1 Euler Rotations

    /

    1 0 0 0 0

    0 0 1 0 0

    0 0 0 0 1b i

    c s c s

    c s s c

    s c s c

    - = = - -

    C C C C

    (c , s : abbreviations for cos , sin each.)

    3.2 NED Navigation System

    Orientation follows NED system.

    3.3 Duct Tilting Angle

    /

    00 1 0

    0d b

    c s

    s c

    - = =

    C C

    4 Transport Theorem

    / / b

    b i b ii b b

    d d d dt dt dt

    = + = +

    5 Assumption

    5.1 The fans are symmetric in form about d z -axis. xxf yyf J J = .

    5.2 All the axes about which the ducts rotate lie on COM of each duct fan assembly.

    5.3 COM of each fan assembly are coincident with COM of its duct.

  • 7/31/2019 Nonlinear Motion Equation

    4/5

    6 Kinematics

    6.1 Angular Motion

    6.1.1 Angular Momentum h .=h ( ){ } / / , / , / ,b b d d b b i d f k Gd i k d d i k f f i k

    k

    m m+ + + +J r v J J

    Where

    ( )[ ] [ ]( )

    / , / /

    / , / , / , / , / , /

    T T

    / / / / /

    T

    /

    /

    0 0 , 0 0

    0 0

    by symmetry.

    b b bGd i k G i b i k

    d d d b bd i k d b k b i k d b k d b k b i

    b d b bd b d b d b d b d b

    d f d f

    b

    k G ik

    = + = + = + = = = = = - =

    v v r

    C

    C

    r v 0

    ( ) ( ){ }( )( ){ }

    / /

    / , / , / , / / ,+

    b b bb b i d f k b i k

    k

    b b d b d k d f d b k d b k b i zzf f d k

    k

    m m

    J

    = + +

    + + +

    h J r r

    C J J C

    6.1.2 Effective Moment

    / b i b b b b bG b i= = + M h h h

    6.1.3 Euler Kinematic Equation

    ( ) 1 / 0 0

    0 0

    0 0

    bb i

    -

    = + + =

    C C H

    6.2 Translational Motion

    6.2.1 Acceleration

    / / / / i b b b b b

    G i G i b i G i= + v v v

    6.2.2 Effective Force

    / b i b

    G im= F v

    6.2.3 Position

    / / / i i b

    G O i b G i=p C v

    6.3 State VectorT T T T

    / / / b b

    G O G i b i = x p

    v

  • 7/31/2019 Nonlinear Motion Equation

    5/5

    7 Dynamics

    7.1 Moment

    7.1.1 Aerodynamic DragT

    ad x y zC p p C q q C r r = - M

    7.1.2 Fan Torque and ThrustT2

    ,0 0d f Q f k C = Q ,

    b br T whereT2

    ,0 0d

    T f k C = - T

    7.1.3 Total Moment

    ( ){ } / , / ,b b d d G k b d k k b d k k ad = + + M r C T C Q M

    7.2 Force

    7.2.1 Aerodynamic Drag

    12

    Dx x

    ad Dy y

    Dz z

    C u u S

    C v v S

    C w w S

    = -

    F

    7.2.2 Thrust and GravitybT , [ ]T0 0i g=G

    7.2.3 Total Force

    / , / b d i

    b d k k b i ad k

    m= + + F C T C G F

    7.3 DC Motor System

    2m m e zzf f f Q f

    K K K J u C

    R R = - - for low motor inductance ( )1 L .

    7.4 Servo System

    ( ){ } ( ) [ ]( ){ } / / / 0 0 T b b d d f b d d f d b d b zzf f act y yd d

    q J dt dt

    + = + + + =

    h h C J J C

    act t act J K u b = - -