Shape_Projection_Fi​lter

Performs match based filtering to remove a varying magnitude shape from a vector

Performs match based filtering to remove a varying magnitude shape (sawtooth) with a step period of shape_period from the time history z.
The methodology is two part. First a dot product correlation is calculated between a single shape (saw tooth) and high pass filtered z, (butter worth, high passed at fc_hi, filtered_order, filtfilt for doubling filtered_order)...
Shapes-to-be-removed are determined to be where the magnitude of this dot product exceeds the corr_thresh value.
In the second part, at each location that exceeds corr_thresh, the projection value between the sawtooth and the filtered z is multiplied by the sawtooth vector and subtracted from the filtered z to form a corrected z history. A final step interplation can optionally be performed accross the points of the saw tooth step fall.

The corrected z is then added to the residue of the original high pass filtering.