Clean up the code, writing tests where appropriate.

Restructure the code so that there are no more magic constants and parameters are easily tune-able.

Also a way to provide resulting doppler data to an event processor of some sort.