cppimplementationofroboticsalgorithmsincludinglocalization,mapping,SLAM,pathplanningandcontrol