MatrixFunctions: Clean up StemFunction.h
merge