Barometer implementation cleanup and bug fixes.

Fixed bugs where if the barometer was below 20*C, I would get odd math errors partially resulting from using unsigned ints in math with signed ints.

Also initial check in of GPS test.