Help implement Kalman filter

Ah, sorry, You had it almost.

ij(x,y) =  round(Int, y), round(Int, x)

I’ll edit.