feat: 增加预瞄点显示
This commit is contained in:
@@ -196,6 +196,23 @@ void Show_Marked_Image(void)
|
||||
// ips200_draw_point(START_X + (uint16_t)((float)pts_left[i][1] * horizontal_zoom_rate), START_Y + (uint16_t)((float)pts_left[i][0] * vertical_zoom_rate), RGB565_YELLOW);
|
||||
// ips200_draw_point(START_X + (uint16_t)((float)pts_left[i][1] * horizontal_zoom_rate) + 1, START_Y + (uint16_t)((float)pts_left[i][0] * vertical_zoom_rate), RGB565_YELLOW);
|
||||
}
|
||||
|
||||
// 打印远近预瞄点
|
||||
uint16 aimpoint_near = (uint16_t)clip((int)round(aim_distance / RESAMPLEDIST), 0, 599);
|
||||
uint16 aimpoint_far = (uint16_t)clip((int)round(0.09 / RESAMPLEDIST), 0, 599);
|
||||
|
||||
// printf("aimpoint_near: %d, aimpoint_far: %d", aimpoint_near, aimpoint_far);
|
||||
|
||||
uint16 ap_x = START_X + (uint16_t)(rptsn[aimpoint_near][1] * horizontal_zoom_rate);
|
||||
uint16 ap_y = START_Y + (uint16_t)(rptsn[aimpoint_near][0] * vertical_zoom_rate);
|
||||
// printf("ap: %d, %d", ap_x, ap_y);
|
||||
ips200_draw_rect(ap_x - 2, ap_y-3, ap_x + 2, ap_y, RGB565_GREEN);
|
||||
|
||||
ap_x = START_X + (uint16_t)(rptsn[aimpoint_far][1] * horizontal_zoom_rate);
|
||||
ap_y = START_Y + (uint16_t)(rptsn[aimpoint_far][0] * vertical_zoom_rate);
|
||||
// printf("ap: %d, %d", ap_x, ap_y);
|
||||
ips200_draw_rect(ap_x - 2, ap_y-3, ap_x + 2, ap_y, RGB565_GREEN);
|
||||
|
||||
#undef IMAGE_DISPLAY_WIDTH
|
||||
#undef START_X
|
||||
#undef START_Y
|
||||
|
||||
Reference in New Issue
Block a user