Systems and methods for terrain contour matching navigation are provided. In one embodiment, a method for terrain contour matching navigation comprises: receiving at least one sample point representing the position of an aircraft, the at least one sample point including a horizontal position and an altitude sample; correlating a first sample point of the at least one sample point across a reference basket array having a plurality of elements; determining a correlation quality; when the correlation quality does not achieve a pre-determined quality threshold, performing at least one additional correlation of an additional sample point of the at least one sample point across the reference basket array; and when the correlation quality does achieve a pre-determined quality threshold, calculating a position error based on the correlating of the first sample point and any additional correlations of any additional sample points.