Update 11-Extended-Kalman-Filters.ipynb

Fixed covariance in control space. It doesn't result in substantially different output.
This commit is contained in:
jdavidberger 2021-12-28 12:39:53 -07:00 committed by GitHub
parent ee586f5d84
commit 16e59292fd
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23

View File

@ -1155,7 +1155,7 @@
" V = array(self.V_j.evalf(subs=self.subs)).astype(float)\n",
"\n",
" # covariance of motion noise in control space\n",
" M = array([[self.std_vel*u[0]**2, 0], \n",
" M = array([[self.std_vel**2, 0], \n",
" [0, self.std_steer**2]])\n",
"\n",
" self.P = F @ self.P @ F.T + V @ M @ V.T\n",