Add test for assert
Add algorithm.hpp
Update cmake
Make algorithms inline