Fixed gps coordinates stuff + added some tests. Tests passed