Fixed references

Fixing several references in the Kalman Model.  (mostly adding a `this.` or an `o.` in front of the variables.)
Also, fixed a vector addition to use the `add` method.