Validate function size before running the solver

[jorisv]

Solver must throw an exception if some cost, constraints or dynamics mismatch the problem size.

[ManifoldFR]

I agree. So far all we have is validation for some cost or dynamics' models constructors, but nothing checks everything yet.

This will have to wait for the upcoming rewrite though

[ManifoldFR]

Related: #208