Add the Kalman filter C implementation.

Takes some matrix code from GLUT/GLE.