adding Ed Herbst fast implementation of the Kalman filter and test
cases with timing. Still needs preprocessor interface (option) and documentation.