This moves the entire algorithm into C++, and includes a faster
initialization heuristic.