本代码由opencv实现,每一步骤都附有详细的说明,文件包中除了实现代码之外还包含一篇ICP的经典文章,注释中的公式指的就是文章中的公式