MAZESOLVER

For now everyoe try running the bug0, bug1, bug2 and gmapping code, and see if the robot moves properly