Professional Documents
Culture Documents
Abstract: By integrating a single antenna GPS receiver and dynamic sensors, key states for electric
vehicle motion control system can be estimated, including yaw angle, sideslip angle, longitudinal
velocity, and lateral velocity. In order to achieve accurate state estimation, Kalman filter with disturbance
accommodating technique considering the handling of time delay in measurements using GPS is
proposed. In this paper, three motion controls of electric vehicle based on the estimated states are
demonstrated. The first is attitude control using front steering angle with feedback-feedforward controller
and disturbance observer. The second is a traction control based on wheel slip ratio control system using
sliding mode control theory. The last is lateral stability control using estimated sideslip angle.
Keywords: electric vehicles, global positioning system, Kalman filter, state estimation, motion control.
gravity on bank road, and the wind effect is also not properly
1. INTRODUCTION
captured. The variation of estimation model’s parameters like
Electric vehicles (EVs) became a novel motion control cornering stiffness according to road condition is another
systems, thanks to the remarkable advantages of electric problem in state estimation of vehicle.
motors (Hori, 2004). The big issue in motion control design
Since the last decade, global positioning system (GPS) has
is how to precisely obtain the key vehicle states in real time.
been a candidate for vehicle state estimation. Besides the
Various states are required to be known for different control
absolute position of vehicle, GPS receiver can provide other
purpose: sideslip angle for lateral stability control,
motion measurement that cannot be obtained from
longitudinal velocity for wheel slip ratio control, yaw angle
conventional dynamic sensor. They are velocity and attitude
for attitude control of electric vehicle, etc. The fact is that
angle or course angle of vehicle. By using double antenna
reliable sensors to measure such kind of motion information
GPS receiver, sideslip angle can be calculated directly
are unavailable at affordable cost. For instance, Corrsys-
without vehicle model (Bevly et al., 2006). This method was
Datron produced the noncontact optical sensor for accurately
applied in vehicle stability control system (Daily et al., 2004).
measuring both longitudinal velocity and sideslip angle.
However, the main disadvantage of this method is the poor
However, due to the very high cost, it cannot be a practical
update rate of GPS receiver which is often less than 50 Hz.
solution for commercial vehicles.
Thus, this method is not applicable for advanced motion
Vehicle state estimation using on-board dynamic sensors control of EV in which the actuators (in-wheel motors or EPS
have been widely researched (Aoki et al., 2005) (Chen et al., motors) can be manipulated at high frequency of 1 kHz or
2008) (Zhao et al., 2011) and applied in motion control of more. In order to provide high rate estimation, the fusion of
vehicle (Chung et al., 2006) (Geng et al., 2009). However, GPS receiver with dynamic sensor has been studied. For
the measurements of dynamic sensor such as gyroscope and instance, the combination of single antenna GPS receiver
accelerometers are often influenced by strong noise, bias, with gyroscope (Anderson et al., 2004) or magnetometer
Attitude control layer Dynamics control layer Actuator control layer
Attitude estimator
vˆx Longitudinal TRR Dynamic
Velocity estimator sensors
β , γ ,ψ vx , v y traction control
Tacc
State estimator
GPS Interface
Fig. 1. EV motion control system using the integration of single antenna GPS receiver and dynamic sensors.
613
IFAC AAC 2013
September 4-7, 2013. Tokyo, Japan
yk
xˆk − N
vy
Fyr V
Fyf yk*
δf
β uk − N +1
vx xˆk +1
uk
... uk −1
γ ψ ν
3.1 Disturbance Accommodating Estimation Model Block diagram of Kalman filter with present time
measurement reconstruction is shown in Fig. 5. The general
In conventional Kalman filter algorithm, the model is often formulation of the reconstruction is expressed as follows:
constructed using the nominal parameters. Therefore, the
N
accuracy of estimation may be degraded due to model yk* = Cd AdN xˆk − N + ∑ AdN − j Bd uk − N + j −1 (13)
uncertainties and external disturbances. Disturbance j =1
accommodating is a simple but effective method to solve this
614
IFAC AAC 2013
September 4-7, 2013. Tokyo, Japan
GPS Receiver C ff
Gyro
Vω ( non − driven) γ ψ* + δ f ,cmd Lower
ν Attitude
Generator
+
-
C fb +
+ control layer
EV
GPS
ψˆ
δf
MRKF 1 Kalman
filter
Nz (Bicycle Model+GPS Model)
DOB
- l fn + lrn
+
vxn
s ψˆ
γˆ ψˆ βˆ V ωc
s+ωc
sin, cos
vɶx vɶ y
Fig. 7. Robust yaw angle control based on DOB.
ax MRKF 2 In (14), n1, n0, d2, and d1 are calculated from vehicle model
( Kinematic Model )
ay parameter, such as cornering stiffness, yaw moment of
initial… with longitudinal velocity. In fact, the values of
vˆx vˆ y cornering stiffness can change according to road condition.
Therefore, the transfer function from front steering angle to
Fig. 6. Double-layer state estimator of EV.
yaw angle contains time-varying parameters. PID controller
3.3 Vehicle State Estimator with constant gains cannot assure the robustness of yaw angle
control under the change of road condition and the influence
Two models established in section 2 are used for constructing of external disturbances like lateral wind force or gravity on
the double-layer state estimator of EV (Fig. 6). Each layer is bank road.
designed using the disturbance accommodating method with
Disturbance observer (DOB) was firstly introduced by
the reconstruction of GPS measurements in present time. The
Ohnishi and then further refined by Hori’s group (Ohnishi,
detailed Kalman filter algorithm can be found in the previous
1987) (Umeno and Hori, 1991). According to this method,
publication of our group (Nguyen et al., 2013a, b).
the feedback loop includes a model of the dynamic of the
As expressed in (1)-(3), the model of the first layer is used for exogenous reference and disturbance signal, called nominal
estimating yaw angle and sideslip angle. This model utilizes internal model. By carefully designing the nominal model
the fusion of course angle obtained from GPS receiver and and a Q-filter, the perfect asymptotic tracking and
yaw rate measured by gyroscope. In this model, velocity is a disturbance compensation are achieved. Until now, DOB has
time varying parameter instead of vehicle state. Therefore, it been widely applied in robust motion control, including
is reasonable to use the velocity of non-driven wheel as the motion control of EV, such as lateral force observer and yaw
approximate measurement of longitudinal velocity. moment observer (Fujimoto and Yamauchi, 2010).
Thanks to the estimated sideslip angle from the fist layer and To improve the robustness of yaw angle control system using
measured velocity vector from GPS receiver, longitudinal front steering angle, the nominal internal model is designed
and lateral velocity can be obtained using (4) but at low as followings:
update rate. In order to achieve velocity estimation at high
rate, accelerometers and gyroscope are used to establish the vxn
P(δ f →ψ ) n ( s) = (15)
second layer model as (5)-(7). (l fn + lrn ) s
ψ ( s) n s+n From (8)-(10), a dynamic model for wheel slip ratio control
Pδ f →ψ ( s ) = = 3 1 2 0 (14) is established as follows:
δ f (s) s + d2 s + d1s
615
IFAC AAC 2013
September 4-7, 2013. Tokyo, Japan
β̂ ax a y C ff
βd δ *f
γ * Gyro
+ Nz
Reference d + +
Tacc V Kalman C fb EV
Torque Tm*
GPS
filter δ cmd model - - GPS
λ* Sliding mode Tslide selector EV βˆ
controller Encoder
ω γˆ Cdis
Kalman
DOB dˆ1 filter
ˆ
Fˆd d 2
λ̂ Slip ratio
vˆx Fig. 9. Lateral stability control system of EV with
calculation
disturbance accommodating in Kalman filter.
Fig. 8. Wheel slip ratio control based on sliding mode
control and DOB. accommodating Kalman filter, we propose lateral stability
control system which is the combination of feedback-feed
vɺx v vɺ v
λɺ = − λ + x 2 Tm − x − x 2 Fd (16) forward controller and the disturbance rejection (Fig. 9).
vx Iω rω v x Iω ω Front steering angle and yaw moment are selected as the
control inputs for controlling both the yaw rate and the
Thanks to the in-wheel motor, driving force Fd can be sideslip angle.
estimated easily from disturbance observer (DOB) using
motor torque and wheel velocity (Furukawa and Hori, 2003). The reference values of sideslip angle and yaw rate are
The slip ratio is obtained from estimated longitudinal velocity calculated as the steady state responses from the driver’s
and wheel velocity. Sliding model theory is applied to design steering angle command. The feed forward controller is
the wheel slip ratio controller. The sliding surface, reaching designed by inversing model (22) with zero disturbances.
law, and Lyapunov function V are expressed as follows: Model following method is applied to design the feedback
controller. The desired model is designed as follows:
S = ( λ − λ* ) (17)
Kβ
0
*
Sɺ = − LS − Qsat ( S ) (18) β s + Kβ
= β
γ (23)
Kγ γ *
0
V = 1 S2 (19) s + Kγ
2
Vɺ = SSɺ = − LS 2 − QSsat ( S ) (20) In (23), the cut-off frequencies Kβ and Kγ are determined by
trial and error experiments to ensure the best responsibility of
In (18), L and Q are selected as positive constant. Thus, Vɺ is the sideslip angle and the yaw rate in the respect of steering
angle command.
always negative. In other words, the stability of the control
system is confirmed. A sliding mode control law is obtained In order to nominalize the system and enhance the robustness
as follows with the estimated slip ratio and the observation of of lateral stability control, we have to compensate d1 and d2
driving force: which represents the total influence of disturbances and
model uncertainties must be compensated. The disturbance
Iω rω 2 vɺˆx vˆx ˆ rejection matrix is designed as follows:
ˆ (1 − λ ) + λɺ +
*
Tslide = F − LS − Qsat ( S ) (21)
2 d
vˆx vx Iω ω −1
b b
Cdis = n11 n12 (24)
The wheel slip ratio control system is shown in Fig. 8. bn 21 bn 22
Using the bicycle model, lateral motion of vehicle can be 5. EXPERIMENTAL VERIFICATION
expressed as follows:
5.1 Verification of Double Layer State Estimator
βɺ an11 an12 β bn11 bn12 δ f d1
= + + (22)
γɺ an 21 an 22 γ bn 21 bn 22 N z d 2 In order to simulate the conventional GPS receiver,
measurements from Hemisphere R320 are sampled at 200
In (22), the disturbance terms d1 and d2 represent the milliseconds (or 5 Hz update rate) and the time delay is set as
influences of external disturbances and the variation of 100 milliseconds.
vehicle parameters from the nominal values. By the Kalman Results of sideslip angle estimation are shown in Fig. 10 (a).
filter with disturbance accommodating methods (the first Another sideslip angle estimation method using dynamic
layer of state estimator), not only sideslip angle but also the sensors is performed for comparison. This method was
disturbance terms can be estimated. Using the disturbance proposed based on linear observer using the measurement of
616
IFAC AAC 2013
September 4-7, 2013. Tokyo, Japan
0.06 Measured
Linear observer (dynamic sensors)
Double-layer estimator (sensor fusion)
0.04
0.02
Beta [rad]
-0.02
-0.04
-0.06
4 6 8 10 12 14
Time [s] (a )Vehicle trace: without attitude control
(a) Sideslip angle estimation results.
Course angle (GPS receiver)
4.6
Course angle (Calculation)
4.5 Yaw angle (Double-layer estimator)
4.4
Attitude [rad]
4.3
4.2
4.1
3.9
4
4.24 Without attitude control
Measured
Obtained from GPS receiver
4.22
3.5 Estimation with non-driven wheel velocity 4.2
Double-layer estimator
3 4.18
2 4 6 8 10 12 14
Time [s]
2.5
4 6 8 10 12 14
Time [s] (c) Yaw angle
(c) Longitudinal velocity estimation results.
Measured With attitude control
0.5 0.01 Without attitude control
Obtained from GPS receiver
Front steering angle [rad]
0
Vy [m/s]
0
-0.005
-0.01
-0.5 2 4 6 8 10 12 14
4 6 8 10 12 14
Time [s]
Time [s]
617
IFAC AAC 2013
September 4-7, 2013. Tokyo, Japan
100
0.6
To evaluate the proposed attitude control, we conduct the 80
Wheel torque
autonomous driving test in which the attitude and velocity of 0.4
T m [N.m ]
60
Landa
Landa reference
EV are automatically controlled by the program. 40 Without control
0.2
20
In case of without attitude control, the front EPS motor 0
always generates zero steering angle for keeping the straight 0
initial attitude of the vehicle is not actually the same as the (a) Wheel torque (b) Slip ratio
reference values, it is impossible to keep the straight direction Fig. 12. EV on slippery road (without control).
of the moving vehicle. Even if the initial attitude and initial
position of steering wheel are satisfied, undesirable influence 120 0.4
Wheel torque Landa reference
from environment, such as strong lateral wind force, the 100
0.3
Sliding mode control
vehicle cannot follow the desired attitude. Results of the 80
Tm [N.m ]
60
Landa
vehicle trajectory on Google Earth, yaw angle, and front 40 0.1
steering angle command. Front steering angle is generated 20
such that the EV can follow the desired trajectory and yaw 0
0
5.3 Verification of Wheel Slip Ratio Control (a) Wheel torque (b) Slip ratio
Fig. 13. EV on slippery road (with traction control).
The low friction sheets covered with water were placed on
the test course to simulate the slippery road. The desired slip 0.035 0.4
ratio on the slippery road is set as 0.1. Because the vehicle 0.03
0.3
motion was straight in this test, it is necessary to show the 0.025
Sides lip angle [ra d]
0.01 0.1
point close to the low friction sheet. In case of without
0.005
control, the wheel slip ratio increases considerably on the 0
0 Reference Reference
when entering the slippery road because the motor torque is Without control Without control
-0.005 -0.1
kept constant as the command from driver (Fig. 12). Fig. 13 5 6 7 8 9 10 5 6 7 8 9 10
Time [s] Time [s]
shows that with the proposed method, wheel slip ratio tracks (a) Sideslip angle (b) Yaw rate
the desired value. Thanks to the proposed sliding mode Fig. 14. Cornering test (without lateral stability control).
controller, motor torque is controlled to be reduced. Thus,
safety traction on low friction road is achieved.
0.035 0.4
0.03
0.3
5.4 Results of Lateral Control 0.025
Sideslip angle [rad]
Yaw ra te [rad/s]
0.02 0.2
Ya w m om ent [N .m ]
zero which means there is no different torque between rear 0.06 -50
the left and rear right in-wheel motors. In contrast, with the 0.04 -100
proposed stability control scheme, front steering angle is
0.02 -150
generated to be different to the driving command (as shown
0 -200
in Fig. 15 (c)). Yaw moment is also generated by using in- Driving command
Front steering angle
wheel motor torque control (a shown in Fig. 15 (d)). As a -0.02
5 6 7 8 9 10
-250
5 6 7 8 9 10
result, the controlled variables can track with the reference Time [s] Time [s]
values, as shown in Fig. 15 (a) and (b). The experimental (c) Front steering angle (d) Yaw moment
results confirm that the proposed control system improve the Fig. 15. Cornering test (with lateral stability control).
stability of electric vehicle.
618
IFAC AAC 2013
September 4-7, 2013. Tokyo, Japan
6. CONCLUSIONS Geng, C., Mostefai, L., Denai, M., and Hori, Y. (2009).
Direct Yaw Moment Control of an In Wheel Motored
We propose a framework of EV motion control based on the Electric Vehicle Based on Body Slip Angle Fuzzy
integration of single antenna GPS receiver and on-board Observer. IEEE Transactions on Industrial Electronics,
dynamic sensors. Kalman filter is developed as the core Vol. 56, pp. 1411-1419.
theory of sensor fusion. In order to deal with model Hori, Y. (2004). Future Vehicle Driven By Electricity and
uncertainties and external disturbances, disturbance Control-Research on 4 Wheel Motored UOT March II.
accommodating method is applied in Kalman filter to IEEE Transactions on Industrial Electronics, Vol. 51,
enhance the robustness of estimation. The time delay of GPS No. 5, pp. 954-962.
receiver is handled by the reconstruction of measurement in Hsiao, F. H. and Pan, S. T. (1996). Robust Kalman Filter
current time applied in Kalman filter. A double-layer state Synthesis for Uncertain Multiple Time Delay Stochastic
estimator is proposed to provide key states for motion control Systems. Journal of Dynamic Systems, Measurement,
of EV. Experiments are conducted to verify the effectiveness and Control, Vol. 118, No. 4, pp. 803-808.
of the proposal in comparison with other estimation methods Johnson, C. (1971). Accommodation of External
using dynamic sensors. Thanks to the state estimator, in this Disturbances in Linear Regulator and Servomechanism
paper, three local motion controls of EV are designed and Problems. IEEE Transactions on Automatic Control, Vol.
performed. However, each local controller is evaluated 16, No. 6, pp. 635-644.
separately from each other. In future works, we will conduct Larsen, T. D., Andersen, N. A., Ravn, O., and Poulsen, N. K.
experiments to verify the integration of local motion (1998). Incorporation of Time Delayed Measurements in
controllers. The other works will be the design of position a Discrete-time Kalman Filter. Proceedings of 37th IEEE
estimator and autonomous guidance to complete a framework Conference on Decision and Control, pp. 3972-3977.
of autonomous EV considering the stability and safety Nguyen, B. M., Wang, Y., Fujimoto, H., and Hori, Y.
motion control. (2013a). Electric Vehicle Stability Control Based on
Disturbance Accommodating Kalman Filter Using GPS.
Proceedings of IEEE International Conference on
REFERENCES Mechatronics, pp. 382-387.
Nguyen, B. M., Wang, Y., Fujimoto, H., and Hori, Y.
Anderson, R. and Bevly, D. M. (2004). Estimation of (2013b). Proceedings of 6th IFAC Symposium on
Sideslip Angle Using Model Based Estimator and GPS. Mechatronics System, pp. 437-444.
American Control Conference, Vol. 3, pp. 2122-2127. Ohnishi, K. (1987). A New Servo Method in Mechatronics.
Aoki, Y., Uchida, T., and Hori, Y. (2005). Experimental Transactions of Japanese Society of Electrical Engineers,
Demonstration of Body Slip Angle Control Based on a 107-D, pp. 83-86.
Novel Linear Observer for Electric Vehicle. Annual Suzuki, S. (2012). Autonomous Navigation, Guidance and
Conference of the IEEE Industrial Electronics Society, Control of Small 4-Wheel Electric Vehicle. Journal of
pp. 2620-2625. Asian Electric Vehicles, Vol. 10, No. 1, pp. 1575-1582.
Bevly, D. M., Ryu, J., and Gerdes, J. C. (2006). Integrating Umeno, T. and Hori, Y. (1991). Robust Speed Control of DC
INS Sensors with GPS Measurements for Continuous Servomotors Using Modern Two Degrees-of-freedom
Estimation of Vehicle Sideslip, Roll, and Tire Cornering Controller Design. IEEE Transactions on Industrial
Stiffness. IEEE Transactions on Intelligent Electronics, Vol. 38, No. 5, pp. 363-368.
Transportation System, Vol. 7, No. 4, pp. 483-493. Yoon, J. H. and Peng, H. (2010). Vehicle Sideslip Angle
Chen, B. C. and Hsieh, F. C. (2008). Sideslip Angle Estimation Using Two Single Antenna GPS Receivers.
Estimation Using Extended Kalman Filter, Journal of Proceedings of ASME 2010 Dynamic Systems and
Vehicle System Dynamics, Vol. 46, No. 1, pp. 483-493. Control Conference.
Chung, T. and Yi, K. (2006). Design and Evaluation of Yoon, J. H. and Peng, H. (2012). Sideslip Angle Estimation
Sideslip Angle-Based Vehicle Stability Control Scheme Based on GPS and Magnetometer Measurements.
on a Virtual Test Track, IEEE Transactions on Control Proceedings of 11th International Symposium on
System Technology, Vol. 14, No. 2, pp. 224-234. Advanced Vehicle Control.
Daily, R. and Bevly, D. M. (2004). The Use of GPS for Zhao, L. H., Liu, Z. Y., and Chen, H. (2011) Design of a
Vehicle Stability Control Systems, IEEE Transactions Nonlinear Observer for Vehicle Velocity Estimation and
on Industrial Electronics, Vol. 51, No. 2, pp. 270-277. Experiments, IEEE Transactions on Control Systems
Furukawa, K. and Hori, Y. (2003). Recent Development of Technology, Vol. 19, No. 3, pp. 664-672.
Road Condition Estimation Techniques for Electric
Vehicle and their Experimental Evaluation using the Test
EV “UOT March I and II”. Proceedings of 29th Annual
Conference of the IEEE Industrial Electronics Society,
pp. 925-930.
Fujimoto, H. and Yamauchi, Y. (2010). Advanced Motion
Control of Electric Vehicle Based on Lateral Force
Observer with Active Steering. Proceedings of IEEE
International Symposium on Industrial Electronics, pp.
3627-2632.
619