Create algorithms of C++

fork now, will code later