Completed waveform estimation with Kalman filter

Code not tested thoroughly yet
Default parameter updates
Test script for Kalman filter model
Improved efficiency of waveform estimation