Basic working prototype.

Something happens to the lower frequencies as they seem an octave
too high, investigate and also adjust hps algorithm.