Fixed problems of last revision, GPS now works as intended.