Initialization of grid relaxation complete but untested
worked on visualization
Done recreating my work. Also added another A* that avoids blockades
effectively
Added files to index
Merge remote-tracking branch 'origin/emil-navigation' into ambulance
finish_implementation