Prasad - QUT · simulation and experimentation. Keyword: Automated Guided Vehicle (AGV), Controlled...

17
This may be the author’s version of a work that was submitted/accepted for publication in the following source: Butdee, Suthep, Suebsomran, Anan, Vignat, Frederic, & Yarlagadda, Prasad (2008) Control and path prediction of an Automate Guided Vehicle. In Gudimetla, P & Yarlagadda, P (Eds.) Proceedings of the 9th Global Congress on Manufacturing and Management (GCMM 2008). Queensland University of Technology, Australia, pp. 1-7. This file was downloaded from: https://eprints.qut.edu.au/18204/ c Copyright 2008 GCMM Board Reproduced in accordance with the copyright policy of the publisher Notice: Please note that this document may not be the Version of Record (i.e. published version) of the work. Author manuscript versions (as Sub- mitted for peer review or as Accepted for publication after peer review) can be identified by an absence of publisher branding and/or typeset appear- ance. If there is any doubt, please refer to the published source. http://www.bee.qut.edu.au/research/events/GCMM08/

Transcript of Prasad - QUT · simulation and experimentation. Keyword: Automated Guided Vehicle (AGV), Controlled...

Page 1: Prasad - QUT · simulation and experimentation. Keyword: Automated Guided Vehicle (AGV), Controlled Path, Kalman Filter Estimator, PID controller . 2 1 Introduction Automated Guided

This may be the author’s version of a work that was submitted/acceptedfor publication in the following source:

Butdee, Suthep, Suebsomran, Anan, Vignat, Frederic, & Yarlagadda,Prasad(2008)Control and path prediction of an Automate Guided Vehicle.In Gudimetla, P & Yarlagadda, P (Eds.) Proceedings of the 9th GlobalCongress on Manufacturing and Management (GCMM 2008).Queensland University of Technology, Australia, pp. 1-7.

This file was downloaded from: https://eprints.qut.edu.au/18204/

c© Copyright 2008 GCMM Board

Reproduced in accordance with the copyright policy of the publisher

Notice: Please note that this document may not be the Version of Record(i.e. published version) of the work. Author manuscript versions (as Sub-mitted for peer review or as Accepted for publication after peer review) canbe identified by an absence of publisher branding and/or typeset appear-ance. If there is any doubt, please refer to the published source.

http://www.bee.qut.edu.au/research/events/GCMM08/

Page 2: Prasad - QUT · simulation and experimentation. Keyword: Automated Guided Vehicle (AGV), Controlled Path, Kalman Filter Estimator, PID controller . 2 1 Introduction Automated Guided

QUT Digital Repository: http://eprints.qut.edu.au/

Butdee, Suthep and Suebsomran, Anan and Vignot, Frederic and Yarlagadda, Prasad K.D.V. (2008) Control and path prediction of an automate guided vehicle. In: 9th Global Congress on Manufacturing and Management, 12-14, November, 2008, Gold Coast, Australia.

© Copyright 2008 GCMM Board

Page 3: Prasad - QUT · simulation and experimentation. Keyword: Automated Guided Vehicle (AGV), Controlled Path, Kalman Filter Estimator, PID controller . 2 1 Introduction Automated Guided

1

ESTIMATION AND CONTROL OF AN AUTOMATED GUIDED VEHICLE

Suthep Butdee Thai French Innovation Center, King Mongkut’s Institute of Technology North, Bangkok,

1518 Piboonsongkram Rd. Bangsue, Bangkok, Thailand 10800, [email protected] Frederic Vignat

3S Laboratory, Institut National Polytechnique de Grenoble, France, [email protected] Anan Suebsomran

Department of Teacher Training in Mechanical Engineering, Faculty of Technical and Education, King Mongkut’s Institute of Technology North Bangkok, 1518 Piboonsongkram

Rd. Bangsue, Bangkok, Thailand 10800, Email: [email protected]

Prasad KDV Yarlagadda School of Engineering Systems. Queensland University of Technology

2, George Street, Brisbane Q4001, Australia, Email: [email protected]

Abstract: In this paper a control strategy of Automated Guided Vehicle (AGV) is proposed. The

