KalmanStatsBuffer.emadl 444 Bytes
Newer Older
Svetlana Pavlitskaya's avatar
Svetlana Pavlitskaya committed
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19
package dp.subcomponents;

component KalmanStatsBuffer(Q startValue) {
    ports in Q^{1, 2} X,
	  in Q^{2, 2} errCov,
          out Q^{1, 2} outX,
	  out Q^{2, 2} outErrCov;

    implementation Math {
            static Q^{1, 2} bufferedX = [startValue, 0];
            static Q^{2, 2} bufferedErrCov = [1000, 0; 0, 1000];

	    outX = bufferedX;
	    outErrCov = bufferedErrCov;

	    bufferedX = X;
	    bufferedErrCov = errCov;
        }
}