Bot now does both feature extarction and odometry, and plots it on the map

TODO: Perfect location of the features plotted
TODO: Add feature/landmark identification