feat: 增加预瞄点显示

This commit is contained in:
bmy
2024-03-15 12:52:02 +08:00
parent 0faecbd1be
commit d803d2d653

View File

@@ -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