Updated Matrix3D tests

Matrix multiplication is working correctly.  Now to finish rotation
concatenation and the matrix created is done.