// Numbers on name representing indicies // current car state x 2 1 0 0 // covariance matrix P 2 2 10 0 0 10 // dynamic model // process error Q 2 2 1 0 0 1 // measure vector H 1 2 1 0 // measurement error R 1 1 5