Added GEO_WGS84_to_ITRF routine and made GEO coords use Latitude and Longitude