经典的算法，有源码，经过调试验证，完全可用。