FLD代码，MATLAB实现。两个.m文件分别可以运行。