move code to Pitch, and use a Queue
tweak Kalman numbers
nicer debug drawing