Added FinalizeMatrixAssembly.h.
Added test for matrix assembly functionality.