media: rcar-vin: Add support for V4L2_FIELD_SEQ_{TB,BT}

[linux-2.6-microblaze.git] / drivers / media / platform / rcar-vin / rcar-dma.c

diff --git a/drivers/media/platform/rcar-vin/rcar-dma.c b/drivers/media/platform/rcar-vin/rcar-dma.c
index 62dee07..1a30cd0 100644 (file)
--- a/drivers/media/platform/rcar-vin/rcar-dma.c
+++ b/drivers/media/platform/rcar-vin/rcar-dma.c
@@ -535,7 +535,7 @@ static void rvin_crop_scale_comp_gen2(struct rvin_dev *vin)
 
        /* Set scaling coefficient */
        crop_height = vin->crop.height;
-       if (V4L2_FIELD_IS_INTERLACED(vin->format.field))
+       if (V4L2_FIELD_HAS_BOTH(vin->format.field))
                crop_height *= 2;
 
        ys = 0;
@@ -564,7 +564,7 @@ static void rvin_crop_scale_comp_gen2(struct rvin_dev *vin)
        rvin_write(vin, 0, VNSLPOC_REG);
        rvin_write(vin, vin->format.width - 1, VNEPPOC_REG);
 
-       if (V4L2_FIELD_IS_INTERLACED(vin->format.field))
+       if (V4L2_FIELD_HAS_BOTH(vin->format.field))
                rvin_write(vin, vin->format.height / 2 - 1, VNELPOC_REG);
        else
                rvin_write(vin, vin->format.height - 1, VNELPOC_REG);
@@ -626,6 +626,8 @@ static int rvin_setup(struct rvin_dev *vin)
        case V4L2_FIELD_INTERLACED_BT:
                vnmc = VNMC_IM_FULL | VNMC_FOC;
                break;
+       case V4L2_FIELD_SEQ_TB:
+       case V4L2_FIELD_SEQ_BT:
        case V4L2_FIELD_NONE:
                vnmc = VNMC_IM_ODD_EVEN;
                progressive = true;
@@ -842,15 +844,32 @@ static void rvin_fill_hw_slot(struct rvin_dev *vin, int slot)
        struct rvin_buffer *buf;
        struct vb2_v4l2_buffer *vbuf;
        dma_addr_t phys_addr;
+       int prev;
 
        /* A already populated slot shall never be overwritten. */
        if (WARN_ON(vin->buf_hw[slot].buffer))
                return;
 
-       vin_dbg(vin, "Filling HW slot: %d\n", slot);
+       prev = (slot == 0 ? HW_BUFFER_NUM : slot) - 1;
 
-       if (list_empty(&vin->buf_list)) {
+       if (vin->buf_hw[prev].type == HALF_TOP) {
+               vbuf = vin->buf_hw[prev].buffer;
+               vin->buf_hw[slot].buffer = vbuf;
+               vin->buf_hw[slot].type = HALF_BOTTOM;
+               switch (vin->format.pixelformat) {
+               case V4L2_PIX_FMT_NV12:
+               case V4L2_PIX_FMT_NV16:
+                       phys_addr = vin->buf_hw[prev].phys +
+                               vin->format.sizeimage / 4;
+                       break;
+               default:
+                       phys_addr = vin->buf_hw[prev].phys +
+                               vin->format.sizeimage / 2;
+                       break;
+               }
+       } else if (list_empty(&vin->buf_list)) {
                vin->buf_hw[slot].buffer = NULL;
+               vin->buf_hw[slot].type = FULL;
                phys_addr = vin->scratch_phys;
        } else {
                /* Keep track of buffer we give to HW */
@@ -859,10 +878,18 @@ static void rvin_fill_hw_slot(struct rvin_dev *vin, int slot)
                list_del_init(to_buf_list(vbuf));
                vin->buf_hw[slot].buffer = vbuf;
 
+               vin->buf_hw[slot].type =
+                       V4L2_FIELD_IS_SEQUENTIAL(vin->format.field) ?
+                       HALF_TOP : FULL;
+
                /* Setup DMA */
                phys_addr = vb2_dma_contig_plane_dma_addr(&vbuf->vb2_buf, 0);
        }
 
+       vin_dbg(vin, "Filling HW slot: %d type: %d buffer: %p\n",
+               slot, vin->buf_hw[slot].type, vin->buf_hw[slot].buffer);
+
+       vin->buf_hw[slot].phys = phys_addr;
        rvin_set_slot_addr(vin, slot, phys_addr);
 }
 
@@ -870,6 +897,11 @@ static int rvin_capture_start(struct rvin_dev *vin)
 {
        int slot, ret;
 
+       for (slot = 0; slot < HW_BUFFER_NUM; slot++) {
+               vin->buf_hw[slot].buffer = NULL;
+               vin->buf_hw[slot].type = FULL;
+       }
+
        for (slot = 0; slot < HW_BUFFER_NUM; slot++)
                rvin_fill_hw_slot(vin, slot);
 
@@ -954,6 +986,16 @@ static irqreturn_t rvin_irq(int irq, void *data)
 
        /* Capture frame */
        if (vin->buf_hw[slot].buffer) {
+               /*
+                * Nothing to do but refill the hardware slot if
+                * capture only filled first half of vb2 buffer.
+                */
+               if (vin->buf_hw[slot].type == HALF_TOP) {
+                       vin->buf_hw[slot].buffer = NULL;
+                       rvin_fill_hw_slot(vin, slot);
+                       goto done;
+               }
+
                vin->buf_hw[slot].buffer->field =
                        rvin_get_active_field(vin, vnms);
                vin->buf_hw[slot].buffer->sequence = vin->sequence;
@@ -981,14 +1023,22 @@ static void return_all_buffers(struct rvin_dev *vin,
                               enum vb2_buffer_state state)
 {
        struct rvin_buffer *buf, *node;
-       int i;
+       struct vb2_v4l2_buffer *freed[HW_BUFFER_NUM];
+       unsigned int i, n;
 
        for (i = 0; i < HW_BUFFER_NUM; i++) {
-               if (vin->buf_hw[i].buffer) {
-                       vb2_buffer_done(&vin->buf_hw[i].buffer->vb2_buf,
-                                       state);
-                       vin->buf_hw[i].buffer = NULL;
+               freed[i] = vin->buf_hw[i].buffer;
+               vin->buf_hw[i].buffer = NULL;
+
+               for (n = 0; n < i; n++) {
+                       if (freed[i] == freed[n]) {
+                               freed[i] = NULL;
+                               break;
+                       }
                }
+
+               if (freed[i])
+                       vb2_buffer_done(&freed[i]->vb2_buf, state);
        }
 
        list_for_each_entry_safe(buf, node, &vin->buf_list, list) {