Code for simulating SS models, plus Kalman filter
Finish Kalman filter code, add Kalman smoother
A few minor tweaks, including parameterizing functions
Add timing blocks to kalman test script