Adds vision submodule
Adds path planning submodule
Adds localization submodule