Professional Documents
Culture Documents
BIOGRAPHY
Yukihiro Kubo received the B.S. and M.S. degrees in electrical and electronic engineering from Ritsumeikan University
in 1997 and 1999 respectively. He is a Ph.D. student at Ritsumeikan University, Shiga, Japan.
ABSTRACT
This paper describes the study on land-vehicle positioning
by DGPS/INS/Wheel Sensor integration. Our purpose is to
integrate the advantages of these systems and to develop a
high precision positioning system that can determine vehicles trajectory and provide the road profile,
On the other hand, recently, it has been very easy to implement the code-based DGPS with a low cost receiver and
convenient communications link, In this work, therefore,
we consider two integrated navigation modes by applying
the Kalman filter such as code-based DGPS/INS mode and
INS/Wheel Sensor mode . And the performance of positioning by using the both navigation modes is also studied.
_..
--
INTRODUCTION
555
-~
The navigation mode is selected appropriately for the situations. Namely, when the DGPS signals are available,
DGPS/INS mode is utilized. And the navigation mode is
switched to INS/Wheel Sensor mode during the periods that
DGPS is not available.
When INS/Wheel Sensor mode is utilized, there are some
problems that must be considered. The wheel sensor (equivalent to odometer in this paper) measures revolution of the
wheel. Then its measurement is multiplied by the scale factor that converts wheel revolution to velocity. Although the
wheel sensor is autonomous, it can become unreliable for
various reasons such as wheel slipping, skidding and error
in the scale factor [3,5]. In order to keep the positioning accurate, in INS/Wheel Sensor mode, the short-term stability
of INS is utilized to detect the wheel slips etc. Thus the estimation problem of the error in wheel sensors scale factor
is aIso discussed.
CONCEPTION
OF THE SYSTEM
Usually wheel sensors scale factor that converts wheel revolution to velocity (or distance traveled in unit time) is calibrated at the first installation or after changing the wheel
size by driving a known distance. In DGPS/INS mode, the
calibration of the scale factor is also implemented by the
comparison of wheel sensor velocity and DGPS velocity. In
this scheme the Kalman filter is also used to estimate the
scale factor error.
2.2
DGPWINS Mode
The main drawback of DGPS positioning is the degradation of the accuracy due to time-lag for the vehicles motion,
satellite obstruction, poor satellite geometry and
The INS is able to measure vehicles accelerations and angular rates precisely with very short time delay by an
Strapdown
~
rrw
m
Errors
Position -1
J
I
556
..
....
Position
Velocity
Attitude
iii) The C frame (Xc, Yc, Zc) is the right-handed computer frame that is defined by rotating the L frame
about negative ZL-axis through the wander angle a,
the Ye-axis is directed toward the negative YL-axis and
the Zc-axis is directed toward the negative ZL-axis
(upward vertical). It is used for integrating acceleration
into velocity, and used as the reference for describing
the strapdown sensor coordinate frame orientation.
iv) The 1? (XE3,YB, ZB ) frame is the strapdown inertial
sensor coordinate frame (body frame). The XB -axis is
directed toward the head of the vehicle; the YB-axis is
the right-hand of the vehicle; the ZB-axis is downward
vertical about the XB-YB plane. The frame is fixed on
the vehicle and rotates with the motion of the vehicle
(Fig. 3).
COORDINATE SYSTEMS
To integrate the navigation systems, it is important to consider the coordinate systems that the navigation systems or
included sensors refer to, This section defines the coordinate
frames used in this paper and represents the angular relationship between them [7, 8].
Jy
Wheel
sensor
gyroscope
YB
accelerometer
ZB
x ,~
North
Pole
Ecruator
ial
olane
XE
557
.
_.
...
No.
1
2
3
4
5
6
7
8
9
1o*
11*
12*
13
14
15
16
17
_ 18
E1=TW!
(1)
The angles Q, (3 and W used in this transformation are generated by integrating the gyroscopic angular rates, but we do
not pursue this subject here.
STATE MODEL
+) +w(t),
(5)
bz by bz dz dy
dz
(6)
(2)
where
(7)
A(k) = eAIkAtJAt
The following dynamic model is then utilized
~(t)= A(t)z(t)
+ q(t),
(3)
(9)
w(k) =
(4)
(k+l)Ai
~{(~+l)At&}q(f)
df.
(lo)
kAt
The INS error model in the state equation (3), namely, the
equations for the states excepting Nos. 10-12 components
of z and also the related components of A(t) are derived
in, for example, [91 1]. For the components of Nos. 1012, in this work, they are modeled as the first order Markov
4.1
558
..
(8)
where the dot above a letter denotes differentiation with respect to time, A(t) is the dynamics matrix and the process
noise q(t) is assumed as mutually uncorrelated zero mean
Gaussian white noise with covariance matrix IV:
E[q(t)?-/T(t)]
= N(t).
R 118+ A(kAt)At,
4.2
By the definition of drz, Jrv and Jh, the INS-indicated positions at time k are modeled as
MeasurementEquationinINS/WheelSensorMode
where the superscripts z and t mean inertial and true respectively. The DGPS position indications aremodeled as the
true positions corrupted by mutually uncorrelated Gaussian
white noises {n: (k) } with zero mean and covariance matrix
R9(k):
(16)
vm=~w+n,
(11)
t?=(~+A~)u
= drz + n?(k)
=(l+&.)~L4/,
(13)
zj(k)~hi(k)hg(k)
=dh+n~(k).
1
urn = Vt
l+&.
Similarly to the above derivation, the measurements for velocity errors can be modeled as
z~(k)~v;(k)
=
h.
zg(k)-vj(k)
= (hv
n!(k)
~;(k)
n:(k)
z~(k)-v;(k)
=
Thusthemeasurement
ten as
(h.
(14)
v:(k)
+
n:(k).
equations(l3)and
(18)
(14)canberewritv:
zg(k)=llgz(k)
+ n,.
v$(k)
+
(17)
(15)
+ng(k),
T1l
COS&@ . Vt
V; =
T21 COSEa
V:
. #
(19)
where
zg(k)=[z~(k)
z;(k) . ..z~(k)]T.]T,
rtg(k)=[n;(k)
n;(k) . . . . ..n~(k)]T.
where the subscripts x, y and z represent C frame coordinate axes, and T~j is the element in row i, column j of T$.
Similarly, the output of the wheel sensor Vm is transformed
as follows:
10000000
01000000
H9
00
0
00
1
00010000
00001000
0
0
00
00
0
0
1
0
Vm
z
T1l
V~
T21 COS&.. Vm
V~
T31 CoS&p
6X7
COS&a . Vm
559
(20)
. Vm.
the
..
z:(k)
{l+&..@); cosEa(k)
{l+&?.@); cos&a(k)
= T31W(IC)
{v:(k) -h.(k)}
{V$(k)-dv,(k)}+
+n~(k)
ny(k)
{V;(k) -c$vz(k)}+ny(k),
(21)
h(z(k)) + rtw(k),
(22)
where
(24)
n~(k)]T,
The DGPS speed W is modeled as the true speed Vt corrupted by the measurement noise ftz:
The above measurement equation (22) is nonlinear. Therefore we apply the extended Kalman filter, namely, (22) is
linearized by applying first order Taylor series approximation around the one-step predictor [12].
4.3
v=
(Vg)
vt +ti.
(25)
(26)
(27)
where
F=
J(vw+(w+
=
.10
T,,
00
[1
(28)
-rVis the correlation time constant and fj(t) is mutually uncorrelated zero mean Gaussian white noise with covariance
matrix lV(t).
(23)
s(k + 1) = rs(k)
560
+ m(k),
(29)
where
35.51
r = eFAt
cx 12 + FAt,
E [m(k)] = O,
35.508 -
E [tIJ(k)t.iJT(j)] = @(k)6/cj.
E
&l
~ 35.506 n
x
u
.g
35.504 -
(30)
35.502
t
where
z(k) = [r(k)
n(k) = [ill(k)
E [~(k)] = O,
139.3695
vg(k)]T
,
ii2(k)]T
,
E [@k) fiT(j)]
Longitude(Deg.
EXPERIMENTAL
E)
= ~(k)dkj ,
The DGPS correction information, provided by Nippon Senpakutsushin, Inc. in RTCM SC-104 format, was obtained on
telecommunications link with a cellular phone. The DGPS
reference station is located in Yokohama City where the distance is about 30 km from the test course. Also, the carrierbased kinematic GPS (KGPS) method with approximately
8 km baseline to the surveyed station in Atsugi City was implemented simultaneously. The coordinates of this KGPS
method were regarded as true for evaluating the system performance. Fig. 5 shows the trajectory of the car measured
by KGPS.
RESULTS
The experiment of the DGPS/INS/Wheel Sensor positioning architecture described above were carried out. The measurement data were obtained from DGPS, INS, wheel sensor
mounted in an experimental car.
The navigation system components of the car consists of
Ashtech G-12 DGPS receiver, Tamagawa Seiki TA7421
strapdown INS and the wheel sensor using Tamagawa Seiki
TS5304N510 optical encoder. The INS is within an accuracy of 2 nmi/h (1a), and some sensor parameters of the
INS are briefly shown in Table 2. The optical encoder outputs 2000 pulses per one revolution of the wheel.
A rectangular course round approximately 2.2 km in suburban area of Atsugi City (Kanagawa Prefecture, Japan) was
selected as a test run course. The car run about 4.5 laps for
15 minutes. Throughout the test, the INS data were collected
at 51.2 Hz rate, and the DGPS and the wheel sensor at 1 Hz
rate. Thus the measurement interval for the Kalman filter
update At was 1 sec.
200
400
600
Time (sec.)
Random error
I 0.008
deg/fi
561
. .
_..
7=0.8-? ---7=1.0+ ..
Positioning Results
7=1.05+
-7=1.5-7
06!"
.... ... ... ... ... ... ... ... ... ... ... ... ... ... ... ..~
i)
600
400
200
Time (sec.)
Fig. 7: Estimetes of d (A7/FYt)
sensor speed W in (24) for the period of 600 sec. The value
of system parameters have been given as
Sensor (INS/Wheel
Sensor
32~
r
,
......................................
-1oo-200 -
I
g
,
...........................................................................................................
Star
35.504
-500 35.502
till
,lJLJ
. I 000 -
II
139.37
139.375
139.38
139
200
Longitude (Deg. E)
,
400
800
600
Time (sec.)
Fig. 8: Positioning by stand alone INS (Trajectory and difference between the results and KGPS)
562
.-
r
35.51
35.508
E
~
35.506
start
i
%
d
35.504
35.502
t
L,
Longitude
139.37 139.371139.372139.3:
200
400
Time
(Deg. E)
600
800
600
800
600
800
(sec.)
Fig. 9: Positioning by DGPS/INS mode (Trajectory and difference between the results and KGPS)
35.51
20 -
10 35.508
start
-8
.fj
35.504
A
-lo -
35.50:
139.37 139.371139.372139.373
-20 0
200
400
Longitude (Deg. E)
Fig. 10 Positioning by wheel speed and INS heading(Trajectory and
difference between the results and KGPS)
10
35.51
35.508
E
-lo start
100
35.502
-10 I
(Deg.
200
400
Time (sec.)
E)
Fig. 11: Positioning by INS/Wheel Sensor mode (Trajectory and difference between the results and KGPS)
563
CONCLUSION
[6] Zickel, R. and Nehemia, N., GPS Aided Dead Reckoning Navigation, Proceedings of ION National Technical Meeting, pp. 577586, 1994.
[7] Lin, C-F., Modern Navigation, Guidance, and Control
Processing, Vol. II, Prentice Hall, New Jersey, 1991.
[8] Farrell, J. L., Integrated Aircrajl Navigation, Academic Press, San Diego, 1976.
[9] Huddle, J. R., Inertial Navigation System Error-Model
Considerations in Kalman Filtering Applications, in
Control and Dynamic Systems Vol. 38, ed. by Leondes, C. T., pp. 293339, Academic Press, San Diego,
1990.
ACKNOWLEDGEMENT
The present work comes out with the collaboration of
Messrs. H. Kumagai, K. Kokue, and O. Sakamoto, Tarnagawa Seiki Co., Ltd. The authors would like to express their
appreciation to them for their valuable supports.
REFERENCES
[1] Lapucha, D., Schwarz, K. P., Cannon, M. E. and Martel, H., The Use of INS/GPS in a Highway Survey System, Proc. of IEEE PLANS, 1990.
[2] EL-Sheimy, N. and Schwarz, K. P., Navigating Urban Areas by VISATA Mobile Mapping System Integrating GPS/INS/Digital Cameras for GIS Applications, Navigation, Journal of The Institute of Navigation, Vol. 45, No. 4, Winter 1998-1999, pp. 275285.
564