algebraic_states not handled correctly in mhe

[EveCharbie]

There is at least a bad initialization from a_init in bioptim/optimization/receding_horizon_optimization.py, but there might be other problems.