Start working on fedorov algorithm in c++
Move fedorov to C++