Add initial math3d.hh