34 int32_t cell_x =
x >> 15;
35 int32_t cell_y =
y >> 15;
40 for (
int dy = -1; dy <= 1; ++dy) {
41 for (
int dx = -1; dx <= 1; ++dx) {
42 int32_t gx = cell_x + dx;
43 int32_t gy = cell_y + dy;
46 feature_point(gx, gy, fx, fy);
48 int32_t feature_x = (gx << 15) + fx;
49 int32_t feature_y = (gy << 15) + fy;
51 int32_t dx_q15 =
x - feature_x;
52 int32_t dy_q15 =
y - feature_y;
57 q15_abs(dx_q15) + q15_abs(dy_q15);
65 return (min_dist << 15) / (2 * Q15_ONE);