Final Commit

- record gps data
- heading trajectory