迭代法及matlab实现