Uses actual GPS update interval

Uses actual GPS update interval instead of hardcoded one
Fixes a few other bugs