该算法用matla进行了仿真,绝对可用!