function ydot = sect_5_4_ode_fn_part_c(t,y) % SECT_5_4_ODE_FN_PART_C - returns the time derivative needed to integrate the covariance evolution equations % % Written by: % -- % John L. Weatherwax 2005-08-14 % % email: wax@alum.mit.edu % % Please send comments and especially bug reports to the % above email address. % %----- % the common terms for all parts (ignores the measurement term -S S^T H^T R_C^{-1} H S): ydot = sect_5_4_ode_fn(t,y); % extract the components: y = y(:); s11 = y(1); s12 = y(2); s22 = y(3); s11Squared = s11^2; s12Squared = s12^2; s22Squared = s22^2; % add in the measurement term (-S S^T H^T R_C^{-1} H S): % ydot(1) = ydot(1) -(s11*(s11Squared + s12Squared))/2.; ydot(2) = ydot(2) -(s12*(s11Squared + s12Squared + s22Squared)); ydot(3) = ydot(3) -(s22*(s12Squared + s22Squared))/2.;