opencv的chamfer用不了,就自己写了一个