Added some algs code

Implemented in C/C++