Gps logging

GPS Logging complete for issue #21 merging with master