Fixed bug where you couldnt set a SquareNonDiagonal if you wanted to.
Added test for bug fixed in previous check in.
#9 Added support to add configuration with blocking pieces in pathfinding. And support for use of all different types of matrixes.