Hello, thanks for nice repo. So far i believe motion model is incorrect.
For state matrix you use [[x], [y]], but state transition matrix is [[1, dt], [0, 1]], which is believe is for state matrix like [x, vx] (one dimentional constant velocity model). You're computing dot product between them here, which seems incorrect.
My suggestion would be to use two dimentional constant velocity model.
State matrix:
Transition matrix:
[[1, 0, dt, 0],
[0, 1, 0, dt],
[0, 0, 1, 0],
[0, 0, 0, 1]],
Hello, thanks for nice repo. So far i believe motion model is incorrect.
For state matrix you use [[x], [y]], but state transition matrix is [[1, dt], [0, 1]], which is believe is for state matrix like [x, vx] (one dimentional constant velocity model). You're computing dot product between them here, which seems incorrect.
My suggestion would be to use two dimentional constant velocity model.
State matrix:
Transition matrix: