A method for constructing a coordinate system relative to a vehicle traveling along a path includes receiving location data, dividing the path into path segments, matching a portion of the location data to a path segment, and determining a registration of the portion of the location data relative to the path segment. The registration may be organized by non-cartesian coordinates relative to a path point lying on the path segment.