/** * g2d_scale_and_blend - apply scaling to source buffer and then blend 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. * @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. * @op: blend operation type. */ int g2d_scale_and_blend(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, enum e_g2d_op op) { union g2d_point_val pt; union g2d_bitblt_cmd_val bitblt; union g2d_blend_func_val blend; unsigned int scale; unsigned int scale_x, scale_y; 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; } 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 (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); } 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 + 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); return g2d_flush(ctx); }
/** * g2d_blend - blend image data in source and destination 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); g2d_add_base_addr(ctx, dst, g2d_dst); 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: g2d_add_base_addr(ctx, src, g2d_src); 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); return g2d_flush(ctx); }
/** * 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); 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_base_addr(ctx, src, g2d_src); 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); return g2d_flush(ctx); }
/** * 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; 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); return g2d_flush(ctx); }
static long g2d_ioctl(struct file *file, unsigned int cmd, unsigned long arg) { g2d_params params; int ret = -1; struct g2d_dma_info dma_info; switch(cmd) { case G2D_GET_MEMORY : ret = copy_to_user((unsigned int *)arg, &(g2d_dev->reserved_mem.base), sizeof(g2d_dev->reserved_mem.base)); if (ret) { FIMG2D_ERROR("error : copy_to_user\n"); return -EINVAL; } return 0; case G2D_GET_MEMORY_SIZE : ret = copy_to_user((unsigned int *)arg, &(g2d_dev->reserved_mem.size), sizeof(g2d_dev->reserved_mem.size)); if (ret) { FIMG2D_ERROR("error : copy_to_user\n"); return -EINVAL; } return 0; case G2D_DMA_CACHE_CLEAN : case G2D_DMA_CACHE_FLUSH : mutex_lock(&g2d_dev->lock); ret = copy_from_user(&dma_info, (struct g2d_dma_info *)arg, sizeof(dma_info)); if (ret) { FIMG2D_ERROR("error : copy_from_user\n"); mutex_unlock(&g2d_dev->lock); return -EINVAL; } if (dma_info.addr == 0) { FIMG2D_ERROR("addr Null Error!!!\n"); mutex_unlock(&g2d_dev->lock); return -EINVAL; } g2d_mem_cache_op(cmd, (void *)dma_info.addr, dma_info.size); mutex_unlock(&g2d_dev->lock); return 0; case G2D_SYNC : g2d_check_fifo_state_wait(g2d_dev); ret = 0; goto g2d_ioctl_done; case G2D_RESET : g2d_reset(g2d_dev); FIMG2D_ERROR("G2D TimeOut Error\n"); ret = 0; goto g2d_ioctl_done; case G2D_BLIT: if (atomic_read(&g2d_dev->ready_to_run) == 0) goto g2d_ioctl_done2; mutex_lock(&g2d_dev->lock); g2d_clk_enable(g2d_dev); if (copy_from_user(¶ms, (struct g2d_params *)arg, sizeof(g2d_params))) { FIMG2D_ERROR("error : copy_from_user\n"); goto g2d_ioctl_done; } g2d_dev->irq_handled = 0; atomic_set(&g2d_dev->in_use, 1); if (atomic_read(&g2d_dev->ready_to_run) == 0) goto g2d_ioctl_done; if (!g2d_do_blit(g2d_dev, ¶ms)) { g2d_dev->irq_handled = 1; goto g2d_ioctl_done; } if (!(params.flag.render_mode & G2D_HYBRID_MODE)) { if(!(file->f_flags & O_NONBLOCK)) { if (!g2d_wait_for_finish(g2d_dev, ¶ms)) goto g2d_ioctl_done; } } else { ret = 0; goto g2d_ioctl_done2; } ret = 0; break; default : goto g2d_ioctl_done2; break; } g2d_ioctl_done : g2d_clk_disable(g2d_dev); mutex_unlock(&g2d_dev->lock); atomic_set(&g2d_dev->in_use, 0); g2d_ioctl_done2 : return ret; }