added least sq initialization and KF constructor