vehicle movement controlled by an inboard PLC do not need physical guide. The vehicle has 3 wheels. The front wheel is used for steering and driving. The 2 rear wheels are free and equipped with 2 encoders. The strategy is based on 2 main purposes: the path is stored in the PLC memory and the vehicle displacement is calculated form the wheel rotation measurement. The comparison between the required path and the actual position of the AGV allow calculating deviation error. Function of this error, a correction strategy of driving speed and steering angle is applied in order to get a smooth and precise displacement. Mobile vehicles must know its position and orientation in order to movement to reach the goals precisely. We describe localization techniques for AGV that is based on the principle of Kalman Filtering (KF) algorithm estimation. This paper also addresses the problems of factory navigation and modelling with focus on keeping automatic travelling along the control path of the AGV. Position and orientation is measured by using encoder sensor on driving and steering axes. The control and localization systems are developed. Reference path and observation measurement are matched. To keep track of the matching result of both positions, the estimated position information used to update the vehicle’s position by using the Kalman Filtering (KF) algorithm. Test performance is verified with accurate positioning control by simulation and experimentation.

Keyword: Automated Guided Vehicle (AGV), Controlled Path, Kalman Filter Estimator, PID controller

Page 4: Prasad - QUT · simulation and experimentation. Keyword: Automated Guided Vehicle (AGV), Controlled Path, Kalman Filter Estimator, PID controller . 2 1 Introduction Automated Guided

2

1 Introduction

Automated Guided Vehicles (AGV) has been applied for the flexible manufacturing system. Many factories were adopted it into assembly line or production line such as automobile, food processing, wood working, and other factories. Many researchers developed and designed in order to suite with their applications which are related to the main problem of factory. Automatic Guided Vehicle (AGV) has firstly developed and conducted the research by [17-18-19] in the attempt to using at Jumbo Truck Manufacturing in Thailand. On the past of developed AGV, we surveyed several papers concerned the design and control aspects as following. The different structures were proposed in several cases as [1] proposed the architecture of AGV with two wheels driven by differential gear drive and parallel linkage steering, and the design and operation was also presented by [2]. This paper stated that the track layout and the number of AGVs in transportation control on a job-shop and a flow-shop were determined by using the queuing network theory. For entire FMS system, [3] proposed the operation control method by using two AGVs system. They solved the problem in scheduling method of AGVs model based on Petri nets. The formulation and heuristic search were used by global search in order to seek the optimal operation of the entire FMS. The operations of AGVs choice of guided path selection problem in FMS system was proposed by [4]. They proposed an approach for material flow modeling based on mathematical optimization method. With this approach, they obtained the guide path layout design with wire guided vehicles. The objective of optimization model is the minimization of the total distance traveled by vehicles to transport the material handing system. The route planning of AGVs in FMS was proposed by [5],[6],[7]. [5] presented the new approach for dynamics route planning and scheduling problem of AGVs. They applied the search algorithm and some heuristic rules to solve the route assignment in dynamic situations. [6] also proposed the path planning strategy of AGV to navigation, collision avoidance and docking to the target. The path planning was implemented on-board computer in order to avoid the wire-guided path. Not only the AGV was moved along the path with collision avoidance, but also it should be navigated with no deadlock condition as done by [8]. They formulated the control algorithm by digraph method in real-time path assignment to the vehicles. The deadlock control of AGV was controlled by colored resource-oriented Petri net model method to deal with the conflict free in real-time control as shown [7]. The AGV control approach was the important part for controlling the AGV actions. [9] applied the variable structure system techniques. The AGV was modeled by using kinematics and dynamic system. Sliding mode control by using Lyapunov design was applied for eliminating the chattering. They only implemented by simulation methods. The other paper proposed the control of AGV by using fuzzy logic control as shown in [10] and [11]. The AGV was guided by photoelectric guide way. The designed controller was the self-adjustment of control parameter by fuzzy controller. [11] proposed the steering control of AGV using fuzzy control. The AGV was guided by guide tape. They showed the response and energy saving in case of step change of guide tape. Fuzzy controller was achieved the reduction of steering energy more than the PI controller. [12] was presented the tracking algorithm of AGV navigation in container terminal. The multiple model algorithm based on multiple sensor detection in order to detect obstacle or other AGVs. Unscented Kalman filter was used to localization of AGV. They verified the propose algorithm by simulation methods. The adaptive control of AGV is also proposed by [13]. The nonlinear of dynamic model was developed for motion generation. The propose control was based on Lyapunov concept to ensure the control of AGV even if the dynamic parameter was not perfect. The intelligent of AGV was also worked on several methods. The integrate sensor and vision was applied for control AGV. [14] studied the intelligent path following and control for vision-based automated guided vehicle. They presented the control

