Корректные состояния с использованием прямых измерений состояния для insfilterMARG
correct( корректирует ковариацию состояния и погрешности оценки состояния на основе ковариации измерения и измерения. Измерение сопоставляется непосредственно с состоянием, указанным индексами. FUSE,idx,measurement,measurementCovariance)idx.