A control system uses a set of regions of states of lateral dynamic of the vehicle corresponding to a set of equilibrium points to control a vehicle. Each region defines a control invariant set of the states of the lateral dynamic determined such that the vehicle having a state within a region is capable to maintain its states within the region. Each region includes a corresponding equilibrium point and intersects with at least one adjacent region. The control system identifies collision-free regions at different time steps of control to produce a collision free sequence of regions forming a union of regions in space and time connecting a region including an initial displacement with a region including a target displacement. The control system produces a trajectory within the union connecting the initial displacement with the target displacement and control the vehicle according to the trajectory.