Updated pathFind. Added a coarsening algo, really sloppy right now. Added a map utility