Added Kalman Update to Bellman Class

It still converges, but only with sigma_max = 1.0e-4.
I’ve added an optimize.brute part in case the problem was with multiple
local minima