Simple, header-only, unoptimized Kalman filter implementation.