Added full grid support

Next Stop: AStar