Update math_3d.h