Fast optimizing control for non-convex state constraints using homotopy properties | IEEE Conference Publication | IEEE Xplore