The goal of this thesis is to develop the control system of autonomous vehicle considering the dynamical model. The control problem will be decomposed in two layers. In the lower layer simple controller will be considered. And, in the upper layer more advanced controllers will be considered. Finally, the proposed two-layers control scheme will be tested on a real test-bed.