Simple Kalman Filter A simple kalman filter Based in https://trandi.wordpress.com/2011/05/16/kalman-filter-simplified-version/