this was just in text, but I used self.W[i], and it should have been
self.Wc[i].
This commit is contained in:
parent
e82f2184d8
commit
99193f7e26
@ -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",
|
||||
|
Loading…
Reference in New Issue
Block a user