[WIP] Start working on fedorov algorithm in c++