Update gps.c
Added init_gps() function
Update gps.c
Update main.c