First release of the localization, mapping and local motion planning

Summary
First release of the localization, mapping and local motion planning