matlab编写,测试过,不错,对于初学者。很有用!