The Lagrange multiplier rule on manifolds and optimal control of nonlinear systems - Bus, J. C. (1982)