Added first library code

This is the first code for the library.
The CMake has been updated and the lib is now
able to compile.