Find problem with cross terms of state and control

[jorgensd]

Need to test

• $\left(\frac{\partial^2 J}{\partial u^2}\dot{u}\right)^*$: Should be checked by Poisson mother (verify)
• $\left(\frac{\partial^2 J}{\partial u \partial m}\delta m\right)^*\lambda$