Renabled simplification on export as it improves optimization convergence. Fixed bug in initialization method so it can handle mismatched problems and only seeds matching variables. Cleaned up n-link pendulum on a cart swing-up and have tested up to 10 links.