Addition of small trigonometry library in C++