Skip to content

Commit

Permalink
Add missing superscript to Kalman filter equations (wpilibsuite#2222)
Browse files Browse the repository at this point in the history
The a posteriori state estimate should be the input to the state
prediction step.
  • Loading branch information
calcmogul authored Mar 21, 2023
1 parent fafa4a0 commit 308e48b
Showing 1 changed file with 1 addition and 1 deletion.
Original file line number Diff line number Diff line change
Expand Up @@ -39,7 +39,7 @@ The following shows the equations of a discrete-time Kalman filter:

.. math::
\text{Predict step} \nonumber \\
\hat{\mathbf{x}}_{k+1}^- &= \mathbf{A}\hat{\mathbf{x}}_k + \mathbf{B} \mathbf{u}_k \\
\hat{\mathbf{x}}_{k+1}^- &= \mathbf{A}\hat{\mathbf{x}}_k^+ + \mathbf{B} \mathbf{u}_k \\
\mathbf{P}_{k+1}^- &= \mathbf{A} \mathbf{P}_k^- \mathbf{A}^T +
\mathbf{\Gamma}\mathbf{Q}\mathbf{\Gamma}^T \\
\text{Update step} \nonumber \\
Expand Down

0 comments on commit 308e48b

Please sign in to comment.