GaTech 3630 Assignment 2 Part 1, Maze runner algorithm in Matlab