计算两点间距离

u32 get_approx_distance(Vect2D_s32 _p1, Vect2D_s32 _p2)

{

// x的距离

u32 dx = abs(_p1.x - _p2.x);


// y的距离

u32 dy = abs(_p1.y - _p2.y);


//返回：最大值 + ( 最小值 >> 2 )

return max(dx, dy) + (min(dx, dy) >> 2);

}