@@ -744,8 +744,7 @@ substitutions ``\mathbf{Â = F̂}(k)`` and ``\mathbf{Ĉ^m = Ĥ^m}(k)``:
744
744
[\m athbf{Ĥ^m}(k)\m athbf{P̂}_{k-1}(k)\m athbf{Ĥ^m}'(k) + \m athbf{R̂}]^{-1} \\
745
745
\m athbf{K̂}(k) &= \m athbf{F̂}(k) \m athbf{M̂}(k) \\
746
746
\m athbf{ŷ^m}(k) &= \m athbf{ĥ^m}\B ig( \m athbf{x̂}_{k-1}(k), \m athbf{d}(k) \B ig) \\
747
- \m athbf{x̂}_{k}(k+1) &= \m ath, covestim::CE,
748
- ) bf{f̂}\B ig( \m athbf{x̂}_{k-1}(k), \m athbf{u}(k), \m athbf{d}(k) \B ig)
747
+ \m athbf{x̂}_{k}(k+1) &= \m athbf{f̂}\B ig( \m athbf{x̂}_{k-1}(k), \m athbf{u}(k), \m athbf{d}(k) \B ig)
749
748
+ \m athbf{K̂}(k)[\m athbf{y^m}(k) - \m athbf{ŷ^m}(k)] \\
750
749
\m athbf{P̂}_{k}(k+1) &= \m athbf{F̂}(k)[\m athbf{P̂}_{k-1}(k)
751
750
- \m athbf{M̂}(k)\m athbf{Ĥ^m}(k)\m athbf{P̂}_{k-1}(k)]\m athbf{F̂}'(k)
@@ -756,8 +755,7 @@ substitutions ``\mathbf{Â = F̂}(k)`` and ``\mathbf{Ĉ^m = Ĥ^m}(k)``:
756
755
automatically computes the Jacobians:
757
756
```math
758
757
\b egin{aligned}
759
- \m athbf{F̂}(k) &= \l eft. \f ra, covestim::CE,
760
- ) c{∂\m athbf{f̂}(\m athbf{x̂}, \m athbf{u}, \m athbf{d})}{∂\m athbf{x̂}} \r ight|_{\m athbf{x̂ = x̂}_{k-1}(k),\, \m athbf{u = u}(k),\, \m athbf{d = d}(k)} \\
758
+ \m athbf{F̂}(k) &= \l eft. \f rac{∂\m athbf{f̂}(\m athbf{x̂}, \m athbf{u}, \m athbf{d})}{∂\m athbf{x̂}} \r ight|_{\m athbf{x̂ = x̂}_{k-1}(k),\, \m athbf{u = u}(k),\, \m athbf{d = d}(k)} \\
761
759
\m athbf{Ĥ}(k) &= \l eft. \f rac{∂\m athbf{ĥ}(\m athbf{x̂}, \m athbf{d})}{∂\m athbf{x̂}} \r ight|_{\m athbf{x̂ = x̂}_{k-1}(k),\, \m athbf{d = d}(k)}
762
760
\e nd{aligned}
763
761
```
0 commit comments