Linsys TODO before linsys: KF: Add script to calulate Kalman estimate and covariance-matrix given a set of measurements and a given system function LQR: Calculation of optimal gain