alexLQG.m finass1.m IM_perunit_model_openloop_rotorflux_estimator_comp.mdl newlqr.m Torque_speed_ch.m