@@ -694,31 +694,29 @@ end
694694
695695Init the matrices for computing the defects over the predicted states.
696696
697- The defects are calculated with an equation similar to the prediction matrices (see
698- [`init_predmat`](@ref)):
697+ An equation similar to the prediction matrices (see
698+ [`init_predmat`](@ref)) computes the defects over the predicted states :
699699```math
700- \b egin{aligned* }
700+ \b egin{aligned}
701701 \m athbf{Ŝ} &= \m athbf{E_ŝ Z} + \m athbf{G_ŝ d_0}(k) + \m athbf{J_ŝ D̂_0}
702- + \m athbf{K_ŝ x̂_0}(k) + \m athbf{V_ŝ u_0}(k-1)
703- + \m athbf{B_ŝ}
702+ + \m athbf{K_ŝ x̂_0}(k) + \m athbf{V_ŝ u_0}(k-1)
703+ + \m athbf{B_ŝ} \\
704704 &= \m athbf{E_ŝ Z} + \m athbf{F_ŝ}
705-
706- \e nd{aligned*}
705+ \e nd{aligned}
707706```
708- They are forced to be ``\m athbf{Ŝ = 0}`` using the equality constraints of the optimizer.
709- The matrices ``\m athbf{E_ŝ, G_ŝ, J_ŝ, K_ŝ, V_ŝ, B_ŝ}`` are defined in the Extended Help
710- section.
707+ They are forced to be ``\m athbf{Ŝ = 0}`` using the optimization equality constraints. The
708+ matrices ``\m athbf{E_ŝ, G_ŝ, J_ŝ, K_ŝ, V_ŝ, B_ŝ}`` are defined in the Extended Help section.
711709
712710# Extended Help
713711!!! details "Extended Help"
714712 The matrices are computed by:
715713 ```math
716714 \b egin{aligned}
717715 \m athbf{E_ŝ} &= \b egin{bmatrix}
718- \m athbf{B̂_u} & \m athbf{0} & \c dots & \m athbf{0} & -\m athbf{I} & \m athbf{0} & \c dots & \m athbf{0} \\
719- \m athbf{0} & \m athbf{B̂_u} & \c dots & \m athbf{0} & \m athbf{Â} & -\m athbf{I} & \c dots & \m athbf{0} \\
720- \v dots & \v dots & \d dots & \v dots & \v dots & \v dots & \d dots & \v dots \\
721- \m athbf{0} & \m athbf{0} & \c dots & \m athbf{B̂_u} \m athbf{0} & \m athbf{0} & \c dots & -\m athbf{I} \e nd{bmatrix} \\
716+ \m athbf{B̂_u} & \m athbf{0} & \c dots & \m athbf{0} & -\m athbf{I} & \m athbf{0} & \c dots & \m athbf{0} \\
717+ \m athbf{0} & \m athbf{B̂_u} & \c dots & \m athbf{0} & \m athbf{Â} & -\m athbf{I} & \c dots & \m athbf{0} \\
718+ \v dots & \v dots & \d dots & \v dots & \v dots & \v dots & \d dots & \v dots \\
719+ \m athbf{0} & \m athbf{0} & \c dots & \m athbf{B̂_u} & \m athbf{0} & \m athbf{0} & \c dots & -\m athbf{I} \e nd{bmatrix} \\
722720 \m athbf{G_ŝ} &= \b egin{bmatrix}
723721 \m athbf{B̂_d} \\ \m athbf{0} \\ \v dots \\ \m athbf{0} \e nd{bmatrix} \\
724722 \m athbf{J_ŝ} &= \b egin{bmatrix}
@@ -729,7 +727,7 @@ section.
729727 \m athbf{K_ŝ} &= \b egin{bmatrix}
730728 \m athbf{Â} \\ \m athbf{0} \\ \v dots \\ \m athbf{0} \e nd{bmatrix} \\
731729 \m athbf{V_ŝ} &= \b egin{bmatrix}
732- \m athbf{B̂_u} \\ \m athbf{B̂_u} \\ \m athbf{B̂_u} \\ \m athbf{B̂_u} \e nd{bmatrix} \\
730+ \m athbf{B̂_u} \\ \m athbf{B̂_u} \\ \v dots \\ \m athbf{B̂_u} \e nd{bmatrix} \\
733731 \m athbf{B_ŝ} &= \b egin{bmatrix}
734732 \m athbf{f̂_{op} - x̂_{op}} \\ \m athbf{f̂_{op} - x̂_{op}} \\ \v dots \\ \m athbf{f̂_{op} - x̂_{op}} \e nd{bmatrix}
735733 \e nd{aligned}
0 commit comments