A control system for a rotary wing aircraft having a reconfigurable element. The control system includes a model predictive control module receiving operator commands, objectives and constraints; and a dynamic inversion module receiving an output of the model predictive control module, the dynamic inversion module providing control commands to reconfigure the reconfigurable element of the rotary wing aircraft.