Fixed incorrect GPS math