Fix state limits.
Do not fix final state.
Derive dynamics as ODE.
Add cost, state, control and duration names in plots.