Finish C++ Implementation of Hu Neng's method