Added math_3d.h lib