maze_solve function

Maze Solver, inspired by Micromouse competitions