这是我自己根据李萨茹的定义编写的算法，里面还有一个编译好的演示程序。