this was just in text, but I used self.W[i], and it should have been

self.Wc[i].
This commit is contained in:
Roger Labbe 2017-05-11 13:20:37 -07:00
parent e82f2184d8
commit 99193f7e26

View File

@ -2449,7 +2449,7 @@
" # compute cross variance of the state and the measurements\n",
" Pxz = np.zeros((self._dim_x, self._dim_z))\n",
" for i in range(self._num_sigmas):\n",
" Pxz += self.W[i] * np.outer(sigmas_f[i] - self.xp,\n",
" Pxz += self.Wc[i] * np.outer(sigmas_f[i] - self.xp,\n",
" sigmas_h[i] - zp)\n",
"\n",
" K = dot(Pxz, inv(Pz)) # Kalman gain\n",