Unit tests

Setup unit tests ready to fill out
Unit tests

Filled out some unit tests, GPS tested
Merge pull request #4 from mweekes/master

Merge with main