自己编的matlab代码，感觉不错和大家分享一下。