try to implement halcon shape based matching, refer to machine vision al...
implement some algorithms of 6d pose estimation