[Feature] control from the state and costate

[joseph-gergaud]

@PierreMartinon @jbcaillau
Describe alternatives you've considered
build the control from the state and the costate cf. Hager

[jbcaillau]

@joseph-gergaud please add Hager's ref