Added test in main.cpp for augmentMatrix()