modal optimal control