depth first search

I discovered some errors in my Kalman filter code. For those keeping track at home I was using the true state to update the filter each iteration, and I used the wrong predicted covariance in one part of the correction step. I’ve updated my code here. Incidentally, I discovered the error when testing whether the [...]