Added generic (non-static) 3x3 matrix implementation. Need to modify CoordMap usage in order to use this for bed leveling