Self-Organizing And Optimal Control For Nonlinear Systems