158. OCR A Level (H446) Implement A star pathfinding