]>
Commit | Line | Data |
---|---|---|
89069699 SK |
1 | /* |
2 | * Copyright (c) 2011 - 2012 Samsung Electronics Co., Ltd. | |
3 | * http://www.samsung.com | |
4 | * | |
5 | * Samsung EXYNOS5 SoC series G-Scaler driver | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or modify | |
8 | * it under the terms of the GNU General Public License as published | |
9 | * by the Free Software Foundation, either version 2 of the License, | |
10 | * or (at your option) any later version. | |
11 | */ | |
12 | ||
13 | #include <linux/module.h> | |
14 | #include <linux/kernel.h> | |
89069699 SK |
15 | #include <linux/types.h> |
16 | #include <linux/errno.h> | |
17 | #include <linux/bug.h> | |
18 | #include <linux/interrupt.h> | |
19 | #include <linux/workqueue.h> | |
20 | #include <linux/device.h> | |
21 | #include <linux/platform_device.h> | |
22 | #include <linux/list.h> | |
23 | #include <linux/io.h> | |
24 | #include <linux/slab.h> | |
25 | #include <linux/clk.h> | |
26 | #include <linux/of.h> | |
27 | #include <media/v4l2-ioctl.h> | |
28 | ||
29 | #include "gsc-core.h" | |
30 | ||
31 | #define GSC_CLOCK_GATE_NAME "gscl" | |
32 | ||
33 | static const struct gsc_fmt gsc_formats[] = { | |
34 | { | |
35 | .name = "RGB565", | |
36 | .pixelformat = V4L2_PIX_FMT_RGB565X, | |
37 | .depth = { 16 }, | |
38 | .color = GSC_RGB, | |
39 | .num_planes = 1, | |
40 | .num_comp = 1, | |
41 | }, { | |
42 | .name = "XRGB-8-8-8-8, 32 bpp", | |
43 | .pixelformat = V4L2_PIX_FMT_RGB32, | |
44 | .depth = { 32 }, | |
45 | .color = GSC_RGB, | |
46 | .num_planes = 1, | |
47 | .num_comp = 1, | |
48 | }, { | |
49 | .name = "YUV 4:2:2 packed, YCbYCr", | |
50 | .pixelformat = V4L2_PIX_FMT_YUYV, | |
51 | .depth = { 16 }, | |
52 | .color = GSC_YUV422, | |
53 | .yorder = GSC_LSB_Y, | |
54 | .corder = GSC_CBCR, | |
55 | .num_planes = 1, | |
56 | .num_comp = 1, | |
27ffaeb0 | 57 | .mbus_code = MEDIA_BUS_FMT_YUYV8_2X8, |
89069699 SK |
58 | }, { |
59 | .name = "YUV 4:2:2 packed, CbYCrY", | |
60 | .pixelformat = V4L2_PIX_FMT_UYVY, | |
61 | .depth = { 16 }, | |
62 | .color = GSC_YUV422, | |
63 | .yorder = GSC_LSB_C, | |
64 | .corder = GSC_CBCR, | |
65 | .num_planes = 1, | |
66 | .num_comp = 1, | |
27ffaeb0 | 67 | .mbus_code = MEDIA_BUS_FMT_UYVY8_2X8, |
89069699 SK |
68 | }, { |
69 | .name = "YUV 4:2:2 packed, CrYCbY", | |
70 | .pixelformat = V4L2_PIX_FMT_VYUY, | |
71 | .depth = { 16 }, | |
72 | .color = GSC_YUV422, | |
73 | .yorder = GSC_LSB_C, | |
74 | .corder = GSC_CRCB, | |
75 | .num_planes = 1, | |
76 | .num_comp = 1, | |
27ffaeb0 | 77 | .mbus_code = MEDIA_BUS_FMT_VYUY8_2X8, |
89069699 SK |
78 | }, { |
79 | .name = "YUV 4:2:2 packed, YCrYCb", | |
80 | .pixelformat = V4L2_PIX_FMT_YVYU, | |
81 | .depth = { 16 }, | |
82 | .color = GSC_YUV422, | |
83 | .yorder = GSC_LSB_Y, | |
84 | .corder = GSC_CRCB, | |
85 | .num_planes = 1, | |
86 | .num_comp = 1, | |
27ffaeb0 | 87 | .mbus_code = MEDIA_BUS_FMT_YVYU8_2X8, |
89069699 SK |
88 | }, { |
89 | .name = "YUV 4:4:4 planar, YCbYCr", | |
90 | .pixelformat = V4L2_PIX_FMT_YUV32, | |
91 | .depth = { 32 }, | |
92 | .color = GSC_YUV444, | |
93 | .yorder = GSC_LSB_Y, | |
94 | .corder = GSC_CBCR, | |
95 | .num_planes = 1, | |
96 | .num_comp = 1, | |
97 | }, { | |
98 | .name = "YUV 4:2:2 planar, Y/Cb/Cr", | |
99 | .pixelformat = V4L2_PIX_FMT_YUV422P, | |
100 | .depth = { 16 }, | |
101 | .color = GSC_YUV422, | |
102 | .yorder = GSC_LSB_Y, | |
103 | .corder = GSC_CBCR, | |
104 | .num_planes = 1, | |
105 | .num_comp = 3, | |
106 | }, { | |
107 | .name = "YUV 4:2:2 planar, Y/CbCr", | |
108 | .pixelformat = V4L2_PIX_FMT_NV16, | |
109 | .depth = { 16 }, | |
110 | .color = GSC_YUV422, | |
111 | .yorder = GSC_LSB_Y, | |
112 | .corder = GSC_CBCR, | |
113 | .num_planes = 1, | |
114 | .num_comp = 2, | |
115 | }, { | |
116 | .name = "YUV 4:2:2 planar, Y/CrCb", | |
117 | .pixelformat = V4L2_PIX_FMT_NV61, | |
118 | .depth = { 16 }, | |
119 | .color = GSC_YUV422, | |
120 | .yorder = GSC_LSB_Y, | |
121 | .corder = GSC_CRCB, | |
122 | .num_planes = 1, | |
123 | .num_comp = 2, | |
124 | }, { | |
125 | .name = "YUV 4:2:0 planar, YCbCr", | |
126 | .pixelformat = V4L2_PIX_FMT_YUV420, | |
127 | .depth = { 12 }, | |
128 | .color = GSC_YUV420, | |
129 | .yorder = GSC_LSB_Y, | |
130 | .corder = GSC_CBCR, | |
131 | .num_planes = 1, | |
132 | .num_comp = 3, | |
133 | }, { | |
134 | .name = "YUV 4:2:0 planar, YCrCb", | |
135 | .pixelformat = V4L2_PIX_FMT_YVU420, | |
136 | .depth = { 12 }, | |
137 | .color = GSC_YUV420, | |
138 | .yorder = GSC_LSB_Y, | |
139 | .corder = GSC_CRCB, | |
140 | .num_planes = 1, | |
141 | .num_comp = 3, | |
142 | ||
143 | }, { | |
144 | .name = "YUV 4:2:0 planar, Y/CbCr", | |
145 | .pixelformat = V4L2_PIX_FMT_NV12, | |
146 | .depth = { 12 }, | |
147 | .color = GSC_YUV420, | |
148 | .yorder = GSC_LSB_Y, | |
149 | .corder = GSC_CBCR, | |
150 | .num_planes = 1, | |
151 | .num_comp = 2, | |
152 | }, { | |
153 | .name = "YUV 4:2:0 planar, Y/CrCb", | |
154 | .pixelformat = V4L2_PIX_FMT_NV21, | |
155 | .depth = { 12 }, | |
156 | .color = GSC_YUV420, | |
157 | .yorder = GSC_LSB_Y, | |
158 | .corder = GSC_CRCB, | |
159 | .num_planes = 1, | |
160 | .num_comp = 2, | |
161 | }, { | |
162 | .name = "YUV 4:2:0 non-contig. 2p, Y/CbCr", | |
163 | .pixelformat = V4L2_PIX_FMT_NV12M, | |
164 | .depth = { 8, 4 }, | |
165 | .color = GSC_YUV420, | |
166 | .yorder = GSC_LSB_Y, | |
167 | .corder = GSC_CBCR, | |
168 | .num_planes = 2, | |
169 | .num_comp = 2, | |
170 | }, { | |
171 | .name = "YUV 4:2:0 non-contig. 3p, Y/Cb/Cr", | |
172 | .pixelformat = V4L2_PIX_FMT_YUV420M, | |
173 | .depth = { 8, 2, 2 }, | |
174 | .color = GSC_YUV420, | |
175 | .yorder = GSC_LSB_Y, | |
176 | .corder = GSC_CBCR, | |
177 | .num_planes = 3, | |
178 | .num_comp = 3, | |
179 | }, { | |
180 | .name = "YUV 4:2:0 non-contig. 3p, Y/Cr/Cb", | |
181 | .pixelformat = V4L2_PIX_FMT_YVU420M, | |
182 | .depth = { 8, 2, 2 }, | |
183 | .color = GSC_YUV420, | |
184 | .yorder = GSC_LSB_Y, | |
185 | .corder = GSC_CRCB, | |
186 | .num_planes = 3, | |
187 | .num_comp = 3, | |
aecede4c SAB |
188 | }, { |
189 | .name = "YUV 4:2:0 n.c. 2p, Y/CbCr tiled", | |
190 | .pixelformat = V4L2_PIX_FMT_NV12MT_16X16, | |
191 | .depth = { 8, 4 }, | |
192 | .color = GSC_YUV420, | |
193 | .yorder = GSC_LSB_Y, | |
194 | .corder = GSC_CBCR, | |
195 | .num_planes = 2, | |
196 | .num_comp = 2, | |
89069699 SK |
197 | } |
198 | }; | |
199 | ||
200 | const struct gsc_fmt *get_format(int index) | |
201 | { | |
202 | if (index >= ARRAY_SIZE(gsc_formats)) | |
203 | return NULL; | |
204 | ||
205 | return (struct gsc_fmt *)&gsc_formats[index]; | |
206 | } | |
207 | ||
208 | const struct gsc_fmt *find_fmt(u32 *pixelformat, u32 *mbus_code, u32 index) | |
209 | { | |
210 | const struct gsc_fmt *fmt, *def_fmt = NULL; | |
211 | unsigned int i; | |
212 | ||
213 | if (index >= ARRAY_SIZE(gsc_formats)) | |
214 | return NULL; | |
215 | ||
216 | for (i = 0; i < ARRAY_SIZE(gsc_formats); ++i) { | |
217 | fmt = get_format(i); | |
218 | if (pixelformat && fmt->pixelformat == *pixelformat) | |
219 | return fmt; | |
220 | if (mbus_code && fmt->mbus_code == *mbus_code) | |
221 | return fmt; | |
222 | if (index == i) | |
223 | def_fmt = fmt; | |
224 | } | |
225 | return def_fmt; | |
226 | ||
227 | } | |
228 | ||
229 | void gsc_set_frame_size(struct gsc_frame *frame, int width, int height) | |
230 | { | |
231 | frame->f_width = width; | |
232 | frame->f_height = height; | |
233 | frame->crop.width = width; | |
234 | frame->crop.height = height; | |
235 | frame->crop.left = 0; | |
236 | frame->crop.top = 0; | |
237 | } | |
238 | ||
239 | int gsc_cal_prescaler_ratio(struct gsc_variant *var, u32 src, u32 dst, | |
240 | u32 *ratio) | |
241 | { | |
242 | if ((dst > src) || (dst >= src / var->poly_sc_down_max)) { | |
243 | *ratio = 1; | |
244 | return 0; | |
245 | } | |
246 | ||
247 | if ((src / var->poly_sc_down_max / var->pre_sc_down_max) > dst) { | |
248 | pr_err("Exceeded maximum downscaling ratio (1/16))"); | |
249 | return -EINVAL; | |
250 | } | |
251 | ||
252 | *ratio = (dst > (src / 8)) ? 2 : 4; | |
253 | ||
254 | return 0; | |
255 | } | |
256 | ||
257 | void gsc_get_prescaler_shfactor(u32 hratio, u32 vratio, u32 *sh) | |
258 | { | |
259 | if (hratio == 4 && vratio == 4) | |
260 | *sh = 4; | |
261 | else if ((hratio == 4 && vratio == 2) || | |
262 | (hratio == 2 && vratio == 4)) | |
263 | *sh = 3; | |
264 | else if ((hratio == 4 && vratio == 1) || | |
265 | (hratio == 1 && vratio == 4) || | |
266 | (hratio == 2 && vratio == 2)) | |
267 | *sh = 2; | |
268 | else if (hratio == 1 && vratio == 1) | |
269 | *sh = 0; | |
270 | else | |
271 | *sh = 1; | |
272 | } | |
273 | ||
274 | void gsc_check_src_scale_info(struct gsc_variant *var, | |
275 | struct gsc_frame *s_frame, u32 *wratio, | |
276 | u32 tx, u32 ty, u32 *hratio) | |
277 | { | |
278 | int remainder = 0, walign, halign; | |
279 | ||
280 | if (is_yuv420(s_frame->fmt->color)) { | |
281 | walign = GSC_SC_ALIGN_4; | |
282 | halign = GSC_SC_ALIGN_4; | |
283 | } else if (is_yuv422(s_frame->fmt->color)) { | |
284 | walign = GSC_SC_ALIGN_4; | |
285 | halign = GSC_SC_ALIGN_2; | |
286 | } else { | |
287 | walign = GSC_SC_ALIGN_2; | |
288 | halign = GSC_SC_ALIGN_2; | |
289 | } | |
290 | ||
291 | remainder = s_frame->crop.width % (*wratio * walign); | |
292 | if (remainder) { | |
293 | s_frame->crop.width -= remainder; | |
294 | gsc_cal_prescaler_ratio(var, s_frame->crop.width, tx, wratio); | |
295 | pr_info("cropped src width size is recalculated from %d to %d", | |
296 | s_frame->crop.width + remainder, s_frame->crop.width); | |
297 | } | |
298 | ||
299 | remainder = s_frame->crop.height % (*hratio * halign); | |
300 | if (remainder) { | |
301 | s_frame->crop.height -= remainder; | |
302 | gsc_cal_prescaler_ratio(var, s_frame->crop.height, ty, hratio); | |
303 | pr_info("cropped src height size is recalculated from %d to %d", | |
304 | s_frame->crop.height + remainder, s_frame->crop.height); | |
305 | } | |
306 | } | |
307 | ||
308 | int gsc_enum_fmt_mplane(struct v4l2_fmtdesc *f) | |
309 | { | |
310 | const struct gsc_fmt *fmt; | |
311 | ||
312 | fmt = find_fmt(NULL, NULL, f->index); | |
313 | if (!fmt) | |
314 | return -EINVAL; | |
315 | ||
316 | strlcpy(f->description, fmt->name, sizeof(f->description)); | |
317 | f->pixelformat = fmt->pixelformat; | |
318 | ||
319 | return 0; | |
320 | } | |
321 | ||
32af858c | 322 | static int get_plane_info(struct gsc_frame *frm, u32 addr, u32 *index, u32 *ret_addr) |
89069699 SK |
323 | { |
324 | if (frm->addr.y == addr) { | |
325 | *index = 0; | |
32af858c | 326 | *ret_addr = frm->addr.y; |
89069699 SK |
327 | } else if (frm->addr.cb == addr) { |
328 | *index = 1; | |
32af858c | 329 | *ret_addr = frm->addr.cb; |
89069699 SK |
330 | } else if (frm->addr.cr == addr) { |
331 | *index = 2; | |
32af858c | 332 | *ret_addr = frm->addr.cr; |
89069699 SK |
333 | } else { |
334 | pr_err("Plane address is wrong"); | |
335 | return -EINVAL; | |
336 | } | |
32af858c | 337 | return 0; |
89069699 SK |
338 | } |
339 | ||
340 | void gsc_set_prefbuf(struct gsc_dev *gsc, struct gsc_frame *frm) | |
341 | { | |
342 | u32 f_chk_addr, f_chk_len, s_chk_addr, s_chk_len; | |
343 | f_chk_addr = f_chk_len = s_chk_addr = s_chk_len = 0; | |
344 | ||
345 | f_chk_addr = frm->addr.y; | |
346 | f_chk_len = frm->payload[0]; | |
347 | if (frm->fmt->num_planes == 2) { | |
348 | s_chk_addr = frm->addr.cb; | |
349 | s_chk_len = frm->payload[1]; | |
350 | } else if (frm->fmt->num_planes == 3) { | |
351 | u32 low_addr, low_plane, mid_addr, mid_plane; | |
352 | u32 high_addr, high_plane; | |
353 | u32 t_min, t_max; | |
354 | ||
355 | t_min = min3(frm->addr.y, frm->addr.cb, frm->addr.cr); | |
32af858c MCC |
356 | if (get_plane_info(frm, t_min, &low_plane, &low_addr)) |
357 | return; | |
89069699 | 358 | t_max = max3(frm->addr.y, frm->addr.cb, frm->addr.cr); |
32af858c MCC |
359 | if (get_plane_info(frm, t_max, &high_plane, &high_addr)) |
360 | return; | |
89069699 SK |
361 | |
362 | mid_plane = 3 - (low_plane + high_plane); | |
363 | if (mid_plane == 0) | |
364 | mid_addr = frm->addr.y; | |
365 | else if (mid_plane == 1) | |
366 | mid_addr = frm->addr.cb; | |
367 | else if (mid_plane == 2) | |
368 | mid_addr = frm->addr.cr; | |
369 | else | |
370 | return; | |
371 | ||
372 | f_chk_addr = low_addr; | |
373 | if (mid_addr + frm->payload[mid_plane] - low_addr > | |
374 | high_addr + frm->payload[high_plane] - mid_addr) { | |
375 | f_chk_len = frm->payload[low_plane]; | |
376 | s_chk_addr = mid_addr; | |
377 | s_chk_len = high_addr + | |
378 | frm->payload[high_plane] - mid_addr; | |
379 | } else { | |
380 | f_chk_len = mid_addr + | |
381 | frm->payload[mid_plane] - low_addr; | |
382 | s_chk_addr = high_addr; | |
383 | s_chk_len = frm->payload[high_plane]; | |
384 | } | |
385 | } | |
386 | pr_debug("f_addr = 0x%08x, f_len = %d, s_addr = 0x%08x, s_len = %d\n", | |
387 | f_chk_addr, f_chk_len, s_chk_addr, s_chk_len); | |
388 | } | |
389 | ||
390 | int gsc_try_fmt_mplane(struct gsc_ctx *ctx, struct v4l2_format *f) | |
391 | { | |
392 | struct gsc_dev *gsc = ctx->gsc_dev; | |
393 | struct gsc_variant *variant = gsc->variant; | |
394 | struct v4l2_pix_format_mplane *pix_mp = &f->fmt.pix_mp; | |
395 | const struct gsc_fmt *fmt; | |
396 | u32 max_w, max_h, mod_x, mod_y; | |
397 | u32 min_w, min_h, tmp_w, tmp_h; | |
398 | int i; | |
399 | ||
400 | pr_debug("user put w: %d, h: %d", pix_mp->width, pix_mp->height); | |
401 | ||
402 | fmt = find_fmt(&pix_mp->pixelformat, NULL, 0); | |
403 | if (!fmt) { | |
404 | pr_err("pixelformat format (0x%X) invalid\n", | |
405 | pix_mp->pixelformat); | |
406 | return -EINVAL; | |
407 | } | |
408 | ||
409 | if (pix_mp->field == V4L2_FIELD_ANY) | |
410 | pix_mp->field = V4L2_FIELD_NONE; | |
411 | else if (pix_mp->field != V4L2_FIELD_NONE) { | |
412 | pr_err("Not supported field order(%d)\n", pix_mp->field); | |
413 | return -EINVAL; | |
414 | } | |
415 | ||
416 | max_w = variant->pix_max->target_rot_dis_w; | |
417 | max_h = variant->pix_max->target_rot_dis_h; | |
418 | ||
419 | mod_x = ffs(variant->pix_align->org_w) - 1; | |
420 | if (is_yuv420(fmt->color)) | |
421 | mod_y = ffs(variant->pix_align->org_h) - 1; | |
422 | else | |
423 | mod_y = ffs(variant->pix_align->org_h) - 2; | |
424 | ||
425 | if (V4L2_TYPE_IS_OUTPUT(f->type)) { | |
426 | min_w = variant->pix_min->org_w; | |
427 | min_h = variant->pix_min->org_h; | |
428 | } else { | |
429 | min_w = variant->pix_min->target_rot_dis_w; | |
430 | min_h = variant->pix_min->target_rot_dis_h; | |
431 | } | |
432 | ||
433 | pr_debug("mod_x: %d, mod_y: %d, max_w: %d, max_h = %d", | |
434 | mod_x, mod_y, max_w, max_h); | |
435 | ||
436 | /* To check if image size is modified to adjust parameter against | |
437 | hardware abilities */ | |
438 | tmp_w = pix_mp->width; | |
439 | tmp_h = pix_mp->height; | |
440 | ||
441 | v4l_bound_align_image(&pix_mp->width, min_w, max_w, mod_x, | |
442 | &pix_mp->height, min_h, max_h, mod_y, 0); | |
443 | if (tmp_w != pix_mp->width || tmp_h != pix_mp->height) | |
444 | pr_info("Image size has been modified from %dx%d to %dx%d", | |
445 | tmp_w, tmp_h, pix_mp->width, pix_mp->height); | |
446 | ||
447 | pix_mp->num_planes = fmt->num_planes; | |
448 | ||
449 | if (pix_mp->width >= 1280) /* HD */ | |
450 | pix_mp->colorspace = V4L2_COLORSPACE_REC709; | |
451 | else /* SD */ | |
452 | pix_mp->colorspace = V4L2_COLORSPACE_SMPTE170M; | |
453 | ||
454 | ||
455 | for (i = 0; i < pix_mp->num_planes; ++i) { | |
456 | int bpl = (pix_mp->width * fmt->depth[i]) >> 3; | |
457 | pix_mp->plane_fmt[i].bytesperline = bpl; | |
458 | pix_mp->plane_fmt[i].sizeimage = bpl * pix_mp->height; | |
459 | ||
460 | pr_debug("[%d]: bpl: %d, sizeimage: %d", | |
461 | i, bpl, pix_mp->plane_fmt[i].sizeimage); | |
462 | } | |
463 | ||
464 | return 0; | |
465 | } | |
466 | ||
467 | int gsc_g_fmt_mplane(struct gsc_ctx *ctx, struct v4l2_format *f) | |
468 | { | |
469 | struct gsc_frame *frame; | |
470 | struct v4l2_pix_format_mplane *pix_mp; | |
471 | int i; | |
472 | ||
473 | frame = ctx_get_frame(ctx, f->type); | |
474 | if (IS_ERR(frame)) | |
475 | return PTR_ERR(frame); | |
476 | ||
477 | pix_mp = &f->fmt.pix_mp; | |
478 | ||
479 | pix_mp->width = frame->f_width; | |
480 | pix_mp->height = frame->f_height; | |
481 | pix_mp->field = V4L2_FIELD_NONE; | |
482 | pix_mp->pixelformat = frame->fmt->pixelformat; | |
483 | pix_mp->colorspace = V4L2_COLORSPACE_REC709; | |
484 | pix_mp->num_planes = frame->fmt->num_planes; | |
485 | ||
486 | for (i = 0; i < pix_mp->num_planes; ++i) { | |
487 | pix_mp->plane_fmt[i].bytesperline = (frame->f_width * | |
488 | frame->fmt->depth[i]) / 8; | |
489 | pix_mp->plane_fmt[i].sizeimage = | |
490 | pix_mp->plane_fmt[i].bytesperline * frame->f_height; | |
491 | } | |
492 | ||
493 | return 0; | |
494 | } | |
495 | ||
496 | void gsc_check_crop_change(u32 tmp_w, u32 tmp_h, u32 *w, u32 *h) | |
497 | { | |
498 | if (tmp_w != *w || tmp_h != *h) { | |
499 | pr_info("Cropped size has been modified from %dx%d to %dx%d", | |
500 | *w, *h, tmp_w, tmp_h); | |
501 | *w = tmp_w; | |
502 | *h = tmp_h; | |
503 | } | |
504 | } | |
505 | ||
506 | int gsc_g_crop(struct gsc_ctx *ctx, struct v4l2_crop *cr) | |
507 | { | |
508 | struct gsc_frame *frame; | |
509 | ||
510 | frame = ctx_get_frame(ctx, cr->type); | |
511 | if (IS_ERR(frame)) | |
512 | return PTR_ERR(frame); | |
513 | ||
514 | cr->c = frame->crop; | |
515 | ||
516 | return 0; | |
517 | } | |
518 | ||
519 | int gsc_try_crop(struct gsc_ctx *ctx, struct v4l2_crop *cr) | |
520 | { | |
521 | struct gsc_frame *f; | |
522 | struct gsc_dev *gsc = ctx->gsc_dev; | |
523 | struct gsc_variant *variant = gsc->variant; | |
524 | u32 mod_x = 0, mod_y = 0, tmp_w, tmp_h; | |
525 | u32 min_w, min_h, max_w, max_h; | |
526 | ||
527 | if (cr->c.top < 0 || cr->c.left < 0) { | |
528 | pr_err("doesn't support negative values for top & left\n"); | |
529 | return -EINVAL; | |
530 | } | |
531 | pr_debug("user put w: %d, h: %d", cr->c.width, cr->c.height); | |
532 | ||
533 | if (cr->type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE) | |
534 | f = &ctx->d_frame; | |
535 | else if (cr->type == V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE) | |
536 | f = &ctx->s_frame; | |
537 | else | |
538 | return -EINVAL; | |
539 | ||
540 | max_w = f->f_width; | |
541 | max_h = f->f_height; | |
542 | tmp_w = cr->c.width; | |
543 | tmp_h = cr->c.height; | |
544 | ||
545 | if (V4L2_TYPE_IS_OUTPUT(cr->type)) { | |
546 | if ((is_yuv422(f->fmt->color) && f->fmt->num_comp == 1) || | |
547 | is_rgb(f->fmt->color)) | |
548 | min_w = 32; | |
549 | else | |
550 | min_w = 64; | |
551 | if ((is_yuv422(f->fmt->color) && f->fmt->num_comp == 3) || | |
552 | is_yuv420(f->fmt->color)) | |
553 | min_h = 32; | |
554 | else | |
555 | min_h = 16; | |
556 | } else { | |
557 | if (is_yuv420(f->fmt->color) || is_yuv422(f->fmt->color)) | |
558 | mod_x = ffs(variant->pix_align->target_w) - 1; | |
559 | if (is_yuv420(f->fmt->color)) | |
560 | mod_y = ffs(variant->pix_align->target_h) - 1; | |
561 | if (ctx->gsc_ctrls.rotate->val == 90 || | |
562 | ctx->gsc_ctrls.rotate->val == 270) { | |
563 | max_w = f->f_height; | |
564 | max_h = f->f_width; | |
565 | min_w = variant->pix_min->target_rot_en_w; | |
566 | min_h = variant->pix_min->target_rot_en_h; | |
567 | tmp_w = cr->c.height; | |
568 | tmp_h = cr->c.width; | |
569 | } else { | |
570 | min_w = variant->pix_min->target_rot_dis_w; | |
571 | min_h = variant->pix_min->target_rot_dis_h; | |
572 | } | |
573 | } | |
574 | pr_debug("mod_x: %d, mod_y: %d, min_w: %d, min_h = %d", | |
575 | mod_x, mod_y, min_w, min_h); | |
576 | pr_debug("tmp_w : %d, tmp_h : %d", tmp_w, tmp_h); | |
577 | ||
578 | v4l_bound_align_image(&tmp_w, min_w, max_w, mod_x, | |
579 | &tmp_h, min_h, max_h, mod_y, 0); | |
580 | ||
581 | if (!V4L2_TYPE_IS_OUTPUT(cr->type) && | |
582 | (ctx->gsc_ctrls.rotate->val == 90 || | |
583 | ctx->gsc_ctrls.rotate->val == 270)) | |
584 | gsc_check_crop_change(tmp_h, tmp_w, | |
585 | &cr->c.width, &cr->c.height); | |
586 | else | |
587 | gsc_check_crop_change(tmp_w, tmp_h, | |
588 | &cr->c.width, &cr->c.height); | |
589 | ||
590 | ||
591 | /* adjust left/top if cropping rectangle is out of bounds */ | |
592 | /* Need to add code to algin left value with 2's multiple */ | |
593 | if (cr->c.left + tmp_w > max_w) | |
594 | cr->c.left = max_w - tmp_w; | |
595 | if (cr->c.top + tmp_h > max_h) | |
596 | cr->c.top = max_h - tmp_h; | |
597 | ||
598 | if ((is_yuv420(f->fmt->color) || is_yuv422(f->fmt->color)) && | |
599 | cr->c.left & 1) | |
600 | cr->c.left -= 1; | |
601 | ||
602 | pr_debug("Aligned l:%d, t:%d, w:%d, h:%d, f_w: %d, f_h: %d", | |
603 | cr->c.left, cr->c.top, cr->c.width, cr->c.height, max_w, max_h); | |
604 | ||
605 | return 0; | |
606 | } | |
607 | ||
608 | int gsc_check_scaler_ratio(struct gsc_variant *var, int sw, int sh, int dw, | |
609 | int dh, int rot, int out_path) | |
610 | { | |
611 | int tmp_w, tmp_h, sc_down_max; | |
612 | ||
613 | if (out_path == GSC_DMA) | |
614 | sc_down_max = var->sc_down_max; | |
615 | else | |
616 | sc_down_max = var->local_sc_down; | |
617 | ||
618 | if (rot == 90 || rot == 270) { | |
619 | tmp_w = dh; | |
620 | tmp_h = dw; | |
621 | } else { | |
622 | tmp_w = dw; | |
623 | tmp_h = dh; | |
624 | } | |
625 | ||
626 | if ((sw / tmp_w) > sc_down_max || | |
627 | (sh / tmp_h) > sc_down_max || | |
628 | (tmp_w / sw) > var->sc_up_max || | |
629 | (tmp_h / sh) > var->sc_up_max) | |
630 | return -EINVAL; | |
631 | ||
632 | return 0; | |
633 | } | |
634 | ||
635 | int gsc_set_scaler_info(struct gsc_ctx *ctx) | |
636 | { | |
637 | struct gsc_scaler *sc = &ctx->scaler; | |
638 | struct gsc_frame *s_frame = &ctx->s_frame; | |
639 | struct gsc_frame *d_frame = &ctx->d_frame; | |
640 | struct gsc_variant *variant = ctx->gsc_dev->variant; | |
641 | struct device *dev = &ctx->gsc_dev->pdev->dev; | |
642 | int tx, ty; | |
643 | int ret; | |
644 | ||
645 | ret = gsc_check_scaler_ratio(variant, s_frame->crop.width, | |
646 | s_frame->crop.height, d_frame->crop.width, d_frame->crop.height, | |
647 | ctx->gsc_ctrls.rotate->val, ctx->out_path); | |
648 | if (ret) { | |
649 | pr_err("out of scaler range"); | |
650 | return ret; | |
651 | } | |
652 | ||
653 | if (ctx->gsc_ctrls.rotate->val == 90 || | |
654 | ctx->gsc_ctrls.rotate->val == 270) { | |
655 | ty = d_frame->crop.width; | |
656 | tx = d_frame->crop.height; | |
657 | } else { | |
658 | tx = d_frame->crop.width; | |
659 | ty = d_frame->crop.height; | |
660 | } | |
661 | ||
662 | if (tx <= 0 || ty <= 0) { | |
663 | dev_err(dev, "Invalid target size: %dx%d", tx, ty); | |
664 | return -EINVAL; | |
665 | } | |
666 | ||
667 | ret = gsc_cal_prescaler_ratio(variant, s_frame->crop.width, | |
668 | tx, &sc->pre_hratio); | |
669 | if (ret) { | |
670 | pr_err("Horizontal scale ratio is out of range"); | |
671 | return ret; | |
672 | } | |
673 | ||
674 | ret = gsc_cal_prescaler_ratio(variant, s_frame->crop.height, | |
675 | ty, &sc->pre_vratio); | |
676 | if (ret) { | |
677 | pr_err("Vertical scale ratio is out of range"); | |
678 | return ret; | |
679 | } | |
680 | ||
681 | gsc_check_src_scale_info(variant, s_frame, &sc->pre_hratio, | |
682 | tx, ty, &sc->pre_vratio); | |
683 | ||
684 | gsc_get_prescaler_shfactor(sc->pre_hratio, sc->pre_vratio, | |
685 | &sc->pre_shfactor); | |
686 | ||
687 | sc->main_hratio = (s_frame->crop.width << 16) / tx; | |
688 | sc->main_vratio = (s_frame->crop.height << 16) / ty; | |
689 | ||
690 | pr_debug("scaler input/output size : sx = %d, sy = %d, tx = %d, ty = %d", | |
691 | s_frame->crop.width, s_frame->crop.height, tx, ty); | |
692 | pr_debug("scaler ratio info : pre_shfactor : %d, pre_h : %d", | |
693 | sc->pre_shfactor, sc->pre_hratio); | |
694 | pr_debug("pre_v :%d, main_h : %d, main_v : %d", | |
695 | sc->pre_vratio, sc->main_hratio, sc->main_vratio); | |
696 | ||
697 | return 0; | |
698 | } | |
699 | ||
700 | static int __gsc_s_ctrl(struct gsc_ctx *ctx, struct v4l2_ctrl *ctrl) | |
701 | { | |
702 | struct gsc_dev *gsc = ctx->gsc_dev; | |
703 | struct gsc_variant *variant = gsc->variant; | |
704 | unsigned int flags = GSC_DST_FMT | GSC_SRC_FMT; | |
705 | int ret = 0; | |
706 | ||
707 | if (ctrl->flags & V4L2_CTRL_FLAG_INACTIVE) | |
708 | return 0; | |
709 | ||
710 | switch (ctrl->id) { | |
711 | case V4L2_CID_HFLIP: | |
712 | ctx->hflip = ctrl->val; | |
713 | break; | |
714 | ||
715 | case V4L2_CID_VFLIP: | |
716 | ctx->vflip = ctrl->val; | |
717 | break; | |
718 | ||
719 | case V4L2_CID_ROTATE: | |
720 | if ((ctx->state & flags) == flags) { | |
721 | ret = gsc_check_scaler_ratio(variant, | |
722 | ctx->s_frame.crop.width, | |
723 | ctx->s_frame.crop.height, | |
724 | ctx->d_frame.crop.width, | |
725 | ctx->d_frame.crop.height, | |
726 | ctx->gsc_ctrls.rotate->val, | |
727 | ctx->out_path); | |
728 | ||
729 | if (ret) | |
730 | return -EINVAL; | |
731 | } | |
732 | ||
733 | ctx->rotation = ctrl->val; | |
734 | break; | |
735 | ||
736 | case V4L2_CID_ALPHA_COMPONENT: | |
737 | ctx->d_frame.alpha = ctrl->val; | |
738 | break; | |
739 | } | |
740 | ||
741 | ctx->state |= GSC_PARAMS; | |
742 | return 0; | |
743 | } | |
744 | ||
745 | static int gsc_s_ctrl(struct v4l2_ctrl *ctrl) | |
746 | { | |
747 | struct gsc_ctx *ctx = ctrl_to_ctx(ctrl); | |
748 | unsigned long flags; | |
749 | int ret; | |
750 | ||
751 | spin_lock_irqsave(&ctx->gsc_dev->slock, flags); | |
752 | ret = __gsc_s_ctrl(ctx, ctrl); | |
753 | spin_unlock_irqrestore(&ctx->gsc_dev->slock, flags); | |
754 | ||
755 | return ret; | |
756 | } | |
757 | ||
d2331c99 | 758 | static const struct v4l2_ctrl_ops gsc_ctrl_ops = { |
89069699 SK |
759 | .s_ctrl = gsc_s_ctrl, |
760 | }; | |
761 | ||
762 | int gsc_ctrls_create(struct gsc_ctx *ctx) | |
763 | { | |
764 | if (ctx->ctrls_rdy) { | |
765 | pr_err("Control handler of this context was created already"); | |
766 | return 0; | |
767 | } | |
768 | ||
769 | v4l2_ctrl_handler_init(&ctx->ctrl_handler, GSC_MAX_CTRL_NUM); | |
770 | ||
771 | ctx->gsc_ctrls.rotate = v4l2_ctrl_new_std(&ctx->ctrl_handler, | |
772 | &gsc_ctrl_ops, V4L2_CID_ROTATE, 0, 270, 90, 0); | |
773 | ctx->gsc_ctrls.hflip = v4l2_ctrl_new_std(&ctx->ctrl_handler, | |
774 | &gsc_ctrl_ops, V4L2_CID_HFLIP, 0, 1, 1, 0); | |
775 | ctx->gsc_ctrls.vflip = v4l2_ctrl_new_std(&ctx->ctrl_handler, | |
776 | &gsc_ctrl_ops, V4L2_CID_VFLIP, 0, 1, 1, 0); | |
777 | ctx->gsc_ctrls.global_alpha = v4l2_ctrl_new_std(&ctx->ctrl_handler, | |
778 | &gsc_ctrl_ops, V4L2_CID_ALPHA_COMPONENT, 0, 255, 1, 0); | |
779 | ||
780 | ctx->ctrls_rdy = ctx->ctrl_handler.error == 0; | |
781 | ||
782 | if (ctx->ctrl_handler.error) { | |
783 | int err = ctx->ctrl_handler.error; | |
784 | v4l2_ctrl_handler_free(&ctx->ctrl_handler); | |
785 | pr_err("Failed to create G-Scaler control handlers"); | |
786 | return err; | |
787 | } | |
788 | ||
789 | return 0; | |
790 | } | |
791 | ||
792 | void gsc_ctrls_delete(struct gsc_ctx *ctx) | |
793 | { | |
794 | if (ctx->ctrls_rdy) { | |
795 | v4l2_ctrl_handler_free(&ctx->ctrl_handler); | |
796 | ctx->ctrls_rdy = false; | |
797 | } | |
798 | } | |
799 | ||
800 | /* The color format (num_comp, num_planes) must be already configured. */ | |
801 | int gsc_prepare_addr(struct gsc_ctx *ctx, struct vb2_buffer *vb, | |
802 | struct gsc_frame *frame, struct gsc_addr *addr) | |
803 | { | |
804 | int ret = 0; | |
805 | u32 pix_size; | |
806 | ||
807 | if ((vb == NULL) || (frame == NULL)) | |
808 | return -EINVAL; | |
809 | ||
810 | pix_size = frame->f_width * frame->f_height; | |
811 | ||
812 | pr_debug("num_planes= %d, num_comp= %d, pix_size= %d", | |
813 | frame->fmt->num_planes, frame->fmt->num_comp, pix_size); | |
814 | ||
815 | addr->y = vb2_dma_contig_plane_dma_addr(vb, 0); | |
816 | ||
817 | if (frame->fmt->num_planes == 1) { | |
818 | switch (frame->fmt->num_comp) { | |
819 | case 1: | |
820 | addr->cb = 0; | |
821 | addr->cr = 0; | |
822 | break; | |
823 | case 2: | |
824 | /* decompose Y into Y/Cb */ | |
825 | addr->cb = (dma_addr_t)(addr->y + pix_size); | |
826 | addr->cr = 0; | |
827 | break; | |
828 | case 3: | |
829 | /* decompose Y into Y/Cb/Cr */ | |
830 | addr->cb = (dma_addr_t)(addr->y + pix_size); | |
831 | if (GSC_YUV420 == frame->fmt->color) | |
832 | addr->cr = (dma_addr_t)(addr->cb | |
833 | + (pix_size >> 2)); | |
834 | else /* 422 */ | |
835 | addr->cr = (dma_addr_t)(addr->cb | |
836 | + (pix_size >> 1)); | |
837 | break; | |
838 | default: | |
839 | pr_err("Invalid the number of color planes"); | |
840 | return -EINVAL; | |
841 | } | |
842 | } else { | |
843 | if (frame->fmt->num_planes >= 2) | |
844 | addr->cb = vb2_dma_contig_plane_dma_addr(vb, 1); | |
845 | ||
846 | if (frame->fmt->num_planes == 3) | |
847 | addr->cr = vb2_dma_contig_plane_dma_addr(vb, 2); | |
848 | } | |
849 | ||
850 | if ((frame->fmt->pixelformat == V4L2_PIX_FMT_VYUY) || | |
851 | (frame->fmt->pixelformat == V4L2_PIX_FMT_YVYU) || | |
852 | (frame->fmt->pixelformat == V4L2_PIX_FMT_NV61) || | |
853 | (frame->fmt->pixelformat == V4L2_PIX_FMT_YVU420) || | |
854 | (frame->fmt->pixelformat == V4L2_PIX_FMT_NV21) || | |
855 | (frame->fmt->pixelformat == V4L2_PIX_FMT_YVU420M)) | |
856 | swap(addr->cb, addr->cr); | |
857 | ||
286da990 MCC |
858 | pr_debug("ADDR: y= %pad cb= %pad cr= %pad ret= %d", |
859 | &addr->y, &addr->cb, &addr->cr, ret); | |
89069699 SK |
860 | |
861 | return ret; | |
862 | } | |
863 | ||
864 | static irqreturn_t gsc_irq_handler(int irq, void *priv) | |
865 | { | |
866 | struct gsc_dev *gsc = priv; | |
867 | struct gsc_ctx *ctx; | |
868 | int gsc_irq; | |
869 | ||
870 | gsc_irq = gsc_hw_get_irq_status(gsc); | |
871 | gsc_hw_clear_irq(gsc, gsc_irq); | |
872 | ||
873 | if (gsc_irq == GSC_IRQ_OVERRUN) { | |
874 | pr_err("Local path input over-run interrupt has occurred!\n"); | |
875 | return IRQ_HANDLED; | |
876 | } | |
877 | ||
878 | spin_lock(&gsc->slock); | |
879 | ||
880 | if (test_and_clear_bit(ST_M2M_PEND, &gsc->state)) { | |
881 | ||
882 | gsc_hw_enable_control(gsc, false); | |
883 | ||
884 | if (test_and_clear_bit(ST_M2M_SUSPENDING, &gsc->state)) { | |
885 | set_bit(ST_M2M_SUSPENDED, &gsc->state); | |
886 | wake_up(&gsc->irq_queue); | |
887 | goto isr_unlock; | |
888 | } | |
889 | ctx = v4l2_m2m_get_curr_priv(gsc->m2m.m2m_dev); | |
890 | ||
891 | if (!ctx || !ctx->m2m_ctx) | |
892 | goto isr_unlock; | |
893 | ||
894 | spin_unlock(&gsc->slock); | |
895 | gsc_m2m_job_finish(ctx, VB2_BUF_STATE_DONE); | |
896 | ||
897 | /* wake_up job_abort, stop_streaming */ | |
898 | if (ctx->state & GSC_CTX_STOP_REQ) { | |
899 | ctx->state &= ~GSC_CTX_STOP_REQ; | |
900 | wake_up(&gsc->irq_queue); | |
901 | } | |
902 | return IRQ_HANDLED; | |
903 | } | |
904 | ||
905 | isr_unlock: | |
906 | spin_unlock(&gsc->slock); | |
907 | return IRQ_HANDLED; | |
908 | } | |
909 | ||
910 | static struct gsc_pix_max gsc_v_100_max = { | |
911 | .org_scaler_bypass_w = 8192, | |
912 | .org_scaler_bypass_h = 8192, | |
913 | .org_scaler_input_w = 4800, | |
914 | .org_scaler_input_h = 3344, | |
915 | .real_rot_dis_w = 4800, | |
916 | .real_rot_dis_h = 3344, | |
917 | .real_rot_en_w = 2047, | |
918 | .real_rot_en_h = 2047, | |
919 | .target_rot_dis_w = 4800, | |
920 | .target_rot_dis_h = 3344, | |
921 | .target_rot_en_w = 2016, | |
922 | .target_rot_en_h = 2016, | |
923 | }; | |
924 | ||
925 | static struct gsc_pix_min gsc_v_100_min = { | |
926 | .org_w = 64, | |
927 | .org_h = 32, | |
928 | .real_w = 64, | |
929 | .real_h = 32, | |
930 | .target_rot_dis_w = 64, | |
931 | .target_rot_dis_h = 32, | |
932 | .target_rot_en_w = 32, | |
933 | .target_rot_en_h = 16, | |
934 | }; | |
935 | ||
936 | static struct gsc_pix_align gsc_v_100_align = { | |
937 | .org_h = 16, | |
938 | .org_w = 16, /* yuv420 : 16, others : 8 */ | |
939 | .offset_h = 2, /* yuv420/422 : 2, others : 1 */ | |
940 | .real_w = 16, /* yuv420/422 : 4~16, others : 2~8 */ | |
941 | .real_h = 16, /* yuv420 : 4~16, others : 1 */ | |
942 | .target_w = 2, /* yuv420/422 : 2, others : 1 */ | |
943 | .target_h = 2, /* yuv420 : 2, others : 1 */ | |
944 | }; | |
945 | ||
946 | static struct gsc_variant gsc_v_100_variant = { | |
947 | .pix_max = &gsc_v_100_max, | |
948 | .pix_min = &gsc_v_100_min, | |
949 | .pix_align = &gsc_v_100_align, | |
1b590133 SAB |
950 | .in_buf_cnt = 32, |
951 | .out_buf_cnt = 32, | |
89069699 SK |
952 | .sc_up_max = 8, |
953 | .sc_down_max = 16, | |
954 | .poly_sc_down_max = 4, | |
955 | .pre_sc_down_max = 4, | |
956 | .local_sc_down = 2, | |
957 | }; | |
958 | ||
959 | static struct gsc_driverdata gsc_v_100_drvdata = { | |
960 | .variant = { | |
961 | [0] = &gsc_v_100_variant, | |
962 | [1] = &gsc_v_100_variant, | |
963 | [2] = &gsc_v_100_variant, | |
964 | [3] = &gsc_v_100_variant, | |
965 | }, | |
966 | .num_entities = 4, | |
967 | .lclk_frequency = 266000000UL, | |
968 | }; | |
969 | ||
89069699 | 970 | static const struct of_device_id exynos_gsc_match[] = { |
84035438 SAB |
971 | { |
972 | .compatible = "samsung,exynos5-gsc", | |
973 | .data = &gsc_v_100_drvdata, | |
974 | }, | |
89069699 SK |
975 | {}, |
976 | }; | |
977 | MODULE_DEVICE_TABLE(of, exynos_gsc_match); | |
978 | ||
979 | static void *gsc_get_drv_data(struct platform_device *pdev) | |
980 | { | |
981 | struct gsc_driverdata *driver_data = NULL; | |
c1ac0571 | 982 | const struct of_device_id *match; |
89069699 | 983 | |
c1ac0571 MS |
984 | match = of_match_node(exynos_gsc_match, pdev->dev.of_node); |
985 | if (match) | |
986 | driver_data = (struct gsc_driverdata *)match->data; | |
89069699 SK |
987 | |
988 | return driver_data; | |
989 | } | |
990 | ||
991 | static void gsc_clk_put(struct gsc_dev *gsc) | |
992 | { | |
e2732ae5 | 993 | if (!IS_ERR(gsc->clock)) |
21ae96d3 | 994 | clk_unprepare(gsc->clock); |
89069699 SK |
995 | } |
996 | ||
997 | static int gsc_clk_get(struct gsc_dev *gsc) | |
998 | { | |
999 | int ret; | |
1000 | ||
1001 | dev_dbg(&gsc->pdev->dev, "gsc_clk_get Called\n"); | |
1002 | ||
e2732ae5 | 1003 | gsc->clock = devm_clk_get(&gsc->pdev->dev, GSC_CLOCK_GATE_NAME); |
9318ab69 SK |
1004 | if (IS_ERR(gsc->clock)) { |
1005 | dev_err(&gsc->pdev->dev, "failed to get clock~~~: %s\n", | |
1006 | GSC_CLOCK_GATE_NAME); | |
e2732ae5 | 1007 | return PTR_ERR(gsc->clock); |
9318ab69 | 1008 | } |
89069699 SK |
1009 | |
1010 | ret = clk_prepare(gsc->clock); | |
1011 | if (ret < 0) { | |
9318ab69 SK |
1012 | dev_err(&gsc->pdev->dev, "clock prepare failed for clock: %s\n", |
1013 | GSC_CLOCK_GATE_NAME); | |
21ae96d3 | 1014 | gsc->clock = ERR_PTR(-EINVAL); |
e2732ae5 | 1015 | return ret; |
89069699 SK |
1016 | } |
1017 | ||
1018 | return 0; | |
89069699 SK |
1019 | } |
1020 | ||
1021 | static int gsc_m2m_suspend(struct gsc_dev *gsc) | |
1022 | { | |
1023 | unsigned long flags; | |
1024 | int timeout; | |
1025 | ||
1026 | spin_lock_irqsave(&gsc->slock, flags); | |
1027 | if (!gsc_m2m_pending(gsc)) { | |
1028 | spin_unlock_irqrestore(&gsc->slock, flags); | |
1029 | return 0; | |
1030 | } | |
1031 | clear_bit(ST_M2M_SUSPENDED, &gsc->state); | |
1032 | set_bit(ST_M2M_SUSPENDING, &gsc->state); | |
1033 | spin_unlock_irqrestore(&gsc->slock, flags); | |
1034 | ||
1035 | timeout = wait_event_timeout(gsc->irq_queue, | |
1036 | test_bit(ST_M2M_SUSPENDED, &gsc->state), | |
1037 | GSC_SHUTDOWN_TIMEOUT); | |
1038 | ||
1039 | clear_bit(ST_M2M_SUSPENDING, &gsc->state); | |
1040 | return timeout == 0 ? -EAGAIN : 0; | |
1041 | } | |
1042 | ||
1043 | static int gsc_m2m_resume(struct gsc_dev *gsc) | |
1044 | { | |
5d83790b | 1045 | struct gsc_ctx *ctx; |
89069699 SK |
1046 | unsigned long flags; |
1047 | ||
1048 | spin_lock_irqsave(&gsc->slock, flags); | |
1049 | /* Clear for full H/W setup in first run after resume */ | |
5d83790b | 1050 | ctx = gsc->m2m.ctx; |
89069699 SK |
1051 | gsc->m2m.ctx = NULL; |
1052 | spin_unlock_irqrestore(&gsc->slock, flags); | |
1053 | ||
1054 | if (test_and_clear_bit(ST_M2M_SUSPENDED, &gsc->state)) | |
5d83790b SAB |
1055 | gsc_m2m_job_finish(ctx, VB2_BUF_STATE_ERROR); |
1056 | ||
89069699 SK |
1057 | return 0; |
1058 | } | |
1059 | ||
1060 | static int gsc_probe(struct platform_device *pdev) | |
1061 | { | |
1062 | struct gsc_dev *gsc; | |
1063 | struct resource *res; | |
1064 | struct gsc_driverdata *drv_data = gsc_get_drv_data(pdev); | |
1065 | struct device *dev = &pdev->dev; | |
1066 | int ret = 0; | |
1067 | ||
1068 | gsc = devm_kzalloc(dev, sizeof(struct gsc_dev), GFP_KERNEL); | |
1069 | if (!gsc) | |
1070 | return -ENOMEM; | |
1071 | ||
c1ac0571 | 1072 | gsc->id = of_alias_get_id(pdev->dev.of_node, "gsc"); |
26a7ed9c | 1073 | if (gsc->id >= drv_data->num_entities) { |
89069699 SK |
1074 | dev_err(dev, "Invalid platform device id: %d\n", gsc->id); |
1075 | return -EINVAL; | |
1076 | } | |
1077 | ||
1078 | gsc->variant = drv_data->variant[gsc->id]; | |
1079 | gsc->pdev = pdev; | |
89069699 SK |
1080 | |
1081 | init_waitqueue_head(&gsc->irq_queue); | |
1082 | spin_lock_init(&gsc->slock); | |
1083 | mutex_init(&gsc->lock); | |
21ae96d3 | 1084 | gsc->clock = ERR_PTR(-EINVAL); |
89069699 SK |
1085 | |
1086 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
f23999ec TR |
1087 | gsc->regs = devm_ioremap_resource(dev, res); |
1088 | if (IS_ERR(gsc->regs)) | |
1089 | return PTR_ERR(gsc->regs); | |
89069699 SK |
1090 | |
1091 | res = platform_get_resource(pdev, IORESOURCE_IRQ, 0); | |
1092 | if (!res) { | |
1093 | dev_err(dev, "failed to get IRQ resource\n"); | |
1094 | return -ENXIO; | |
1095 | } | |
1096 | ||
1097 | ret = gsc_clk_get(gsc); | |
1098 | if (ret) | |
1099 | return ret; | |
1100 | ||
1101 | ret = devm_request_irq(dev, res->start, gsc_irq_handler, | |
1102 | 0, pdev->name, gsc); | |
1103 | if (ret) { | |
1104 | dev_err(dev, "failed to install irq (%d)\n", ret); | |
1105 | goto err_clk; | |
1106 | } | |
1107 | ||
d0b1c313 | 1108 | ret = v4l2_device_register(dev, &gsc->v4l2_dev); |
89069699 SK |
1109 | if (ret) |
1110 | goto err_clk; | |
1111 | ||
d0b1c313 AK |
1112 | ret = gsc_register_m2m_device(gsc); |
1113 | if (ret) | |
1114 | goto err_v4l2; | |
1115 | ||
89069699 SK |
1116 | platform_set_drvdata(pdev, gsc); |
1117 | pm_runtime_enable(dev); | |
1118 | ret = pm_runtime_get_sync(&pdev->dev); | |
1119 | if (ret < 0) | |
1120 | goto err_m2m; | |
1121 | ||
1122 | /* Initialize continious memory allocator */ | |
1123 | gsc->alloc_ctx = vb2_dma_contig_init_ctx(dev); | |
1124 | if (IS_ERR(gsc->alloc_ctx)) { | |
1125 | ret = PTR_ERR(gsc->alloc_ctx); | |
1126 | goto err_pm; | |
1127 | } | |
1128 | ||
1129 | dev_dbg(dev, "gsc-%d registered successfully\n", gsc->id); | |
1130 | ||
1131 | pm_runtime_put(dev); | |
1132 | return 0; | |
1133 | err_pm: | |
1134 | pm_runtime_put(dev); | |
1135 | err_m2m: | |
1136 | gsc_unregister_m2m_device(gsc); | |
d0b1c313 AK |
1137 | err_v4l2: |
1138 | v4l2_device_unregister(&gsc->v4l2_dev); | |
89069699 SK |
1139 | err_clk: |
1140 | gsc_clk_put(gsc); | |
1141 | return ret; | |
1142 | } | |
1143 | ||
4c62e976 | 1144 | static int gsc_remove(struct platform_device *pdev) |
89069699 SK |
1145 | { |
1146 | struct gsc_dev *gsc = platform_get_drvdata(pdev); | |
1147 | ||
1148 | gsc_unregister_m2m_device(gsc); | |
d0b1c313 | 1149 | v4l2_device_unregister(&gsc->v4l2_dev); |
89069699 SK |
1150 | |
1151 | vb2_dma_contig_cleanup_ctx(gsc->alloc_ctx); | |
1152 | pm_runtime_disable(&pdev->dev); | |
21ae96d3 | 1153 | gsc_clk_put(gsc); |
89069699 SK |
1154 | |
1155 | dev_dbg(&pdev->dev, "%s driver unloaded\n", pdev->name); | |
1156 | return 0; | |
1157 | } | |
1158 | ||
1159 | static int gsc_runtime_resume(struct device *dev) | |
1160 | { | |
1161 | struct gsc_dev *gsc = dev_get_drvdata(dev); | |
1162 | int ret = 0; | |
1163 | ||
1164 | pr_debug("gsc%d: state: 0x%lx", gsc->id, gsc->state); | |
1165 | ||
1166 | ret = clk_enable(gsc->clock); | |
1167 | if (ret) | |
1168 | return ret; | |
1169 | ||
1170 | gsc_hw_set_sw_reset(gsc); | |
1171 | gsc_wait_reset(gsc); | |
1172 | ||
1173 | return gsc_m2m_resume(gsc); | |
1174 | } | |
1175 | ||
1176 | static int gsc_runtime_suspend(struct device *dev) | |
1177 | { | |
1178 | struct gsc_dev *gsc = dev_get_drvdata(dev); | |
1179 | int ret = 0; | |
1180 | ||
1181 | ret = gsc_m2m_suspend(gsc); | |
1182 | if (!ret) | |
1183 | clk_disable(gsc->clock); | |
1184 | ||
1185 | pr_debug("gsc%d: state: 0x%lx", gsc->id, gsc->state); | |
1186 | return ret; | |
1187 | } | |
1188 | ||
1189 | static int gsc_resume(struct device *dev) | |
1190 | { | |
1191 | struct gsc_dev *gsc = dev_get_drvdata(dev); | |
1192 | unsigned long flags; | |
1193 | ||
1194 | pr_debug("gsc%d: state: 0x%lx", gsc->id, gsc->state); | |
1195 | ||
1196 | /* Do not resume if the device was idle before system suspend */ | |
1197 | spin_lock_irqsave(&gsc->slock, flags); | |
1198 | if (!test_and_clear_bit(ST_SUSPEND, &gsc->state) || | |
5d83790b | 1199 | !gsc_m2m_opened(gsc)) { |
89069699 SK |
1200 | spin_unlock_irqrestore(&gsc->slock, flags); |
1201 | return 0; | |
1202 | } | |
89069699 SK |
1203 | spin_unlock_irqrestore(&gsc->slock, flags); |
1204 | ||
f9fa906f P |
1205 | if (!pm_runtime_suspended(dev)) |
1206 | return gsc_runtime_resume(dev); | |
1207 | ||
1208 | return 0; | |
89069699 SK |
1209 | } |
1210 | ||
1211 | static int gsc_suspend(struct device *dev) | |
1212 | { | |
1213 | struct gsc_dev *gsc = dev_get_drvdata(dev); | |
1214 | ||
1215 | pr_debug("gsc%d: state: 0x%lx", gsc->id, gsc->state); | |
1216 | ||
1217 | if (test_and_set_bit(ST_SUSPEND, &gsc->state)) | |
1218 | return 0; | |
1219 | ||
f9fa906f P |
1220 | if (!pm_runtime_suspended(dev)) |
1221 | return gsc_runtime_suspend(dev); | |
1222 | ||
1223 | return 0; | |
89069699 SK |
1224 | } |
1225 | ||
1226 | static const struct dev_pm_ops gsc_pm_ops = { | |
1227 | .suspend = gsc_suspend, | |
1228 | .resume = gsc_resume, | |
1229 | .runtime_suspend = gsc_runtime_suspend, | |
1230 | .runtime_resume = gsc_runtime_resume, | |
1231 | }; | |
1232 | ||
1233 | static struct platform_driver gsc_driver = { | |
1234 | .probe = gsc_probe, | |
4c62e976 | 1235 | .remove = gsc_remove, |
89069699 SK |
1236 | .driver = { |
1237 | .name = GSC_MODULE_NAME, | |
89069699 SK |
1238 | .pm = &gsc_pm_ops, |
1239 | .of_match_table = exynos_gsc_match, | |
1240 | } | |
1241 | }; | |
1242 | ||
1243 | module_platform_driver(gsc_driver); | |
1244 | ||
1245 | MODULE_AUTHOR("Hyunwong Kim <khw0178.kim@samsung.com>"); | |
1246 | MODULE_DESCRIPTION("Samsung EXYNOS5 Soc series G-Scaler driver"); | |
1247 | MODULE_LICENSE("GPL"); |