Nav Python Code Added

I added the navigation and sensor filter code into the scratch work folder.