A simple A* implementation in Rust