Function astar_path 

pub fn astar_path(
    hmap: &Heightmap,
    start: GridNode,
    goal: GridNode,
    cost_params: &RoadCostParams,
) -> Option<Vec<GridNode>>

A* pathfinding on a heightmap grid