Multi-modal control of systems with constraints