Update Functions

Modify GPS function and data output scheme
“Compartmentalize” setup() function in main program