Matrix measurementCovariance = MatrixFactory.getDefault().copyArray(
new double[][] {{trueSigma2}});
Vector truePsi = VectorFactory.getDefault().copyValues(3d, 0.2d);
LinearDynamicalSystem dlm = new LinearDynamicalSystem(
MatrixFactory.getDefault().copyArray(new double[][] {{truePsi.getElement(1)}}),
MatrixFactory.getDefault().copyArray(new double[][] {{1d}}),
MatrixFactory.getDefault().copyArray(new double[][] {{1d}})
);
KalmanFilter trueKf = new KalmanFilter(dlm, modelCovariance, measurementCovariance);