Implemented A* in navbot