V4L/DVB (9244): video: improve sh_mobile_ceu buffer handling

This patch improves the buffer handling in the sh_mobile_ceu driver.

Instead of marking all queued buffers as VIDEOBUF_ACTIVE the code now
marks queued-but-not-active buffers as VIDEOBUF_QUEUED and buffers
involved in dma as VIDEOBUF_ACTIVE. The code is also updated with
code to cancel active buffers, thanks to Morimoto-san.

Tested-by: Kuninori Morimoto <morimoto.kuninori@renesas.com>
Signed-off-by: Magnus Damm <damm@igel.co.jp>
Signed-off-by: Guennadi Liakhovetski <g.liakhovetski@gmx.de>
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>

1 files changed, 14 insertions, 1 deletions

diff --git a/drivers/media/video/sh_mobile_ceu_camera.c b/drivers/media/video/sh_mobile_ceu_camera.c
index fa88d382d5b5..2407607f2eff 100644
--- a/drivers/media/video/sh_mobile_ceu_camera.c
+++ b/drivers/media/video/sh_mobile_ceu_camera.c
@@ -165,6 +165,7 @@ static void sh_mobile_ceu_capture(struct sh_mobile_ceu_dev *pcdev)
         ceu_write(pcdev, CETCR, 0x0317f313 ^ 0x10);
 
         if (pcdev->active) {
+                pcdev->active->state = VIDEOBUF_ACTIVE;
                 ceu_write(pcdev, CDAYR, videobuf_to_dma_contig(pcdev->active));
                 ceu_write(pcdev, CAPSR, 0x1); /* start capture */
         }
@@ -236,7 +237,7 @@ static void sh_mobile_ceu_videobuf_queue(struct videobuf_queue *vq,
         dev_dbg(&icd->dev, "%s (vb=0x%p) 0x%08lx %zd\n", __func__,
                 vb, vb->baddr, vb->bsize);
 
-        vb->state = VIDEOBUF_ACTIVE;
+        vb->state = VIDEOBUF_QUEUED;
         spin_lock_irqsave(&pcdev->lock, flags);
         list_add_tail(&vb->queue, &pcdev->capture);
 
@@ -323,12 +324,24 @@ static void sh_mobile_ceu_remove_device(struct soc_camera_device *icd)
 {
         struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
         struct sh_mobile_ceu_dev *pcdev = ici->priv;
+        unsigned long flags;
 
         BUG_ON(icd != pcdev->icd);
 
         /* disable capture, disable interrupts */
         ceu_write(pcdev, CEIER, 0);
         ceu_write(pcdev, CAPSR, 1 << 16); /* reset */
+
+        /* make sure active buffer is canceled */
+        spin_lock_irqsave(&pcdev->lock, flags);
+        if (pcdev->active) {
+                list_del(&pcdev->active->queue);
+                pcdev->active->state = VIDEOBUF_ERROR;
+                wake_up_all(&pcdev->active->done);
+                pcdev->active = NULL;
+        }
+        spin_unlock_irqrestore(&pcdev->lock, flags);
+
         icd->ops->release(icd);
 
         dev_info(&icd->dev,