Environment Modeling for the Application in optimization-based Trajectory Planning | IEEE Conference Publication | IEEE Xplore