Professional Documents
Culture Documents
AbstractTheobjectiveofthispaperistoproposearobust
obstacle avoidance method for service robot in indoor
environment. The method for obstacles avoidance uses
informationaboutstaticobstaclesonthelandmarkusing
edgedetection.Speedanddirectionofpeoplethatwalks
as moving obstacle obtained by single camera using
tracking and recognition system and distance
measurement using 3 ultrasonic sensors. A new
geometricalmodelandmaneuveringmethodformoving
obstacle avoidance introduced and combined with
Bayesian approach for state estimation. The obstacle
avoidance problem is formulated using decision theory,
prior and posterior distribution and loss function to
determine an optimal response based on inaccurate
sensor data. Algorithms for moving obstacles avoidance
methodproposedandexperimentresultsimplementedto
service robot also presented. Various experiments show
that our proposed method very fast, robust and
successfullyimplementedtoservicerobotcalledSrikandi
IIthatequippedwith4DOFarmrobotdevelopedinour
laboratory.
Keywords obstacles avoidance, service robot, moving
obstacle,bayesian,navigation.
1.Introduction
www.intechweb.org
www.intechopen.com
(BorensteinJ.,1991).AnotherdrawbacksisPFMandVFH
didnt provide complete mechanism for vision based
obstacles avoidance and maneuvering for service robot.
Obstacle avoidance methods based on ultrasonic sensors
must account for the sensors shortcomings, such as
inaccuracies, crosstalk, and spurious readings, so
combination of vision and ultrasonic sensors for this
research considered, because they are important sensors
for face recognition and tracking system and distance
measurementforvisionbasedservicerobot.
Themainchallengefordevelopmentofservicerobotisto
accurately detect moving obstacles in the landmark.
Moving entities must be identified and their future
positionneedstobepredictedoverafinitetime(Lidoris
G. et al., 2008). Due to sensor limitations, the robot can
observer only small part of its environment and these
observations are corrupted by noise. By integrating
successive observations, a map can be created, but since
the motion of the robot is subject to error, the mapping
problemalsocomprisesalocalizationproblem.
The system for mobile robot to detects moving obstacles
in order to gradually stop the robot to avoid collision
without maneuvering around obstacle already proposed
in (Li Y., et al, 2005), the system uses polar mapping to
simplify the segmentation of the moving object from the
background.Predictivecontrolofrobotvelocitytoavoid
obstacles in a dynamic environments using Hierarchical
Partially Observable Markov Decision Process (POMDP)
proposedin(OkaF.,etal.,2003),inthismethod,therobot
can choose to move at three different speeds: slow,
normalandfast.
Bayesiantechniquesprovideapowerfulstatisticaltoolto
help manage measurement uncertainty and perform
multisensor fusion and identity estimation. The
advantages of probabilistic robotics are able to
accommodate imperfect sensors, robust in real world
applications and best known approach to many hard
roboticsproblem.Usingsensoryinformationtolocatethe
robot in its environment is the most fundamental
problem to providing a service robot with autonomous
capabilities(ThrunS.,2006).
Based on literatures obtained by the authors, many
researchindevelopmentofservicerobotsuchas(Acosta
L.etal.,2006andQingXiaoY.etal.,2010)thatproviding
basicservicesuchasordering,fetchingandsendingfood,
settlement and so on for customers in the robot
restaurant. But there is no flexible and robust obstacles
avoidance and maneuvering method for service robot in
indoor environment exposed. In previous paper, we
already proposed a novel method for static and moving
obstacles avoidance for visionbased service robot, but it
was using predefined maneuver (Budiharto W. et al,
2010).
Thecontributionofthispaperistheintroductionofanew
method for navigating and maneuvering to avoids
moving obstacle that very fast and suitable for service
38
Figure1.VisionbasedservicerobotcalledSrikandiIIdeveloped
and used in this research equipped with 4 DOF arm robot. The
camera has a 640x480 pixel resolution. Compass sensor, 3
ultrasonic sensors used as additional sensor for distance
measurement and Laptop for image processing ( Budiharto, W.
etal.,2010).
2.KinematicsOfWheeledServiceRobot
x R v R cos R (1)
y R v R sin R (2)
(3)
R
d MO sin MO R
(7)
(v R sin R v MO sin MO )
WeusingrecursiveBayesdecisionruleandlossfunction
for deciding the best action for robot (manuevering or
stop) that will be described in detail in section 3.2. The
speed of moving obstacle v MO based on vision is a
complextask,weproposethemodelforcalculatethe vMO
that moving with angle MO detected by the camera,
whereas at the same time the robot moving with speed
v R tothegoalwithangle R ,weneed2pointoftracked
d r
dt
and
d l
dt
(4)
Finally,thelinearvelocity v R canbeformulatedas:
v R R( r l ) / 2
(5)
MO _ R 180 ( R cam )
MO , MO _ R , Cam , R , vR and
(6)
Widodo Budiharto, Djoko Purwanto and Achmad Jazidie: A robust obstacle avoidance for service robot using Bayesian approach
39
3.ProposedMethod
3.1.MovingobstacleavoidanceMethod
R ( (k / d MO )) if d MO d safe (8)
2
Figure4.Flowchartofobstaclesavoidanceandstateestimation
ofmovingobstacleusingBayesiandecisionruleforservicerobot
fromstarttogoalposition.
40
R if d safe d MO d n (9)
If d safe d MO d n reached,thenrobotstarttoreorientation
tothegoalusingcompasssensorbasedondataobtained
before. The velocity of the robot
vR
when in the
vmax
vmax , and
avoidance mode is configured between
2
, the
proposedformulais:
v R = v
max
m
1 0.5
(10)
3.2.StateEstimationusingBayesian
Then,werestricttheactionspacedenotedas as:
(a1, a 2 ) (19)
p( x, y )
p( y | x, z ) p( x | z )
(11)
p( y | z )
xt
conditionedonallsensordataavailableattime t :
(1 , 2 )
(17)
(
obstacle
,
no
_
obstacle
)
(18)
Wedefinealossfunction L( , a) whichgivesameasure
of the loss incurred in taking action a when the state is
.Therobotshouldchoosesanactionafromtheset
of possible actions based on the observation z of the
current state of the path . This gives the posterior
distributionof as:
p ( | z )
p ( z | ) p ( )
p( z | ) p( ) (21)
B ( p ( | z ), a ) L( , a ) p( | z ) (22)
(12)
For implementing the above method, we proposed
p ( z t | xt )bel ( xt ) (13) algorithm obstacles avoidance for service robot that run
fromstarttogoalposition,givingacuptocustomerand
Thisposterioristheprobabilitydistributionoverthestate
goingbacktohomeasshownbelow.
xt at time t , conditioned on all past measurements zt
Captureandsavinglandmark
CallstaticObstacleDetection//UsingCANNYedgedetector
Faceidentification//Facerecognitionsystem
bel ( xt ) p( xt | z1:t 1, u1:t )
if(customer_detected==true)then
(14)
dowhilenotgoal
p ( xt | u t , xt 1 )bel ( xt 1 ) dxt 1 (15) Setheadingrobottothegoal
CallmovingObstacleDetectionTracking
x p( xt | u t , xt 1 )bel ( xt 1 ) (16) Robotrunningwithnormalspeed
t 1
if(moving_obstacle==true)then
This probability distribution is often referred to as
Trackingmovingobstacleandcalculatespeed
Distancemeasurementofmovingobject
prediction in the context of probabilistic filtering (Thrun
StateestimationofmovingobstacleusingBayesian
S., 2006). To apply Bayesian decision theory for obstacle
if(min_distance d safe ==trueandcollision==true)then
avoidance,weconsidertheappearanceofanunexpected
normalizerinBayesrulevariable.Tocalculateaposterior
beforeincorporating zt justafterexecutingthecontrol ut :
//maneuveringrobot
Adjustturningangleandspeed
Updatepositionofrobottothegoalposition
endif
Widodo Budiharto, Djoko Purwanto and Achmad Jazidie: A robust obstacle avoidance for service robot using Bayesian approach
41
else
Movetogoalposition
endif
Movetogoalposition
Givingacuptocustomerandgotohome/startposition
else
Robotstop//ifnocustomerdetected
endif
functionstaticObstacleDetection
captureLandmarkandstaticobstacleprocessing
endfunction
functionmovingObstacleDetectionTracking
Movingobstacledetectionandtracking
endfunction
4.ExperimentalResultsandDiscussion
Variable
s
MO
0 30
v MO
0.150.3m/s
vR
0.150.3m/s
Cam
30
d safe
120cm
dn
90cm
Values
Table1.Variablesusedinourexperiments.
Theprocedureofexperimentcanbedescribedhere.First,
robot will capture the landmark and processing the
imagestoobtainstaticobstaclesandstartgoalpositionas
shown in fig. 6, then robot will detects if the customer
availableorno,ifthecustomerexist,programwilldetects
and tracking moving obstacles. We use upper body
features for moving obstacles detection from OpenCV
library,frontalfacefeaturesusedforcustomersdetection
and camshift method for tracking. Robot continuously
measures the distance of obstacle and send the data to
Laptop.Becausethelimitationofarea,peopleasmoving
obstacleonlywalkstraightinfrontofrobotandapproach
to robot. The speed of robot limited to 3 condition, low
speedis0.1m/s,normalspeedisequalto0.2m/sandfast
isequalto0.3m/s.
For estimating the directionof moving obstacles, we use
tracking and motion history method as shown in fig. 7.
42
Thesemethodsbetterthanopticalflowmethodthatvery
sensitiveanddifficulttocalculatingthespeed.
(a)
(b)
Ifthereiswasnomovingobstacle,robotrunfromstartto
goal position in normal speed. If moving obstacle
appeared and collision will occurred, robot will
maneuver to avoids obstacle, and the turning angle and
speed varied based on eq. 810. To calculate the Bayes
decision,suppose:
Then,wecalculatetheposteriordistribution:
p(1 | z )
p( z | 1 ) p (1 )
2
p ( z | i ) p( i )
i 1
(25)
0.7 x 0.8
p ( 2 | z )
p( z | 2 ) p( 2 )
2
i 1
p ( z | i ) p ( i )
(27)
0.3x 0.2
0.019 (28)
Then,wecalculatetheposteriorexpectedlossfor a1 and
a2 . L(1 , a1 ) is the loss incurred by taking the action
a1 (maneuver)giventhatthepathispassable, 1 .The
Action
(obstacle) (no_obstacle)
1
a1 (maneuver)
a 2 (stop)
10
Table2.Definitionoflossfunction
B ( p( | z ), a1 ) L( i , a1 ) p( i | z )
i 1
0x 0.907 5x 0.019
0.095 (29)
B ( p( | z ), a 2 ) L( i , a 2 ) p ( i | z )
i 1
5x 0.907 10 x 0.019
4.725 (30)
Figure8.Resultofexperimentforobstacleavoidanceforservice
robot. It shown that robot succesfully avoids static and moving
obstaclewhilereachingthegoalposition.
Calculatingthemovingobstacledistance
Calculatethespeedcommand
Determinetheaction
5.Conclusion
Thispaperpresentsarobustobstaclesavoidancemethod
for service robot in indoor environment. Geometrical
modelformovingobstacleavoidanceandalgorithmsfor
static and moving obstacle proposed then implemented
to service robot. Integration of vision and ultrasonic
Widodo Budiharto, Djoko Purwanto and Achmad Jazidie: A robust obstacle avoidance for service robot using Bayesian approach
43
6.References
44
DOI:
10.1109/ACT.2010.51.
BudihartoW.,PurwantoD.andJazidieA.(2010).Indoor
Navigation using ANFIS controller for Servant
Robot,inproc.IEEE2ndInternationalConferenceon
Computer Engineering and Its Application (ICCEA
2010),
BaliIndonesia,
pp.
582.586.
DOI:
10.1109/ICCEA.2010.119.
Hu H. And Brady M. (1994). A Bayesian Approach to
RealTime Obstacle Avoidance for a Mobile Robot.
Autonomous Robots, vol. 1, Kluwer Academic
Publishers,Boston,pp.6992.
Acosta, L., Gonzlez, E.J., Rodrguez, J.N., Hamilton,
A.F.(2006), Design and Implementation of a Service
Robot for A Restaurant, International Journal of
roboticsandautomation,vol.21no.4,pp.273281.