add MatrixHelper
temp 3d charpter6 ok