@@ -39,23 +39,22 @@ Extended Help for details on ``\mathbf{û_0, f̂}`` and ``\mathbf{ĥ}`` implem
3939 the augmented model functions are:
4040 ```math
4141 \b egin{aligned}
42- \m athbf{f̂}\B ig(\m athbf{x̂_0}(k), \m athbf{u_0}(k), \m athbf{d_0}(k)\B ig) &= \b egin{bmatrix}
43- \m athbf{f}\B ig(\m athbf{x_0}(k), \m athbf{û_0}(k), \m athbf{d_0}(k), \m athbf{p}\B ig) \\
44- \m athbf{A_s} \m athbf{x_s}(k)
45- \e nd{bmatrix}
46- \m athbf{ĥ}\B ig(\m athbf{x̂_0}(k), \m athbf{d_0}(k)\B ig) &=
47- \b egin{aligned}
48- \m athbf{h}\B ig(\m athbf{x_0}(k), \m athbf{d_0}(k), \m athbf{p}\B ig) + \m athbf{y_{s_y}}(k) \\
49- \m athbf{h}\B ig(\m athbf{x_0}(k), \m athbf{d_0}(k), \m athbf{p}\B ig) + \m athbf{C_{s_y} x_s}(k)
42+ \m athbf{f̂}\B ig(\m athbf{x̂_0}(k), \m athbf{u_0}(k), \m athbf{d_0}(k)\B ig) &= \b egin{bmatrix}
43+ \m athbf{f}\B ig(\m athbf{x_0}(k), \m athbf{û_0}(k), \m athbf{d_0}(k), \m athbf{p}\B ig) \\
44+ \m athbf{A_s} \m athbf{x_s}(k) \e nd{bmatrix} \\
45+ \m athbf{ĥ}\B ig(\m athbf{x̂_0}(k), \m athbf{d_0}(k)\B ig) &=
46+ \m athbf{h}\B ig(\m athbf{x_0}(k), \m athbf{d_0}(k), \m athbf{p}\B ig) + \m athbf{y_{s_y}}(k)
5047 \e nd{aligned}
51- and the disturbed input is:
48+ ```
49+ in which:
5250 ```math
5351 \b egin{aligned}
54- \m athbf{û_0}(k) &= \m athbf{u_0}(k) + \m athbf{y_{s_u}(k)}
55- &= \m athbf{u_0}(k) + \m athbf{C_{s_u} x_s}(k)
52+ \m athbf{û_0}(k) &= \m athbf{u_0}(k) + \m athbf{y_{s_u}(k)} \\
53+ \m athbf{y_{s_u}}(k) &= \m athbf{C_{s_u} x_s}(k) \\
54+ \m athbf{y_{s_y}}(k) &= \m athbf{C_{s_y} x_s}(k)
5655 \e nd{aligned}
5756 ```
58- The ``\m athbf{f}`` and ``\m athbf{h}`` functions above are in fact [`f!`](@ref) and
57+ The ``\m athbf{f}`` and ``\m athbf{h}`` functions above are in fact the [`f!`](@ref) and
5958 [`h!`](@ref) methods, respectively.
6059"""
6160function f̂! (x̂0next, û0, k0, estim:: StateEstimator , model:: SimModel , x̂0, u0, d0)
0 commit comments