Geometry Based Approach to Obstacle Avoidance of Triomnidirectional Wheeled Mobile Robotic Platform

Algorithm 1

Method of correcting wheel rotation direction.

for  ; ;   do

  compute each wheel speed  

  if    then

  else if    then

  else

  end if

end for