In this algorithm the model of robot s workspace was established with grid method and foldback iterating was used to search the aims by simulating the foraging behavior of ant colony.