Moving the CRDoubleMatrix concatenate function into matrices.h and .cc