]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - drivers/gpu/ipu-v3/ipu-image-convert.c
PCI: PM: Skip devices in D0 for suspend-to-idle
[mirror_ubuntu-bionic-kernel.git] / drivers / gpu / ipu-v3 / ipu-image-convert.c
CommitLineData
cd98e85a
SL
1/*
2 * Copyright (C) 2012-2016 Mentor Graphics Inc.
3 *
4 * Queued image conversion support, with tiling and rotation.
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 * This program is distributed in the hope that it will be useful, but
12 * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
13 * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
14 * for more details.
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 * The IC Resizer has a restriction that the output frame from the
24 * resizer must be 1024 or less in both width (pixels) and height
25 * (lines).
26 *
27 * The image converter attempts to split up a conversion when
28 * the desired output (converted) frame resolution exceeds the
29 * IC resizer limit of 1024 in either dimension.
30 *
31 * If either dimension of the output frame exceeds the limit, the
32 * dimension is split into 1, 2, or 4 equal stripes, for a maximum
33 * of 4*4 or 16 tiles. A conversion is then carried out for each
34 * tile (but taking care to pass the full frame stride length to
35 * the DMA channel's parameter memory!). IDMA double-buffering is used
36 * to convert each tile back-to-back when possible (see note below
37 * when double_buffering boolean is set).
38 *
39 * Note that the input frame must be split up into the same number
40 * of tiles as the output frame.
41 *
42 * FIXME: at this point there is no attempt to deal with visible seams
43 * at the tile boundaries when upscaling. The seams are caused by a reset
44 * of the bilinear upscale interpolation when starting a new tile. The
45 * seams are barely visible for small upscale factors, but become
46 * increasingly visible as the upscale factor gets larger, since more
47 * interpolated pixels get thrown out at the tile boundaries. A possilble
48 * fix might be to overlap tiles of different sizes, but this must be done
49 * while also maintaining the IDMAC dma buffer address alignment and 8x8 IRT
50 * alignment restrictions of each tile.
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/* dimensions of one tile */
84struct ipu_image_tile {
85 u32 width;
86 u32 height;
87 /* size and strides are in bytes */
88 u32 size;
89 u32 stride;
90 u32 rot_stride;
91 /* start Y or packed offset of this tile */
92 u32 offset;
93 /* offset from start to tile in U plane, for planar formats */
94 u32 u_off;
95 /* offset from start to tile in V plane, for planar formats */
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 /* # of rows (horizontal stripes) if dest height is > 1024 */
107 unsigned int num_rows;
108 /* # of columns (vertical stripes) if dest width is > 1024 */
109 unsigned int num_cols;
110
111 struct ipu_image_tile tile[MAX_TILES];
112};
113
114struct ipu_image_pixfmt {
115 u32 fourcc; /* V4L2 fourcc */
116 int bpp; /* total bpp */
117 int uv_width_dec; /* decimation in width for U/V planes */
118 int uv_height_dec; /* decimation in height for U/V planes */
119 bool planar; /* planar format */
120 bool uv_swapped; /* U and V planes are swapped */
121 bool uv_packed; /* partial planar (U and V in same plane) */
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 /* Source/destination image data and rotation mode */
135 struct ipu_image_convert_image in;
136 struct ipu_image_convert_image out;
137 enum ipu_rotate_mode rot_mode;
138
139 /* intermediate buffer for rotation */
140 struct ipu_image_convert_dma_buf rot_intermediate[2];
141
142 /* current buffer number for double buffering */
143 int cur_buf_num;
144
145 bool aborting;
146 struct completion aborted;
147
148 /* can we use double-buffering for this conversion operation? */
149 bool double_buffering;
150 /* num_rows * num_cols */
151 unsigned int num_tiles;
152 /* next tile to process */
153 unsigned int next_tile;
154 /* where to place converted tile in dest image */
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 /* the IPU end-of-frame irqs */
173 int out_eof_irq;
174 int rot_out_eof_irq;
175
176 spinlock_t irqlock;
177
178 /* list of convert contexts */
179 struct list_head ctx_list;
180 /* queue of conversion runs */
181 struct list_head pending_q;
182 /* queue of completed runs */
183 struct list_head done_q;
184
185 /* the current conversion run */
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 /* Format found */
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 * Use the rotation transformation to find the tile coordinates
385 * (row, col) of a tile in the destination frame that corresponds
386 * to the given tile coordinates of a source frame. The destination
387 * coordinate is then converted to a tile index.
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 /* with no rotation it's a 1:1 mapping */
399 if (ctx->rot_mode == IPU_ROTATE_NONE)
400 return src_row * s_image->num_cols + src_col;
401
402 /*
403 * before doing the transform, first we have to translate
404 * source row,col for an origin in the center of s_image
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 /* do the rotation transform */
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 /* apply flip */
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 * finally translate dest row,col using an origin in upper
429 * left of d_image
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 * Fill the out_tile_map[] with transformed destination tile indeces.
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 /* setup some convenience vars */
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 /* setup some convenience vars */
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 * return the number of runs in given queue (pending_q or done_q)
563 * for this context. hold irqlock when calling.
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 /* disable IC tasks and the channels */
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
320a89ad
LS
674 /*
675 * Setting a non-zero AXI ID collides with the PRG AXI snooping, so
676 * only do this when there is no PRG present.
677 */
678 if (!channel->ipu->prg_priv)
679 ipu_cpmem_set_axi_id(channel, 1);
cd98e85a
SL
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 /* swap width/height for resizer */
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 /* setup the IC resizer and CSC */
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 /* init the source MEM-->IC PP IDMAC channel */
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 /* init the IC PP-->MEM IDMAC channel */
728 init_idmac_channel(ctx, chan->out_chan, d_image,
729 IPU_ROTATE_NONE, true);
730
731 /* init the MEM-->IC PP ROT IDMAC channel */
732 init_idmac_channel(ctx, chan->rotation_in_chan, d_image,
733 ctx->rot_mode, true);
734
735 /* init the destination IC PP ROT-->MEM IDMAC channel */
736 init_idmac_channel(ctx, chan->rotation_out_chan, d_image,
737 IPU_ROTATE_NONE, false);
738
739 /* now link IC PP-->MEM to MEM-->IC PP ROT */
740 ipu_idmac_link(chan->out_chan, chan->rotation_in_chan);
741 } else {
742 /* init the destination IC PP-->MEM IDMAC channel */
743 init_idmac_channel(ctx, chan->out_chan, d_image,
744 ctx->rot_mode, false);
745 }
746
747 /* enable the IC */
748 ipu_ic_enable(chan->ic);
749
750 /* set buffers ready */
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 /* enable the channels! */
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/* hold irqlock when calling */
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 /* remove run from pending_q and set as current */
799 list_del(&run->list);
800 chan->current_run = run;
801
802 return convert_start(run);
803}
804
805/* hold irqlock when calling */
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 /* skip contexts that are aborting */
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 * something went wrong with start, add the run
829 * to done q and continue to the next run in the
830 * pending q.
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 /* call the completion callback and free the run */
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 * the bottom half thread clears out the done_q, calling the
868 * completion handler for each.
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 * the done_q is cleared out, signal any contexts
886 * that are aborting that abort can complete.
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/* hold irqlock when calling */
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 * It is difficult to stop the channel DMA before the channels
923 * enter the paused state. Without double-buffering the channels
924 * are always in a paused state when the EOF irq occurs, so it
925 * is safe to stop the channels now. For double-buffering we
926 * just ignore the abort until the operation completes, when it
927 * is safe to shut down.
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 * the conversion is complete
938 */
939 convert_stop(run);
940 run->status = 0;
941 goto done;
942 }
943
944 /*
945 * not done, place the next tile buffers.
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 /* get current run and its context */
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 /* this is a rotation operation, just ignore */
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 /* get current run and its context */
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 /* this was NOT a rotation operation, shouldn't happen */
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 * try to force the completion of runs for this ctx. Called when
1061 * abort wait times out in ipu_image_convert_abort().
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 /* get IC */
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 /* get IDMAC channels */
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 /* acquire the EOF interrupts */
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/* borrowed from drivers/media/v4l2-core/v4l2-common.c */
1202static unsigned int clamp_align(unsigned int x, unsigned int min,
1203 unsigned int max, unsigned int align)
1204{
1205 /* Bits that must be zero to be aligned */
1206 unsigned int mask = ~((1 << align) - 1);
1207
1208 /* Clamp to aligned min and max */
1209 x = clamp(x, (min + ~mask) & mask, max & mask);
1210
1211 /* Round to nearest aligned value */
1212 if (align)
1213 x = (x + (1 << (align - 1))) & mask;
1214
1215 return x;
1216}
1217
1218/*
1219 * We have to adjust the tile width such that the tile physaddrs and
1220 * U and V plane offsets are multiples of 8 bytes as required by
1221 * the IPU DMA Controller. For the planar formats, this corresponds
1222 * to a pixel alignment of 16 (but use a more formal equation since
1223 * the variables are available). For all the packed formats, 8 is
1224 * good enough.
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 * For tile height alignment, we have to ensure that the output tile
1233 * heights are multiples of 8 lines if the IRT is required by the
1234 * given rotation mode (the IRT performs rotations on 8x8 blocks
1235 * at a time). If the IRT is not used, or for input image tiles,
1236 * 2 lines are good enough.
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/* Adjusts input/output images to IPU restrictions */
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 /* set some default pixel formats if needed */
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 /* image converter does not handle fields */
1268 in->pix.field = out->pix.field = V4L2_FIELD_NONE;
1269
1270 /* resizer cannot downsize more than 4:1 */
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 /* get tiling rows/cols from output format */
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 /* align input width/height */
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 /* align output width/height */
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 /* set input/output strides and image sizes */
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 * this is used by ipu_image_convert_prepare() to verify set input and
1318 * output images are valid before starting the conversion. Clients can
1319 * also call it before calling ipu_image_convert_prepare().
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 * Call ipu_image_convert_prepare() to prepare for the conversion of
1343 * given images and rotation mode. Returns a new conversion context.
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 /* verify the in/out images before continuing */
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 /* set tiling and rotation */
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 * Can we use double-buffering for this operation? If there is
1419 * only one tile (the whole image can be converted in a single
1420 * operation) there's no point in using double-buffering. Also,
1421 * the IPU's IDMAC channels allow only a single U and V plane
1422 * offset shared between both buffers, but these offsets change
1423 * for every tile, and therefore would have to be updated for
1424 * each buffer which is not possible. So double-buffering is
1425 * impossible when either the source or destination images are
1426 * a planar format (YUV420, YUV422P, etc.).
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 * Carry out a single image conversion run. Only the physaddr's of the input
1477 * and output image buffers are needed. The conversion context must have
1478 * been created previously with ipu_image_convert_prepare().
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/* Abort any active or pending conversions for this context */
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 /* move all remaining pending runs in this context to done_q */
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/* Unprepare image conversion context */
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 /* make sure no runs are hanging around */
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 * "Canned" asynchronous single image conversion. Allocates and returns
1608 * a new conversion run. On successful return the caller must free the
1609 * run and call ipu_image_convert_unprepare() after conversion completes.
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))
4ad3e92c 1625 return ERR_CAST(ctx);
cd98e85a
SL
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/* "Canned" synchronous single image conversion */
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}