Development Of Algorithm For Robot