casadi_tools to OptVarSet

Goal: match interface of jax_tools w/ OptVarSet, should simplify the object structure a bit.

• Fix singleshootingsolver afterwards