Increase GPS freq when close to final destination

To improve when final position is reached we must increase GPS freq when
we are closing in on destination.