Professional Documents
Culture Documents
20
Robot and Human Interactive Communication
Gyeongju, Korea, August 26-29, 2013
Abstract— This study deals with the independent localization it is small size and low power consumption. The strapdown
system of AGV which is sensor fusion strapdown inertial technique is a method which keeps attitude of accelerometer
navigation system and laser navigation to develope more fast and using attitude measurement result of gyro. However, the SINS
accurate for the AGV. the strapdown inertial navigation system is difficult to apply to the AGV because the SINS demand less
is very expensive and has large system. Hence, we propose the error and expensive accelerometer and gyro to maintain
independent and stable localization system with sensor fusion higher or the same as the previous INS[13,14]. The SINS
using a low-cost strapdown inertial navigation system which which can high speed localization without the influence of
consists of MEMS inertial sensor. To reduce errors of the external factors of moving object has very benefit to
strapdown inertial navigation system, we performed localization of AGV, but it is unsuitable to low cost AGV
compensation using proportional method to gyro sensor and rather than airplane and military equipment. Therefore, in the
low-pass filter to accelerometer. We used transformation matrix generality of cases, the AGV used mostly encoder and gyro
with a result of attitude reference using Kalman filter. Finally, to
for localization. However, if the encoder is used, it has
compensate the result of error, fuzzy inference system is used. To
problem that is subordinate to structure of system.
verify the performance of the proposed system, experiments is
performed with a Mecanum wheeled AGV and a forklift AGV. This problem is divided to apply encoder in AGV, to be
In the experiments result, we confirmed that the proposed adapted the AGV at environment and to recycle completed
system can estimate the position. positioning system. First problem is that the AGV is applied
I. INTRODUCTION the encoder. This problem is impossible to resolve due to
structural defect and cost increase from installing encoder in
In the early 20th century, the technique for localization of the AGV. Second problem is environment adaptation. The
moving type military equipment according to military purpose localization system which is made depending on structure of
is rapid developed. Those techniques reduce loss of lives kinematic of AGV requires detailed optimization according to
which occurred because people was carrier of arms to directly environment in the AGV. If the AGV moves at indoor and
attack at enemy camp in past, and those are developed to show outdoor that are large changes of environment without single
technical superiority among power nations[1-4]. Global environment. Third problem is that the AGV redo
positioning system (GPS) developed at that time measure environment adaptation because if localization system using
absolute positioning of airplane and missile in Earth's global. encoder in an AGV is made, the AGV is not perfect equal to
A pinpoint strike arm using it was developed. However, the mechanism even though structure of the AGV is equal. To
GPS is unsuitable for localization of moving object at high solve problem is inefficiency of encoder, using SNIS give
speed as airplane and missile because it has low speed better results because it resolve completely system
response time. To make up for fault, inertial navigation system dependence of encoder and it can measure high speed position
(INS) which can measure moved variation through to measure of 10ms better than localization system using encoder on
inertial of object is made[5-8]. maximum 50~100ms of speed. Response time of MEMS type
The INS is device to calculate relative moved variation of accelerometer and gyro is high speed 10ms or under.
object by integrating twice in measured acceleration of object Therefore, integration error to calculate position is decreased
through accelerometer[9-12]. It is used precision localization by the faster measurement of data. However, it is difficult to
of military equipment with GPS. In particular, strapdown INS resolve the error of the sensor occurred when using
(SINS) is applied autonomous guided vehicle (AGV) because considerably lower price sensor than the inertial sensor which
is commonly used for SINS. Even though SINS is developed
* This research was supported by the MKE(The Ministry of Knowledge
suitably for AGV, this problem makes that it difficult to apply.
Economy), Korea. thus, this paper propose a method to solve a fundamental
H. H. Cho is with the Department of Interdisciplinary Cooperative matter of SINS, and propose localization system to fuse
Course: Robot, Pusan National University, Pusan, Korea (e-mail: Kalman filter, Fuzzy inference system, SINS and Laser
darkruby1004@pusan.ac.kr). navigation for localization of AGV. Laser navigation is
H.J. Song is with the Department of Electrical Engineering, Pusan
Global localization with the high accuracy, but has slow
National University, Pusan, Korea (e-mail: darkhajun@pusan.ac.kr).
M.H. Park is with the Department of Electrical Engineering, Pusan response rate of 250 ms or more. The SINS has the fast slow
National University, Pusan, Korea (e-mail: 82akakak@pusan.ac.kr). response, though it has a aforementioned fundamental matter.
J.Y Kim is with the Department of Electrical Engineering, Pusan National Therefore, we were used to mix the merit of laser navigation
University, Pusan, Korea (e-mail: arioner@pusan.ac.kr). and SINS through the Kalman filter, and reduced the error of
S.B Woo was with the Department of Interdisciplinary Cooperative SINS by Fuzzy inference system. Kalman filter was used to
Course: Robot, Pusan National University, Pusan, Korea (e-mail:
rhei@pusan.ac.kr).
fill the gap of the sensors(Laser navigation and SINS) through
S.S Kim is with the Electrical Engineering Department, Pusan National to fuse the data of sensors and to calculate the speed and
University, Pusan, Korea (corresponding author to provide phone: position information by the estimated information in Kalman
+82-51-510-2374; fax: +82-51-510-0212; e-mail: sskim@pusan.ac.kr).
2054
what we use for the proposed SINS are 1-axis gyro sensor, 2048
2042
sensitivity 0.242°/s/LSB 0.25°/s/LSB The SINS is possible to measure position about X, Y, and
Z axis. However, in case of AGV, The paper performs only
the position calculation about X, Y axis, because Altitude
Posture estimating requires not only roll, pitch but also change is almost nothing. However, in case of AGV, The
yaw. In the case of roll and pitch, they can be fused in paper performs only the position calculation about X, Y axis,
acceleration sensor using KF whereas yaw. For this reason, in because Altitude change is almost nothing. In this case, X and
this paper, we choice the high-accuracy gyro sensor for Y axis of acceleration sensor should be exactly perpendicular
estimating of yaw than gyro sensor for roll and pitch. The to the center of the earth, because output values of
equation to calculate the angular velocity of 1-axis and 2-axis acceleration sensor include value of two type and acceleration
gyro sensor is as follows. In (1), Const presents the sensitivity sensor outputs to both acceleration of gravity and movement
of sensor. It has 0.250 and 0.242 when gyro sensor is 1-axis acceleration. If X and Y axis of acceleration sensor aren’t
and 2-axis, respectively. perpendicular to the center of the earth, Large errors occur
when calculating the position because the actual acceleration
Angularvelocity = (GyroADC GyrocenterConst values. Moving vehicle makes the oscillation, though it
400 400
400 400
200 200 200 200 reason, we fused laser navigation sensor with inertial
X-axis Acc. Data
-400
-200 -200
-400
-200
0 0 0 0
0 200 400 600 800 1000 1200 1400 1600 1800 2000
-600
-600
0 200 400 600 800 1000 1200 1400 1600 1800 2000 Kalman
0 200 400 600 800 1000 1200 Time 1400 1600 1800 2000 0 200 400 600 800 1000 1200 1400
Time 1600 1800 2000 Cbn
Time Time
filter
0 0
0
-20 -20 -4 -4
X-axis position(mm)
Y-axis position(mm)
X-axis position(mm)
Y-axis position(mm)
-6 -6
-40 -40
-8 -8
-16
-14
0.8 0.8
Degree of membership
Degree of membership
0.6 0.6
0.4 0.4
0.2 0.2
0 0
0 50 100 150 200 250 300 350 0 50 100 150 200 250 300 350
Angle using position Angle of gyro and laser navigation
L ML M MH H
1
0.8
Degree of membership
0.6
0.4
0.2
As mentioned, experimental method is that the AGV was
0
repeatedly driving 10 times each about all directions, that is
0 50 100 150 200
Angle for compensation
250 300 350
straight, side and diagonal, and that a half of total running
(c) Angle for compensation(Output)
times is stopped intentionally. If laser navigation doesn’t
perform for 1~2 seconds per 2~3 times about entire driving
times, the way to block is that observational value of Kalman
filter doesn’t be inputted. Fig. 8 shows a result which was
TABLE IV. RULE OF FUZZY REFERENCE chosen randomly among repeated experiments 10 times about
straight driving.
Position
Angle L M H Figure 8. Result of straight driving.
Yaw Angle
L L ML L
M ML M MH
H L MH H
COAyiyiyi
IV. EXPERIMENT
In Fig. 8, it is graph about measured positions and it is
A. Experimental Environment graph to expand a section among randomly blocked sections
To evaluate the performance of localization using the in total running results. As shown in Fig 8, localization using
proposed sensor fusion, we performed experiments to the proposed sensor fusion supplements blocking of laser
measure the position about driving of straight, side and navigation exactly. Table 5 shows maximum distance errors
diagonal of 3x3 m2 using a Mecanum wheel AGV. Since the and average distance errors to calculate 10 times in blocked
true value to verify the behavior of laser navigation doesn’t sections about straight driving.