Dynamic Inversion Matlab