First attempt at pathfinding using boost::graph