Updated main.cpp to demonstrate odometry and mapping capablity in Azolla.