Page 5: Prasad - QUT · simulation and experimentation. Keyword: Automated Guided Vehicle (AGV), Controlled Path, Kalman Filter Estimator, PID controller . 2 1 Introduction Automated Guided

3

path following of AGV by vision control system, and multi-sensors was also applied in real time steering control. The hough transform algorithm was applied to detect the guideline of path as shown by [15]. The guideline of path was recognized by optical sensor as proposed by [16]. This paper proposed the array of optical sensor with 14 infrared (IR) emitter-detector pairs arranged in two columns. The trajectory recognition was based on neural networks.

Position and orientation of vehicle must keep the precise navigation and known its positioning at each place during travelling. To known and maintain its position, the currently the localization is the key of research on mobile vehicle. AGV is one of the significance of the present research trend. In industrial application, manufacturing factory is brought the mobile vehicle to incorporate working with other machine in order to being the automated manufacturing system. Many applications were adopted the AGV in different tasks such as material handling system, AS/RS system, transportation system, etc. Thus the research on the localization of mobile vehicle has increasingly researched in different aspects for improving the ability of vehicle. For reviewing the past research, several methods have been reported the localization of mobile vehicle such as [21-22] was developed a system in which the basic localization algorithm is formalized as a vehicle-tracking problem, employing an extended Kalman filter (EKF) to match beacon observations to a navigation map to maintain an estimate of mobile robot location. Tong and Tang proposed the robot self-localization. They applied the sensor fusion algorithm, which is used ultrasonic and CCD sensors, to filter out unreliable the sensor data reading. Moreover Extend Discrete Kalman Filters (EDKF) used to design for raw sensor data fusion to obtain more reliable representation in environment perception procedures [23]. Modeling of ultrasonic range sensors was developed by [7], and they presented a probabilistic model of ultrasonic range sensors using back propagation neural networks trained on experimental data. Extend Kalman filter is used for update location from the prediction and observation matching as shown in [24-25]. Self-localization techniques by using probabilistic for mobile robot that based on the maximum-likelihood estimation were also done by [26]. For outdoor navigation problem of mobile robot, [27] reported the localization with 2-D mobile robot localization based on observability analysis in order to determine the undergo difficulties. They developed the localization algorithm called multisensor localization system (MLS). Due to nonlinear system model obtained in state-space description, Extend Kalman Filter is applied for estimate the state X which is done in two steps, prediction and filtering, respectively. The use of GPS and inertial plate sensor for outdoor navigation also is presented by [28]. They presented the localization algorithm based on Kalman filtering that tries to fuse information coming from an inexpensive single GPS with inertial data and map-based data. And also [29] developed a localization system that employs two methods. The first method uses odometry, a compass and tile sensor, and global position sensor (GPS). An Extended Kalman filter integrates the sensor data and keeps track of uncertainty associated with it. The second method is based on camera pose estimation. Another localization method was implemented and based on vision sensor. As reported by [30], they proposed a new approach for determining the location of a mobile robot using image of a moving object. This scheme combines data from the observed position, using dead-reckoning sensors, and the estimated position, using images of moving objects captured by a fix camera to determine the location of a mobile robot. The proposed methods utilizes the error between the observed and estimated image coordinates to localize the mobile robot, and the Kalman filtering scheme is used for the estimation of mobile robot location. [31] applied the vision based localization, and used Monte Carlo for extracting each image in the database a set of possible viewpoints using a two-dimension map of the environment, but [32] used vision sensor to localize and build simultaneous three-dimensional map in global

Page 6: Prasad - QUT · simulation and experimentation. Keyword: Automated Guided Vehicle (AGV), Controlled Path, Kalman Filter Estimator, PID controller . 2 1 Introduction Automated Guided

4

localization. Multiple robot formation is done by [33] to localize the group of mobile robots, a leader and follower control.

In this paper a new architecture and control strategy of an AGV is proposed. It is organized as follows. The system architecture is explained in section 2. Section 3 deals with the kinematics model of the AGV and the path definition. Section 4 deals with Kalman filter. Section 5 presents the control system. In section 6, the simulation and experiment of AGV implementation is described, and the conclusion and recommendation are given in section 7.

2 System Architecture

Figure 1. Photo of the AGV prototype

The AGV prototype design is based on existing JUMBO industrial truck as shown figure 1. It is a three wheels vehicle as shown in figure 2. The front wheel is used for driving and steering the AGV and the two rear wheels are free. The steering and driving are DC motor. Two encoders are individually attached on the two rear wheels in order to measure the vehicle displacement and then calculate its real time position and orientation. The choice of positioning the encoders on the free wheels provides to the vehicle an accurate measurement of its progression. A programmable logic control (PLC) is used for motion control.

