Nimza, ПМП наверняка не работает для задач в которых ограничение на управление не фиксировано, а зависит от фазовых переменных. Можно попробовать выкрутиться из данной ситуации. Вместо управления

ввести виртуальное управление

, такое, что ограничения

не зависят от фазовых переменных. Проблема - найти преобразование

. По всей видимости, оно ещё должно быть диффеоморфным..