Thanks @jpfeifer, annoyingly I thought I almost had it but then the H matrix seems to make things difficult. I will try what you said. I came across this post
Would you say this is a good starting point? Also, I have seen that you replicated Dynare’s Kalman results with the internal MATLAB implementation. Do you remember whether you have used the