No errors, old functions removed, position and heading hard coded
initial commit from WindRunner project
Mission manager in and works with going to points
Recursion in, but horribly wrong
dijkstra works and gives output path
changed map
Took out a lot of the bloat from original writing
slam and particle filtering