用C++写的一个算法,写得简单,不过很实用的哟。。。