add math3d folder and add vector3.h