Page 7: Prasad - QUT · simulation and experimentation. Keyword: Automated Guided Vehicle (AGV), Controlled Path, Kalman Filter Estimator, PID controller . 2 1 Introduction Automated Guided

5

W

T

Control point

R

θ

front

rear

Figure 2. AGV prototype architecture

The parameters of the motion are driving speed and steering angle which determine the evolution of the position and orientation of the AGV. The input and output signal are interfaced with PLC module. The inputs are the encoder signal from left and right rear wheels. The driving speed and steering angle are calculated form these inputs and the digital output is converted to analog signal to drive amplifier of the driving motor and steering motor on front wheel as shown in figure 3.

PLC

DC Motor+ amplifierDC Motor+ amplifier

DC Motor+ amplifierDC Motor+ amplifier

Analog output

Analog output

Driving motor

Steering motorAnalogcontrol

left rear wheel encoder

HS counter

HS counter

right rear wheel encoder

Figure 3. AGV prototype command architecture

3 Path definition and Kinematics Model of AGV

The required path of the AGV is be defined by line and circle as shown in figure 3. The path is constructed in order to guide the vehicle movement and stored in the memory of the PLC. During the vehicle movement an error will occur between the actual position P(t) of the AGV and the defined path as shown figure 4.

Page 8: Prasad - QUT · simulation and experimentation. Keyword: Automated Guided Vehicle (AGV), Controlled Path, Kalman Filter Estimator, PID controller . 2 1 Introduction Automated Guided

6

Path :defined by line and circles

d : calculated error

Position of the vehicle (x,y)Calculated by PLC fromRear wheel speed informations

L(1)

C(1)

C(2)

L(2)

Figure 4. Path description

AGV movement is modelled on the basis of the kinematics analysis. The position and orientation are defined at the instants t and t+dt by figure 5 below. Two coordinates systems are defined; AGV (X1,Y1) and world (X,Y) coordinates systems. The initial position P(t) at the point (X1,Y1) and the initial orientation β(t) are defined.

X

YP(t)

Xl(t)

α(t)

β(t)

P(t+dt)

Yl(t)

R(t)

Xl(t+dt)Yl(t+dt)

β(t+dt)

Figure 5. Kinematics model of an AGV

Page 9: Prasad - QUT · simulation and experimentation. Keyword: Automated Guided Vehicle (AGV), Controlled Path, Kalman Filter Estimator, PID controller . 2 1 Introduction Automated Guided

7

The position and orientation at t+dt are calculated in vehicle coordinate system at instant t by equation (1)

( )( )(Xl( t ),Yl(t ))R sin( )P(t dt) R cos 1

αα

⎡ ⎤+ =⎢ ⎥−⎣ ⎦ (1)

The position and orientation are transformed from vehicle coordinate to the world coordinate (X,Y) system in order to determine the new position of the AUV using equation (2).

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

cos t sin t R sin( )P(t dt) P(t)R cos 1sin t cos t(t dt) (t) (t)

⎡ ⎤ ⎡ ⎤+ = +⎢ ⎥ ⎢ ⎥−− ⎣ ⎦⎣ ⎦+ = −

β β ααβ β

β β α (2)

Equation (2) can then be written using the left encoder pulse increment (lpi) and right encoder pulse increment (rpi).

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

( )

( )( )

( )

wheel

pr2

wheel

pr

wheel

pr

Rlpi rpiNcos t sin tP(t dt) P(t)lpi rpi lpi rpisin t cos t R

N Tlpi rpi R(t dt) (t) 2

N T

×⎡ ⎤+ ×⎢ ⎥−⎡ ⎤ ⎢ ⎥+ = +⎢ ⎥ + −⎛ ⎞×⎢ ⎥⎣ ⎦ − ×⎜ ⎟⎢ ⎥⎝ ⎠⎣ ⎦−

+ = − × ×

πβ ββ β π

β β π

(3)

The actual position P(t) of the vehicle being determined the deviation error can be calculated. For linear path, the error is determined between the vehicle point P(t) and the line which is starting at point Ps and ending at point Pe as shown figure 6 a). For the circular path, the error is determined between the vehicle point P(t) and the circle of center Pc, starting point Ps and ending point Pe, as shown figure 6 b).

P(t)

Ps

deviation

progress

P(t)

Ps

Pe

deviation

Pc

