/* * g2d_add_base_addr - helper function to set dst/src base address register. * * @ctx: a pointer to g2d_context structure. * @img: a pointer to the dst/src g2d_image structure. * @reg: the register that should be set. */ static void g2d_add_base_addr(struct g2d_context *ctx, struct g2d_image *img, enum g2d_base_addr_reg reg) { const unsigned long cmd = (reg == g2d_dst) ? DST_BASE_ADDR_REG : SRC_BASE_ADDR_REG; if (img->buf_type == G2D_IMGBUF_USERPTR) g2d_add_cmd(ctx, cmd | G2D_BUF_USERPTR, (unsigned long)&img->user_ptr[0]); else g2d_add_cmd(ctx, cmd, img->bo[0]); }
/* * g2d_reset - reset fimg2d hardware. * * @ctx: a pointer to g2d_context structure. * */ static void g2d_reset(struct g2d_context *ctx) { ctx->cmd_nr = 0; ctx->cmd_buf_nr = 0; g2d_add_cmd(ctx, SOFT_RESET_REG, 0x01); }
/** * g2d_solid_fill - fill given buffer with given color data. * * @ctx: a pointer to g2d_context structure. * @img: a pointer to g2d_image structure including image and buffer * information. * @x: x start position to buffer filled with given color data. * @y: y start position to buffer filled with given color data. * @w: width value to buffer filled with given color data. * @h: height value to buffer filled with given color data. */ int g2d_solid_fill(struct g2d_context *ctx, struct g2d_image *img, unsigned int x, unsigned int y, unsigned int w, unsigned int h) { union g2d_bitblt_cmd_val bitblt; union g2d_point_val pt; g2d_add_cmd(ctx, DST_SELECT_REG, G2D_SELECT_MODE_NORMAL); g2d_add_cmd(ctx, DST_COLOR_MODE_REG, img->color_mode); if (img->buf_type == G2D_IMGBUF_USERPTR) g2d_add_cmd(ctx, DST_BASE_ADDR_REG | G2D_BUF_USERPTR, (unsigned long)&img->user_ptr[0]); else g2d_add_cmd(ctx, DST_BASE_ADDR_REG, img->bo[0]); g2d_add_cmd(ctx, DST_STRIDE_REG, img->stride); if (x + w > img->width) w = img->width - x; if (y + h > img->height) h = img->height - y; pt.val = 0; pt.data.x = x; pt.data.y = y; g2d_add_cmd(ctx, DST_LEFT_TOP_REG, pt.val); pt.val = 0; pt.data.x = x + w; pt.data.y = y + h; g2d_add_cmd(ctx, DST_RIGHT_BOTTOM_REG, pt.val); g2d_add_cmd(ctx, SF_COLOR_REG, img->color); bitblt.val = 0; bitblt.data.fast_solid_color_fill_en = 1; g2d_add_cmd(ctx, BITBLT_COMMAND_REG, bitblt.val); g2d_flush(ctx); return 0; }
/** * g2d_solid_fill - fill given buffer with given color data. * * @ctx: a pointer to g2d_context structure. * @img: a pointer to g2d_image structure including image and buffer * information. * @x: x start position to buffer filled with given color data. * @y: y start position to buffer filled with given color data. * @w: width value to buffer filled with given color data. * @h: height value to buffer filled with given color data. */ drm_public int g2d_solid_fill(struct g2d_context *ctx, struct g2d_image *img, unsigned int x, unsigned int y, unsigned int w, unsigned int h) { union g2d_bitblt_cmd_val bitblt; union g2d_point_val pt; g2d_add_cmd(ctx, DST_SELECT_REG, G2D_SELECT_MODE_NORMAL); g2d_add_cmd(ctx, DST_COLOR_MODE_REG, img->color_mode); g2d_add_base_addr(ctx, img, g2d_dst); g2d_add_cmd(ctx, DST_STRIDE_REG, img->stride); if (x + w > img->width) w = img->width - x; if (y + h > img->height) h = img->height - y; pt.val = 0; pt.data.x = x; pt.data.y = y; g2d_add_cmd(ctx, DST_LEFT_TOP_REG, pt.val); pt.val = 0; pt.data.x = x + w; pt.data.y = y + h; g2d_add_cmd(ctx, DST_RIGHT_BOTTOM_REG, pt.val); g2d_add_cmd(ctx, SF_COLOR_REG, img->color); bitblt.val = 0; bitblt.data.fast_solid_color_fill_en = 1; g2d_add_cmd(ctx, BITBLT_COMMAND_REG, bitblt.val); g2d_flush(ctx); return 0; }
/** * g2d_blend - blend image data in source and destion buffers * * @ctx: a pointer to g2d_context structure. * @src: a pointer to g2d_image structure including image and buffer * information to source. * @dst: a pointer to g2d_image structure including image and buffer * information to destination. * @src_x: x start position to source buffer. * @src_y: y start position to source buffer. * @dst_x: x start position to destination buffer. * @dst_y: y start position to destination buffer. * @w: width value to source and destination buffer. * @h: height value to source and destination buffer. * @op: blend operation type. */ int g2d_blend(struct g2d_context *ctx, struct g2d_image *src, struct g2d_image *dst, unsigned int src_x, unsigned int src_y, unsigned int dst_x, unsigned int dst_y, unsigned int w, unsigned int h, enum e_g2d_op op) { union g2d_point_val pt; union g2d_bitblt_cmd_val bitblt; union g2d_blend_func_val blend; unsigned int src_w = 0, src_h = 0, dst_w = 0, dst_h = 0; bitblt.val = 0; blend.val = 0; if (op == G2D_OP_SRC || op == G2D_OP_CLEAR) g2d_add_cmd(ctx, DST_SELECT_REG, G2D_SELECT_MODE_BGCOLOR); else g2d_add_cmd(ctx, DST_SELECT_REG, G2D_SELECT_MODE_NORMAL); g2d_add_cmd(ctx, DST_COLOR_MODE_REG, dst->color_mode); if (dst->buf_type == G2D_IMGBUF_USERPTR) g2d_add_cmd(ctx, DST_BASE_ADDR_REG | G2D_BUF_USERPTR, (unsigned long)&dst->user_ptr[0]); else g2d_add_cmd(ctx, DST_BASE_ADDR_REG, dst->bo[0]); g2d_add_cmd(ctx, DST_STRIDE_REG, dst->stride); g2d_add_cmd(ctx, SRC_SELECT_REG, src->select_mode); g2d_add_cmd(ctx, SRC_COLOR_MODE_REG, src->color_mode); switch (src->select_mode) { case G2D_SELECT_MODE_NORMAL: if (src->buf_type == G2D_IMGBUF_USERPTR) g2d_add_cmd(ctx, SRC_BASE_ADDR_REG | G2D_BUF_USERPTR, (unsigned long)&src->user_ptr[0]); else g2d_add_cmd(ctx, SRC_BASE_ADDR_REG, src->bo[0]); g2d_add_cmd(ctx, SRC_STRIDE_REG, src->stride); break; case G2D_SELECT_MODE_FGCOLOR: g2d_add_cmd(ctx, FG_COLOR_REG, src->color); break; case G2D_SELECT_MODE_BGCOLOR: g2d_add_cmd(ctx, BG_COLOR_REG, src->color); break; default: fprintf(stderr , "failed to set src.\n"); return -EINVAL; } src_w = w; src_h = h; if (src_x + w > src->width) src_w = src->width - src_x; if (src_y + h > src->height) src_h = src->height - src_y; dst_w = w; dst_h = h; if (dst_x + w > dst->width) dst_w = dst->width - dst_x; if (dst_y + h > dst->height) dst_h = dst->height - dst_y; w = MIN(src_w, dst_w); h = MIN(src_h, dst_h); if (w <= 0 || h <= 0) { fprintf(stderr, "invalid width or height.\n"); g2d_reset(ctx); return -EINVAL; } bitblt.data.alpha_blend_mode = G2D_ALPHA_BLEND_MODE_ENABLE; blend.val = g2d_get_blend_op(op); g2d_add_cmd(ctx, BITBLT_COMMAND_REG, bitblt.val); g2d_add_cmd(ctx, BLEND_FUNCTION_REG, blend.val); pt.val = 0; pt.data.x = src_x; pt.data.y = src_y; g2d_add_cmd(ctx, SRC_LEFT_TOP_REG, pt.val); pt.val = 0; pt.data.x = src_x + w; pt.data.y = src_y + h; g2d_add_cmd(ctx, SRC_RIGHT_BOTTOM_REG, pt.val); pt.val = 0; pt.data.x = dst_x; pt.data.y = dst_y; g2d_add_cmd(ctx, DST_LEFT_TOP_REG, pt.val); pt.val = 0; pt.data.x = dst_x + w; pt.data.y = dst_y + h; g2d_add_cmd(ctx, DST_RIGHT_BOTTOM_REG, pt.val); g2d_flush(ctx); return 0; }
/** * g2d_copy_with_scale - copy contents in source buffer to destination buffer * scaling up or down properly. * * @ctx: a pointer to g2d_context structure. * @src: a pointer to g2d_image structure including image and buffer * information to source. * @dst: a pointer to g2d_image structure including image and buffer * information to destination. * @src_x: x start position to source buffer. * @src_y: y start position to source buffer. * @src_w: width value to source buffer. * @src_h: height value to source buffer. * @dst_x: x start position to destination buffer. * @dst_y: y start position to destination buffer. * @dst_w: width value to destination buffer. * @dst_h: height value to destination buffer. * @negative: indicate that it uses color negative to source and * destination buffers. */ int g2d_copy_with_scale(struct g2d_context *ctx, struct g2d_image *src, struct g2d_image *dst, unsigned int src_x, unsigned int src_y, unsigned int src_w, unsigned int src_h, unsigned int dst_x, unsigned int dst_y, unsigned int dst_w, unsigned int dst_h, unsigned int negative) { union g2d_rop4_val rop4; union g2d_point_val pt; unsigned int scale; double scale_x = 0.0f, scale_y = 0.0f; g2d_add_cmd(ctx, DST_SELECT_REG, G2D_SELECT_MODE_BGCOLOR); g2d_add_cmd(ctx, DST_COLOR_MODE_REG, dst->color_mode); if (dst->buf_type == G2D_IMGBUF_USERPTR) g2d_add_cmd(ctx, DST_BASE_ADDR_REG | G2D_BUF_USERPTR, (unsigned long)&dst->user_ptr[0]); else g2d_add_cmd(ctx, DST_BASE_ADDR_REG, dst->bo[0]); g2d_add_cmd(ctx, DST_STRIDE_REG, dst->stride); g2d_add_cmd(ctx, SRC_SELECT_REG, G2D_SELECT_MODE_NORMAL); g2d_add_cmd(ctx, SRC_COLOR_MODE_REG, src->color_mode); if (src->buf_type == G2D_IMGBUF_USERPTR) g2d_add_cmd(ctx, SRC_BASE_ADDR_REG | G2D_BUF_USERPTR, (unsigned long)&src->user_ptr[0]); else g2d_add_cmd(ctx, SRC_BASE_ADDR_REG, src->bo[0]); g2d_add_cmd(ctx, SRC_STRIDE_REG, src->stride); if (src_w == dst_w && src_h == dst_h) scale = 0; else { scale = 1; scale_x = (double)src_w / (double)dst_w; scale_y = (double)src_h / (double)dst_h; } if (src_x + src_w > src->width) src_w = src->width - src_x; if (src_y + src_h > src->height) src_h = src->height - src_y; if (dst_x + dst_w > dst->width) dst_w = dst->width - dst_x; if (dst_y + dst_h > dst->height) dst_h = dst->height - dst_y; if (src_w <= 0 || src_h <= 0 || dst_w <= 0 || dst_h <= 0) { fprintf(stderr, "invalid width or height.\n"); g2d_reset(ctx); return -EINVAL; } if (negative) { g2d_add_cmd(ctx, BG_COLOR_REG, 0x00FFFFFF); rop4.val = 0; rop4.data.unmasked_rop3 = G2D_ROP3_SRC^G2D_ROP3_DST; g2d_add_cmd(ctx, ROP4_REG, rop4.val); } else { rop4.val = 0; rop4.data.unmasked_rop3 = G2D_ROP3_SRC; g2d_add_cmd(ctx, ROP4_REG, rop4.val); } if (scale) { g2d_add_cmd(ctx, SRC_SCALE_CTRL_REG, G2D_SCALE_MODE_BILINEAR); g2d_add_cmd(ctx, SRC_XSCALE_REG, G2D_DOUBLE_TO_FIXED(scale_x)); g2d_add_cmd(ctx, SRC_YSCALE_REG, G2D_DOUBLE_TO_FIXED(scale_y)); } pt.val = 0; pt.data.x = src_x; pt.data.y = src_y; g2d_add_cmd(ctx, SRC_LEFT_TOP_REG, pt.val); pt.val = 0; pt.data.x = src_x + src_w; pt.data.y = src_y + src_h; g2d_add_cmd(ctx, SRC_RIGHT_BOTTOM_REG, pt.val); pt.val = 0; pt.data.x = dst_x; pt.data.y = dst_y; g2d_add_cmd(ctx, DST_LEFT_TOP_REG, pt.val); pt.val = 0; pt.data.x = dst_x + dst_w; pt.data.y = dst_y + dst_h; g2d_add_cmd(ctx, DST_RIGHT_BOTTOM_REG, pt.val); g2d_flush(ctx); return 0; }
/** * g2d_copy - copy contents in source buffer to destination buffer. * * @ctx: a pointer to g2d_context structure. * @src: a pointer to g2d_image structure including image and buffer * information to source. * @dst: a pointer to g2d_image structure including image and buffer * information to destination. * @src_x: x start position to source buffer. * @src_y: y start position to source buffer. * @dst_x: x start position to destination buffer. * @dst_y: y start position to destination buffer. * @w: width value to source and destination buffers. * @h: height value to source and destination buffers. */ int g2d_copy(struct g2d_context *ctx, struct g2d_image *src, struct g2d_image *dst, unsigned int src_x, unsigned int src_y, unsigned int dst_x, unsigned dst_y, unsigned int w, unsigned int h) { union g2d_rop4_val rop4; union g2d_point_val pt; unsigned int src_w = 0, src_h = 0, dst_w = 0, dst_h = 0; g2d_add_cmd(ctx, DST_SELECT_REG, G2D_SELECT_MODE_BGCOLOR); g2d_add_cmd(ctx, DST_COLOR_MODE_REG, dst->color_mode); if (dst->buf_type == G2D_IMGBUF_USERPTR) g2d_add_cmd(ctx, DST_BASE_ADDR_REG | G2D_BUF_USERPTR, (unsigned long)&dst->user_ptr[0]); else g2d_add_cmd(ctx, DST_BASE_ADDR_REG, dst->bo[0]); g2d_add_cmd(ctx, DST_STRIDE_REG, dst->stride); g2d_add_cmd(ctx, SRC_SELECT_REG, G2D_SELECT_MODE_NORMAL); g2d_add_cmd(ctx, SRC_COLOR_MODE_REG, src->color_mode); if (src->buf_type == G2D_IMGBUF_USERPTR) g2d_add_cmd(ctx, SRC_BASE_ADDR_REG | G2D_BUF_USERPTR, (unsigned long)&src->user_ptr[0]); else g2d_add_cmd(ctx, SRC_BASE_ADDR_REG, src->bo[0]); g2d_add_cmd(ctx, SRC_STRIDE_REG, src->stride); src_w = w; src_h = h; if (src_x + src->width > w) src_w = src->width - src_x; if (src_y + src->height > h) src_h = src->height - src_y; dst_w = w; dst_h = w; if (dst_x + dst->width > w) dst_w = dst->width - dst_x; if (dst_y + dst->height > h) dst_h = dst->height - dst_y; w = MIN(src_w, dst_w); h = MIN(src_h, dst_h); if (w <= 0 || h <= 0) { fprintf(stderr, "invalid width or height.\n"); g2d_reset(ctx); return -EINVAL; } pt.val = 0; pt.data.x = src_x; pt.data.y = src_y; g2d_add_cmd(ctx, SRC_LEFT_TOP_REG, pt.val); pt.val = 0; pt.data.x = src_x + w; pt.data.y = src_y + h; g2d_add_cmd(ctx, SRC_RIGHT_BOTTOM_REG, pt.val); pt.val = 0; pt.data.x = dst_x; pt.data.y = dst_y; g2d_add_cmd(ctx, DST_LEFT_TOP_REG, pt.val); pt.val = 0; pt.data.x = dst_x + w; pt.data.y = dst_y + h; g2d_add_cmd(ctx, DST_RIGHT_BOTTOM_REG, pt.val); rop4.val = 0; rop4.data.unmasked_rop3 = G2D_ROP3_SRC; g2d_add_cmd(ctx, ROP4_REG, rop4.val); g2d_flush(ctx); return 0; }
/** * g2d_copy_with_scale - copy contents in source buffer to destination buffer * scaling up or down properly. * * @ctx: a pointer to g2d_context structure. * @src: a pointer to g2d_image structure including image and buffer * information to source. * @dst: a pointer to g2d_image structure including image and buffer * information to destination. * @src_x: x start position to source buffer. * @src_y: y start position to source buffer. * @src_w: width value to source buffer. * @src_h: height value to source buffer. * @dst_x: x start position to destination buffer. * @dst_y: y start position to destination buffer. * @dst_w: width value to destination buffer. * @dst_h: height value to destination buffer. * @negative: indicate that it uses color negative to source and * destination buffers. */ drm_public int g2d_copy_with_scale(struct g2d_context *ctx, struct g2d_image *src, struct g2d_image *dst, unsigned int src_x, unsigned int src_y, unsigned int src_w, unsigned int src_h, unsigned int dst_x, unsigned int dst_y, unsigned int dst_w, unsigned int dst_h, unsigned int negative) { union g2d_rop4_val rop4; union g2d_point_val pt; unsigned int scale; unsigned int scale_x, scale_y; g2d_add_cmd(ctx, DST_SELECT_REG, G2D_SELECT_MODE_BGCOLOR); g2d_add_cmd(ctx, DST_COLOR_MODE_REG, dst->color_mode); g2d_add_base_addr(ctx, dst, g2d_dst); g2d_add_cmd(ctx, DST_STRIDE_REG, dst->stride); g2d_add_cmd(ctx, SRC_SELECT_REG, G2D_SELECT_MODE_NORMAL); g2d_add_cmd(ctx, SRC_COLOR_MODE_REG, src->color_mode); g2d_add_cmd(ctx, SRC_REPEAT_MODE_REG, src->repeat_mode); if (src->repeat_mode == G2D_REPEAT_MODE_PAD) g2d_add_cmd(ctx, SRC_PAD_VALUE_REG, dst->color); g2d_add_base_addr(ctx, src, g2d_src); g2d_add_cmd(ctx, SRC_STRIDE_REG, src->stride); if (src_w == dst_w && src_h == dst_h) scale = 0; else { scale = 1; scale_x = g2d_get_scaling(src_w, dst_w); scale_y = g2d_get_scaling(src_h, dst_h); } if (src_x + src_w > src->width) src_w = src->width - src_x; if (src_y + src_h > src->height) src_h = src->height - src_y; if (dst_x + dst_w > dst->width) dst_w = dst->width - dst_x; if (dst_y + dst_h > dst->height) dst_h = dst->height - dst_y; if (src_w <= 0 || src_h <= 0 || dst_w <= 0 || dst_h <= 0) { fprintf(stderr, "invalid width or height.\n"); g2d_reset(ctx); return -EINVAL; } if (negative) { g2d_add_cmd(ctx, BG_COLOR_REG, 0x00FFFFFF); rop4.val = 0; rop4.data.unmasked_rop3 = G2D_ROP3_SRC^G2D_ROP3_DST; g2d_add_cmd(ctx, ROP4_REG, rop4.val); } else { rop4.val = 0; rop4.data.unmasked_rop3 = G2D_ROP3_SRC; g2d_add_cmd(ctx, ROP4_REG, rop4.val); } if (scale) { g2d_add_cmd(ctx, SRC_SCALE_CTRL_REG, G2D_SCALE_MODE_BILINEAR); g2d_add_cmd(ctx, SRC_XSCALE_REG, scale_x); g2d_add_cmd(ctx, SRC_YSCALE_REG, scale_y); } pt.val = 0; pt.data.x = src_x; pt.data.y = src_y; g2d_add_cmd(ctx, SRC_LEFT_TOP_REG, pt.val); pt.val = 0; pt.data.x = src_x + src_w; pt.data.y = src_y + src_h; g2d_add_cmd(ctx, SRC_RIGHT_BOTTOM_REG, pt.val); pt.val = 0; pt.data.x = dst_x; pt.data.y = dst_y; g2d_add_cmd(ctx, DST_LEFT_TOP_REG, pt.val); pt.val = 0; pt.data.x = dst_x + dst_w; pt.data.y = dst_y + dst_h; g2d_add_cmd(ctx, DST_RIGHT_BOTTOM_REG, pt.val); g2d_flush(ctx); return 0; }