カルマンフィルタを実装する（トロッコの問題）

制御工学 Python

カルマンフィルタを実装してみました。
こちらの解説を参考に。http://www.cs.unc.edu/~welch/kalman/kalmanIntro.html
問題はwikipediaにあるトロッコの問題。
早速コードから。

グラフはこちら。
0