2D/3D mathematics library for C++