Initially, I ran into a dead end using Jensen's inequality. After some poking around on the web, I stumbled upon the suggestion to take an f(x) ≠ h(x) when substituting into the inequality equation. From there, it came out a bit cleaner.
I implemented the Kalman filter simulation in Java. Use the slider on the right to adjust the standard deviation of the process noise
which in this case can be used to tune the filter. Linear Algebra calculations are being carried out with JAMA ,
a java matrix package developed by MathWorks and NIST.
[Web Start]
[Source Code]