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