The A* pathfinding algorithm is among the most documented algorithms out there. What exactly are you having trouble with?
