Added gps data test files so the gps tests run. Added sanity check for empty cloud in pathplanning