Added printf formatting and added data proccessing code to process gps data
Fixed bugs and added formatting for printf