1 /*
2 * Copyright (C) 2013 Samsung Electronics Co.Ltd
3 * Authors:
4 * Inki Dae <inki.dae@samsung.com>
5 *
6 * This program is free software; you can redistribute it and/or modify it
7 * under the terms of the GNU General Public License as published by the
8 * Free Software Foundation; either version 2 of the License, or (at your
9 * option) any later version.
10 *
11 */
12
13 #ifdef HAVE_CONFIG_H
14 #include "config.h"
15 #endif
16
17 #include <stdlib.h>
18 #include <stdio.h>
19 #include <string.h>
20 #include <errno.h>
21 #include <assert.h>
22
23 #include <sys/mman.h>
24 #include <linux/stddef.h>
25
26 #include <xf86drm.h>
27
28 #include "libdrm_macros.h"
29 #include "exynos_drm.h"
30 #include "fimg2d_reg.h"
31 #include "exynos_fimg2d.h"
32
33 #define SET_BF(val, sc, si, scsa, scda, dc, di, dcsa, dcda) \
34 val.data.src_coeff = sc; \
35 val.data.inv_src_color_coeff = si; \
36 val.data.src_coeff_src_a = scsa; \
37 val.data.src_coeff_dst_a = scda; \
38 val.data.dst_coeff = dc; \
39 val.data.inv_dst_color_coeff = di; \
40 val.data.dst_coeff_src_a = dcsa; \
41 val.data.dst_coeff_dst_a = dcda;
42
43 #define MIN(a, b) ((a) < (b) ? (a) : (b))
44
45 #define MSG_PREFIX "exynos/fimg2d: "
46
47 #define G2D_MAX_CMD_NR 64
48 #define G2D_MAX_GEM_CMD_NR 64
49 #define G2D_MAX_CMD_LIST_NR 64
50
51 struct g2d_context {
52 int fd;
53 unsigned int major;
54 unsigned int minor;
55 struct drm_exynos_g2d_cmd cmd[G2D_MAX_CMD_NR];
56 struct drm_exynos_g2d_cmd cmd_buf[G2D_MAX_GEM_CMD_NR];
57 unsigned int cmd_nr;
58 unsigned int cmd_buf_nr;
59 unsigned int cmdlist_nr;
60 void *event_userdata;
61 };
62
63 enum g2d_base_addr_reg {
64 g2d_dst = 0,
65 g2d_src
66 };
67
68 enum e_g2d_dir_mode {
69 G2D_DIR_MODE_POSITIVE = 0,
70 G2D_DIR_MODE_NEGATIVE = 1
71 };
72
73 union g2d_direction_val {
74 unsigned int val[2];
75 struct {
76 /* SRC_MSK_DIRECT_REG [0:1] (source) */
77 enum e_g2d_dir_mode src_x_direction:1;
78 enum e_g2d_dir_mode src_y_direction:1;
79
80 /* SRC_MSK_DIRECT_REG [2:3] */
81 unsigned int reversed1:2;
82
83 /* SRC_MSK_DIRECT_REG [4:5] (mask) */
84 enum e_g2d_dir_mode mask_x_direction:1;
85 enum e_g2d_dir_mode mask_y_direction:1;
86
87 /* SRC_MSK_DIRECT_REG [6:31] */
88 unsigned int padding1:26;
89
90 /* DST_PAT_DIRECT_REG [0:1] (destination) */
91 enum e_g2d_dir_mode dst_x_direction:1;
92 enum e_g2d_dir_mode dst_y_direction:1;
93
94 /* DST_PAT_DIRECT_REG [2:3] */
95 unsigned int reversed2:2;
96
97 /* DST_PAT_DIRECT_REG [4:5] (pattern) */
98 enum e_g2d_dir_mode pat_x_direction:1;
99 enum e_g2d_dir_mode pat_y_direction:1;
100
101 /* DST_PAT_DIRECT_REG [6:31] */
102 unsigned int padding2:26;
103 } data;
104 };
105
g2d_get_scaling(unsigned int src,unsigned int dst)106 static unsigned int g2d_get_scaling(unsigned int src, unsigned int dst)
107 {
108 /*
109 * The G2D hw scaling factor is a normalized inverse of the scaling factor.
110 * For example: When source width is 100 and destination width is 200
111 * (scaling of 2x), then the hw factor is NC * 100 / 200.
112 * The normalization factor (NC) is 2^16 = 0x10000.
113 */
114
115 return ((src << 16) / dst);
116 }
117
g2d_get_blend_op(enum e_g2d_op op)118 static unsigned int g2d_get_blend_op(enum e_g2d_op op)
119 {
120 union g2d_blend_func_val val;
121
122 val.val = 0;
123
124 /*
125 * The switch statement is missing the default branch since
126 * we assume that the caller checks the blending operation
127 * via g2d_validate_blending_op() first.
128 */
129 switch (op) {
130 case G2D_OP_CLEAR:
131 case G2D_OP_DISJOINT_CLEAR:
132 case G2D_OP_CONJOINT_CLEAR:
133 SET_BF(val, G2D_COEFF_MODE_ZERO, 0, 0, 0, G2D_COEFF_MODE_ZERO,
134 0, 0, 0);
135 break;
136 case G2D_OP_SRC:
137 case G2D_OP_DISJOINT_SRC:
138 case G2D_OP_CONJOINT_SRC:
139 SET_BF(val, G2D_COEFF_MODE_ONE, 0, 0, 0, G2D_COEFF_MODE_ZERO,
140 0, 0, 0);
141 break;
142 case G2D_OP_DST:
143 case G2D_OP_DISJOINT_DST:
144 case G2D_OP_CONJOINT_DST:
145 SET_BF(val, G2D_COEFF_MODE_ZERO, 0, 0, 0, G2D_COEFF_MODE_ONE,
146 0, 0, 0);
147 break;
148 case G2D_OP_OVER:
149 SET_BF(val, G2D_COEFF_MODE_ONE, 0, 0, 0,
150 G2D_COEFF_MODE_SRC_ALPHA, 1, 0, 0);
151 break;
152 case G2D_OP_INTERPOLATE:
153 SET_BF(val, G2D_COEFF_MODE_SRC_ALPHA, 0, 0, 0,
154 G2D_COEFF_MODE_SRC_ALPHA, 1, 0, 0);
155 break;
156 }
157
158 return val.val;
159 }
160
161 /*
162 * g2d_check_space - check if command buffers have enough space left.
163 *
164 * @ctx: a pointer to g2d_context structure.
165 * @num_cmds: number of (regular) commands.
166 * @num_gem_cmds: number of GEM commands.
167 */
g2d_check_space(const struct g2d_context * ctx,unsigned int num_cmds,unsigned int num_gem_cmds)168 static unsigned int g2d_check_space(const struct g2d_context *ctx,
169 unsigned int num_cmds, unsigned int num_gem_cmds)
170 {
171 if (ctx->cmd_nr + num_cmds >= G2D_MAX_CMD_NR ||
172 ctx->cmd_buf_nr + num_gem_cmds >= G2D_MAX_GEM_CMD_NR)
173 return 1;
174 else
175 return 0;
176 }
177
178 /*
179 * g2d_validate_select_mode - validate select mode.
180 *
181 * @mode: the mode to validate
182 *
183 * Returns zero for an invalid mode and one otherwise.
184 */
g2d_validate_select_mode(enum e_g2d_select_mode mode)185 static int g2d_validate_select_mode(
186 enum e_g2d_select_mode mode)
187 {
188 switch (mode) {
189 case G2D_SELECT_MODE_NORMAL:
190 case G2D_SELECT_MODE_FGCOLOR:
191 case G2D_SELECT_MODE_BGCOLOR:
192 return 1;
193 }
194
195 return 0;
196 }
197
198 /*
199 * g2d_validate_blending_op - validate blending operation.
200 *
201 * @operation: the operation to validate
202 *
203 * Returns zero for an invalid mode and one otherwise.
204 */
g2d_validate_blending_op(enum e_g2d_op operation)205 static int g2d_validate_blending_op(
206 enum e_g2d_op operation)
207 {
208 switch (operation) {
209 case G2D_OP_CLEAR:
210 case G2D_OP_SRC:
211 case G2D_OP_DST:
212 case G2D_OP_OVER:
213 case G2D_OP_INTERPOLATE:
214 case G2D_OP_DISJOINT_CLEAR:
215 case G2D_OP_DISJOINT_SRC:
216 case G2D_OP_DISJOINT_DST:
217 case G2D_OP_CONJOINT_CLEAR:
218 case G2D_OP_CONJOINT_SRC:
219 case G2D_OP_CONJOINT_DST:
220 return 1;
221 }
222
223 return 0;
224 }
225
226 /*
227 * g2d_add_cmd - set given command and value to user side command buffer.
228 *
229 * @ctx: a pointer to g2d_context structure.
230 * @cmd: command data.
231 * @value: value data.
232 *
233 * The caller has to make sure that the commands buffers have enough space
234 * left to hold the command. Use g2d_check_space() to ensure this.
235 */
g2d_add_cmd(struct g2d_context * ctx,unsigned long cmd,unsigned long value)236 static void g2d_add_cmd(struct g2d_context *ctx, unsigned long cmd,
237 unsigned long value)
238 {
239 switch (cmd & ~(G2D_BUF_USERPTR)) {
240 case SRC_BASE_ADDR_REG:
241 case SRC_PLANE2_BASE_ADDR_REG:
242 case DST_BASE_ADDR_REG:
243 case DST_PLANE2_BASE_ADDR_REG:
244 case PAT_BASE_ADDR_REG:
245 case MASK_BASE_ADDR_REG:
246 assert(ctx->cmd_buf_nr < G2D_MAX_GEM_CMD_NR);
247
248 ctx->cmd_buf[ctx->cmd_buf_nr].offset = cmd;
249 ctx->cmd_buf[ctx->cmd_buf_nr].data = value;
250 ctx->cmd_buf_nr++;
251 break;
252 default:
253 assert(ctx->cmd_nr < G2D_MAX_CMD_NR);
254
255 ctx->cmd[ctx->cmd_nr].offset = cmd;
256 ctx->cmd[ctx->cmd_nr].data = value;
257 ctx->cmd_nr++;
258 break;
259 }
260 }
261
262 /*
263 * g2d_add_base_addr - helper function to set dst/src base address register.
264 *
265 * @ctx: a pointer to g2d_context structure.
266 * @img: a pointer to the dst/src g2d_image structure.
267 * @reg: the register that should be set.
268 */
g2d_add_base_addr(struct g2d_context * ctx,struct g2d_image * img,enum g2d_base_addr_reg reg)269 static void g2d_add_base_addr(struct g2d_context *ctx, struct g2d_image *img,
270 enum g2d_base_addr_reg reg)
271 {
272 const unsigned long cmd = (reg == g2d_dst) ?
273 DST_BASE_ADDR_REG : SRC_BASE_ADDR_REG;
274
275 if (img->buf_type == G2D_IMGBUF_USERPTR)
276 g2d_add_cmd(ctx, cmd | G2D_BUF_USERPTR,
277 (unsigned long)&img->user_ptr[0]);
278 else
279 g2d_add_cmd(ctx, cmd, img->bo[0]);
280 }
281
282 /*
283 * g2d_set_direction - setup direction register (useful for overlapping blits).
284 *
285 * @ctx: a pointer to g2d_context structure.
286 * @dir: a pointer to the g2d_direction_val structure.
287 */
g2d_set_direction(struct g2d_context * ctx,const union g2d_direction_val * dir)288 static void g2d_set_direction(struct g2d_context *ctx,
289 const union g2d_direction_val *dir)
290 {
291 g2d_add_cmd(ctx, SRC_MASK_DIRECT_REG, dir->val[0]);
292 g2d_add_cmd(ctx, DST_PAT_DIRECT_REG, dir->val[1]);
293 }
294
295 /*
296 * g2d_reset - reset fimg2d hardware.
297 *
298 * @ctx: a pointer to g2d_context structure.
299 *
300 */
g2d_reset(struct g2d_context * ctx)301 static void g2d_reset(struct g2d_context *ctx)
302 {
303 ctx->cmd_nr = 0;
304 ctx->cmd_buf_nr = 0;
305
306 g2d_add_cmd(ctx, SOFT_RESET_REG, 0x01);
307 }
308
309 /*
310 * g2d_flush - submit all commands and values in user side command buffer
311 * to command queue aware of fimg2d dma.
312 *
313 * @ctx: a pointer to g2d_context structure.
314 *
315 * This function should be called after all commands and values to user
316 * side command buffer are set. It submits that buffer to the kernel side driver.
317 */
g2d_flush(struct g2d_context * ctx)318 static int g2d_flush(struct g2d_context *ctx)
319 {
320 int ret;
321 struct drm_exynos_g2d_set_cmdlist cmdlist = {0};
322
323 if (ctx->cmd_nr == 0 && ctx->cmd_buf_nr == 0)
324 return 0;
325
326 if (ctx->cmdlist_nr >= G2D_MAX_CMD_LIST_NR) {
327 fprintf(stderr, MSG_PREFIX "command list overflow.\n");
328 return -EINVAL;
329 }
330
331 cmdlist.cmd = (uint64_t)(uintptr_t)&ctx->cmd[0];
332 cmdlist.cmd_buf = (uint64_t)(uintptr_t)&ctx->cmd_buf[0];
333 cmdlist.cmd_nr = ctx->cmd_nr;
334 cmdlist.cmd_buf_nr = ctx->cmd_buf_nr;
335
336 if (ctx->event_userdata) {
337 cmdlist.event_type = G2D_EVENT_NONSTOP;
338 cmdlist.user_data = (uint64_t)(uintptr_t)(ctx->event_userdata);
339 ctx->event_userdata = NULL;
340 } else {
341 cmdlist.event_type = G2D_EVENT_NOT;
342 cmdlist.user_data = 0;
343 }
344
345 ctx->cmd_nr = 0;
346 ctx->cmd_buf_nr = 0;
347
348 ret = drmIoctl(ctx->fd, DRM_IOCTL_EXYNOS_G2D_SET_CMDLIST, &cmdlist);
349 if (ret < 0) {
350 fprintf(stderr, MSG_PREFIX "failed to set cmdlist.\n");
351 return ret;
352 }
353
354 ctx->cmdlist_nr++;
355
356 return ret;
357 }
358
359 /**
360 * g2d_init - create a new g2d context and get hardware version.
361 *
362 * fd: a file descriptor to an opened drm device.
363 */
g2d_init(int fd)364 struct g2d_context *g2d_init(int fd)
365 {
366 struct drm_exynos_g2d_get_ver ver;
367 struct g2d_context *ctx;
368 int ret;
369
370 ctx = calloc(1, sizeof(*ctx));
371 if (!ctx) {
372 fprintf(stderr, MSG_PREFIX "failed to allocate context.\n");
373 return NULL;
374 }
375
376 ctx->fd = fd;
377
378 ret = drmIoctl(fd, DRM_IOCTL_EXYNOS_G2D_GET_VER, &ver);
379 if (ret < 0) {
380 fprintf(stderr, MSG_PREFIX "failed to get version.\n");
381 free(ctx);
382 return NULL;
383 }
384
385 ctx->major = ver.major;
386 ctx->minor = ver.minor;
387
388 printf(MSG_PREFIX "G2D version (%d.%d).\n", ctx->major, ctx->minor);
389 return ctx;
390 }
391
g2d_fini(struct g2d_context * ctx)392 void g2d_fini(struct g2d_context *ctx)
393 {
394 free(ctx);
395 }
396
397 /**
398 * g2d_config_event - setup userdata configuration for a g2d event.
399 * The next invocation of a g2d call (e.g. g2d_solid_fill) is
400 * then going to flag the command buffer as 'nonstop'.
401 * Completion of the command buffer execution can then be
402 * determined by using drmHandleEvent on the DRM fd.
403 * The userdata is 'consumed' in the process.
404 *
405 * @ctx: a pointer to g2d_context structure.
406 * @userdata: a pointer to the user data
407 */
g2d_config_event(struct g2d_context * ctx,void * userdata)408 void g2d_config_event(struct g2d_context *ctx, void *userdata)
409 {
410 ctx->event_userdata = userdata;
411 }
412
413 /**
414 * g2d_exec - start the dma to process all commands summited by g2d_flush().
415 *
416 * @ctx: a pointer to g2d_context structure.
417 */
g2d_exec(struct g2d_context * ctx)418 int g2d_exec(struct g2d_context *ctx)
419 {
420 struct drm_exynos_g2d_exec exec;
421 int ret;
422
423 if (ctx->cmdlist_nr == 0)
424 return -EINVAL;
425
426 exec.async = 0;
427
428 ret = drmIoctl(ctx->fd, DRM_IOCTL_EXYNOS_G2D_EXEC, &exec);
429 if (ret < 0) {
430 fprintf(stderr, MSG_PREFIX "failed to execute.\n");
431 return ret;
432 }
433
434 ctx->cmdlist_nr = 0;
435
436 return ret;
437 }
438
439 /**
440 * g2d_solid_fill - fill given buffer with given color data.
441 *
442 * @ctx: a pointer to g2d_context structure.
443 * @img: a pointer to g2d_image structure including image and buffer
444 * information.
445 * @x: x start position to buffer filled with given color data.
446 * @y: y start position to buffer filled with given color data.
447 * @w: width value to buffer filled with given color data.
448 * @h: height value to buffer filled with given color data.
449 */
450 int
g2d_solid_fill(struct g2d_context * ctx,struct g2d_image * img,unsigned int x,unsigned int y,unsigned int w,unsigned int h)451 g2d_solid_fill(struct g2d_context *ctx, struct g2d_image *img,
452 unsigned int x, unsigned int y, unsigned int w,
453 unsigned int h)
454 {
455 union g2d_bitblt_cmd_val bitblt;
456 union g2d_point_val pt;
457
458 if (g2d_check_space(ctx, 7, 1))
459 return -ENOSPC;
460
461 g2d_add_cmd(ctx, DST_SELECT_REG, G2D_SELECT_MODE_NORMAL);
462 g2d_add_cmd(ctx, DST_COLOR_MODE_REG, img->color_mode);
463 g2d_add_base_addr(ctx, img, g2d_dst);
464 g2d_add_cmd(ctx, DST_STRIDE_REG, img->stride);
465
466 if (x + w > img->width)
467 w = img->width - x;
468 if (y + h > img->height)
469 h = img->height - y;
470
471 pt.data.x = x;
472 pt.data.y = y;
473 g2d_add_cmd(ctx, DST_LEFT_TOP_REG, pt.val);
474
475 pt.data.x = x + w;
476 pt.data.y = y + h;
477 g2d_add_cmd(ctx, DST_RIGHT_BOTTOM_REG, pt.val);
478
479 g2d_add_cmd(ctx, SF_COLOR_REG, img->color);
480
481 bitblt.val = 0;
482 bitblt.data.fast_solid_color_fill_en = 1;
483 g2d_add_cmd(ctx, BITBLT_COMMAND_REG, bitblt.val);
484
485 return g2d_flush(ctx);
486 }
487
488 /**
489 * g2d_copy - copy contents in source buffer to destination buffer.
490 *
491 * @ctx: a pointer to g2d_context structure.
492 * @src: a pointer to g2d_image structure including image and buffer
493 * information to source.
494 * @dst: a pointer to g2d_image structure including image and buffer
495 * information to destination.
496 * @src_x: x start position to source buffer.
497 * @src_y: y start position to source buffer.
498 * @dst_x: x start position to destination buffer.
499 * @dst_y: y start position to destination buffer.
500 * @w: width value to source and destination buffers.
501 * @h: height value to source and destination buffers.
502 */
503 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)504 g2d_copy(struct g2d_context *ctx, struct g2d_image *src,
505 struct g2d_image *dst, unsigned int src_x, unsigned int src_y,
506 unsigned int dst_x, unsigned dst_y, unsigned int w,
507 unsigned int h)
508 {
509 union g2d_rop4_val rop4;
510 union g2d_point_val pt;
511 unsigned int src_w, src_h, dst_w, dst_h;
512
513 src_w = w;
514 src_h = h;
515 if (src_x + src->width > w)
516 src_w = src->width - src_x;
517 if (src_y + src->height > h)
518 src_h = src->height - src_y;
519
520 dst_w = w;
521 dst_h = w;
522 if (dst_x + dst->width > w)
523 dst_w = dst->width - dst_x;
524 if (dst_y + dst->height > h)
525 dst_h = dst->height - dst_y;
526
527 w = MIN(src_w, dst_w);
528 h = MIN(src_h, dst_h);
529
530 if (w <= 0 || h <= 0) {
531 fprintf(stderr, MSG_PREFIX "invalid width or height.\n");
532 return -EINVAL;
533 }
534
535 if (g2d_check_space(ctx, 11, 2))
536 return -ENOSPC;
537
538 g2d_add_cmd(ctx, DST_SELECT_REG, G2D_SELECT_MODE_BGCOLOR);
539 g2d_add_cmd(ctx, DST_COLOR_MODE_REG, dst->color_mode);
540 g2d_add_base_addr(ctx, dst, g2d_dst);
541 g2d_add_cmd(ctx, DST_STRIDE_REG, dst->stride);
542
543 g2d_add_cmd(ctx, SRC_SELECT_REG, G2D_SELECT_MODE_NORMAL);
544 g2d_add_cmd(ctx, SRC_COLOR_MODE_REG, src->color_mode);
545 g2d_add_base_addr(ctx, src, g2d_src);
546 g2d_add_cmd(ctx, SRC_STRIDE_REG, src->stride);
547
548 pt.data.x = src_x;
549 pt.data.y = src_y;
550 g2d_add_cmd(ctx, SRC_LEFT_TOP_REG, pt.val);
551 pt.data.x = src_x + w;
552 pt.data.y = src_y + h;
553 g2d_add_cmd(ctx, SRC_RIGHT_BOTTOM_REG, pt.val);
554
555 pt.data.x = dst_x;
556 pt.data.y = dst_y;
557 g2d_add_cmd(ctx, DST_LEFT_TOP_REG, pt.val);
558 pt.data.x = dst_x + w;
559 pt.data.y = dst_y + h;
560 g2d_add_cmd(ctx, DST_RIGHT_BOTTOM_REG, pt.val);
561
562 rop4.val = 0;
563 rop4.data.unmasked_rop3 = G2D_ROP3_SRC;
564 g2d_add_cmd(ctx, ROP4_REG, rop4.val);
565
566 return g2d_flush(ctx);
567 }
568
569 /**
570 * g2d_move - copy content inside single buffer.
571 * Similar to libc's memmove() this copies a rectangular
572 * region of the provided buffer to another location, while
573 * properly handling the situation where source and
574 * destination rectangle overlap.
575 *
576 * @ctx: a pointer to g2d_context structure.
577 * @img: a pointer to g2d_image structure providing
578 * buffer information.
579 * @src_x: x position of source rectangle.
580 * @src_y: y position of source rectangle.
581 * @dst_x: x position of destination rectangle.
582 * @dst_y: y position of destination rectangle.
583 * @w: width of rectangle to move.
584 * @h: height of rectangle to move.
585 */
586 int
g2d_move(struct g2d_context * ctx,struct g2d_image * img,unsigned int src_x,unsigned int src_y,unsigned int dst_x,unsigned dst_y,unsigned int w,unsigned int h)587 g2d_move(struct g2d_context *ctx, struct g2d_image *img,
588 unsigned int src_x, unsigned int src_y,
589 unsigned int dst_x, unsigned dst_y, unsigned int w,
590 unsigned int h)
591 {
592 union g2d_rop4_val rop4;
593 union g2d_point_val pt;
594 union g2d_direction_val dir;
595 unsigned int src_w, src_h, dst_w, dst_h;
596
597 src_w = w;
598 src_h = h;
599 if (src_x + img->width > w)
600 src_w = img->width - src_x;
601 if (src_y + img->height > h)
602 src_h = img->height - src_y;
603
604 dst_w = w;
605 dst_h = w;
606 if (dst_x + img->width > w)
607 dst_w = img->width - dst_x;
608 if (dst_y + img->height > h)
609 dst_h = img->height - dst_y;
610
611 w = MIN(src_w, dst_w);
612 h = MIN(src_h, dst_h);
613
614 if (w == 0 || h == 0) {
615 fprintf(stderr, MSG_PREFIX "invalid width or height.\n");
616 return -EINVAL;
617 }
618
619 if (g2d_check_space(ctx, 13, 2))
620 return -ENOSPC;
621
622 g2d_add_cmd(ctx, DST_SELECT_REG, G2D_SELECT_MODE_BGCOLOR);
623 g2d_add_cmd(ctx, SRC_SELECT_REG, G2D_SELECT_MODE_NORMAL);
624
625 g2d_add_cmd(ctx, DST_COLOR_MODE_REG, img->color_mode);
626 g2d_add_cmd(ctx, SRC_COLOR_MODE_REG, img->color_mode);
627
628 g2d_add_base_addr(ctx, img, g2d_dst);
629 g2d_add_base_addr(ctx, img, g2d_src);
630
631 g2d_add_cmd(ctx, DST_STRIDE_REG, img->stride);
632 g2d_add_cmd(ctx, SRC_STRIDE_REG, img->stride);
633
634 dir.val[0] = dir.val[1] = 0;
635
636 if (dst_x >= src_x)
637 dir.data.src_x_direction = dir.data.dst_x_direction = 1;
638 if (dst_y >= src_y)
639 dir.data.src_y_direction = dir.data.dst_y_direction = 1;
640
641 g2d_set_direction(ctx, &dir);
642
643 pt.data.x = src_x;
644 pt.data.y = src_y;
645 g2d_add_cmd(ctx, SRC_LEFT_TOP_REG, pt.val);
646 pt.data.x = src_x + w;
647 pt.data.y = src_y + h;
648 g2d_add_cmd(ctx, SRC_RIGHT_BOTTOM_REG, pt.val);
649
650 pt.data.x = dst_x;
651 pt.data.y = dst_y;
652 g2d_add_cmd(ctx, DST_LEFT_TOP_REG, pt.val);
653 pt.data.x = dst_x + w;
654 pt.data.y = dst_y + h;
655 g2d_add_cmd(ctx, DST_RIGHT_BOTTOM_REG, pt.val);
656
657 rop4.val = 0;
658 rop4.data.unmasked_rop3 = G2D_ROP3_SRC;
659 g2d_add_cmd(ctx, ROP4_REG, rop4.val);
660
661 return g2d_flush(ctx);
662 }
663
664 /**
665 * g2d_copy_with_scale - copy contents in source buffer to destination buffer
666 * scaling up or down properly.
667 *
668 * @ctx: a pointer to g2d_context structure.
669 * @src: a pointer to g2d_image structure including image and buffer
670 * information to source.
671 * @dst: a pointer to g2d_image structure including image and buffer
672 * information to destination.
673 * @src_x: x start position to source buffer.
674 * @src_y: y start position to source buffer.
675 * @src_w: width value to source buffer.
676 * @src_h: height value to source buffer.
677 * @dst_x: x start position to destination buffer.
678 * @dst_y: y start position to destination buffer.
679 * @dst_w: width value to destination buffer.
680 * @dst_h: height value to destination buffer.
681 * @negative: indicate that it uses color negative to source and
682 * destination buffers.
683 */
684 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)685 g2d_copy_with_scale(struct g2d_context *ctx, struct g2d_image *src,
686 struct g2d_image *dst, unsigned int src_x,
687 unsigned int src_y, unsigned int src_w,
688 unsigned int src_h, unsigned int dst_x,
689 unsigned int dst_y, unsigned int dst_w,
690 unsigned int dst_h, unsigned int negative)
691 {
692 union g2d_rop4_val rop4;
693 union g2d_point_val pt;
694 unsigned int scale, repeat_pad;
695 unsigned int scale_x, scale_y;
696
697 /* Sanitize this parameter to facilitate space computation below. */
698 if (negative)
699 negative = 1;
700
701 if (src_w == dst_w && src_h == dst_h)
702 scale = 0;
703 else {
704 scale = 1;
705 scale_x = g2d_get_scaling(src_w, dst_w);
706 scale_y = g2d_get_scaling(src_h, dst_h);
707 }
708
709 repeat_pad = src->repeat_mode == G2D_REPEAT_MODE_PAD ? 1 : 0;
710
711 if (src_x + src_w > src->width)
712 src_w = src->width - src_x;
713 if (src_y + src_h > src->height)
714 src_h = src->height - src_y;
715
716 if (dst_x + dst_w > dst->width)
717 dst_w = dst->width - dst_x;
718 if (dst_y + dst_h > dst->height)
719 dst_h = dst->height - dst_y;
720
721 if (src_w <= 0 || src_h <= 0 || dst_w <= 0 || dst_h <= 0) {
722 fprintf(stderr, MSG_PREFIX "invalid width or height.\n");
723 return -EINVAL;
724 }
725
726 if (g2d_check_space(ctx, 12 + scale * 3 + negative + repeat_pad, 2))
727 return -ENOSPC;
728
729 g2d_add_cmd(ctx, DST_SELECT_REG, G2D_SELECT_MODE_BGCOLOR);
730 g2d_add_cmd(ctx, DST_COLOR_MODE_REG, dst->color_mode);
731 g2d_add_base_addr(ctx, dst, g2d_dst);
732 g2d_add_cmd(ctx, DST_STRIDE_REG, dst->stride);
733
734 g2d_add_cmd(ctx, SRC_SELECT_REG, G2D_SELECT_MODE_NORMAL);
735 g2d_add_cmd(ctx, SRC_COLOR_MODE_REG, src->color_mode);
736
737 g2d_add_cmd(ctx, SRC_REPEAT_MODE_REG, src->repeat_mode);
738 if (repeat_pad)
739 g2d_add_cmd(ctx, SRC_PAD_VALUE_REG, dst->color);
740
741 g2d_add_base_addr(ctx, src, g2d_src);
742 g2d_add_cmd(ctx, SRC_STRIDE_REG, src->stride);
743
744 rop4.val = 0;
745 rop4.data.unmasked_rop3 = G2D_ROP3_SRC;
746
747 if (negative) {
748 g2d_add_cmd(ctx, BG_COLOR_REG, 0x00FFFFFF);
749 rop4.data.unmasked_rop3 ^= G2D_ROP3_DST;
750 }
751
752 g2d_add_cmd(ctx, ROP4_REG, rop4.val);
753
754 if (scale) {
755 g2d_add_cmd(ctx, SRC_SCALE_CTRL_REG, G2D_SCALE_MODE_BILINEAR);
756 g2d_add_cmd(ctx, SRC_XSCALE_REG, scale_x);
757 g2d_add_cmd(ctx, SRC_YSCALE_REG, scale_y);
758 }
759
760 pt.data.x = src_x;
761 pt.data.y = src_y;
762 g2d_add_cmd(ctx, SRC_LEFT_TOP_REG, pt.val);
763 pt.data.x = src_x + src_w;
764 pt.data.y = src_y + src_h;
765 g2d_add_cmd(ctx, SRC_RIGHT_BOTTOM_REG, pt.val);
766
767 pt.data.x = dst_x;
768 pt.data.y = dst_y;
769 g2d_add_cmd(ctx, DST_LEFT_TOP_REG, pt.val);
770 pt.data.x = dst_x + dst_w;
771 pt.data.y = dst_y + dst_h;
772 g2d_add_cmd(ctx, DST_RIGHT_BOTTOM_REG, pt.val);
773
774 return g2d_flush(ctx);
775 }
776
777 /**
778 * g2d_blend - blend image data in source and destination buffers.
779 *
780 * @ctx: a pointer to g2d_context structure.
781 * @src: a pointer to g2d_image structure including image and buffer
782 * information to source.
783 * @dst: a pointer to g2d_image structure including image and buffer
784 * information to destination.
785 * @src_x: x start position to source buffer.
786 * @src_y: y start position to source buffer.
787 * @dst_x: x start position to destination buffer.
788 * @dst_y: y start position to destination buffer.
789 * @w: width value to source and destination buffer.
790 * @h: height value to source and destination buffer.
791 * @op: blend operation type.
792 */
793 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)794 g2d_blend(struct g2d_context *ctx, struct g2d_image *src,
795 struct g2d_image *dst, unsigned int src_x,
796 unsigned int src_y, unsigned int dst_x, unsigned int dst_y,
797 unsigned int w, unsigned int h, enum e_g2d_op op)
798 {
799 union g2d_point_val pt;
800 union g2d_bitblt_cmd_val bitblt;
801 union g2d_blend_func_val blend;
802 unsigned int gem_space;
803 unsigned int src_w, src_h, dst_w, dst_h;
804
805 src_w = w;
806 src_h = h;
807 if (src_x + w > src->width)
808 src_w = src->width - src_x;
809 if (src_y + h > src->height)
810 src_h = src->height - src_y;
811
812 dst_w = w;
813 dst_h = h;
814 if (dst_x + w > dst->width)
815 dst_w = dst->width - dst_x;
816 if (dst_y + h > dst->height)
817 dst_h = dst->height - dst_y;
818
819 w = MIN(src_w, dst_w);
820 h = MIN(src_h, dst_h);
821
822 if (w <= 0 || h <= 0) {
823 fprintf(stderr, MSG_PREFIX "invalid width or height.\n");
824 return -EINVAL;
825 }
826
827 if (!g2d_validate_select_mode(src->select_mode)) {
828 fprintf(stderr , MSG_PREFIX "invalid select mode for source.\n");
829 return -EINVAL;
830 }
831
832 if (!g2d_validate_blending_op(op)) {
833 fprintf(stderr , MSG_PREFIX "unsupported blending operation.\n");
834 return -EINVAL;
835 }
836
837 gem_space = src->select_mode == G2D_SELECT_MODE_NORMAL ? 2 : 1;
838
839 if (g2d_check_space(ctx, 12, gem_space))
840 return -ENOSPC;
841
842 bitblt.val = 0;
843 blend.val = 0;
844
845 if (op == G2D_OP_SRC || op == G2D_OP_CLEAR)
846 g2d_add_cmd(ctx, DST_SELECT_REG, G2D_SELECT_MODE_BGCOLOR);
847 else
848 g2d_add_cmd(ctx, DST_SELECT_REG, G2D_SELECT_MODE_NORMAL);
849
850 g2d_add_cmd(ctx, DST_COLOR_MODE_REG, dst->color_mode);
851 g2d_add_base_addr(ctx, dst, g2d_dst);
852 g2d_add_cmd(ctx, DST_STRIDE_REG, dst->stride);
853
854 g2d_add_cmd(ctx, SRC_SELECT_REG, src->select_mode);
855 g2d_add_cmd(ctx, SRC_COLOR_MODE_REG, src->color_mode);
856
857 switch (src->select_mode) {
858 case G2D_SELECT_MODE_NORMAL:
859 g2d_add_base_addr(ctx, src, g2d_src);
860 g2d_add_cmd(ctx, SRC_STRIDE_REG, src->stride);
861 break;
862 case G2D_SELECT_MODE_FGCOLOR:
863 g2d_add_cmd(ctx, FG_COLOR_REG, src->color);
864 break;
865 case G2D_SELECT_MODE_BGCOLOR:
866 g2d_add_cmd(ctx, BG_COLOR_REG, src->color);
867 break;
868 }
869
870 bitblt.data.alpha_blend_mode = G2D_ALPHA_BLEND_MODE_ENABLE;
871 blend.val = g2d_get_blend_op(op);
872 g2d_add_cmd(ctx, BITBLT_COMMAND_REG, bitblt.val);
873 g2d_add_cmd(ctx, BLEND_FUNCTION_REG, blend.val);
874
875 pt.data.x = src_x;
876 pt.data.y = src_y;
877 g2d_add_cmd(ctx, SRC_LEFT_TOP_REG, pt.val);
878 pt.data.x = src_x + w;
879 pt.data.y = src_y + h;
880 g2d_add_cmd(ctx, SRC_RIGHT_BOTTOM_REG, pt.val);
881
882 pt.data.x = dst_x;
883 pt.data.y = dst_y;
884 g2d_add_cmd(ctx, DST_LEFT_TOP_REG, pt.val);
885 pt.data.x = dst_x + w;
886 pt.data.y = dst_y + h;
887 g2d_add_cmd(ctx, DST_RIGHT_BOTTOM_REG, pt.val);
888
889 return g2d_flush(ctx);
890 }
891
892 /**
893 * g2d_scale_and_blend - apply scaling to source buffer and then blend to destination buffer
894 *
895 * @ctx: a pointer to g2d_context structure.
896 * @src: a pointer to g2d_image structure including image and buffer
897 * information to source.
898 * @dst: a pointer to g2d_image structure including image and buffer
899 * information to destination.
900 * @src_x: x start position to source buffer.
901 * @src_y: y start position to source buffer.
902 * @src_w: width value to source buffer.
903 * @src_h: height value to source buffer.
904 * @dst_x: x start position to destination buffer.
905 * @dst_y: y start position to destination buffer.
906 * @dst_w: width value to destination buffer.
907 * @dst_h: height value to destination buffer.
908 * @op: blend operation type.
909 */
910 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)911 g2d_scale_and_blend(struct g2d_context *ctx, struct g2d_image *src,
912 struct g2d_image *dst, unsigned int src_x, unsigned int src_y,
913 unsigned int src_w, unsigned int src_h, unsigned int dst_x,
914 unsigned int dst_y, unsigned int dst_w, unsigned int dst_h,
915 enum e_g2d_op op)
916 {
917 union g2d_point_val pt;
918 union g2d_bitblt_cmd_val bitblt;
919 union g2d_blend_func_val blend;
920 unsigned int scale, gem_space;
921 unsigned int scale_x, scale_y;
922
923 if (src_w == dst_w && src_h == dst_h)
924 scale = 0;
925 else {
926 scale = 1;
927 scale_x = g2d_get_scaling(src_w, dst_w);
928 scale_y = g2d_get_scaling(src_h, dst_h);
929 }
930
931 if (src_x + src_w > src->width)
932 src_w = src->width - src_x;
933 if (src_y + src_h > src->height)
934 src_h = src->height - src_y;
935
936 if (dst_x + dst_w > dst->width)
937 dst_w = dst->width - dst_x;
938 if (dst_y + dst_h > dst->height)
939 dst_h = dst->height - dst_y;
940
941 if (src_w <= 0 || src_h <= 0 || dst_w <= 0 || dst_h <= 0) {
942 fprintf(stderr, MSG_PREFIX "invalid width or height.\n");
943 return -EINVAL;
944 }
945
946 if (!g2d_validate_select_mode(src->select_mode)) {
947 fprintf(stderr , MSG_PREFIX "invalid select mode for source.\n");
948 return -EINVAL;
949 }
950
951 if (!g2d_validate_blending_op(op)) {
952 fprintf(stderr , MSG_PREFIX "unsupported blending operation.\n");
953 return -EINVAL;
954 }
955
956 gem_space = src->select_mode == G2D_SELECT_MODE_NORMAL ? 2 : 1;
957
958 if (g2d_check_space(ctx, 12 + scale * 3, gem_space))
959 return -ENOSPC;
960
961 bitblt.val = 0;
962 blend.val = 0;
963
964 if (op == G2D_OP_SRC || op == G2D_OP_CLEAR)
965 g2d_add_cmd(ctx, DST_SELECT_REG, G2D_SELECT_MODE_BGCOLOR);
966 else
967 g2d_add_cmd(ctx, DST_SELECT_REG, G2D_SELECT_MODE_NORMAL);
968
969 g2d_add_cmd(ctx, DST_COLOR_MODE_REG, dst->color_mode);
970 g2d_add_base_addr(ctx, dst, g2d_dst);
971 g2d_add_cmd(ctx, DST_STRIDE_REG, dst->stride);
972
973 g2d_add_cmd(ctx, SRC_SELECT_REG, src->select_mode);
974 g2d_add_cmd(ctx, SRC_COLOR_MODE_REG, src->color_mode);
975
976 switch (src->select_mode) {
977 case G2D_SELECT_MODE_NORMAL:
978 g2d_add_base_addr(ctx, src, g2d_src);
979 g2d_add_cmd(ctx, SRC_STRIDE_REG, src->stride);
980 break;
981 case G2D_SELECT_MODE_FGCOLOR:
982 g2d_add_cmd(ctx, FG_COLOR_REG, src->color);
983 break;
984 case G2D_SELECT_MODE_BGCOLOR:
985 g2d_add_cmd(ctx, BG_COLOR_REG, src->color);
986 break;
987 }
988
989 if (scale) {
990 g2d_add_cmd(ctx, SRC_SCALE_CTRL_REG, G2D_SCALE_MODE_BILINEAR);
991 g2d_add_cmd(ctx, SRC_XSCALE_REG, scale_x);
992 g2d_add_cmd(ctx, SRC_YSCALE_REG, scale_y);
993 }
994
995 bitblt.data.alpha_blend_mode = G2D_ALPHA_BLEND_MODE_ENABLE;
996 blend.val = g2d_get_blend_op(op);
997 g2d_add_cmd(ctx, BITBLT_COMMAND_REG, bitblt.val);
998 g2d_add_cmd(ctx, BLEND_FUNCTION_REG, blend.val);
999
1000 pt.data.x = src_x;
1001 pt.data.y = src_y;
1002 g2d_add_cmd(ctx, SRC_LEFT_TOP_REG, pt.val);
1003 pt.data.x = src_x + src_w;
1004 pt.data.y = src_y + src_h;
1005 g2d_add_cmd(ctx, SRC_RIGHT_BOTTOM_REG, pt.val);
1006
1007 pt.data.x = dst_x;
1008 pt.data.y = dst_y;
1009 g2d_add_cmd(ctx, DST_LEFT_TOP_REG, pt.val);
1010 pt.data.x = dst_x + dst_w;
1011 pt.data.y = dst_y + dst_h;
1012 g2d_add_cmd(ctx, DST_RIGHT_BOTTOM_REG, pt.val);
1013
1014 return g2d_flush(ctx);
1015 }
1016