Collocation And Optimization Initialization