separated geometry from speed planning and simulation