算法C实现