Fix GPS and use 1000mHz at boot

Change-Id: I6e3c7835a916ada0a5a1719d478e17bbbab5a67a