Separated linear target truth and measurement model from the Kalman filter itself.
Operational code with limited waveform library and self-defined initial estimate covariance.

Optimal waveform selection technique is based on minimisation of mean square track error.