Gnss rework

@Kynos this is your original PR, just merged with master and sdlog2_fix.