Create 3dmath.cpp - Compile time improvement

Moving the impelementation of the core math structures to a file, to
reduce compile times. It already take some minutes to compile the
project(which at current stage look like a gl framework, what will
happen when it is complete)