Fixes accidential line deletion in NavStatesgit add .
Working obstacle module. Needs major improvements though.
The obstacle detection that works! Still needs a little tweaking... but so close!