GPS method added

Added single frame GPS data retrieval method and a GPS test module
Documentation changes

Documentation edits
Simplified program for motion estimation

Work in progress. Not functional yet.