Finish optimal control part. Still missing classification for spline optimal control.