2 * SuperH Video Output Unit (VOU) driver
4 * Copyright (C) 2010, Guennadi Liakhovetski <g.liakhovetski@gmx.de>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
11 #include <linux/dma-mapping.h>
12 #include <linux/delay.h>
13 #include <linux/errno.h>
15 #include <linux/i2c.h>
16 #include <linux/init.h>
17 #include <linux/interrupt.h>
18 #include <linux/kernel.h>
19 #include <linux/platform_device.h>
20 #include <linux/pm_runtime.h>
21 #include <linux/slab.h>
22 #include <linux/videodev2.h>
23 #include <linux/module.h>
25 #include <media/sh_vou.h>
26 #include <media/v4l2-common.h>
27 #include <media/v4l2-device.h>
28 #include <media/v4l2-ioctl.h>
29 #include <media/v4l2-mediabus.h>
30 #include <media/videobuf-dma-contig.h>
32 /* Mirror addresses are not available for all registers */
60 #define VOU_MAX_IMAGE_WIDTH 720
61 #define VOU_MAX_IMAGE_HEIGHT 576
63 struct sh_vou_device
{
64 struct v4l2_device v4l2_dev
;
65 struct video_device
*vdev
;
67 struct sh_vou_pdata
*pdata
;
70 /* State information */
71 struct v4l2_pix_format pix
;
72 struct v4l2_rect rect
;
73 struct list_head queue
;
76 struct videobuf_buffer
*active
;
77 enum sh_vou_status status
;
78 struct mutex fop_lock
;
82 struct videobuf_queue vbq
;
85 /* Register access routines for sides A, B and mirror addresses */
86 static void sh_vou_reg_a_write(struct sh_vou_device
*vou_dev
, unsigned int reg
,
89 __raw_writel(value
, vou_dev
->base
+ reg
);
92 static void sh_vou_reg_ab_write(struct sh_vou_device
*vou_dev
, unsigned int reg
,
95 __raw_writel(value
, vou_dev
->base
+ reg
);
96 __raw_writel(value
, vou_dev
->base
+ reg
+ 0x1000);
99 static void sh_vou_reg_m_write(struct sh_vou_device
*vou_dev
, unsigned int reg
,
102 __raw_writel(value
, vou_dev
->base
+ reg
+ 0x2000);
105 static u32
sh_vou_reg_a_read(struct sh_vou_device
*vou_dev
, unsigned int reg
)
107 return __raw_readl(vou_dev
->base
+ reg
);
110 static void sh_vou_reg_a_set(struct sh_vou_device
*vou_dev
, unsigned int reg
,
113 u32 old
= __raw_readl(vou_dev
->base
+ reg
);
115 value
= (value
& mask
) | (old
& ~mask
);
116 __raw_writel(value
, vou_dev
->base
+ reg
);
119 static void sh_vou_reg_b_set(struct sh_vou_device
*vou_dev
, unsigned int reg
,
122 sh_vou_reg_a_set(vou_dev
, reg
+ 0x1000, value
, mask
);
125 static void sh_vou_reg_ab_set(struct sh_vou_device
*vou_dev
, unsigned int reg
,
128 sh_vou_reg_a_set(vou_dev
, reg
, value
, mask
);
129 sh_vou_reg_b_set(vou_dev
, reg
, value
, mask
);
141 /* Further pixel formats can be added */
142 static struct sh_vou_fmt vou_fmt
[] = {
144 .pfmt
= V4L2_PIX_FMT_NV12
,
146 .desc
= "YVU420 planar",
151 .pfmt
= V4L2_PIX_FMT_NV16
,
153 .desc
= "YVYU planar",
158 .pfmt
= V4L2_PIX_FMT_RGB24
,
165 .pfmt
= V4L2_PIX_FMT_RGB565
,
172 .pfmt
= V4L2_PIX_FMT_RGB565X
,
174 .desc
= "RGB565 byteswapped",
180 static void sh_vou_schedule_next(struct sh_vou_device
*vou_dev
,
181 struct videobuf_buffer
*vb
)
183 dma_addr_t addr1
, addr2
;
185 addr1
= videobuf_to_dma_contig(vb
);
186 switch (vou_dev
->pix
.pixelformat
) {
187 case V4L2_PIX_FMT_NV12
:
188 case V4L2_PIX_FMT_NV16
:
189 addr2
= addr1
+ vou_dev
->pix
.width
* vou_dev
->pix
.height
;
195 sh_vou_reg_m_write(vou_dev
, VOUAD1R
, addr1
);
196 sh_vou_reg_m_write(vou_dev
, VOUAD2R
, addr2
);
199 static void sh_vou_stream_start(struct sh_vou_device
*vou_dev
,
200 struct videobuf_buffer
*vb
)
202 unsigned int row_coeff
;
203 #ifdef __LITTLE_ENDIAN
209 switch (vou_dev
->pix
.pixelformat
) {
210 case V4L2_PIX_FMT_NV12
:
211 case V4L2_PIX_FMT_NV16
:
214 case V4L2_PIX_FMT_RGB565
:
216 case V4L2_PIX_FMT_RGB565X
:
219 case V4L2_PIX_FMT_RGB24
:
224 sh_vou_reg_a_write(vou_dev
, VOUSWR
, dataswap
);
225 sh_vou_reg_ab_write(vou_dev
, VOUAIR
, vou_dev
->pix
.width
* row_coeff
);
226 sh_vou_schedule_next(vou_dev
, vb
);
229 static void free_buffer(struct videobuf_queue
*vq
, struct videobuf_buffer
*vb
)
231 BUG_ON(in_interrupt());
233 /* Wait until this buffer is no longer in STATE_QUEUED or STATE_ACTIVE */
234 videobuf_waiton(vq
, vb
, 0, 0);
235 videobuf_dma_contig_free(vq
, vb
);
236 vb
->state
= VIDEOBUF_NEEDS_INIT
;
239 /* Locking: caller holds fop_lock mutex */
240 static int sh_vou_buf_setup(struct videobuf_queue
*vq
, unsigned int *count
,
243 struct video_device
*vdev
= vq
->priv_data
;
244 struct sh_vou_device
*vou_dev
= video_get_drvdata(vdev
);
246 *size
= vou_fmt
[vou_dev
->pix_idx
].bpp
* vou_dev
->pix
.width
*
247 vou_dev
->pix
.height
/ 8;
252 /* Taking into account maximum frame size, *count will stay >= 2 */
253 if (PAGE_ALIGN(*size
) * *count
> 4 * 1024 * 1024)
254 *count
= 4 * 1024 * 1024 / PAGE_ALIGN(*size
);
256 dev_dbg(vq
->dev
, "%s(): count=%d, size=%d\n", __func__
, *count
, *size
);
261 /* Locking: caller holds fop_lock mutex */
262 static int sh_vou_buf_prepare(struct videobuf_queue
*vq
,
263 struct videobuf_buffer
*vb
,
264 enum v4l2_field field
)
266 struct video_device
*vdev
= vq
->priv_data
;
267 struct sh_vou_device
*vou_dev
= video_get_drvdata(vdev
);
268 struct v4l2_pix_format
*pix
= &vou_dev
->pix
;
269 int bytes_per_line
= vou_fmt
[vou_dev
->pix_idx
].bpp
* pix
->width
/ 8;
272 dev_dbg(vq
->dev
, "%s()\n", __func__
);
274 if (vb
->width
!= pix
->width
||
275 vb
->height
!= pix
->height
||
276 vb
->field
!= pix
->field
) {
277 vb
->width
= pix
->width
;
278 vb
->height
= pix
->height
;
280 if (vb
->state
!= VIDEOBUF_NEEDS_INIT
)
284 vb
->size
= vb
->height
* bytes_per_line
;
285 if (vb
->baddr
&& vb
->bsize
< vb
->size
) {
286 /* User buffer too small */
287 dev_warn(vq
->dev
, "User buffer too small: [%u] @ %lx\n",
288 vb
->bsize
, vb
->baddr
);
292 if (vb
->state
== VIDEOBUF_NEEDS_INIT
) {
293 ret
= videobuf_iolock(vq
, vb
, NULL
);
295 dev_warn(vq
->dev
, "IOLOCK buf-type %d: %d\n",
299 vb
->state
= VIDEOBUF_PREPARED
;
303 "%s(): fmt #%d, %u bytes per line, phys 0x%x, type %d, state %d\n",
304 __func__
, vou_dev
->pix_idx
, bytes_per_line
,
305 videobuf_to_dma_contig(vb
), vb
->memory
, vb
->state
);
310 /* Locking: caller holds fop_lock mutex and vq->irqlock spinlock */
311 static void sh_vou_buf_queue(struct videobuf_queue
*vq
,
312 struct videobuf_buffer
*vb
)
314 struct video_device
*vdev
= vq
->priv_data
;
315 struct sh_vou_device
*vou_dev
= video_get_drvdata(vdev
);
317 dev_dbg(vq
->dev
, "%s()\n", __func__
);
319 vb
->state
= VIDEOBUF_QUEUED
;
320 list_add_tail(&vb
->queue
, &vou_dev
->queue
);
322 if (vou_dev
->status
== SH_VOU_RUNNING
) {
324 } else if (!vou_dev
->active
) {
325 vou_dev
->active
= vb
;
326 /* Start from side A: we use mirror addresses, so, set B */
327 sh_vou_reg_a_write(vou_dev
, VOURPR
, 1);
328 dev_dbg(vq
->dev
, "%s: first buffer status 0x%x\n", __func__
,
329 sh_vou_reg_a_read(vou_dev
, VOUSTR
));
330 sh_vou_schedule_next(vou_dev
, vb
);
331 /* Only activate VOU after the second buffer */
332 } else if (vou_dev
->active
->queue
.next
== &vb
->queue
) {
333 /* Second buffer - initialise register side B */
334 sh_vou_reg_a_write(vou_dev
, VOURPR
, 0);
335 sh_vou_stream_start(vou_dev
, vb
);
337 /* Register side switching with frame VSYNC */
338 sh_vou_reg_a_write(vou_dev
, VOURCR
, 5);
339 dev_dbg(vq
->dev
, "%s: second buffer status 0x%x\n", __func__
,
340 sh_vou_reg_a_read(vou_dev
, VOUSTR
));
342 /* Enable End-of-Frame (VSYNC) interrupts */
343 sh_vou_reg_a_write(vou_dev
, VOUIR
, 0x10004);
344 /* Two buffers on the queue - activate the hardware */
346 vou_dev
->status
= SH_VOU_RUNNING
;
347 sh_vou_reg_a_write(vou_dev
, VOUER
, 0x107);
351 static void sh_vou_buf_release(struct videobuf_queue
*vq
,
352 struct videobuf_buffer
*vb
)
354 struct video_device
*vdev
= vq
->priv_data
;
355 struct sh_vou_device
*vou_dev
= video_get_drvdata(vdev
);
358 dev_dbg(vq
->dev
, "%s()\n", __func__
);
360 spin_lock_irqsave(&vou_dev
->lock
, flags
);
362 if (vou_dev
->active
== vb
) {
364 sh_vou_reg_a_set(vou_dev
, VOUER
, 0, 1);
365 /* ...but the current frame will complete */
366 sh_vou_reg_a_set(vou_dev
, VOUIR
, 0, 0x30000);
367 vou_dev
->active
= NULL
;
370 if ((vb
->state
== VIDEOBUF_ACTIVE
|| vb
->state
== VIDEOBUF_QUEUED
)) {
371 vb
->state
= VIDEOBUF_ERROR
;
372 list_del(&vb
->queue
);
375 spin_unlock_irqrestore(&vou_dev
->lock
, flags
);
380 static struct videobuf_queue_ops sh_vou_video_qops
= {
381 .buf_setup
= sh_vou_buf_setup
,
382 .buf_prepare
= sh_vou_buf_prepare
,
383 .buf_queue
= sh_vou_buf_queue
,
384 .buf_release
= sh_vou_buf_release
,
388 static int sh_vou_querycap(struct file
*file
, void *priv
,
389 struct v4l2_capability
*cap
)
391 struct sh_vou_file
*vou_file
= priv
;
393 dev_dbg(vou_file
->vbq
.dev
, "%s()\n", __func__
);
395 strlcpy(cap
->card
, "SuperH VOU", sizeof(cap
->card
));
396 cap
->capabilities
= V4L2_CAP_VIDEO_OUTPUT
| V4L2_CAP_STREAMING
;
400 /* Enumerate formats, that the device can accept from the user */
401 static int sh_vou_enum_fmt_vid_out(struct file
*file
, void *priv
,
402 struct v4l2_fmtdesc
*fmt
)
404 struct sh_vou_file
*vou_file
= priv
;
406 if (fmt
->index
>= ARRAY_SIZE(vou_fmt
))
409 dev_dbg(vou_file
->vbq
.dev
, "%s()\n", __func__
);
411 fmt
->type
= V4L2_BUF_TYPE_VIDEO_OUTPUT
;
412 strlcpy(fmt
->description
, vou_fmt
[fmt
->index
].desc
,
413 sizeof(fmt
->description
));
414 fmt
->pixelformat
= vou_fmt
[fmt
->index
].pfmt
;
419 static int sh_vou_g_fmt_vid_out(struct file
*file
, void *priv
,
420 struct v4l2_format
*fmt
)
422 struct video_device
*vdev
= video_devdata(file
);
423 struct sh_vou_device
*vou_dev
= video_get_drvdata(vdev
);
425 dev_dbg(vou_dev
->v4l2_dev
.dev
, "%s()\n", __func__
);
427 fmt
->type
= V4L2_BUF_TYPE_VIDEO_OUTPUT
;
428 fmt
->fmt
.pix
= vou_dev
->pix
;
433 static const unsigned char vou_scale_h_num
[] = {1, 9, 2, 9, 4};
434 static const unsigned char vou_scale_h_den
[] = {1, 8, 1, 4, 1};
435 static const unsigned char vou_scale_h_fld
[] = {0, 2, 1, 3};
436 static const unsigned char vou_scale_v_num
[] = {1, 2, 4};
437 static const unsigned char vou_scale_v_den
[] = {1, 1, 1};
438 static const unsigned char vou_scale_v_fld
[] = {0, 1};
440 static void sh_vou_configure_geometry(struct sh_vou_device
*vou_dev
,
441 int pix_idx
, int w_idx
, int h_idx
)
443 struct sh_vou_fmt
*fmt
= vou_fmt
+ pix_idx
;
444 unsigned int black_left
, black_top
, width_max
, height_max
,
445 frame_in_height
, frame_out_height
, frame_out_top
;
446 struct v4l2_rect
*rect
= &vou_dev
->rect
;
447 struct v4l2_pix_format
*pix
= &vou_dev
->pix
;
448 u32 vouvcr
= 0, dsr_h
, dsr_v
;
450 if (vou_dev
->std
& V4L2_STD_525_60
) {
458 frame_in_height
= pix
->height
/ 2;
459 frame_out_height
= rect
->height
/ 2;
460 frame_out_top
= rect
->top
/ 2;
463 * Cropping scheme: max useful image is 720x480, and the total video
464 * area is 858x525 (NTSC) or 864x625 (PAL). AK8813 / 8814 starts
465 * sampling data beginning with fixed 276th (NTSC) / 288th (PAL) clock,
466 * of which the first 33 / 25 clocks HSYNC must be held active. This
467 * has to be configured in CR[HW]. 1 pixel equals 2 clock periods.
468 * This gives CR[HW] = 16 / 12, VPR[HVP] = 138 / 144, which gives
469 * exactly 858 - 138 = 864 - 144 = 720! We call the out-of-display area,
470 * beyond DSR, specified on the left and top by the VPR register "black
471 * pixels" and out-of-image area (DPR) "background pixels." We fix VPR
472 * at 138 / 144 : 20, because that's the HSYNC timing, that our first
473 * client requires, and that's exactly what leaves us 720 pixels for the
474 * image; we leave VPR[VVP] at default 20 for now, because the client
475 * doesn't seem to have any special requirements for it. Otherwise we
476 * could also set it to max - 240 = 22 / 72. Thus VPR depends only on
477 * the selected standard, and DPR and DSR are selected according to
478 * cropping. Q: how does the client detect the first valid line? Does
479 * HSYNC stay inactive during invalid (black) lines?
481 black_left
= width_max
- VOU_MAX_IMAGE_WIDTH
;
484 dsr_h
= rect
->width
+ rect
->left
;
485 dsr_v
= frame_out_height
+ frame_out_top
;
487 dev_dbg(vou_dev
->v4l2_dev
.dev
,
488 "image %ux%u, black %u:%u, offset %u:%u, display %ux%u\n",
489 pix
->width
, frame_in_height
, black_left
, black_top
,
490 rect
->left
, frame_out_top
, dsr_h
, dsr_v
);
492 /* VOUISR height - half of a frame height in frame mode */
493 sh_vou_reg_ab_write(vou_dev
, VOUISR
, (pix
->width
<< 16) | frame_in_height
);
494 sh_vou_reg_ab_write(vou_dev
, VOUVPR
, (black_left
<< 16) | black_top
);
495 sh_vou_reg_ab_write(vou_dev
, VOUDPR
, (rect
->left
<< 16) | frame_out_top
);
496 sh_vou_reg_ab_write(vou_dev
, VOUDSR
, (dsr_h
<< 16) | dsr_v
);
499 * if necessary, we could set VOUHIR to
500 * max(black_left + dsr_h, width_max) here
504 vouvcr
|= (1 << 15) | (vou_scale_h_fld
[w_idx
- 1] << 4);
506 vouvcr
|= (1 << 14) | vou_scale_v_fld
[h_idx
- 1];
508 dev_dbg(vou_dev
->v4l2_dev
.dev
, "%s: scaling 0x%x\n", fmt
->desc
, vouvcr
);
510 /* To produce a colour bar for testing set bit 23 of VOUVCR */
511 sh_vou_reg_ab_write(vou_dev
, VOUVCR
, vouvcr
);
512 sh_vou_reg_ab_write(vou_dev
, VOUDFR
,
513 fmt
->pkf
| (fmt
->yf
<< 8) | (fmt
->rgb
<< 16));
516 struct sh_vou_geometry
{
517 struct v4l2_rect output
;
518 unsigned int in_width
;
519 unsigned int in_height
;
525 * Find input geometry, that we can use to produce output, closest to the
526 * requested rectangle, using VOU scaling
528 static void vou_adjust_input(struct sh_vou_geometry
*geo
, v4l2_std_id std
)
530 /* The compiler cannot know, that best and idx will indeed be set */
531 unsigned int best_err
= UINT_MAX
, best
= 0, img_height_max
;
534 if (std
& V4L2_STD_525_60
)
535 img_height_max
= 480;
537 img_height_max
= 576;
539 /* Image width must be a multiple of 4 */
540 v4l_bound_align_image(&geo
->in_width
, 0, VOU_MAX_IMAGE_WIDTH
, 2,
541 &geo
->in_height
, 0, img_height_max
, 1, 0);
543 /* Select scales to come as close as possible to the output image */
544 for (i
= ARRAY_SIZE(vou_scale_h_num
) - 1; i
>= 0; i
--) {
546 unsigned int found
= geo
->output
.width
* vou_scale_h_den
[i
] /
549 if (found
> VOU_MAX_IMAGE_WIDTH
)
550 /* scales increase */
553 err
= abs(found
- geo
->in_width
);
554 if (err
< best_err
) {
563 geo
->in_width
= best
;
564 geo
->scale_idx_h
= idx
;
568 /* This loop can be replaced with one division */
569 for (i
= ARRAY_SIZE(vou_scale_v_num
) - 1; i
>= 0; i
--) {
571 unsigned int found
= geo
->output
.height
* vou_scale_v_den
[i
] /
574 if (found
> img_height_max
)
575 /* scales increase */
578 err
= abs(found
- geo
->in_height
);
579 if (err
< best_err
) {
588 geo
->in_height
= best
;
589 geo
->scale_idx_v
= idx
;
593 * Find output geometry, that we can produce, using VOU scaling, closest to
594 * the requested rectangle
596 static void vou_adjust_output(struct sh_vou_geometry
*geo
, v4l2_std_id std
)
598 unsigned int best_err
= UINT_MAX
, best
, width_max
, height_max
,
602 if (std
& V4L2_STD_525_60
) {
604 height_max
= 262 * 2;
605 img_height_max
= 480;
608 height_max
= 312 * 2;
609 img_height_max
= 576;
612 /* Select scales to come as close as possible to the output image */
613 for (i
= 0; i
< ARRAY_SIZE(vou_scale_h_num
); i
++) {
615 unsigned int found
= geo
->in_width
* vou_scale_h_num
[i
] /
618 if (found
> VOU_MAX_IMAGE_WIDTH
)
619 /* scales increase */
622 err
= abs(found
- geo
->output
.width
);
623 if (err
< best_err
) {
632 geo
->output
.width
= best
;
633 geo
->scale_idx_h
= idx
;
634 if (geo
->output
.left
+ best
> width_max
)
635 geo
->output
.left
= width_max
- best
;
637 pr_debug("%s(): W %u * %u/%u = %u\n", __func__
, geo
->in_width
,
638 vou_scale_h_num
[idx
], vou_scale_h_den
[idx
], best
);
642 /* This loop can be replaced with one division */
643 for (i
= 0; i
< ARRAY_SIZE(vou_scale_v_num
); i
++) {
645 unsigned int found
= geo
->in_height
* vou_scale_v_num
[i
] /
648 if (found
> img_height_max
)
649 /* scales increase */
652 err
= abs(found
- geo
->output
.height
);
653 if (err
< best_err
) {
662 geo
->output
.height
= best
;
663 geo
->scale_idx_v
= idx
;
664 if (geo
->output
.top
+ best
> height_max
)
665 geo
->output
.top
= height_max
- best
;
667 pr_debug("%s(): H %u * %u/%u = %u\n", __func__
, geo
->in_height
,
668 vou_scale_v_num
[idx
], vou_scale_v_den
[idx
], best
);
671 static int sh_vou_s_fmt_vid_out(struct file
*file
, void *priv
,
672 struct v4l2_format
*fmt
)
674 struct video_device
*vdev
= video_devdata(file
);
675 struct sh_vou_device
*vou_dev
= video_get_drvdata(vdev
);
676 struct v4l2_pix_format
*pix
= &fmt
->fmt
.pix
;
677 unsigned int img_height_max
;
679 struct sh_vou_geometry geo
;
680 struct v4l2_mbus_framefmt mbfmt
= {
681 /* Revisit: is this the correct code? */
682 .code
= V4L2_MBUS_FMT_YUYV8_2X8
,
683 .field
= V4L2_FIELD_INTERLACED
,
684 .colorspace
= V4L2_COLORSPACE_SMPTE170M
,
688 dev_dbg(vou_dev
->v4l2_dev
.dev
, "%s(): %ux%u -> %ux%u\n", __func__
,
689 vou_dev
->rect
.width
, vou_dev
->rect
.height
,
690 pix
->width
, pix
->height
);
692 if (pix
->field
== V4L2_FIELD_ANY
)
693 pix
->field
= V4L2_FIELD_NONE
;
695 if (fmt
->type
!= V4L2_BUF_TYPE_VIDEO_OUTPUT
||
696 pix
->field
!= V4L2_FIELD_NONE
)
699 for (pix_idx
= 0; pix_idx
< ARRAY_SIZE(vou_fmt
); pix_idx
++)
700 if (vou_fmt
[pix_idx
].pfmt
== pix
->pixelformat
)
703 if (pix_idx
== ARRAY_SIZE(vou_fmt
))
706 if (vou_dev
->std
& V4L2_STD_525_60
)
707 img_height_max
= 480;
709 img_height_max
= 576;
711 /* Image width must be a multiple of 4 */
712 v4l_bound_align_image(&pix
->width
, 0, VOU_MAX_IMAGE_WIDTH
, 2,
713 &pix
->height
, 0, img_height_max
, 1, 0);
715 geo
.in_width
= pix
->width
;
716 geo
.in_height
= pix
->height
;
717 geo
.output
= vou_dev
->rect
;
719 vou_adjust_output(&geo
, vou_dev
->std
);
721 mbfmt
.width
= geo
.output
.width
;
722 mbfmt
.height
= geo
.output
.height
;
723 ret
= v4l2_device_call_until_err(&vou_dev
->v4l2_dev
, 0, video
,
725 /* Must be implemented, so, don't check for -ENOIOCTLCMD */
729 dev_dbg(vou_dev
->v4l2_dev
.dev
, "%s(): %ux%u -> %ux%u\n", __func__
,
730 geo
.output
.width
, geo
.output
.height
, mbfmt
.width
, mbfmt
.height
);
733 if ((unsigned)mbfmt
.width
> VOU_MAX_IMAGE_WIDTH
||
734 (unsigned)mbfmt
.height
> img_height_max
||
735 mbfmt
.code
!= V4L2_MBUS_FMT_YUYV8_2X8
)
738 if (mbfmt
.width
!= geo
.output
.width
||
739 mbfmt
.height
!= geo
.output
.height
) {
740 geo
.output
.width
= mbfmt
.width
;
741 geo
.output
.height
= mbfmt
.height
;
743 vou_adjust_input(&geo
, vou_dev
->std
);
746 /* We tried to preserve output rectangle, but it could have changed */
747 vou_dev
->rect
= geo
.output
;
748 pix
->width
= geo
.in_width
;
749 pix
->height
= geo
.in_height
;
751 dev_dbg(vou_dev
->v4l2_dev
.dev
, "%s(): %ux%u\n", __func__
,
752 pix
->width
, pix
->height
);
754 vou_dev
->pix_idx
= pix_idx
;
758 sh_vou_configure_geometry(vou_dev
, pix_idx
,
759 geo
.scale_idx_h
, geo
.scale_idx_v
);
764 static int sh_vou_try_fmt_vid_out(struct file
*file
, void *priv
,
765 struct v4l2_format
*fmt
)
767 struct sh_vou_file
*vou_file
= priv
;
768 struct v4l2_pix_format
*pix
= &fmt
->fmt
.pix
;
771 dev_dbg(vou_file
->vbq
.dev
, "%s()\n", __func__
);
773 fmt
->type
= V4L2_BUF_TYPE_VIDEO_OUTPUT
;
774 pix
->field
= V4L2_FIELD_NONE
;
776 v4l_bound_align_image(&pix
->width
, 0, VOU_MAX_IMAGE_WIDTH
, 1,
777 &pix
->height
, 0, VOU_MAX_IMAGE_HEIGHT
, 1, 0);
779 for (i
= 0; ARRAY_SIZE(vou_fmt
); i
++)
780 if (vou_fmt
[i
].pfmt
== pix
->pixelformat
)
783 pix
->pixelformat
= vou_fmt
[0].pfmt
;
788 static int sh_vou_reqbufs(struct file
*file
, void *priv
,
789 struct v4l2_requestbuffers
*req
)
791 struct sh_vou_file
*vou_file
= priv
;
793 dev_dbg(vou_file
->vbq
.dev
, "%s()\n", __func__
);
795 if (req
->type
!= V4L2_BUF_TYPE_VIDEO_OUTPUT
)
798 return videobuf_reqbufs(&vou_file
->vbq
, req
);
801 static int sh_vou_querybuf(struct file
*file
, void *priv
,
802 struct v4l2_buffer
*b
)
804 struct sh_vou_file
*vou_file
= priv
;
806 dev_dbg(vou_file
->vbq
.dev
, "%s()\n", __func__
);
808 return videobuf_querybuf(&vou_file
->vbq
, b
);
811 static int sh_vou_qbuf(struct file
*file
, void *priv
, struct v4l2_buffer
*b
)
813 struct sh_vou_file
*vou_file
= priv
;
815 dev_dbg(vou_file
->vbq
.dev
, "%s()\n", __func__
);
817 return videobuf_qbuf(&vou_file
->vbq
, b
);
820 static int sh_vou_dqbuf(struct file
*file
, void *priv
, struct v4l2_buffer
*b
)
822 struct sh_vou_file
*vou_file
= priv
;
824 dev_dbg(vou_file
->vbq
.dev
, "%s()\n", __func__
);
826 return videobuf_dqbuf(&vou_file
->vbq
, b
, file
->f_flags
& O_NONBLOCK
);
829 static int sh_vou_streamon(struct file
*file
, void *priv
,
830 enum v4l2_buf_type buftype
)
832 struct video_device
*vdev
= video_devdata(file
);
833 struct sh_vou_device
*vou_dev
= video_get_drvdata(vdev
);
834 struct sh_vou_file
*vou_file
= priv
;
837 dev_dbg(vou_file
->vbq
.dev
, "%s()\n", __func__
);
839 ret
= v4l2_device_call_until_err(&vou_dev
->v4l2_dev
, 0,
841 if (ret
< 0 && ret
!= -ENOIOCTLCMD
)
844 /* This calls our .buf_queue() (== sh_vou_buf_queue) */
845 return videobuf_streamon(&vou_file
->vbq
);
848 static int sh_vou_streamoff(struct file
*file
, void *priv
,
849 enum v4l2_buf_type buftype
)
851 struct video_device
*vdev
= video_devdata(file
);
852 struct sh_vou_device
*vou_dev
= video_get_drvdata(vdev
);
853 struct sh_vou_file
*vou_file
= priv
;
855 dev_dbg(vou_file
->vbq
.dev
, "%s()\n", __func__
);
858 * This calls buf_release from host driver's videobuf_queue_ops for all
859 * remaining buffers. When the last buffer is freed, stop streaming
861 videobuf_streamoff(&vou_file
->vbq
);
862 v4l2_device_call_until_err(&vou_dev
->v4l2_dev
, 0, video
, s_stream
, 0);
867 static u32
sh_vou_ntsc_mode(enum sh_vou_bus_fmt bus_fmt
)
871 pr_warning("%s(): Invalid bus-format code %d, using default 8-bit\n",
873 case SH_VOU_BUS_8BIT
:
875 case SH_VOU_BUS_16BIT
:
877 case SH_VOU_BUS_BT656
:
882 static int sh_vou_s_std(struct file
*file
, void *priv
, v4l2_std_id
*std_id
)
884 struct video_device
*vdev
= video_devdata(file
);
885 struct sh_vou_device
*vou_dev
= video_get_drvdata(vdev
);
888 dev_dbg(vou_dev
->v4l2_dev
.dev
, "%s(): 0x%llx\n", __func__
, *std_id
);
890 if (*std_id
& ~vdev
->tvnorms
)
893 ret
= v4l2_device_call_until_err(&vou_dev
->v4l2_dev
, 0, video
,
894 s_std_output
, *std_id
);
895 /* Shall we continue, if the subdev doesn't support .s_std_output()? */
896 if (ret
< 0 && ret
!= -ENOIOCTLCMD
)
899 if (*std_id
& V4L2_STD_525_60
)
900 sh_vou_reg_ab_set(vou_dev
, VOUCR
,
901 sh_vou_ntsc_mode(vou_dev
->pdata
->bus_fmt
) << 29, 7 << 29);
903 sh_vou_reg_ab_set(vou_dev
, VOUCR
, 5 << 29, 7 << 29);
905 vou_dev
->std
= *std_id
;
910 static int sh_vou_g_std(struct file
*file
, void *priv
, v4l2_std_id
*std
)
912 struct video_device
*vdev
= video_devdata(file
);
913 struct sh_vou_device
*vou_dev
= video_get_drvdata(vdev
);
915 dev_dbg(vou_dev
->v4l2_dev
.dev
, "%s()\n", __func__
);
922 static int sh_vou_g_crop(struct file
*file
, void *fh
, struct v4l2_crop
*a
)
924 struct video_device
*vdev
= video_devdata(file
);
925 struct sh_vou_device
*vou_dev
= video_get_drvdata(vdev
);
927 dev_dbg(vou_dev
->v4l2_dev
.dev
, "%s()\n", __func__
);
929 a
->type
= V4L2_BUF_TYPE_VIDEO_OUTPUT
;
930 a
->c
= vou_dev
->rect
;
935 /* Assume a dull encoder, do all the work ourselves. */
936 static int sh_vou_s_crop(struct file
*file
, void *fh
, const struct v4l2_crop
*a
)
938 struct v4l2_crop a_writable
= *a
;
939 struct video_device
*vdev
= video_devdata(file
);
940 struct sh_vou_device
*vou_dev
= video_get_drvdata(vdev
);
941 struct v4l2_rect
*rect
= &a_writable
.c
;
942 struct v4l2_crop sd_crop
= {.type
= V4L2_BUF_TYPE_VIDEO_OUTPUT
};
943 struct v4l2_pix_format
*pix
= &vou_dev
->pix
;
944 struct sh_vou_geometry geo
;
945 struct v4l2_mbus_framefmt mbfmt
= {
946 /* Revisit: is this the correct code? */
947 .code
= V4L2_MBUS_FMT_YUYV8_2X8
,
948 .field
= V4L2_FIELD_INTERLACED
,
949 .colorspace
= V4L2_COLORSPACE_SMPTE170M
,
951 unsigned int img_height_max
;
954 dev_dbg(vou_dev
->v4l2_dev
.dev
, "%s(): %ux%u@%u:%u\n", __func__
,
955 rect
->width
, rect
->height
, rect
->left
, rect
->top
);
957 if (a
->type
!= V4L2_BUF_TYPE_VIDEO_OUTPUT
)
960 if (vou_dev
->std
& V4L2_STD_525_60
)
961 img_height_max
= 480;
963 img_height_max
= 576;
965 v4l_bound_align_image(&rect
->width
, 0, VOU_MAX_IMAGE_WIDTH
, 1,
966 &rect
->height
, 0, img_height_max
, 1, 0);
968 if (rect
->width
+ rect
->left
> VOU_MAX_IMAGE_WIDTH
)
969 rect
->left
= VOU_MAX_IMAGE_WIDTH
- rect
->width
;
971 if (rect
->height
+ rect
->top
> img_height_max
)
972 rect
->top
= img_height_max
- rect
->height
;
975 geo
.in_width
= pix
->width
;
976 geo
.in_height
= pix
->height
;
978 /* Configure the encoder one-to-one, position at 0, ignore errors */
979 sd_crop
.c
.width
= geo
.output
.width
;
980 sd_crop
.c
.height
= geo
.output
.height
;
982 * We first issue a S_CROP, so that the subsequent S_FMT delivers the
983 * final encoder configuration.
985 v4l2_device_call_until_err(&vou_dev
->v4l2_dev
, 0, video
,
987 mbfmt
.width
= geo
.output
.width
;
988 mbfmt
.height
= geo
.output
.height
;
989 ret
= v4l2_device_call_until_err(&vou_dev
->v4l2_dev
, 0, video
,
991 /* Must be implemented, so, don't check for -ENOIOCTLCMD */
996 if ((unsigned)mbfmt
.width
> VOU_MAX_IMAGE_WIDTH
||
997 (unsigned)mbfmt
.height
> img_height_max
||
998 mbfmt
.code
!= V4L2_MBUS_FMT_YUYV8_2X8
)
1001 geo
.output
.width
= mbfmt
.width
;
1002 geo
.output
.height
= mbfmt
.height
;
1005 * No down-scaling. According to the API, current call has precedence:
1006 * http://v4l2spec.bytesex.org/spec/x1904.htm#AEN1954 paragraph two.
1008 vou_adjust_input(&geo
, vou_dev
->std
);
1010 /* We tried to preserve output rectangle, but it could have changed */
1011 vou_dev
->rect
= geo
.output
;
1012 pix
->width
= geo
.in_width
;
1013 pix
->height
= geo
.in_height
;
1015 sh_vou_configure_geometry(vou_dev
, vou_dev
->pix_idx
,
1016 geo
.scale_idx_h
, geo
.scale_idx_v
);
1022 * Total field: NTSC 858 x 2 * 262/263, PAL 864 x 2 * 312/313, default rectangle
1023 * is the initial register values, height takes the interlaced format into
1024 * account. The actual image can only go up to 720 x 2 * 240, So, VOUVPR can
1025 * actually only meaningfully contain values <= 720 and <= 240 respectively, and
1026 * not <= 864 and <= 312.
1028 static int sh_vou_cropcap(struct file
*file
, void *priv
,
1029 struct v4l2_cropcap
*a
)
1031 struct sh_vou_file
*vou_file
= priv
;
1033 dev_dbg(vou_file
->vbq
.dev
, "%s()\n", __func__
);
1035 a
->type
= V4L2_BUF_TYPE_VIDEO_OUTPUT
;
1038 a
->bounds
.width
= VOU_MAX_IMAGE_WIDTH
;
1039 a
->bounds
.height
= VOU_MAX_IMAGE_HEIGHT
;
1040 /* Default = max, set VOUDPR = 0, which is not hardware default */
1041 a
->defrect
.left
= 0;
1043 a
->defrect
.width
= VOU_MAX_IMAGE_WIDTH
;
1044 a
->defrect
.height
= VOU_MAX_IMAGE_HEIGHT
;
1045 a
->pixelaspect
.numerator
= 1;
1046 a
->pixelaspect
.denominator
= 1;
1051 static irqreturn_t
sh_vou_isr(int irq
, void *dev_id
)
1053 struct sh_vou_device
*vou_dev
= dev_id
;
1054 static unsigned long j
;
1055 struct videobuf_buffer
*vb
;
1058 u32 irq_status
= sh_vou_reg_a_read(vou_dev
, VOUIR
), masked
;
1059 u32 vou_status
= sh_vou_reg_a_read(vou_dev
, VOUSTR
);
1061 if (!(irq_status
& 0x300)) {
1062 if (printk_timed_ratelimit(&j
, 500))
1063 dev_warn(vou_dev
->v4l2_dev
.dev
, "IRQ status 0x%x!\n",
1068 spin_lock(&vou_dev
->lock
);
1069 if (!vou_dev
->active
|| list_empty(&vou_dev
->queue
)) {
1070 if (printk_timed_ratelimit(&j
, 500))
1071 dev_warn(vou_dev
->v4l2_dev
.dev
,
1072 "IRQ without active buffer: %x!\n", irq_status
);
1073 /* Just ack: buf_release will disable further interrupts */
1074 sh_vou_reg_a_set(vou_dev
, VOUIR
, 0, 0x300);
1075 spin_unlock(&vou_dev
->lock
);
1079 masked
= ~(0x300 & irq_status
) & irq_status
& 0x30304;
1080 dev_dbg(vou_dev
->v4l2_dev
.dev
,
1081 "IRQ status 0x%x -> 0x%x, VOU status 0x%x, cnt %d\n",
1082 irq_status
, masked
, vou_status
, cnt
);
1085 side
= vou_status
& 0x10000;
1087 /* Clear only set interrupts */
1088 sh_vou_reg_a_write(vou_dev
, VOUIR
, masked
);
1090 vb
= vou_dev
->active
;
1091 list_del(&vb
->queue
);
1093 vb
->state
= VIDEOBUF_DONE
;
1094 do_gettimeofday(&vb
->ts
);
1098 if (list_empty(&vou_dev
->queue
)) {
1100 dev_dbg(vou_dev
->v4l2_dev
.dev
, "%s: queue empty after %d\n",
1102 sh_vou_reg_a_set(vou_dev
, VOUER
, 0, 1);
1103 vou_dev
->active
= NULL
;
1104 vou_dev
->status
= SH_VOU_INITIALISING
;
1105 /* Disable End-of-Frame (VSYNC) interrupts */
1106 sh_vou_reg_a_set(vou_dev
, VOUIR
, 0, 0x30000);
1107 spin_unlock(&vou_dev
->lock
);
1111 vou_dev
->active
= list_entry(vou_dev
->queue
.next
,
1112 struct videobuf_buffer
, queue
);
1114 if (vou_dev
->active
->queue
.next
!= &vou_dev
->queue
) {
1115 struct videobuf_buffer
*new = list_entry(vou_dev
->active
->queue
.next
,
1116 struct videobuf_buffer
, queue
);
1117 sh_vou_schedule_next(vou_dev
, new);
1120 spin_unlock(&vou_dev
->lock
);
1125 static int sh_vou_hw_init(struct sh_vou_device
*vou_dev
)
1127 struct sh_vou_pdata
*pdata
= vou_dev
->pdata
;
1128 u32 voucr
= sh_vou_ntsc_mode(pdata
->bus_fmt
) << 29;
1131 /* Disable all IRQs */
1132 sh_vou_reg_a_write(vou_dev
, VOUIR
, 0);
1134 /* Reset VOU interfaces - registers unaffected */
1135 sh_vou_reg_a_write(vou_dev
, VOUSRR
, 0x101);
1136 while (--i
&& (sh_vou_reg_a_read(vou_dev
, VOUSRR
) & 0x101))
1142 dev_dbg(vou_dev
->v4l2_dev
.dev
, "Reset took %dus\n", 100 - i
);
1144 if (pdata
->flags
& SH_VOU_PCLK_FALLING
)
1146 if (pdata
->flags
& SH_VOU_HSYNC_LOW
)
1148 if (pdata
->flags
& SH_VOU_VSYNC_LOW
)
1150 sh_vou_reg_ab_set(vou_dev
, VOUCR
, voucr
, 0xfc000000);
1152 /* Manual register side switching at first */
1153 sh_vou_reg_a_write(vou_dev
, VOURCR
, 4);
1154 /* Default - fixed HSYNC length, can be made configurable is required */
1155 sh_vou_reg_ab_write(vou_dev
, VOUMSR
, 0x800000);
1160 /* File operations */
1161 static int sh_vou_open(struct file
*file
)
1163 struct video_device
*vdev
= video_devdata(file
);
1164 struct sh_vou_device
*vou_dev
= video_get_drvdata(vdev
);
1165 struct sh_vou_file
*vou_file
= kzalloc(sizeof(struct sh_vou_file
),
1171 dev_dbg(vou_dev
->v4l2_dev
.dev
, "%s()\n", __func__
);
1173 file
->private_data
= vou_file
;
1175 if (mutex_lock_interruptible(&vou_dev
->fop_lock
))
1176 return -ERESTARTSYS
;
1177 if (atomic_inc_return(&vou_dev
->use_count
) == 1) {
1180 vou_dev
->status
= SH_VOU_INITIALISING
;
1181 pm_runtime_get_sync(vdev
->v4l2_dev
->dev
);
1182 ret
= sh_vou_hw_init(vou_dev
);
1184 atomic_dec(&vou_dev
->use_count
);
1185 pm_runtime_put(vdev
->v4l2_dev
->dev
);
1186 vou_dev
->status
= SH_VOU_IDLE
;
1187 mutex_unlock(&vou_dev
->fop_lock
);
1192 videobuf_queue_dma_contig_init(&vou_file
->vbq
, &sh_vou_video_qops
,
1193 vou_dev
->v4l2_dev
.dev
, &vou_dev
->lock
,
1194 V4L2_BUF_TYPE_VIDEO_OUTPUT
,
1196 sizeof(struct videobuf_buffer
), vdev
,
1197 &vou_dev
->fop_lock
);
1198 mutex_unlock(&vou_dev
->fop_lock
);
1203 static int sh_vou_release(struct file
*file
)
1205 struct video_device
*vdev
= video_devdata(file
);
1206 struct sh_vou_device
*vou_dev
= video_get_drvdata(vdev
);
1207 struct sh_vou_file
*vou_file
= file
->private_data
;
1209 dev_dbg(vou_file
->vbq
.dev
, "%s()\n", __func__
);
1211 if (!atomic_dec_return(&vou_dev
->use_count
)) {
1212 mutex_lock(&vou_dev
->fop_lock
);
1214 vou_dev
->status
= SH_VOU_IDLE
;
1215 sh_vou_reg_a_set(vou_dev
, VOUER
, 0, 0x101);
1216 pm_runtime_put(vdev
->v4l2_dev
->dev
);
1217 mutex_unlock(&vou_dev
->fop_lock
);
1220 file
->private_data
= NULL
;
1226 static int sh_vou_mmap(struct file
*file
, struct vm_area_struct
*vma
)
1228 struct video_device
*vdev
= video_devdata(file
);
1229 struct sh_vou_device
*vou_dev
= video_get_drvdata(vdev
);
1230 struct sh_vou_file
*vou_file
= file
->private_data
;
1233 dev_dbg(vou_file
->vbq
.dev
, "%s()\n", __func__
);
1235 if (mutex_lock_interruptible(&vou_dev
->fop_lock
))
1236 return -ERESTARTSYS
;
1237 ret
= videobuf_mmap_mapper(&vou_file
->vbq
, vma
);
1238 mutex_unlock(&vou_dev
->fop_lock
);
1242 static unsigned int sh_vou_poll(struct file
*file
, poll_table
*wait
)
1244 struct video_device
*vdev
= video_devdata(file
);
1245 struct sh_vou_device
*vou_dev
= video_get_drvdata(vdev
);
1246 struct sh_vou_file
*vou_file
= file
->private_data
;
1249 dev_dbg(vou_file
->vbq
.dev
, "%s()\n", __func__
);
1251 mutex_lock(&vou_dev
->fop_lock
);
1252 res
= videobuf_poll_stream(file
, &vou_file
->vbq
, wait
);
1253 mutex_unlock(&vou_dev
->fop_lock
);
1257 static int sh_vou_g_chip_ident(struct file
*file
, void *fh
,
1258 struct v4l2_dbg_chip_ident
*id
)
1260 struct video_device
*vdev
= video_devdata(file
);
1261 struct sh_vou_device
*vou_dev
= video_get_drvdata(vdev
);
1263 return v4l2_device_call_until_err(&vou_dev
->v4l2_dev
, 0, core
, g_chip_ident
, id
);
1266 #ifdef CONFIG_VIDEO_ADV_DEBUG
1267 static int sh_vou_g_register(struct file
*file
, void *fh
,
1268 struct v4l2_dbg_register
*reg
)
1270 struct video_device
*vdev
= video_devdata(file
);
1271 struct sh_vou_device
*vou_dev
= video_get_drvdata(vdev
);
1273 return v4l2_device_call_until_err(&vou_dev
->v4l2_dev
, 0, core
, g_register
, reg
);
1276 static int sh_vou_s_register(struct file
*file
, void *fh
,
1277 struct v4l2_dbg_register
*reg
)
1279 struct video_device
*vdev
= video_devdata(file
);
1280 struct sh_vou_device
*vou_dev
= video_get_drvdata(vdev
);
1282 return v4l2_device_call_until_err(&vou_dev
->v4l2_dev
, 0, core
, s_register
, reg
);
1286 /* sh_vou display ioctl operations */
1287 static const struct v4l2_ioctl_ops sh_vou_ioctl_ops
= {
1288 .vidioc_querycap
= sh_vou_querycap
,
1289 .vidioc_enum_fmt_vid_out
= sh_vou_enum_fmt_vid_out
,
1290 .vidioc_g_fmt_vid_out
= sh_vou_g_fmt_vid_out
,
1291 .vidioc_s_fmt_vid_out
= sh_vou_s_fmt_vid_out
,
1292 .vidioc_try_fmt_vid_out
= sh_vou_try_fmt_vid_out
,
1293 .vidioc_reqbufs
= sh_vou_reqbufs
,
1294 .vidioc_querybuf
= sh_vou_querybuf
,
1295 .vidioc_qbuf
= sh_vou_qbuf
,
1296 .vidioc_dqbuf
= sh_vou_dqbuf
,
1297 .vidioc_streamon
= sh_vou_streamon
,
1298 .vidioc_streamoff
= sh_vou_streamoff
,
1299 .vidioc_s_std
= sh_vou_s_std
,
1300 .vidioc_g_std
= sh_vou_g_std
,
1301 .vidioc_cropcap
= sh_vou_cropcap
,
1302 .vidioc_g_crop
= sh_vou_g_crop
,
1303 .vidioc_s_crop
= sh_vou_s_crop
,
1304 .vidioc_g_chip_ident
= sh_vou_g_chip_ident
,
1305 #ifdef CONFIG_VIDEO_ADV_DEBUG
1306 .vidioc_g_register
= sh_vou_g_register
,
1307 .vidioc_s_register
= sh_vou_s_register
,
1311 static const struct v4l2_file_operations sh_vou_fops
= {
1312 .owner
= THIS_MODULE
,
1313 .open
= sh_vou_open
,
1314 .release
= sh_vou_release
,
1315 .unlocked_ioctl
= video_ioctl2
,
1316 .mmap
= sh_vou_mmap
,
1317 .poll
= sh_vou_poll
,
1320 static const struct video_device sh_vou_video_template
= {
1322 .fops
= &sh_vou_fops
,
1323 .ioctl_ops
= &sh_vou_ioctl_ops
,
1324 .tvnorms
= V4L2_STD_525_60
, /* PAL only supported in 8-bit non-bt656 mode */
1325 .current_norm
= V4L2_STD_NTSC_M
,
1326 .vfl_dir
= VFL_DIR_TX
,
1329 static int sh_vou_probe(struct platform_device
*pdev
)
1331 struct sh_vou_pdata
*vou_pdata
= pdev
->dev
.platform_data
;
1332 struct v4l2_rect
*rect
;
1333 struct v4l2_pix_format
*pix
;
1334 struct i2c_adapter
*i2c_adap
;
1335 struct video_device
*vdev
;
1336 struct sh_vou_device
*vou_dev
;
1337 struct resource
*reg_res
, *region
;
1338 struct v4l2_subdev
*subdev
;
1341 reg_res
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
1342 irq
= platform_get_irq(pdev
, 0);
1344 if (!vou_pdata
|| !reg_res
|| irq
<= 0) {
1345 dev_err(&pdev
->dev
, "Insufficient VOU platform information.\n");
1349 vou_dev
= kzalloc(sizeof(*vou_dev
), GFP_KERNEL
);
1353 INIT_LIST_HEAD(&vou_dev
->queue
);
1354 spin_lock_init(&vou_dev
->lock
);
1355 mutex_init(&vou_dev
->fop_lock
);
1356 atomic_set(&vou_dev
->use_count
, 0);
1357 vou_dev
->pdata
= vou_pdata
;
1358 vou_dev
->status
= SH_VOU_IDLE
;
1360 rect
= &vou_dev
->rect
;
1361 pix
= &vou_dev
->pix
;
1363 /* Fill in defaults */
1364 vou_dev
->std
= sh_vou_video_template
.current_norm
;
1367 rect
->width
= VOU_MAX_IMAGE_WIDTH
;
1369 pix
->width
= VOU_MAX_IMAGE_WIDTH
;
1371 pix
->pixelformat
= V4L2_PIX_FMT_YVYU
;
1372 pix
->field
= V4L2_FIELD_NONE
;
1373 pix
->bytesperline
= VOU_MAX_IMAGE_WIDTH
* 2;
1374 pix
->sizeimage
= VOU_MAX_IMAGE_WIDTH
* 2 * 480;
1375 pix
->colorspace
= V4L2_COLORSPACE_SMPTE170M
;
1377 region
= request_mem_region(reg_res
->start
, resource_size(reg_res
),
1380 dev_err(&pdev
->dev
, "VOU region already claimed\n");
1385 vou_dev
->base
= ioremap(reg_res
->start
, resource_size(reg_res
));
1386 if (!vou_dev
->base
) {
1391 ret
= request_irq(irq
, sh_vou_isr
, 0, "vou", vou_dev
);
1395 ret
= v4l2_device_register(&pdev
->dev
, &vou_dev
->v4l2_dev
);
1397 dev_err(&pdev
->dev
, "Error registering v4l2 device\n");
1401 /* Allocate memory for video device */
1402 vdev
= video_device_alloc();
1408 *vdev
= sh_vou_video_template
;
1409 if (vou_pdata
->bus_fmt
== SH_VOU_BUS_8BIT
)
1410 vdev
->tvnorms
|= V4L2_STD_PAL
;
1411 vdev
->v4l2_dev
= &vou_dev
->v4l2_dev
;
1412 vdev
->release
= video_device_release
;
1413 vdev
->lock
= &vou_dev
->fop_lock
;
1415 vou_dev
->vdev
= vdev
;
1416 video_set_drvdata(vdev
, vou_dev
);
1418 pm_runtime_enable(&pdev
->dev
);
1419 pm_runtime_resume(&pdev
->dev
);
1421 i2c_adap
= i2c_get_adapter(vou_pdata
->i2c_adap
);
1427 ret
= sh_vou_hw_init(vou_dev
);
1431 subdev
= v4l2_i2c_new_subdev_board(&vou_dev
->v4l2_dev
, i2c_adap
,
1432 vou_pdata
->board_info
, NULL
);
1438 ret
= video_register_device(vdev
, VFL_TYPE_GRABBER
, -1);
1447 i2c_put_adapter(i2c_adap
);
1449 video_device_release(vdev
);
1450 pm_runtime_disable(&pdev
->dev
);
1452 v4l2_device_unregister(&vou_dev
->v4l2_dev
);
1454 free_irq(irq
, vou_dev
);
1456 iounmap(vou_dev
->base
);
1458 release_mem_region(reg_res
->start
, resource_size(reg_res
));
1464 static int sh_vou_remove(struct platform_device
*pdev
)
1466 int irq
= platform_get_irq(pdev
, 0);
1467 struct v4l2_device
*v4l2_dev
= platform_get_drvdata(pdev
);
1468 struct sh_vou_device
*vou_dev
= container_of(v4l2_dev
,
1469 struct sh_vou_device
, v4l2_dev
);
1470 struct v4l2_subdev
*sd
= list_entry(v4l2_dev
->subdevs
.next
,
1471 struct v4l2_subdev
, list
);
1472 struct i2c_client
*client
= v4l2_get_subdevdata(sd
);
1473 struct resource
*reg_res
;
1476 free_irq(irq
, vou_dev
);
1477 pm_runtime_disable(&pdev
->dev
);
1478 video_unregister_device(vou_dev
->vdev
);
1479 i2c_put_adapter(client
->adapter
);
1480 v4l2_device_unregister(&vou_dev
->v4l2_dev
);
1481 iounmap(vou_dev
->base
);
1482 reg_res
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
1484 release_mem_region(reg_res
->start
, resource_size(reg_res
));
1489 static struct platform_driver __refdata sh_vou
= {
1490 .remove
= sh_vou_remove
,
1493 .owner
= THIS_MODULE
,
1497 static int __init
sh_vou_init(void)
1499 return platform_driver_probe(&sh_vou
, sh_vou_probe
);
1502 static void __exit
sh_vou_exit(void)
1504 platform_driver_unregister(&sh_vou
);
1507 module_init(sh_vou_init
);
1508 module_exit(sh_vou_exit
);
1510 MODULE_DESCRIPTION("SuperH VOU driver");
1511 MODULE_AUTHOR("Guennadi Liakhovetski <g.liakhovetski@gmx.de>");
1512 MODULE_LICENSE("GPL v2");
1513 MODULE_VERSION("0.1.0");
1514 MODULE_ALIAS("platform:sh-vou");