a little optimization

Using subtraction operator to calculate the difference of cv::Point2i is a little intensive.