Electronic Differential Control With Vehicle State Observer Based on Extended Kalman Filter

Embed Size (px)

Citation preview

  • 8/13/2019 Electronic Differential Control With Vehicle State Observer Based on Extended Kalman Filter

    1/4

    Electronic Differential Control with Vehicle State Observer Based on Extended

    Kalman Filter

    Li Jun1, Duan Jie-li1, and Tian Shen2

    1College of EngineeringSouth China Agricultural University

    Guangzhou, Chinae-mail: [email protected]

    2School of Civil Engineering and TransportationSouth China University of Technology

    Guangzhou, Chinae-mail: [email protected]

    AbstractThe growing demands for high level of energy

    efficiency have given much new impetus to the development of

    electric vehicle in Agricultural Machines. To improve the

    performance of the state observer for an 8-DOF four-wheel

    vehicle, a state observer based on the Extended Kalman Filter

    is proposed. With the observer, the tire-road forces and the

    vehicle roll velocity are estimated accurately according to the

    simulation results. With the consideration of the nonlinearcharacters of tire and electric vehicle, the electronic

    differential controller is proposed to select the wheel slip ratios

    as the control tracking variables and distribute the torques to

    ensure the steering stability by using modified exponent-

    approaching sliding mode control method. The proposed

    electronic differential controller is robust to improve the

    handling performance and control response of electric vehicle

    with the numerical verification.

    Keywords- electrical differential control; Extended Kalman

    Filter; sliding mode control; Magic Formula tyre model

    I. INTRODUCTION

    Presently, continuing interests of the green agriculturalequipments have further stimulated the development ofelectric off-road vehicles. The in-wheel motor multi-drivesystems for electric off-road vehicles have advantages overthe classical construction with one central machine. Wheelmotor drive systems provide better handling stability withthe electronic differential control during steering manoeuvres.

    However, it is difficult for the steering control system toobtain directly some parameters including the sideslip angle,yaw rate and lateral velocity of vehicle. Therefore, severalvirtual observers had been employed to estimate the states ofnonlinear dynamic vehicle. The sliding mode observers were

    proposed to replace the expensive sensors used for themeasurement of tires forces, side slip angle and velocity of

    vehicle [1, 2]. The H observer-based controller was provedto have considerable improvements in the vehicle handlingwhen the sideslip angle was unavailable for measurement [3].To address vehicle nonlinearities and unmodeled dynamics,the unscented Kalman filtering technique was applied for theobserver of lateral tire forces and sideslip angle [4, 5].

    Different from the mechanical differential, the forces androtational speeds of the electrical differential motors cannotautomatically coordinate while cornering for the requiredchanges of steering angle and torques. Based on Ackermanturning geometry, many approaches taken account of the

    speed difference between the drive wheels when steeringwere proposed [6, 7]. Other steering controllers using thevehicle speed as input were designed to guarantee theelectric vehicle dynamics and stability [8, 9].

    In this paper, an eight-DOF nonlinear model of vehicle isdeveloped with some general assumptions to obtain steeringdynamics. Consequently, a vehicle state observer based on

    the Extended Kalman Filter (EKF) is proposed. To improvethe performance of electronic differential controller, themodified exponent-approaching sliding mode control schemeis implemented with the selection of wheel torques as controlvariables. The proposed controller is robust to improve thehandling performance and control response of vehicle.

    II. VEHICLE STEERING MODEL

    To describe vehicle dynamic movements including rolland yaw, a vehicle model with eight degrees of freedom isdeveloped in this section, which comprising the longitudinalmotion in x and y direction, rolling motion around x-axis,yawing motion around z-axis and wheel rotational motion offour tires.

    Assume that the front steering angle and side slipangle at vehicle center of gravityare small, thenvxV vyV sin cos1

    WhereVis the total velocity at vehicle center of gravity, vxand vy are the longitudinal and lateral velocity at vehiclecenter of gravity.

    Ignore the aerodynamic forces and rolling resistance ofthe tires, thus, the eight-DOF nonlinear model of vehicle can

    be obtained [10]

    (1)While mis the vehicle mass, mSis the mass of the sprungmass, FxfandFxrare the longitudinal tire force on front andrear tires,FyfandFyrare the lateral tire force on front and reartires,ris the yaw rate of vehicle,is the vehicle roll angle,hsis the distance between the sprung mass center of gravityto the x-axis, lfand lr are the longitudinal distance fromvehicle center of gravity to front and rear tires, C is the

    ( )( ) ( )

    ( )

    1 2 1 2 1 2

    1 2 1 2 1 2

    1 2 1 2 1 2

    ( )

    2

    x r xf xf xr xr yf yf

    x r s s xf xf yf yf yr yr

    z z r xz f xf f xf f yf f yf r yr r yr

    f f

    X mv F F F F F F

    Y mv m h F F F F F F

    M I I l F l F l F l F l F l F

    dl K

    = + = + + + +

    = + = + + + + +

    = = + + +

    +

    ( ) ( )

    2f r

    r r

    x x xz r s s x r s s

    dl K

    d d

    M I I m h v K m h g C

    = + = +

    2011 International Conference on Computer Distributed Control and Intelligent Environmental Monitoring

    978-0-7695-4350-5/11 $26.00 2011 IEEE

    DOI 10.1109/CDCIEM.2011.376

    172

  • 8/13/2019 Electronic Differential Control With Vehicle State Observer Based on Extended Kalman Filter

    2/4

    equivalent damping coefficient of the rolling motion, KfandKr are the front and rear wheel tire camber thrustcoefficients, df/dand dr/dare the front and rear wheelcamber angles per unit roll angle, Izis the total yaw momentof inertia around the vertical axis passing through the vehiclecenter of gravity, and Ixis the rolling moment of inertia ofthe sprung mass around the x-axis.

    Using (1), the vehicle longitudinal acceleration axandlateral accelerationayare

    [ ]( )[ ]

    1 2 1 2 1 2

    1 2 1 2 1 2

    ( )x xf xf xr xr yf yf

    y xf xf yf yf yr yr

    a F F F F F F m

    a F F F F F F m

    = + + + += + + + + +

    (2)

    The longitudinal slip ratioof the front or rear wheel isdefined as

    ( ), , , ,

    , =1, 2fi ri fi ri fi ri fi ri

    r u u i = (3)

    Wherefi,riis the rotational speed of front or rear wheel,risthe wheel effective radius. Variable u fi,ri is the velocity offront or rear wheel, and it can be calculated from

    1 2

    1 2

    2 2

    2 2

    f f

    wf r f wf r f

    r r

    wr r r wr r r

    b bu V l u V l

    b bu V l u V l

    = = + +

    = + = +

    (4)

    Wherebf,brare the front and rear track of vehicle.The slip angles at front and rear tires are [11]

    1 2

    1 2

    arctan arctan2 2

    arctan arctan2 2

    x f r x f r

    f f

    x f r x f r

    x r r x r r

    r r

    x r r x r r

    v l v l

    v b v b

    v l v l

    v b v b

    + += =

    +

    = = +

    (5)With the definition of the height of center of gravity of

    vehicle as constant h, the normal loadFzfi,zri of front and reartires can be written as

    ( )

    ( )

    ( 1)2 2

    , =1, 2

    ( 1)2 2

    i y xr

    zfi

    f r f f r

    if y x

    zri

    f r r f r

    ma h ma hl mgF

    l l b l l i

    l ma h ma hmgF

    l l b l l

    = + + +

    = + ++ +

    (6)

    The Magic Formula tire model is used to describe tirebehavior as follows:

    ( ){ }[ ]sin arctan arctanv

    h

    y D C Bx E Bx Bx

    Y y S

    x X S

    = = +=

    (7)

    Where Y are the output variables including longitudinalforce Fx, lateral force Fyor aligning moment Mz, Xare theinput variables including slip angle or slip ratio ,Shis thehorizontal shift,Svis the vertical shift.

    With the selection of the constants a1, a2, , a8, thestiffness factor B, shape factor C, peak value D andcurvature factor E can be expressed as functions of the

    normal loadFzas follows

    ( )( ) ( )3 4 5

    2 2

    1 2 6 7 8

    sin arctan lateral force

    ,z

    z z z z

    BCD a a a F

    D a F a F E a F a F a

    =

    = = + + (8)

    To describe the lateral transient behavior of tires, therelaxation lengthis introduced, so that,

    ( ), , ,

    , =1, 2x

    yfi yri yfi yrii yfi yri

    vF F F i

    = (9)

    Where,yfi yri

    F is the lateral force in the Magic Formula tyre

    model frame.

    III. STATE OBSERVER DESIGN

    Due to the EKF is an optimal stochastic observer in theleast-square sense for the estimation of nonlinear systems,the proposed vehicle state observer is designed by using theEKF technique to estimate the tire-force and dynamics ofvehicle especially including the roll angular velocity.

    Defining:State vector:

    ( ) ( )[ ]1 2 1 2 1 2 1 2

    , , , , , , , ,r yf yf yr yr xf xf xr xr

    x F F F F F F F F = + +

    Input vector: [ ]1 2 1 2 1 2 1 2, , , , , , , ,f f r r fz fz rz rzu F F F F =

    Output vector: [ ], , ,r x y x

    y a a v=

    For this application, the nonlinear eight-DOF dynamicstate-space equations of vehicle are expressed as

    ( ) ( )( ) ( ) ( ) ( )( ) ( ) ( )( ) ( )

    0 00 ~ , , ( ) ~ (0, ), ( ) ~ (0, )

    x t A x t x t Bu t Gw t

    y t Cx t v t

    x x P w t Q v t R

    = + += +

    (10)

    Where w(t) and v(t) are the zero-mean Gaussian processnoise and measurement noise vectors with covariancematricesQandRrespectively.

    Assuming a sampling time of Ts, the corresponding

    discrete time model can be obtained as( )

    1

    ~ (0, ), ~ (0, )

    k d k k d k k

    k d k k

    k K k K

    x A x x B u w

    y C x v

    w Q v R

    + = + += + (11)

    WhereAdI+ATs , BdBTs ,Cd=C, RK=R/Ts,

    0

    ( ) ,s

    s

    TA T T

    k K sw e Gw d Q GQG T

    = The prediction of the state covariance requires the

    online computation of Jacobian matrix, defined as

    ( )[ ]1

    1k

    k d k k x xA A x x

    x +

    + =

    =

    (12)

    The recursive algorithm of the Extended Kalman Filter

    can be derived as below.Step 1: State prediction (time update)

    ( )1 1 1 1

    ,T

    k d k k d k k k k k K x A x x B u P A P A Q

    + + + += + = + (13)

    Step 2: Innovation (measurement update)

    ( )1 1 1 1 1 1 1 1 1

    ,k k k k d k k k k d k

    x x K y C x P P K C P+ + + + + + + + +

    = + = (14)

    The Extended Kalman Filter gain matrixKis calculated by

    ( )1

    1 1 1

    T T

    k k d d k d K K P C C P C R

    + + += + (15)

    173

  • 8/13/2019 Electronic Differential Control With Vehicle State Observer Based on Extended Kalman Filter

    3/4

    IV. ELECTRONICDIFFERENTIALCONTROLLER DESIGN

    To avoid skidding, the speed of the inner wheel has tobe different from that of the outer wheel while cornering.Assume that the front and rear tracks of the vehicle areequal and the drive wheels are turning without slip. So that,the conventional electronic differential controller of electric

    vehicle is designed using the Ackerman turning geometry.In the geometry, the difference between the angular speedsof the wheel drives is expressed by the relation

    ,0

    ,

    2

    2

    f r

    i f r

    R b

    R b

    +=

    (16)

    Wherei andoare the angular velocities of the inner and

    outer drive wheels,Ris the radius of rotation.However, the longitudinal slip of tires and nonlinear

    dynamic characters of vehicle cannot be neglected for bettersteering control. Therefore, an electronic differential controlscheme based on sliding mode control and EKF stateobserver is proposed. The proposed controller chooses the

    tire longitudinal slip ratios as control variables not the wheelspeed, and distributes the torque value to track the referenceslip ratio of each drive wheel by using the sliding modecontrol. The EKF state observer is employed to estimate thevehicle state parameters and feedback them to the steeringcontroller.

    The dynamics of dual rear wheel drives are given by

    , =1, 2w ri ri xri

    J T F r i = (17)

    WhereJwis the wheel moment of inertia, Triis the torqueof rear wheel.

    Note that the variables and both are the functions of the

    slip ratios from (3), (6) and (7), the speed u ri and normal

    load Fzri of the rear tires can be considered as constants

    compared to the slip ratio when the control system is stableand if the sampling period is short enough. So that, (17) can

    be rewritten as

    , =1, 2ri ri ri

    A BT i = + (18)

    Further, the sliding surface of the electronic differential

    control scheme is given as

    ( )*ri ri ri

    S c

    = (19)

    Whereri*is the reference longitudinal slip ratio which is relative to the adhesion coefficient.

    To guarantee rapid responses and depress system ripple,

    (19) can be derived as follow

    Figure 1. The block diagram of the proposed controller

    ri

    ri ri

    ri

    SS S

    S

    = +

    (20)

    Wherec,,andare positive control constants.Since the control performance of a discrete system is

    much influenced by the sampling periodTsand constant, itis necessary to modify the exponential approximation law.

    The discrete modified form of (20) is selected as follow

    ( ) ( )

    ( ) ( )( )

    ri

    ri ri ri

    ri

    S kS k S k S k

    S k

    = +

    (21)

    Then, (21) can be rewritten in the form

    ( ) ( )

    1 ( ) ( ) ( )

    ( )

    ri

    ri ri s ri s ri

    ri

    S kS k S k T S k T S k

    S k

    + =

    +(22)

    When the sampling period Tsis sufficiently short, the

    existence of sliding surface for a discrete controller can be

    guaranteed if the following equation is satisfied

    {[ ( 1) ( )]sign[ ( )] 0[ ( 1) ( )]sign[ ( )] 0S k S k S k

    S k S k S k

    +

    (23)

    Substituting (22) into (23), it is easy to prove that themodified discrete sliding mode control system is globalasymptotical stable when the values of the control constants

    c,and all are within their bound.

    V. SIMULATION RESULTS

    To confirm the effectiveness of the proposed nonlinearvehicle state observer and electronic differential controller,some numerical simulations are implemented with the 8DOFmodel and Magic Formula tire model. The specifications ofvehicle is listed in Table I. The vehicle is undergoing anextreme maneuver with a small steering angle = 2 (positiveindicates a left turn), and a constant speed of 20m/s.

    TABLE I. SPECIFICATIONS OFVEHICLE WITHDUAL WHEEL DRIVES

    Vehicle mass,m 1252kg

    Distance from vehicle C.G. to front tire,lf 1.2 m

    longitudinal distance from vehicle C.G. to rear tire,lr 1.37m

    Height of vehicle C.G., h 0.53m

    Wheel effective radius,r 0.32m

    Yaw moment of inertia around vertical axis,Iz2027kgm2

    Wheel moment of inertia,J 2.4 kgm2

    Rolling moment of inertia around x-axis,Ix 381kgm2

    Sprung mass,ms 1020kg

    Distance between sprung mass C.G. to x-axis,hs 0.42m

    Vehicle track,bf= b r 1.4m

    SMC Controller EKF Observer

    *

    r

    1rT

    2rT

    1xrF

    2xrF

    Magic Formula Tire Model

    zrF

    2r2f

    1r

    2r

    zfF

    174

  • 8/13/2019 Electronic Differential Control With Vehicle State Observer Based on Extended Kalman Filter

    4/4

    (a)

    (b)

    (c)

    Figure 2. Simulation results of the proposed EKF observer

    (a)

    (b)

    Figure 3. Responses of rear torques, wheel velocities and slip ratios with

    the proposed sliding model controller

    Fig. 2 (a)-(c) show the responses of side slip angle, rollangular velocity, yaw rate and lateral forces with slidingmode steering control. The results demonstrate that the

    proposed vehicle state observer based on EKF is a suitableestimator and matches the actual parameters excellently.These torque values, velocities and slip ratios of the rear leftand right wheel are chosen to ensure differential controlfeasibility as seen in Fig. 3 (a)-(b). With a stepwise left turn,the modified exponent-approaching sliding mode controller

    can adaptively adjust the inner and outer wheel drive torqueto track the reference slip ratios rapidly.

    VI. CONLUSIONS

    This paper discusses the electronic differential control foran electric vehicle with independently wheel drives. Aneight-DOF four-wheel model for state observer was derived.

    With the proposed EKF observer, the important parametersaffecting vehicle stability and the risk of skipping can beestimate, especially including the tire-road forces and thevehicle roll angular velocity. Different to the conventionalelectronic differential controller, the control variables of the

    proposed controller based on modified exponent approachingsliding mode control method are the slip ratios of the wheeldrives not the rotational speeds. The proposed observer andcontroller are validated by simulation results.

    ACKNOWLEDGMENT

    The author would like to acknowledge the referees, Prof.Hong Tian-shen for helpful discussions on this topic and thefinancial support of Department of Education of Guangdong

    Province, China.

    REFERENCES

    [1] H. Shraim, B. Ananou, L. Fridman, H.Noura, and M. Ouladsine,Sliding Mode Observers for the Estimation of Vehicle Parameters,

    Forces and States of the Center of Gravity, IEEE Decision andControl Conference, Dec. 2006, pp.1635-1640.

    [2] O. Khemoudj, H. Imine, M. Djemai, and L. Fridman, Variable gainsliding mode observer for heavy duty vehicle tyre forces estimation,International Workshop on Variable Structure Systems, June. 2010,pp.522-527.

    [3] M. Chadli, A. El Hajjaji, and A. Rabhi, H observer-based robustmultiple controller design for vehicle lateral dynamics, American

    Control Conference, June. 2010, pp.1508-1513.

    [4] M. Doumiati, A. Victorino, A. Charara, and D. Lechner, Unscented

    Kalman filter for real-time vehicle lateral tire forces and sideslipangle estimation, IEEE Intelligent Vehicles Symposium, June. 2009,

    pp.901-906.

    [5] Z. Pan, C. Zong, J. Zhang, X. Xie, and Y. Dong, UKF and EKFestimator design based on a nonlinear vehicle model containingUniTire model, IEEE Mechatronics and Automation Conference,Aug. 2009, pp.4780-4784.

    [6] S. Gair, A. Cruden, J. McDonald, and B. Hredzak, Electronic differenti al

    with sliding mode controller for a direct wheel drive electric vehicle,IEEE Mechatronics Conference, June. 2004, pp.98-103.

    [7] B. Chen, C. Yu, W. Lee, and W. Hsu, Design of an ElectricDifferential System for Three-Wheeled Electric Welfare VehiclesWith Driver-in-the-Loop Verification, IEEE Trans, On VehicularTechnology, Volume 56, Issue 4, 2007, pp.1498-1505.

    [8] A. Haddoun, M. El Hachemi Benbouzid, and D. Diallo, Modeling,Analysis, and Neural Network Control of an EV Electrical

    Differential, IEEE Trans, On Industrial Electronics, Volume 55,Issue 6, 2008, pp.2286-2294.

    [9] A. Haddoun, F. Khoucha, M. E. H. Benbouzid, D. Diallo, R.Abdessemed, and K. Srairi, SDTC Neural Network Traction Controlof an Electric Vehicle without Differential Gears, IEEE VehiclePower and Propulsion Conference, Sept. 2007, pp.259-266.

    [10] M. Abe, Vehicle Handling Dynamics Theory and Application,Oxford: Butterworth-Heinemann, 2009, pp.191193.

    [11] U. Kiencke, and L. Nielsen, Automotive Control Systems For Engine,Driveline, and Vehicle, 2rd ed., Berlin: Springer, 2005, pp.312316.

    175