По сути, у вас есть ситуация, когда
rdot(2) = a2 + b2*rdot(4)
rdot(4) = a4 + b4*rdot(2)
, где a2,b2,a4,b4
содержит все другие термины в ваших выражениях.
Это линейная система, которую вам нужно решить, чтобы получитьправильные значения для возврата.Вы можете использовать линейный решатель Matlab или в этом простом двумерном случае сделать это вручную,
rdot(2) = a2 + b2*(a4 + b4*rdot(2)) ==> rdot(2) = (a2 + b2*a4) / (1 - b2*b4)
rdot(4) = a4 + b4*(a2 + b2*rdot(4)) ==> rdot(2) = (a4 + b4*a2) / (1 - b2*b4)
Чтобы применить это, вам нужно разделить
T1_1 as T1_1a + T1_1b*rdot(4),
Вы можете вычислить T1_1a
и T1_1b
из заданных констант и переменных состояния.Затем, где у вас есть в конце
rdot(2)=(other + coeff*T1_1)/denom
, вы должны разделить на
a2 =(other + coeff*T1_1a) / denom and
b2 = coeff*T1_1b / denom
и сделать то же самое для второй части, чтобы получить a4,b4
, а затем применить формулы решения выше,