这个代码是我亲自调试通过的,在matlab下完整跑通,应该还不错的,可以下载看看