Смотреть главы в: Приближенное решение задач оптимального управления -> Метод последовательной линеаризации. Вычислительная технология