progress

Pe

a). Error evaluation of a line b). Error evaluation of a circle Figure 6. Path deviation evaluation

Page 10: Prasad - QUT · simulation and experimentation. Keyword: Automated Guided Vehicle (AGV), Controlled Path, Kalman Filter Estimator, PID controller . 2 1 Introduction Automated Guided

8

The error deviation of linear path is calculated by the equation (4) below.

⎟⎟

⎜⎜

⎛×= )(tPsP

PsPePsPedl (4)

Where dl is the error deviation of linear path, Ps is the starting point, Pe is the end point, and P(t) is the current position.

The error deviation of circular path is calculated by the equation (5) below.

cd distance(Pc, P(t)) radius= ± − (5)

Where dc is the error deviation of circular path, Pc is the center point of curve, and P(t) is the current position. The sign is plus (+) when turning left and minus (-) when turning right.

4. Kalman Filter

Vector Kalman filter [20] is formulated with state equations for linear system as following;

( ) ( 1) ( 1)( ) ( ) ( )

x k Ax k w ky k Cx k v k

= − + −= +

(6)

Where ( )x k and ( 1)x k − are state transition matrix by column vector at time k and 1k − ,

respectively. ( 1)w k − is a noise process which is white obtained by-zero mean and independent of all others in dimension of column vector. A is a system transition coefficients with dimension of square matrix. ( )y k is the measurement state output matrix at time k . C is the measurement or observation matrix. ( )v k represents an additive noise matrix during measurement process at time k .

4.1 Kalman Filter Estimator

Procedure of the Kalman filter estimator can be successfully computed to optimal estimation at each step as following:

(7) (8) (9) (10) The optimum filter deviation of estimation is needed to minimizing the random process

system. By estimation, we need the best estimated signal ˆ( )x k at time k of the estimation

Estimator:

[ ]ˆ ˆ ˆ( ) ( 1) ( ) ( ) ( 1)x k Ax k K k y k CAx k= − + − − Filter gain:

1

1 1( ) ( ) ( ) ( )T TK k P k C CP k C R k−

⎡ ⎤= −⎣ ⎦

Where 1( ) ( 1) ( 1)TP k AP k A Q k= − + − Error covariance matrix:

1 1( ) ( ) ( ) ( ) ( )P k P k K k C k P k= −

Page 11: Prasad - QUT · simulation and experimentation. Keyword: Automated Guided Vehicle (AGV), Controlled Path, Kalman Filter Estimator, PID controller . 2 1 Introduction Automated Guided

9

signal of ( )x k . The error of state estimation between two signal vectors at time k needed to minimize to zero by using mean-square error corresponding to

2( ) ( )p k E e k⎡ ⎤= ⎣ ⎦ (11) Where ˆ( ) ( ) ( )e k x k x k= − is the error.

The problem is how to form ˆ( )x k , the best linear estimate (filter value) of ( )x k and how to form ˆ 1x k k − is the best predicted value. Mean estimators that minimize the mean-square error of each signal component simultaneously as shown by (12) for filter operation each mean- square error.

2ˆ( ) ( )qE x k x kα⎡ ⎤−⎣ ⎦ where α =1,2…,q (12)

The error is to be minimized, and α is a number of signal components. The observation noise covariance matrix is written as

( ) ( ) ( )TR k E v k v k⎡ ⎤= ⎣ ⎦ (13) Similarly, for the signal noise, we have

( ) ( ) ( )TQ k E w k w k⎡ ⎤= ⎣ ⎦ (14) Where ( )Q k represents the system noise covariance matrix. If there is no noise

correlation between noise processes, the off-diagonal terms are zero. The mean-square error covariance matrix can be obtained by (15).

( ) ( ) ( )TP k e k e k⎡ ⎤= ⎣ ⎦ (15)

4.2 Localization System AGV mobile vehicle is needed to move with the precision position and orientation along the defined path. Vehicle must keep the command trajectory generated by path definition. Due to the error sources occurred during moving, then mobility would estimate and adjust position and orientation itself with knowledge of system estimation known as Kalman filter. The localisation technique of AGV has shown in figure 7 as described in block diagram.

[ , , ]o o ox y θ

Path Command

AGV Motion Control

Direction Wheel Encoder :L

Steering wheel Encoder

Direction Wheel Encoder : R

Sensor Reading Value

Kalman Filter Estimator

Matching

ˆˆ ˆ[ , , ]x y θ

[ , , ]r r rx y θ

Command Trajectory

Location Update

Observation

Page 12: Prasad - QUT · simulation and experimentation. Keyword: Automated Guided Vehicle (AGV), Controlled Path, Kalman Filter Estimator, PID controller . 2 1 Introduction Automated Guided

10

Figure 7. Location estimation of AGV

From block diagram in figure 7, the localization can be done for maintaining the AGV movement along with the given path. Observations are measured by using encoder attached on wheels of AGV in translational and rotational exes. Estimation is performed by Kalman filter, the matching uses for compare the current observer and trajectory command, the error is occurred during this process. The estimation of AGV position will correct and update its positioning by Kalman filter estimator algorithm.

5 Control System of AGV

The deviation error being evaluated, the steering and driving command signal can be calculated and converted to analog signal by the PLC. The steering and driving control strategy are showed by the to simple block diagram figure 8. The correction applied to the command signal is a proportional one for the driving signal and proportional derivative for the steering signal.

Correctiond Motor and

transmission ∫Us

∫ L(θ,v)θ Vehicle position

Measured by the 2 rear encoders

+

-

ωsPLC

+

-

Vehicle speed

Path

Measured by the 2 rear encoders

Speed demand Motor and transmission

Ud Vehicle speed

Measured by the 2 rear encoders

+

-

PLC

Correction

Figure 8. Block diagram of steering and driving control

The new proposed control structure is shown in Figure 8. Information is derived from encoder sensor attached on each axis of vehicle, displacement and steering axis. PID control output is obtained by differential equation used in this research is:

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

n

p i d p D Ik

u t K e t K e n e n K e k=

= + − − + ∑ (16)

Where ( ) pidu t is the output signal, ( )e t is the error signal between the actual and the desired output, [ ( ) ( 1)]DK e n e n− − is a signal proportional to the time derivative of the error, and

Page 13: Prasad - QUT · simulation and experimentation. Keyword: Automated Guided Vehicle (AGV), Controlled Path, Kalman Filter Estimator, PID controller . 2 1 Introduction Automated Guided

11

1

( )n

Ik

K e k=∑ is the signal proportional to the time integral of the error at any time t . ,p DK K and

IK are tunable and they are to be determined on the basis of specifications of plant.

The control algorithm of the AGV has been implemented by using PLC TSX micro form SCHNEIDER. The implemented program is written by PL7 Pro using Grafcet as shown figure 9 and structured text language. The main inputs of the PLC are the 2 high speed up and down counter connected to the 2 encoders. The outputs of steering and driving command are converted to analog output ranged by 0-5 V. The grafcet loop execute 3 consecutive tasks: 20 is used for reading the input value from encoder and to calculate vehicle new position and deviation error, 30 is used to apply correction and calculate output signal and in 40 the output signal is sent to output module of PLC. This loop is executed every 5 ms.

Figure 9. AGV control Grafcet

6 Simulation and Tested Experiment

6.1 Simulation results In this section, the developed algorithm of the AGV is firstly tested by simulation method

using LABVIEW software as shown figure 10. All architecture parameters are obtained from the AGV information such as dimension, gear ratio, motor parameter etc. The control parameters are estimated by this simulation and the next step, physical tests, can therefore be performed.

Page 14: Prasad - QUT · simulation and experimentation. Keyword: Automated Guided Vehicle (AGV), Controlled Path, Kalman Filter Estimator, PID controller . 2 1 Introduction Automated Guided

12

Figure 10. Labview simulation window

The tests reveal a smooth movement and a calculated error maintained within 10 mm which is for the first step a convenient result. The tests reveal also some none detected errors due to floor imperfection and a new loop of control will have to be added in order to correct this.

6.2 Experiment Results Command window illustrated in Figure 11 uses for control AGV movement operation through PC in long distance area. There are two types of command such as positioning command (x,y position) and jog mode command which is tested motion control in each axis such as go, turn left, turn right etc. In positioning command, set of x,y coordinated position are sent to AGV with the design path of movement. Experiments are conducted in several tests, for example, Figure 12 is shown the design path with S-curve shape of AGV moving on PC. The position pairs are sent to AGV with wireless communication channel. AGV receives the command of two axes, steering and driving axes, to control AGV with regarding to specified path. The result of AGV moving with the specified path have is shown in Figure 13.

Page 15: Prasad - QUT · simulation and experimentation. Keyword: Automated Guided Vehicle (AGV), Controlled Path, Kalman Filter Estimator, PID controller . 2 1 Introduction Automated Guided

13

Figure 11. AGV command window

Figure 12. S–curve path of command motion from window

Figure 13. Result of AGV motion with S–curve path 7 Conclusion

In this paper, An Automated Guided Vehicle (AGV) is presented. The developed algorithm is based on memorised path and kinematics determination of the movement. The vehicle position and deviation are calculated from rear wheels rotation measurement. The steering and driving command are determined from this deviation. Localization of AGV by Kaman filtering algorithm is presented. Overall structure of designing AGV is described. Control of AGV motion is implemented by using PID control scheme. Displacement axis and steering axis are separated to implement the motion control. We proposed the localization system for estimation of AGV. Position and orientation are estimated by Kalman filtering in

Page 16: Prasad - QUT · simulation and experimentation. Keyword: Automated Guided Vehicle (AGV), Controlled Path, Kalman Filter Estimator, PID controller . 2 1 Introduction Automated Guided

14

state-space model. Position and orientation of AGV are measured and used for simulation for localization system. We conclude that the vehicle can reach from the initial position moved along with generated path with accurate location. A Schneider PLC is used to implement this control. The tests reveal a smooth movement and convenient deviation. The first prototype working, the next research steps will be development of a correction system to correct none detected errors. It will also be necessary to develop the fleet management strategy and software. Future work is planed to increase the accuracy of the system by equip more sensors for observation technique. Treatment of dynamic model of vehicle is also planed to the next step.

8 Acknowledgement

The authors would like to thank the Schneider electric for Automation solution and JUMBO, industrial trucks manufacturer, to support the AGV prototype construction.

9 References

[1] E. Sung, Ng. K. Loon and Y. C. Yin, Parallel Linkage Steering for an Automated Guided Vehicle, IEEE Control Systems Magazine, October1989, pp. 3-8

[2] R. J. Mentel and H. R.A. Landeweerd, Design and operation control of an AGV system, International Journal of Production Economics, Vol. 41 (1995), pp. 257-256

[3] D. Y. Lee and F. DiCesare, Integrated Scheduling of Flexible Manufacturing System Employing Automated Guided Vehicles, IEEE Transactions on Industrial Electronics, Vol. 41, NO.6, December 1994, pp. 602-610

[4] M. Gourgand, X-C. Sun and N. Tchernev, Choice of the Guide Path Layout for an AGV Based Material Handling, IEEE, 1995, pp. 475-483

[5] P-S. Liu and L-C Fu, Planning and Scheduling in a Flexible Manufacturing System Using a Dynamic Routing Method for Automated Guided Vehicles, IEEE, 1989, pp. 1584-1589

[6] Naiqi Wu and M-C. ZFou, AGV Routing for Conflict Planning and Scheduling in a Flexible Manufacturing System Using at Resolution in AGV Systems, Proceeding of the 2003 IEEE International Conference on Robotics & Automation, Taipei, Taiwan, September 14-19,2003, pp. 1428-1433

[7] Naiqi Wu and M-C. ZFou, Modeling and Deadlock Control of Automated Guided Vehicle Systems, IEEE/ASME Transactions on Mechatronics, Vol.9, No. 1, March 2004, pp.50-57

[8] M. P. Fanti and B. Turchiano, Deadlock Avoidance in Automated Guided Vehicle Systems, 2001 IEEE/ASME International Conference on Advanced Intelligent Mechatronics Proceedings, Como, Italy, 8-12 July 2001, pp.1017-1022

[9] M. Ertugrul, O. Kaynak and A. Sabanovic, A Comparison of Various VSS Techniques on the Control of Automated Guided Vehicles, IEEE, pp.837-842

[10] Y. Dianyong and X. Hui, Application of Fuzzy Control Method to AGV, Proceeding of the 2003 IEEE International Conference on Robotics, Intelligent Systems and Signal Processing,Changsha, Chaina, October 2003, pp.768-772

[11] S. Senoo, M. Mino and S. Funabiki, Steering Control of Automated Guided Vehicle for Steering Energy Saving by Fuzzy Reasoning, IEEE , October1989, pp. 1712-1716

[12] Y-S Kim and K-S Hong, A Tracking Galgorithm for Autonomous Navigation of AGVs in a Container, The 30 Annual Conference of the IEEE Industrial Electronics Society, Busan, Korea, November 2-6, 2004, pp.401-406

[13] L. Beji and Y. Bestaoui, Motion Generation and Adaptive Control Method of Automated Guided Vehicles in Road Following, IEEE Transactions on Intelligent Transportation Systems, Vol.6, NO. 1, March 2005, pp.113-123

Page 17: Prasad - QUT · simulation and experimentation. Keyword: Automated Guided Vehicle (AGV), Controlled Path, Kalman Filter Estimator, PID controller . 2 1 Introduction Automated Guided

15

[14] Q. Fang and C. Xie, A Study on Intelligent Path Following and Control for Vision-based Automated Guided Vehicle, Proceedings of the 5th World Congress on Intelligent Control and Automation, Hangzhou, P.R. China, June 15-19, 2004, pp.4811-4815

[15] H-B. Zhang, K. Yuan, S-Q. Mei, Q-R. Zhou, Visual Navigation of an Automated Guided Vehicle based on Path Recognition, Proceedings of the Third International Conference on Machine Learning and Cybernetics, Shanghai, China, August 15-19, 2004, pp.3877-3881

[16] G. A. Borges, A. M. N. Lima and G. S. Deep, Characterization of a Trajectory Recognition Optical Sensor for an Automated Guided Vehicle, IEEE Transactions on Instrumentation and Measurement, Vol.49, NO. 4, August 2000, pp.813-819

[17] Butdee, S., and Suebsomran, A. (2007). Localization Based on Matching Location of AGV, Proceeding of the 24th International Manufacturing Conference, IMC24, Waterford Institute of Technology, Ireland, pp. 1121-1128.

[18] S. Butdee and A Suebsomran, Learning and recognition algorithm of intelligent AGV system, GCMM2006, 13-72.

[19] S. Butdee, F. Vignat, and A. Suebsomran, Self-alignment control of an automated unguided vehicle, IDMME06, 16-19 May 2006. [20] S.M. Bozic, Digital and Kalman filtering, Edward Arnold, (1990) [21] G.C. Anousaki and K.J. Kyriakopoulos, Simultaneous Localization and map building for

mobile robot navigation, IEEE Robotic and Automation Magazine, 1999, 42-53 [22] J.J. Leonard and H.F. Durrant-Whyte, Mobile robot localization by tracking geometric

beacons, IEEE Transactions on Robotics and Automation, Vol.7 (1991) 376-382 [23] K-T. Song and W-H. Tang, Environment perception for a mobile robot using double

ultrasonic sensors and a CCD camera, IEEE Transactions on Industrial Electronics, Vol. 43 (1996) 372-379

[24] R.Gutierrez-Osuna, J.A. Janet, and R.C. Luo, Modeling of ultrasonic range sensors for localization of autonomous mobile robot, IEEE Transactions on Industrial Electronics, Vol. 45 (1998) 654-662

[25] C-C. Tsai, A localization system of a mobile robot by fusing dead-rokening and ultrasonic measurements, IEEE Transactions on Instrumentation and Measurement, Vol. 47 (1998) 1399-1404

[26] C. F. Olson, Probabilistic self-localization for mobile robots, IEEE Transactions on Robotics and Automation, Vol. 16 (2000) 55-66

[27] P. Bonnifait and G. Garcia, Design and experimental validation of an odometric and goniometric localization system for outdoor robot vehicles, IEEE Transactions on Robotics and Automation, Vol. 14 (1998) 541-548

[28] S. Panzieri, F. Pascucci, and G. Ulivi, An outdoor navigation system using GPS and inertial platform, IEEE/ASME Transactions on Mechatronics, Vol. 7 (2002) 134-142

[29] A. Georgiev and P. K. Allen, Localization methods for a mobile robot in urban environments, IEEE Transactions on Robotics, Vol. 20 (2004) 851-864

[30] J.M. Lee, K. Son, M.C. Lee, J.W. Choi, S.H. Han, and M.H. Lee, Localization of a mobile robot using the image of a moving object, IEEE Transactions on Industrial Electronics, Vol. 50 (2003) 612-619

[31] J. Wolf, W. Burgard, and H. Barkhardt, Robust vision-based localization by combining an image-retrival system with monte carlo localization, IEEE Transactions on Robotics, Vol. 21 (2005) 208-215

[32] S. Se, D.G. Lowe, and J.J. Litle, Vision-based global localization and mapping for mobile robots, IEEE Transactions on Robotics, Vol. 21 (2005) 364-375

[33] J. Huang, S.M. Farritor, A. Qadi, and S. Goddard, Localization and follow-the-leader control of a heterogeneous group of mobile robots, IEEE/ASME Transactions on Mechatronics, Vol. 11 (2006) 205-215