1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17#include <linux/interrupt.h>
18#include <linux/dma-mapping.h>
19#include <video/imx-ipu-image-convert.h>
20#include "ipu-prv.h"
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53#define MAX_STRIPES_W 4
54#define MAX_STRIPES_H 4
55#define MAX_TILES (MAX_STRIPES_W * MAX_STRIPES_H)
56
57#define MIN_W 16
58#define MIN_H 8
59#define MAX_W 4096
60#define MAX_H 4096
61
62enum ipu_image_convert_type {
63 IMAGE_CONVERT_IN = 0,
64 IMAGE_CONVERT_OUT,
65};
66
67struct ipu_image_convert_dma_buf {
68 void *virt;
69 dma_addr_t phys;
70 unsigned long len;
71};
72
73struct ipu_image_convert_dma_chan {
74 int in;
75 int out;
76 int rot_in;
77 int rot_out;
78 int vdi_in_p;
79 int vdi_in;
80 int vdi_in_n;
81};
82
83
84struct ipu_image_tile {
85 u32 width;
86 u32 height;
87
88 u32 size;
89 u32 stride;
90 u32 rot_stride;
91
92 u32 offset;
93
94 u32 u_off;
95
96 u32 v_off;
97};
98
99struct ipu_image_convert_image {
100 struct ipu_image base;
101 enum ipu_image_convert_type type;
102
103 const struct ipu_image_pixfmt *fmt;
104 unsigned int stride;
105
106
107 unsigned int num_rows;
108
109 unsigned int num_cols;
110
111 struct ipu_image_tile tile[MAX_TILES];
112};
113
114struct ipu_image_pixfmt {
115 u32 fourcc;
116 int bpp;
117 int uv_width_dec;
118 int uv_height_dec;
119 bool planar;
120 bool uv_swapped;
121 bool uv_packed;
122};
123
124struct ipu_image_convert_ctx;
125struct ipu_image_convert_chan;
126struct ipu_image_convert_priv;
127
128struct ipu_image_convert_ctx {
129 struct ipu_image_convert_chan *chan;
130
131 ipu_image_convert_cb_t complete;
132 void *complete_context;
133
134
135 struct ipu_image_convert_image in;
136 struct ipu_image_convert_image out;
137 enum ipu_rotate_mode rot_mode;
138
139
140 struct ipu_image_convert_dma_buf rot_intermediate[2];
141
142
143 int cur_buf_num;
144
145 bool aborting;
146 struct completion aborted;
147
148
149 bool double_buffering;
150
151 unsigned int num_tiles;
152
153 unsigned int next_tile;
154
155 unsigned int out_tile_map[MAX_TILES];
156
157 struct list_head list;
158};
159
160struct ipu_image_convert_chan {
161 struct ipu_image_convert_priv *priv;
162
163 enum ipu_ic_task ic_task;
164 const struct ipu_image_convert_dma_chan *dma_ch;
165
166 struct ipu_ic *ic;
167 struct ipuv3_channel *in_chan;
168 struct ipuv3_channel *out_chan;
169 struct ipuv3_channel *rotation_in_chan;
170 struct ipuv3_channel *rotation_out_chan;
171
172
173 int out_eof_irq;
174 int rot_out_eof_irq;
175
176 spinlock_t irqlock;
177
178
179 struct list_head ctx_list;
180
181 struct list_head pending_q;
182
183 struct list_head done_q;
184
185
186 struct ipu_image_convert_run *current_run;
187};
188
189struct ipu_image_convert_priv {
190 struct ipu_image_convert_chan chan[IC_NUM_TASKS];
191 struct ipu_soc *ipu;
192};
193
194static const struct ipu_image_convert_dma_chan
195image_convert_dma_chan[IC_NUM_TASKS] = {
196 [IC_TASK_VIEWFINDER] = {
197 .in = IPUV3_CHANNEL_MEM_IC_PRP_VF,
198 .out = IPUV3_CHANNEL_IC_PRP_VF_MEM,
199 .rot_in = IPUV3_CHANNEL_MEM_ROT_VF,
200 .rot_out = IPUV3_CHANNEL_ROT_VF_MEM,
201 .vdi_in_p = IPUV3_CHANNEL_MEM_VDI_PREV,
202 .vdi_in = IPUV3_CHANNEL_MEM_VDI_CUR,
203 .vdi_in_n = IPUV3_CHANNEL_MEM_VDI_NEXT,
204 },
205 [IC_TASK_POST_PROCESSOR] = {
206 .in = IPUV3_CHANNEL_MEM_IC_PP,
207 .out = IPUV3_CHANNEL_IC_PP_MEM,
208 .rot_in = IPUV3_CHANNEL_MEM_ROT_PP,
209 .rot_out = IPUV3_CHANNEL_ROT_PP_MEM,
210 },
211};
212
213static const struct ipu_image_pixfmt image_convert_formats[] = {
214 {
215 .fourcc = V4L2_PIX_FMT_RGB565,
216 .bpp = 16,
217 }, {
218 .fourcc = V4L2_PIX_FMT_RGB24,
219 .bpp = 24,
220 }, {
221 .fourcc = V4L2_PIX_FMT_BGR24,
222 .bpp = 24,
223 }, {
224 .fourcc = V4L2_PIX_FMT_RGB32,
225 .bpp = 32,
226 }, {
227 .fourcc = V4L2_PIX_FMT_BGR32,
228 .bpp = 32,
229 }, {
230 .fourcc = V4L2_PIX_FMT_YUYV,
231 .bpp = 16,
232 .uv_width_dec = 2,
233 .uv_height_dec = 1,
234 }, {
235 .fourcc = V4L2_PIX_FMT_UYVY,
236 .bpp = 16,
237 .uv_width_dec = 2,
238 .uv_height_dec = 1,
239 }, {
240 .fourcc = V4L2_PIX_FMT_YUV420,
241 .bpp = 12,
242 .planar = true,
243 .uv_width_dec = 2,
244 .uv_height_dec = 2,
245 }, {
246 .fourcc = V4L2_PIX_FMT_YVU420,
247 .bpp = 12,
248 .planar = true,
249 .uv_width_dec = 2,
250 .uv_height_dec = 2,
251 .uv_swapped = true,
252 }, {
253 .fourcc = V4L2_PIX_FMT_NV12,
254 .bpp = 12,
255 .planar = true,
256 .uv_width_dec = 2,
257 .uv_height_dec = 2,
258 .uv_packed = true,
259 }, {
260 .fourcc = V4L2_PIX_FMT_YUV422P,
261 .bpp = 16,
262 .planar = true,
263 .uv_width_dec = 2,
264 .uv_height_dec = 1,
265 }, {
266 .fourcc = V4L2_PIX_FMT_NV16,
267 .bpp = 16,
268 .planar = true,
269 .uv_width_dec = 2,
270 .uv_height_dec = 1,
271 .uv_packed = true,
272 },
273};
274
275static const struct ipu_image_pixfmt *get_format(u32 fourcc)
276{
277 const struct ipu_image_pixfmt *ret = NULL;
278 unsigned int i;
279
280 for (i = 0; i < ARRAY_SIZE(image_convert_formats); i++) {
281 if (image_convert_formats[i].fourcc == fourcc) {
282 ret = &image_convert_formats[i];
283 break;
284 }
285 }
286
287 return ret;
288}
289
290static void dump_format(struct ipu_image_convert_ctx *ctx,
291 struct ipu_image_convert_image *ic_image)
292{
293 struct ipu_image_convert_chan *chan = ctx->chan;
294 struct ipu_image_convert_priv *priv = chan->priv;
295
296 dev_dbg(priv->ipu->dev,
297 "task %u: ctx %p: %s format: %dx%d (%dx%d tiles of size %dx%d), %c%c%c%c\n",
298 chan->ic_task, ctx,
299 ic_image->type == IMAGE_CONVERT_OUT ? "Output" : "Input",
300 ic_image->base.pix.width, ic_image->base.pix.height,
301 ic_image->num_cols, ic_image->num_rows,
302 ic_image->tile[0].width, ic_image->tile[0].height,
303 ic_image->fmt->fourcc & 0xff,
304 (ic_image->fmt->fourcc >> 8) & 0xff,
305 (ic_image->fmt->fourcc >> 16) & 0xff,
306 (ic_image->fmt->fourcc >> 24) & 0xff);
307}
308
309int ipu_image_convert_enum_format(int index, u32 *fourcc)
310{
311 const struct ipu_image_pixfmt *fmt;
312
313 if (index >= (int)ARRAY_SIZE(image_convert_formats))
314 return -EINVAL;
315
316
317 fmt = &image_convert_formats[index];
318 *fourcc = fmt->fourcc;
319 return 0;
320}
321EXPORT_SYMBOL_GPL(ipu_image_convert_enum_format);
322
323static void free_dma_buf(struct ipu_image_convert_priv *priv,
324 struct ipu_image_convert_dma_buf *buf)
325{
326 if (buf->virt)
327 dma_free_coherent(priv->ipu->dev,
328 buf->len, buf->virt, buf->phys);
329 buf->virt = NULL;
330 buf->phys = 0;
331}
332
333static int alloc_dma_buf(struct ipu_image_convert_priv *priv,
334 struct ipu_image_convert_dma_buf *buf,
335 int size)
336{
337 buf->len = PAGE_ALIGN(size);
338 buf->virt = dma_alloc_coherent(priv->ipu->dev, buf->len, &buf->phys,
339 GFP_DMA | GFP_KERNEL);
340 if (!buf->virt) {
341 dev_err(priv->ipu->dev, "failed to alloc dma buffer\n");
342 return -ENOMEM;
343 }
344
345 return 0;
346}
347
348static inline int num_stripes(int dim)
349{
350 if (dim <= 1024)
351 return 1;
352 else if (dim <= 2048)
353 return 2;
354 else
355 return 4;
356}
357
358static void calc_tile_dimensions(struct ipu_image_convert_ctx *ctx,
359 struct ipu_image_convert_image *image)
360{
361 int i;
362
363 for (i = 0; i < ctx->num_tiles; i++) {
364 struct ipu_image_tile *tile = &image->tile[i];
365
366 tile->height = image->base.pix.height / image->num_rows;
367 tile->width = image->base.pix.width / image->num_cols;
368 tile->size = ((tile->height * image->fmt->bpp) >> 3) *
369 tile->width;
370
371 if (image->fmt->planar) {
372 tile->stride = tile->width;
373 tile->rot_stride = tile->height;
374 } else {
375 tile->stride =
376 (image->fmt->bpp * tile->width) >> 3;
377 tile->rot_stride =
378 (image->fmt->bpp * tile->height) >> 3;
379 }
380 }
381}
382
383
384
385
386
387
388
389static int transform_tile_index(struct ipu_image_convert_ctx *ctx,
390 int src_row, int src_col)
391{
392 struct ipu_image_convert_chan *chan = ctx->chan;
393 struct ipu_image_convert_priv *priv = chan->priv;
394 struct ipu_image_convert_image *s_image = &ctx->in;
395 struct ipu_image_convert_image *d_image = &ctx->out;
396 int dst_row, dst_col;
397
398
399 if (ctx->rot_mode == IPU_ROTATE_NONE)
400 return src_row * s_image->num_cols + src_col;
401
402
403
404
405
406 src_row = src_row * 2 - (s_image->num_rows - 1);
407 src_col = src_col * 2 - (s_image->num_cols - 1);
408
409
410 if (ctx->rot_mode & IPU_ROT_BIT_90) {
411 dst_col = -src_row;
412 dst_row = src_col;
413 } else {
414 dst_col = src_col;
415 dst_row = src_row;
416 }
417
418
419 if (ctx->rot_mode & IPU_ROT_BIT_HFLIP)
420 dst_col = -dst_col;
421 if (ctx->rot_mode & IPU_ROT_BIT_VFLIP)
422 dst_row = -dst_row;
423
424 dev_dbg(priv->ipu->dev, "task %u: ctx %p: [%d,%d] --> [%d,%d]\n",
425 chan->ic_task, ctx, src_col, src_row, dst_col, dst_row);
426
427
428
429
430
431 dst_row += d_image->num_rows - 1;
432 dst_col += d_image->num_cols - 1;
433 dst_row /= 2;
434 dst_col /= 2;
435
436 return dst_row * d_image->num_cols + dst_col;
437}
438
439
440
441
442static void calc_out_tile_map(struct ipu_image_convert_ctx *ctx)
443{
444 struct ipu_image_convert_image *s_image = &ctx->in;
445 unsigned int row, col, tile = 0;
446
447 for (row = 0; row < s_image->num_rows; row++) {
448 for (col = 0; col < s_image->num_cols; col++) {
449 ctx->out_tile_map[tile] =
450 transform_tile_index(ctx, row, col);
451 tile++;
452 }
453 }
454}
455
456static void calc_tile_offsets_planar(struct ipu_image_convert_ctx *ctx,
457 struct ipu_image_convert_image *image)
458{
459 struct ipu_image_convert_chan *chan = ctx->chan;
460 struct ipu_image_convert_priv *priv = chan->priv;
461 const struct ipu_image_pixfmt *fmt = image->fmt;
462 unsigned int row, col, tile = 0;
463 u32 H, w, h, y_stride, uv_stride;
464 u32 uv_row_off, uv_col_off, uv_off, u_off, v_off, tmp;
465 u32 y_row_off, y_col_off, y_off;
466 u32 y_size, uv_size;
467
468
469 H = image->base.pix.height;
470
471 y_stride = image->stride;
472 uv_stride = y_stride / fmt->uv_width_dec;
473 if (fmt->uv_packed)
474 uv_stride *= 2;
475
476 y_size = H * y_stride;
477 uv_size = y_size / (fmt->uv_width_dec * fmt->uv_height_dec);
478
479 for (row = 0; row < image->num_rows; row++) {
480 w = image->tile[tile].width;
481 h = image->tile[tile].height;
482 y_row_off = row * h * y_stride;
483 uv_row_off = (row * h * uv_stride) / fmt->uv_height_dec;
484
485 for (col = 0; col < image->num_cols; col++) {
486 y_col_off = col * w;
487 uv_col_off = y_col_off / fmt->uv_width_dec;
488 if (fmt->uv_packed)
489 uv_col_off *= 2;
490
491 y_off = y_row_off + y_col_off;
492 uv_off = uv_row_off + uv_col_off;
493
494 u_off = y_size - y_off + uv_off;
495 v_off = (fmt->uv_packed) ? 0 : u_off + uv_size;
496 if (fmt->uv_swapped) {
497 tmp = u_off;
498 u_off = v_off;
499 v_off = tmp;
500 }
501
502 image->tile[tile].offset = y_off;
503 image->tile[tile].u_off = u_off;
504 image->tile[tile++].v_off = v_off;
505
506 dev_dbg(priv->ipu->dev,
507 "task %u: ctx %p: %s@[%d,%d]: y_off %08x, u_off %08x, v_off %08x\n",
508 chan->ic_task, ctx,
509 image->type == IMAGE_CONVERT_IN ?
510 "Input" : "Output", row, col,
511 y_off, u_off, v_off);
512 }
513 }
514}
515
516static void calc_tile_offsets_packed(struct ipu_image_convert_ctx *ctx,
517 struct ipu_image_convert_image *image)
518{
519 struct ipu_image_convert_chan *chan = ctx->chan;
520 struct ipu_image_convert_priv *priv = chan->priv;
521 const struct ipu_image_pixfmt *fmt = image->fmt;
522 unsigned int row, col, tile = 0;
523 u32 w, h, bpp, stride;
524 u32 row_off, col_off;
525
526
527 stride = image->stride;
528 bpp = fmt->bpp;
529
530 for (row = 0; row < image->num_rows; row++) {
531 w = image->tile[tile].width;
532 h = image->tile[tile].height;
533 row_off = row * h * stride;
534
535 for (col = 0; col < image->num_cols; col++) {
536 col_off = (col * w * bpp) >> 3;
537
538 image->tile[tile].offset = row_off + col_off;
539 image->tile[tile].u_off = 0;
540 image->tile[tile++].v_off = 0;
541
542 dev_dbg(priv->ipu->dev,
543 "task %u: ctx %p: %s@[%d,%d]: phys %08x\n",
544 chan->ic_task, ctx,
545 image->type == IMAGE_CONVERT_IN ?
546 "Input" : "Output", row, col,
547 row_off + col_off);
548 }
549 }
550}
551
552static void calc_tile_offsets(struct ipu_image_convert_ctx *ctx,
553 struct ipu_image_convert_image *image)
554{
555 if (image->fmt->planar)
556 calc_tile_offsets_planar(ctx, image);
557 else
558 calc_tile_offsets_packed(ctx, image);
559}
560
561
562
563
564
565static int get_run_count(struct ipu_image_convert_ctx *ctx,
566 struct list_head *q)
567{
568 struct ipu_image_convert_run *run;
569 int count = 0;
570
571 lockdep_assert_held(&ctx->chan->irqlock);
572
573 list_for_each_entry(run, q, list) {
574 if (run->ctx == ctx)
575 count++;
576 }
577
578 return count;
579}
580
581static void convert_stop(struct ipu_image_convert_run *run)
582{
583 struct ipu_image_convert_ctx *ctx = run->ctx;
584 struct ipu_image_convert_chan *chan = ctx->chan;
585 struct ipu_image_convert_priv *priv = chan->priv;
586
587 dev_dbg(priv->ipu->dev, "%s: task %u: stopping ctx %p run %p\n",
588 __func__, chan->ic_task, ctx, run);
589
590
591 ipu_ic_task_disable(chan->ic);
592 ipu_idmac_disable_channel(chan->in_chan);
593 ipu_idmac_disable_channel(chan->out_chan);
594
595 if (ipu_rot_mode_is_irt(ctx->rot_mode)) {
596 ipu_idmac_disable_channel(chan->rotation_in_chan);
597 ipu_idmac_disable_channel(chan->rotation_out_chan);
598 ipu_idmac_unlink(chan->out_chan, chan->rotation_in_chan);
599 }
600
601 ipu_ic_disable(chan->ic);
602}
603
604static void init_idmac_channel(struct ipu_image_convert_ctx *ctx,
605 struct ipuv3_channel *channel,
606 struct ipu_image_convert_image *image,
607 enum ipu_rotate_mode rot_mode,
608 bool rot_swap_width_height)
609{
610 struct ipu_image_convert_chan *chan = ctx->chan;
611 unsigned int burst_size;
612 u32 width, height, stride;
613 dma_addr_t addr0, addr1 = 0;
614 struct ipu_image tile_image;
615 unsigned int tile_idx[2];
616
617 if (image->type == IMAGE_CONVERT_OUT) {
618 tile_idx[0] = ctx->out_tile_map[0];
619 tile_idx[1] = ctx->out_tile_map[1];
620 } else {
621 tile_idx[0] = 0;
622 tile_idx[1] = 1;
623 }
624
625 if (rot_swap_width_height) {
626 width = image->tile[0].height;
627 height = image->tile[0].width;
628 stride = image->tile[0].rot_stride;
629 addr0 = ctx->rot_intermediate[0].phys;
630 if (ctx->double_buffering)
631 addr1 = ctx->rot_intermediate[1].phys;
632 } else {
633 width = image->tile[0].width;
634 height = image->tile[0].height;
635 stride = image->stride;
636 addr0 = image->base.phys0 +
637 image->tile[tile_idx[0]].offset;
638 if (ctx->double_buffering)
639 addr1 = image->base.phys0 +
640 image->tile[tile_idx[1]].offset;
641 }
642
643 ipu_cpmem_zero(channel);
644
645 memset(&tile_image, 0, sizeof(tile_image));
646 tile_image.pix.width = tile_image.rect.width = width;
647 tile_image.pix.height = tile_image.rect.height = height;
648 tile_image.pix.bytesperline = stride;
649 tile_image.pix.pixelformat = image->fmt->fourcc;
650 tile_image.phys0 = addr0;
651 tile_image.phys1 = addr1;
652 ipu_cpmem_set_image(channel, &tile_image);
653
654 if (image->fmt->planar && !rot_swap_width_height)
655 ipu_cpmem_set_uv_offset(channel,
656 image->tile[tile_idx[0]].u_off,
657 image->tile[tile_idx[0]].v_off);
658
659 if (rot_mode)
660 ipu_cpmem_set_rotation(channel, rot_mode);
661
662 if (channel == chan->rotation_in_chan ||
663 channel == chan->rotation_out_chan) {
664 burst_size = 8;
665 ipu_cpmem_set_block_mode(channel);
666 } else
667 burst_size = (width % 16) ? 8 : 16;
668
669 ipu_cpmem_set_burstsize(channel, burst_size);
670
671 ipu_ic_task_idma_init(chan->ic, channel, width, height,
672 burst_size, rot_mode);
673
674
675
676
677
678 if (!channel->ipu->prg_priv)
679 ipu_cpmem_set_axi_id(channel, 1);
680
681 ipu_idmac_set_double_buffer(channel, ctx->double_buffering);
682}
683
684static int convert_start(struct ipu_image_convert_run *run)
685{
686 struct ipu_image_convert_ctx *ctx = run->ctx;
687 struct ipu_image_convert_chan *chan = ctx->chan;
688 struct ipu_image_convert_priv *priv = chan->priv;
689 struct ipu_image_convert_image *s_image = &ctx->in;
690 struct ipu_image_convert_image *d_image = &ctx->out;
691 enum ipu_color_space src_cs, dest_cs;
692 unsigned int dest_width, dest_height;
693 int ret;
694
695 dev_dbg(priv->ipu->dev, "%s: task %u: starting ctx %p run %p\n",
696 __func__, chan->ic_task, ctx, run);
697
698 src_cs = ipu_pixelformat_to_colorspace(s_image->fmt->fourcc);
699 dest_cs = ipu_pixelformat_to_colorspace(d_image->fmt->fourcc);
700
701 if (ipu_rot_mode_is_irt(ctx->rot_mode)) {
702
703 dest_width = d_image->tile[0].height;
704 dest_height = d_image->tile[0].width;
705 } else {
706 dest_width = d_image->tile[0].width;
707 dest_height = d_image->tile[0].height;
708 }
709
710
711 ret = ipu_ic_task_init(chan->ic,
712 s_image->tile[0].width,
713 s_image->tile[0].height,
714 dest_width,
715 dest_height,
716 src_cs, dest_cs);
717 if (ret) {
718 dev_err(priv->ipu->dev, "ipu_ic_task_init failed, %d\n", ret);
719 return ret;
720 }
721
722
723 init_idmac_channel(ctx, chan->in_chan, s_image,
724 IPU_ROTATE_NONE, false);
725
726 if (ipu_rot_mode_is_irt(ctx->rot_mode)) {
727
728 init_idmac_channel(ctx, chan->out_chan, d_image,
729 IPU_ROTATE_NONE, true);
730
731
732 init_idmac_channel(ctx, chan->rotation_in_chan, d_image,
733 ctx->rot_mode, true);
734
735
736 init_idmac_channel(ctx, chan->rotation_out_chan, d_image,
737 IPU_ROTATE_NONE, false);
738
739
740 ipu_idmac_link(chan->out_chan, chan->rotation_in_chan);
741 } else {
742
743 init_idmac_channel(ctx, chan->out_chan, d_image,
744 ctx->rot_mode, false);
745 }
746
747
748 ipu_ic_enable(chan->ic);
749
750
751 ipu_idmac_select_buffer(chan->in_chan, 0);
752 ipu_idmac_select_buffer(chan->out_chan, 0);
753 if (ipu_rot_mode_is_irt(ctx->rot_mode))
754 ipu_idmac_select_buffer(chan->rotation_out_chan, 0);
755 if (ctx->double_buffering) {
756 ipu_idmac_select_buffer(chan->in_chan, 1);
757 ipu_idmac_select_buffer(chan->out_chan, 1);
758 if (ipu_rot_mode_is_irt(ctx->rot_mode))
759 ipu_idmac_select_buffer(chan->rotation_out_chan, 1);
760 }
761
762
763 ipu_idmac_enable_channel(chan->in_chan);
764 ipu_idmac_enable_channel(chan->out_chan);
765 if (ipu_rot_mode_is_irt(ctx->rot_mode)) {
766 ipu_idmac_enable_channel(chan->rotation_in_chan);
767 ipu_idmac_enable_channel(chan->rotation_out_chan);
768 }
769
770 ipu_ic_task_enable(chan->ic);
771
772 ipu_cpmem_dump(chan->in_chan);
773 ipu_cpmem_dump(chan->out_chan);
774 if (ipu_rot_mode_is_irt(ctx->rot_mode)) {
775 ipu_cpmem_dump(chan->rotation_in_chan);
776 ipu_cpmem_dump(chan->rotation_out_chan);
777 }
778
779 ipu_dump(priv->ipu);
780
781 return 0;
782}
783
784
785static int do_run(struct ipu_image_convert_run *run)
786{
787 struct ipu_image_convert_ctx *ctx = run->ctx;
788 struct ipu_image_convert_chan *chan = ctx->chan;
789
790 lockdep_assert_held(&chan->irqlock);
791
792 ctx->in.base.phys0 = run->in_phys;
793 ctx->out.base.phys0 = run->out_phys;
794
795 ctx->cur_buf_num = 0;
796 ctx->next_tile = 1;
797
798
799 list_del(&run->list);
800 chan->current_run = run;
801
802 return convert_start(run);
803}
804
805
806static void run_next(struct ipu_image_convert_chan *chan)
807{
808 struct ipu_image_convert_priv *priv = chan->priv;
809 struct ipu_image_convert_run *run, *tmp;
810 int ret;
811
812 lockdep_assert_held(&chan->irqlock);
813
814 list_for_each_entry_safe(run, tmp, &chan->pending_q, list) {
815
816 if (run->ctx->aborting) {
817 dev_dbg(priv->ipu->dev,
818 "%s: task %u: skipping aborting ctx %p run %p\n",
819 __func__, chan->ic_task, run->ctx, run);
820 continue;
821 }
822
823 ret = do_run(run);
824 if (!ret)
825 break;
826
827
828
829
830
831
832 run->status = ret;
833 list_add_tail(&run->list, &chan->done_q);
834 chan->current_run = NULL;
835 }
836}
837
838static void empty_done_q(struct ipu_image_convert_chan *chan)
839{
840 struct ipu_image_convert_priv *priv = chan->priv;
841 struct ipu_image_convert_run *run;
842 unsigned long flags;
843
844 spin_lock_irqsave(&chan->irqlock, flags);
845
846 while (!list_empty(&chan->done_q)) {
847 run = list_entry(chan->done_q.next,
848 struct ipu_image_convert_run,
849 list);
850
851 list_del(&run->list);
852
853 dev_dbg(priv->ipu->dev,
854 "%s: task %u: completing ctx %p run %p with %d\n",
855 __func__, chan->ic_task, run->ctx, run, run->status);
856
857
858 spin_unlock_irqrestore(&chan->irqlock, flags);
859 run->ctx->complete(run, run->ctx->complete_context);
860 spin_lock_irqsave(&chan->irqlock, flags);
861 }
862
863 spin_unlock_irqrestore(&chan->irqlock, flags);
864}
865
866
867
868
869
870static irqreturn_t do_bh(int irq, void *dev_id)
871{
872 struct ipu_image_convert_chan *chan = dev_id;
873 struct ipu_image_convert_priv *priv = chan->priv;
874 struct ipu_image_convert_ctx *ctx;
875 unsigned long flags;
876
877 dev_dbg(priv->ipu->dev, "%s: task %u: enter\n", __func__,
878 chan->ic_task);
879
880 empty_done_q(chan);
881
882 spin_lock_irqsave(&chan->irqlock, flags);
883
884
885
886
887
888 list_for_each_entry(ctx, &chan->ctx_list, list) {
889 if (ctx->aborting) {
890 dev_dbg(priv->ipu->dev,
891 "%s: task %u: signaling abort for ctx %p\n",
892 __func__, chan->ic_task, ctx);
893 complete(&ctx->aborted);
894 }
895 }
896
897 spin_unlock_irqrestore(&chan->irqlock, flags);
898
899 dev_dbg(priv->ipu->dev, "%s: task %u: exit\n", __func__,
900 chan->ic_task);
901
902 return IRQ_HANDLED;
903}
904
905
906static irqreturn_t do_irq(struct ipu_image_convert_run *run)
907{
908 struct ipu_image_convert_ctx *ctx = run->ctx;
909 struct ipu_image_convert_chan *chan = ctx->chan;
910 struct ipu_image_tile *src_tile, *dst_tile;
911 struct ipu_image_convert_image *s_image = &ctx->in;
912 struct ipu_image_convert_image *d_image = &ctx->out;
913 struct ipuv3_channel *outch;
914 unsigned int dst_idx;
915
916 lockdep_assert_held(&chan->irqlock);
917
918 outch = ipu_rot_mode_is_irt(ctx->rot_mode) ?
919 chan->rotation_out_chan : chan->out_chan;
920
921
922
923
924
925
926
927
928
929 if (ctx->aborting && !ctx->double_buffering) {
930 convert_stop(run);
931 run->status = -EIO;
932 goto done;
933 }
934
935 if (ctx->next_tile == ctx->num_tiles) {
936
937
938
939 convert_stop(run);
940 run->status = 0;
941 goto done;
942 }
943
944
945
946
947 if (!ctx->double_buffering) {
948
949 src_tile = &s_image->tile[ctx->next_tile];
950 dst_idx = ctx->out_tile_map[ctx->next_tile];
951 dst_tile = &d_image->tile[dst_idx];
952
953 ipu_cpmem_set_buffer(chan->in_chan, 0,
954 s_image->base.phys0 + src_tile->offset);
955 ipu_cpmem_set_buffer(outch, 0,
956 d_image->base.phys0 + dst_tile->offset);
957 if (s_image->fmt->planar)
958 ipu_cpmem_set_uv_offset(chan->in_chan,
959 src_tile->u_off,
960 src_tile->v_off);
961 if (d_image->fmt->planar)
962 ipu_cpmem_set_uv_offset(outch,
963 dst_tile->u_off,
964 dst_tile->v_off);
965
966 ipu_idmac_select_buffer(chan->in_chan, 0);
967 ipu_idmac_select_buffer(outch, 0);
968
969 } else if (ctx->next_tile < ctx->num_tiles - 1) {
970
971 src_tile = &s_image->tile[ctx->next_tile + 1];
972 dst_idx = ctx->out_tile_map[ctx->next_tile + 1];
973 dst_tile = &d_image->tile[dst_idx];
974
975 ipu_cpmem_set_buffer(chan->in_chan, ctx->cur_buf_num,
976 s_image->base.phys0 + src_tile->offset);
977 ipu_cpmem_set_buffer(outch, ctx->cur_buf_num,
978 d_image->base.phys0 + dst_tile->offset);
979
980 ipu_idmac_select_buffer(chan->in_chan, ctx->cur_buf_num);
981 ipu_idmac_select_buffer(outch, ctx->cur_buf_num);
982
983 ctx->cur_buf_num ^= 1;
984 }
985
986 ctx->next_tile++;
987 return IRQ_HANDLED;
988done:
989 list_add_tail(&run->list, &chan->done_q);
990 chan->current_run = NULL;
991 run_next(chan);
992 return IRQ_WAKE_THREAD;
993}
994
995static irqreturn_t norotate_irq(int irq, void *data)
996{
997 struct ipu_image_convert_chan *chan = data;
998 struct ipu_image_convert_ctx *ctx;
999 struct ipu_image_convert_run *run;
1000 unsigned long flags;
1001 irqreturn_t ret;
1002
1003 spin_lock_irqsave(&chan->irqlock, flags);
1004
1005
1006 run = chan->current_run;
1007 if (!run) {
1008 ret = IRQ_NONE;
1009 goto out;
1010 }
1011
1012 ctx = run->ctx;
1013
1014 if (ipu_rot_mode_is_irt(ctx->rot_mode)) {
1015
1016 spin_unlock_irqrestore(&chan->irqlock, flags);
1017 return IRQ_HANDLED;
1018 }
1019
1020 ret = do_irq(run);
1021out:
1022 spin_unlock_irqrestore(&chan->irqlock, flags);
1023 return ret;
1024}
1025
1026static irqreturn_t rotate_irq(int irq, void *data)
1027{
1028 struct ipu_image_convert_chan *chan = data;
1029 struct ipu_image_convert_priv *priv = chan->priv;
1030 struct ipu_image_convert_ctx *ctx;
1031 struct ipu_image_convert_run *run;
1032 unsigned long flags;
1033 irqreturn_t ret;
1034
1035 spin_lock_irqsave(&chan->irqlock, flags);
1036
1037
1038 run = chan->current_run;
1039 if (!run) {
1040 ret = IRQ_NONE;
1041 goto out;
1042 }
1043
1044 ctx = run->ctx;
1045
1046 if (!ipu_rot_mode_is_irt(ctx->rot_mode)) {
1047
1048 dev_err(priv->ipu->dev, "Unexpected rotation interrupt\n");
1049 spin_unlock_irqrestore(&chan->irqlock, flags);
1050 return IRQ_HANDLED;
1051 }
1052
1053 ret = do_irq(run);
1054out:
1055 spin_unlock_irqrestore(&chan->irqlock, flags);
1056 return ret;
1057}
1058
1059
1060
1061
1062
1063static void force_abort(struct ipu_image_convert_ctx *ctx)
1064{
1065 struct ipu_image_convert_chan *chan = ctx->chan;
1066 struct ipu_image_convert_run *run;
1067 unsigned long flags;
1068
1069 spin_lock_irqsave(&chan->irqlock, flags);
1070
1071 run = chan->current_run;
1072 if (run && run->ctx == ctx) {
1073 convert_stop(run);
1074 run->status = -EIO;
1075 list_add_tail(&run->list, &chan->done_q);
1076 chan->current_run = NULL;
1077 run_next(chan);
1078 }
1079
1080 spin_unlock_irqrestore(&chan->irqlock, flags);
1081
1082 empty_done_q(chan);
1083}
1084
1085static void release_ipu_resources(struct ipu_image_convert_chan *chan)
1086{
1087 if (chan->out_eof_irq >= 0)
1088 free_irq(chan->out_eof_irq, chan);
1089 if (chan->rot_out_eof_irq >= 0)
1090 free_irq(chan->rot_out_eof_irq, chan);
1091
1092 if (!IS_ERR_OR_NULL(chan->in_chan))
1093 ipu_idmac_put(chan->in_chan);
1094 if (!IS_ERR_OR_NULL(chan->out_chan))
1095 ipu_idmac_put(chan->out_chan);
1096 if (!IS_ERR_OR_NULL(chan->rotation_in_chan))
1097 ipu_idmac_put(chan->rotation_in_chan);
1098 if (!IS_ERR_OR_NULL(chan->rotation_out_chan))
1099 ipu_idmac_put(chan->rotation_out_chan);
1100 if (!IS_ERR_OR_NULL(chan->ic))
1101 ipu_ic_put(chan->ic);
1102
1103 chan->in_chan = chan->out_chan = chan->rotation_in_chan =
1104 chan->rotation_out_chan = NULL;
1105 chan->out_eof_irq = chan->rot_out_eof_irq = -1;
1106}
1107
1108static int get_ipu_resources(struct ipu_image_convert_chan *chan)
1109{
1110 const struct ipu_image_convert_dma_chan *dma = chan->dma_ch;
1111 struct ipu_image_convert_priv *priv = chan->priv;
1112 int ret;
1113
1114
1115 chan->ic = ipu_ic_get(priv->ipu, chan->ic_task);
1116 if (IS_ERR(chan->ic)) {
1117 dev_err(priv->ipu->dev, "could not acquire IC\n");
1118 ret = PTR_ERR(chan->ic);
1119 goto err;
1120 }
1121
1122
1123 chan->in_chan = ipu_idmac_get(priv->ipu, dma->in);
1124 chan->out_chan = ipu_idmac_get(priv->ipu, dma->out);
1125 if (IS_ERR(chan->in_chan) || IS_ERR(chan->out_chan)) {
1126 dev_err(priv->ipu->dev, "could not acquire idmac channels\n");
1127 ret = -EBUSY;
1128 goto err;
1129 }
1130
1131 chan->rotation_in_chan = ipu_idmac_get(priv->ipu, dma->rot_in);
1132 chan->rotation_out_chan = ipu_idmac_get(priv->ipu, dma->rot_out);
1133 if (IS_ERR(chan->rotation_in_chan) || IS_ERR(chan->rotation_out_chan)) {
1134 dev_err(priv->ipu->dev,
1135 "could not acquire idmac rotation channels\n");
1136 ret = -EBUSY;
1137 goto err;
1138 }
1139
1140
1141 chan->out_eof_irq = ipu_idmac_channel_irq(priv->ipu,
1142 chan->out_chan,
1143 IPU_IRQ_EOF);
1144
1145 ret = request_threaded_irq(chan->out_eof_irq, norotate_irq, do_bh,
1146 0, "ipu-ic", chan);
1147 if (ret < 0) {
1148 dev_err(priv->ipu->dev, "could not acquire irq %d\n",
1149 chan->out_eof_irq);
1150 chan->out_eof_irq = -1;
1151 goto err;
1152 }
1153
1154 chan->rot_out_eof_irq = ipu_idmac_channel_irq(priv->ipu,
1155 chan->rotation_out_chan,
1156 IPU_IRQ_EOF);
1157
1158 ret = request_threaded_irq(chan->rot_out_eof_irq, rotate_irq, do_bh,
1159 0, "ipu-ic", chan);
1160 if (ret < 0) {
1161 dev_err(priv->ipu->dev, "could not acquire irq %d\n",
1162 chan->rot_out_eof_irq);
1163 chan->rot_out_eof_irq = -1;
1164 goto err;
1165 }
1166
1167 return 0;
1168err:
1169 release_ipu_resources(chan);
1170 return ret;
1171}
1172
1173static int fill_image(struct ipu_image_convert_ctx *ctx,
1174 struct ipu_image_convert_image *ic_image,
1175 struct ipu_image *image,
1176 enum ipu_image_convert_type type)
1177{
1178 struct ipu_image_convert_priv *priv = ctx->chan->priv;
1179
1180 ic_image->base = *image;
1181 ic_image->type = type;
1182
1183 ic_image->fmt = get_format(image->pix.pixelformat);
1184 if (!ic_image->fmt) {
1185 dev_err(priv->ipu->dev, "pixelformat not supported for %s\n",
1186 type == IMAGE_CONVERT_OUT ? "Output" : "Input");
1187 return -EINVAL;
1188 }
1189
1190 if (ic_image->fmt->planar)
1191 ic_image->stride = ic_image->base.pix.width;
1192 else
1193 ic_image->stride = ic_image->base.pix.bytesperline;
1194
1195 calc_tile_dimensions(ctx, ic_image);
1196 calc_tile_offsets(ctx, ic_image);
1197
1198 return 0;
1199}
1200
1201
1202static unsigned int clamp_align(unsigned int x, unsigned int min,
1203 unsigned int max, unsigned int align)
1204{
1205
1206 unsigned int mask = ~((1 << align) - 1);
1207
1208
1209 x = clamp(x, (min + ~mask) & mask, max & mask);
1210
1211
1212 if (align)
1213 x = (x + (1 << (align - 1))) & mask;
1214
1215 return x;
1216}
1217
1218
1219
1220
1221
1222
1223
1224
1225
1226static inline u32 tile_width_align(const struct ipu_image_pixfmt *fmt)
1227{
1228 return fmt->planar ? 8 * fmt->uv_width_dec : 8;
1229}
1230
1231
1232
1233
1234
1235
1236
1237
1238static inline u32 tile_height_align(enum ipu_image_convert_type type,
1239 enum ipu_rotate_mode rot_mode)
1240{
1241 return (type == IMAGE_CONVERT_OUT &&
1242 ipu_rot_mode_is_irt(rot_mode)) ? 8 : 2;
1243}
1244
1245
1246void ipu_image_convert_adjust(struct ipu_image *in, struct ipu_image *out,
1247 enum ipu_rotate_mode rot_mode)
1248{
1249 const struct ipu_image_pixfmt *infmt, *outfmt;
1250 unsigned int num_in_rows, num_in_cols;
1251 unsigned int num_out_rows, num_out_cols;
1252 u32 w_align, h_align;
1253
1254 infmt = get_format(in->pix.pixelformat);
1255 outfmt = get_format(out->pix.pixelformat);
1256
1257
1258 if (!infmt) {
1259 in->pix.pixelformat = V4L2_PIX_FMT_RGB24;
1260 infmt = get_format(V4L2_PIX_FMT_RGB24);
1261 }
1262 if (!outfmt) {
1263 out->pix.pixelformat = V4L2_PIX_FMT_RGB24;
1264 outfmt = get_format(V4L2_PIX_FMT_RGB24);
1265 }
1266
1267
1268 in->pix.field = out->pix.field = V4L2_FIELD_NONE;
1269
1270
1271 if (ipu_rot_mode_is_irt(rot_mode)) {
1272 out->pix.height = max_t(__u32, out->pix.height,
1273 in->pix.width / 4);
1274 out->pix.width = max_t(__u32, out->pix.width,
1275 in->pix.height / 4);
1276 } else {
1277 out->pix.width = max_t(__u32, out->pix.width,
1278 in->pix.width / 4);
1279 out->pix.height = max_t(__u32, out->pix.height,
1280 in->pix.height / 4);
1281 }
1282
1283
1284 num_out_rows = num_stripes(out->pix.height);
1285 num_out_cols = num_stripes(out->pix.width);
1286 if (ipu_rot_mode_is_irt(rot_mode)) {
1287 num_in_rows = num_out_cols;
1288 num_in_cols = num_out_rows;
1289 } else {
1290 num_in_rows = num_out_rows;
1291 num_in_cols = num_out_cols;
1292 }
1293
1294
1295 w_align = ilog2(tile_width_align(infmt) * num_in_cols);
1296 h_align = ilog2(tile_height_align(IMAGE_CONVERT_IN, rot_mode) *
1297 num_in_rows);
1298 in->pix.width = clamp_align(in->pix.width, MIN_W, MAX_W, w_align);
1299 in->pix.height = clamp_align(in->pix.height, MIN_H, MAX_H, h_align);
1300
1301
1302 w_align = ilog2(tile_width_align(outfmt) * num_out_cols);
1303 h_align = ilog2(tile_height_align(IMAGE_CONVERT_OUT, rot_mode) *
1304 num_out_rows);
1305 out->pix.width = clamp_align(out->pix.width, MIN_W, MAX_W, w_align);
1306 out->pix.height = clamp_align(out->pix.height, MIN_H, MAX_H, h_align);
1307
1308
1309 in->pix.bytesperline = (in->pix.width * infmt->bpp) >> 3;
1310 in->pix.sizeimage = in->pix.height * in->pix.bytesperline;
1311 out->pix.bytesperline = (out->pix.width * outfmt->bpp) >> 3;
1312 out->pix.sizeimage = out->pix.height * out->pix.bytesperline;
1313}
1314EXPORT_SYMBOL_GPL(ipu_image_convert_adjust);
1315
1316
1317
1318
1319
1320
1321int ipu_image_convert_verify(struct ipu_image *in, struct ipu_image *out,
1322 enum ipu_rotate_mode rot_mode)
1323{
1324 struct ipu_image testin, testout;
1325
1326 testin = *in;
1327 testout = *out;
1328
1329 ipu_image_convert_adjust(&testin, &testout, rot_mode);
1330
1331 if (testin.pix.width != in->pix.width ||
1332 testin.pix.height != in->pix.height ||
1333 testout.pix.width != out->pix.width ||
1334 testout.pix.height != out->pix.height)
1335 return -EINVAL;
1336
1337 return 0;
1338}
1339EXPORT_SYMBOL_GPL(ipu_image_convert_verify);
1340
1341
1342
1343
1344
1345struct ipu_image_convert_ctx *
1346ipu_image_convert_prepare(struct ipu_soc *ipu, enum ipu_ic_task ic_task,
1347 struct ipu_image *in, struct ipu_image *out,
1348 enum ipu_rotate_mode rot_mode,
1349 ipu_image_convert_cb_t complete,
1350 void *complete_context)
1351{
1352 struct ipu_image_convert_priv *priv = ipu->image_convert_priv;
1353 struct ipu_image_convert_image *s_image, *d_image;
1354 struct ipu_image_convert_chan *chan;
1355 struct ipu_image_convert_ctx *ctx;
1356 unsigned long flags;
1357 bool get_res;
1358 int ret;
1359
1360 if (!in || !out || !complete ||
1361 (ic_task != IC_TASK_VIEWFINDER &&
1362 ic_task != IC_TASK_POST_PROCESSOR))
1363 return ERR_PTR(-EINVAL);
1364
1365
1366 ret = ipu_image_convert_verify(in, out, rot_mode);
1367 if (ret) {
1368 dev_err(priv->ipu->dev, "%s: in/out formats invalid\n",
1369 __func__);
1370 return ERR_PTR(ret);
1371 }
1372
1373 chan = &priv->chan[ic_task];
1374
1375 ctx = kzalloc(sizeof(*ctx), GFP_KERNEL);
1376 if (!ctx)
1377 return ERR_PTR(-ENOMEM);
1378
1379 dev_dbg(priv->ipu->dev, "%s: task %u: ctx %p\n", __func__,
1380 chan->ic_task, ctx);
1381
1382 ctx->chan = chan;
1383 init_completion(&ctx->aborted);
1384
1385 s_image = &ctx->in;
1386 d_image = &ctx->out;
1387
1388
1389 d_image->num_rows = num_stripes(out->pix.height);
1390 d_image->num_cols = num_stripes(out->pix.width);
1391 if (ipu_rot_mode_is_irt(rot_mode)) {
1392 s_image->num_rows = d_image->num_cols;
1393 s_image->num_cols = d_image->num_rows;
1394 } else {
1395 s_image->num_rows = d_image->num_rows;
1396 s_image->num_cols = d_image->num_cols;
1397 }
1398
1399 ctx->num_tiles = d_image->num_cols * d_image->num_rows;
1400 ctx->rot_mode = rot_mode;
1401
1402 ret = fill_image(ctx, s_image, in, IMAGE_CONVERT_IN);
1403 if (ret)
1404 goto out_free;
1405 ret = fill_image(ctx, d_image, out, IMAGE_CONVERT_OUT);
1406 if (ret)
1407 goto out_free;
1408
1409 calc_out_tile_map(ctx);
1410
1411 dump_format(ctx, s_image);
1412 dump_format(ctx, d_image);
1413
1414 ctx->complete = complete;
1415 ctx->complete_context = complete_context;
1416
1417
1418
1419
1420
1421
1422
1423
1424
1425
1426
1427
1428 ctx->double_buffering = (ctx->num_tiles > 1 &&
1429 !s_image->fmt->planar &&
1430 !d_image->fmt->planar);
1431
1432 if (ipu_rot_mode_is_irt(ctx->rot_mode)) {
1433 ret = alloc_dma_buf(priv, &ctx->rot_intermediate[0],
1434 d_image->tile[0].size);
1435 if (ret)
1436 goto out_free;
1437 if (ctx->double_buffering) {
1438 ret = alloc_dma_buf(priv,
1439 &ctx->rot_intermediate[1],
1440 d_image->tile[0].size);
1441 if (ret)
1442 goto out_free_dmabuf0;
1443 }
1444 }
1445
1446 spin_lock_irqsave(&chan->irqlock, flags);
1447
1448 get_res = list_empty(&chan->ctx_list);
1449
1450 list_add_tail(&ctx->list, &chan->ctx_list);
1451
1452 spin_unlock_irqrestore(&chan->irqlock, flags);
1453
1454 if (get_res) {
1455 ret = get_ipu_resources(chan);
1456 if (ret)
1457 goto out_free_dmabuf1;
1458 }
1459
1460 return ctx;
1461
1462out_free_dmabuf1:
1463 free_dma_buf(priv, &ctx->rot_intermediate[1]);
1464 spin_lock_irqsave(&chan->irqlock, flags);
1465 list_del(&ctx->list);
1466 spin_unlock_irqrestore(&chan->irqlock, flags);
1467out_free_dmabuf0:
1468 free_dma_buf(priv, &ctx->rot_intermediate[0]);
1469out_free:
1470 kfree(ctx);
1471 return ERR_PTR(ret);
1472}
1473EXPORT_SYMBOL_GPL(ipu_image_convert_prepare);
1474
1475
1476
1477
1478
1479
1480int ipu_image_convert_queue(struct ipu_image_convert_run *run)
1481{
1482 struct ipu_image_convert_chan *chan;
1483 struct ipu_image_convert_priv *priv;
1484 struct ipu_image_convert_ctx *ctx;
1485 unsigned long flags;
1486 int ret = 0;
1487
1488 if (!run || !run->ctx || !run->in_phys || !run->out_phys)
1489 return -EINVAL;
1490
1491 ctx = run->ctx;
1492 chan = ctx->chan;
1493 priv = chan->priv;
1494
1495 dev_dbg(priv->ipu->dev, "%s: task %u: ctx %p run %p\n", __func__,
1496 chan->ic_task, ctx, run);
1497
1498 INIT_LIST_HEAD(&run->list);
1499
1500 spin_lock_irqsave(&chan->irqlock, flags);
1501
1502 if (ctx->aborting) {
1503 ret = -EIO;
1504 goto unlock;
1505 }
1506
1507 list_add_tail(&run->list, &chan->pending_q);
1508
1509 if (!chan->current_run) {
1510 ret = do_run(run);
1511 if (ret)
1512 chan->current_run = NULL;
1513 }
1514unlock:
1515 spin_unlock_irqrestore(&chan->irqlock, flags);
1516 return ret;
1517}
1518EXPORT_SYMBOL_GPL(ipu_image_convert_queue);
1519
1520
1521void ipu_image_convert_abort(struct ipu_image_convert_ctx *ctx)
1522{
1523 struct ipu_image_convert_chan *chan = ctx->chan;
1524 struct ipu_image_convert_priv *priv = chan->priv;
1525 struct ipu_image_convert_run *run, *active_run, *tmp;
1526 unsigned long flags;
1527 int run_count, ret;
1528 bool need_abort;
1529
1530 reinit_completion(&ctx->aborted);
1531
1532 spin_lock_irqsave(&chan->irqlock, flags);
1533
1534
1535 list_for_each_entry_safe(run, tmp, &chan->pending_q, list) {
1536 if (run->ctx != ctx)
1537 continue;
1538 run->status = -EIO;
1539 list_move_tail(&run->list, &chan->done_q);
1540 }
1541
1542 run_count = get_run_count(ctx, &chan->done_q);
1543 active_run = (chan->current_run && chan->current_run->ctx == ctx) ?
1544 chan->current_run : NULL;
1545
1546 need_abort = (run_count || active_run);
1547
1548 ctx->aborting = need_abort;
1549
1550 spin_unlock_irqrestore(&chan->irqlock, flags);
1551
1552 if (!need_abort) {
1553 dev_dbg(priv->ipu->dev,
1554 "%s: task %u: no abort needed for ctx %p\n",
1555 __func__, chan->ic_task, ctx);
1556 return;
1557 }
1558
1559 dev_dbg(priv->ipu->dev,
1560 "%s: task %u: wait for completion: %d runs, active run %p\n",
1561 __func__, chan->ic_task, run_count, active_run);
1562
1563 ret = wait_for_completion_timeout(&ctx->aborted,
1564 msecs_to_jiffies(10000));
1565 if (ret == 0) {
1566 dev_warn(priv->ipu->dev, "%s: timeout\n", __func__);
1567 force_abort(ctx);
1568 }
1569
1570 ctx->aborting = false;
1571}
1572EXPORT_SYMBOL_GPL(ipu_image_convert_abort);
1573
1574
1575void ipu_image_convert_unprepare(struct ipu_image_convert_ctx *ctx)
1576{
1577 struct ipu_image_convert_chan *chan = ctx->chan;
1578 struct ipu_image_convert_priv *priv = chan->priv;
1579 unsigned long flags;
1580 bool put_res;
1581
1582
1583 ipu_image_convert_abort(ctx);
1584
1585 dev_dbg(priv->ipu->dev, "%s: task %u: removing ctx %p\n", __func__,
1586 chan->ic_task, ctx);
1587
1588 spin_lock_irqsave(&chan->irqlock, flags);
1589
1590 list_del(&ctx->list);
1591
1592 put_res = list_empty(&chan->ctx_list);
1593
1594 spin_unlock_irqrestore(&chan->irqlock, flags);
1595
1596 if (put_res)
1597 release_ipu_resources(chan);
1598
1599 free_dma_buf(priv, &ctx->rot_intermediate[1]);
1600 free_dma_buf(priv, &ctx->rot_intermediate[0]);
1601
1602 kfree(ctx);
1603}
1604EXPORT_SYMBOL_GPL(ipu_image_convert_unprepare);
1605
1606
1607
1608
1609
1610
1611struct ipu_image_convert_run *
1612ipu_image_convert(struct ipu_soc *ipu, enum ipu_ic_task ic_task,
1613 struct ipu_image *in, struct ipu_image *out,
1614 enum ipu_rotate_mode rot_mode,
1615 ipu_image_convert_cb_t complete,
1616 void *complete_context)
1617{
1618 struct ipu_image_convert_ctx *ctx;
1619 struct ipu_image_convert_run *run;
1620 int ret;
1621
1622 ctx = ipu_image_convert_prepare(ipu, ic_task, in, out, rot_mode,
1623 complete, complete_context);
1624 if (IS_ERR(ctx))
1625 return ERR_CAST(ctx);
1626
1627 run = kzalloc(sizeof(*run), GFP_KERNEL);
1628 if (!run) {
1629 ipu_image_convert_unprepare(ctx);
1630 return ERR_PTR(-ENOMEM);
1631 }
1632
1633 run->ctx = ctx;
1634 run->in_phys = in->phys0;
1635 run->out_phys = out->phys0;
1636
1637 ret = ipu_image_convert_queue(run);
1638 if (ret) {
1639 ipu_image_convert_unprepare(ctx);
1640 kfree(run);
1641 return ERR_PTR(ret);
1642 }
1643
1644 return run;
1645}
1646EXPORT_SYMBOL_GPL(ipu_image_convert);
1647
1648
1649static void image_convert_sync_complete(struct ipu_image_convert_run *run,
1650 void *data)
1651{
1652 struct completion *comp = data;
1653
1654 complete(comp);
1655}
1656
1657int ipu_image_convert_sync(struct ipu_soc *ipu, enum ipu_ic_task ic_task,
1658 struct ipu_image *in, struct ipu_image *out,
1659 enum ipu_rotate_mode rot_mode)
1660{
1661 struct ipu_image_convert_run *run;
1662 struct completion comp;
1663 int ret;
1664
1665 init_completion(&comp);
1666
1667 run = ipu_image_convert(ipu, ic_task, in, out, rot_mode,
1668 image_convert_sync_complete, &comp);
1669 if (IS_ERR(run))
1670 return PTR_ERR(run);
1671
1672 ret = wait_for_completion_timeout(&comp, msecs_to_jiffies(10000));
1673 ret = (ret == 0) ? -ETIMEDOUT : 0;
1674
1675 ipu_image_convert_unprepare(run->ctx);
1676 kfree(run);
1677
1678 return ret;
1679}
1680EXPORT_SYMBOL_GPL(ipu_image_convert_sync);
1681
1682int ipu_image_convert_init(struct ipu_soc *ipu, struct device *dev)
1683{
1684 struct ipu_image_convert_priv *priv;
1685 int i;
1686
1687 priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
1688 if (!priv)
1689 return -ENOMEM;
1690
1691 ipu->image_convert_priv = priv;
1692 priv->ipu = ipu;
1693
1694 for (i = 0; i < IC_NUM_TASKS; i++) {
1695 struct ipu_image_convert_chan *chan = &priv->chan[i];
1696
1697 chan->ic_task = i;
1698 chan->priv = priv;
1699 chan->dma_ch = &image_convert_dma_chan[i];
1700 chan->out_eof_irq = -1;
1701 chan->rot_out_eof_irq = -1;
1702
1703 spin_lock_init(&chan->irqlock);
1704 INIT_LIST_HEAD(&chan->ctx_list);
1705 INIT_LIST_HEAD(&chan->pending_q);
1706 INIT_LIST_HEAD(&chan->done_q);
1707 }
1708
1709 return 0;
1710}
1711
1712void ipu_image_convert_exit(struct ipu_soc *ipu)
1713{
1714}
1715