Fix a whole bunch of style in robot_nav.py
Split navigation out into its own folder.
Improve some more formatting and improved the point_distance interface.
A couple little tweaks.