Adding GPS header, C implementation, and test code. Also adding i2c headers and implementations.