$diag\left(a_{i,i}\right)$

$Q_{c,p}$

$Q_{c,e}$

$Q_{\dot{q}}$

$A_e$

$a_{i,i}$

0.001

2

0.001

−1