算法功能、测试类 完全实现，暂未对性能和内存占用进行优化