Integrated maze logic into micromouse.  Had to refactor/format a couple maze things.