[GPS] Added GPS state update
Added helper functions