RT,看到有matlab实现,参照写了C++实现,vs环境需要配置opencv