参考这篇文章,结合上次发的matlab代码:http://wenku.baidu.com/link?url=k9PkZBqfNbUL_QeGvOWyISIEbEBEMlsfOeruuW82QnyLxvikZVf-E5CiFrm7EXXGkKGx-DZX62fuZJPW25jT3Es-v3zjwhGhunGnlR0AqNC