[media] s5p-fimc: Add v4l2_device notification support for single frame capture

Signed-off-by: Sylwester Nawrocki <s.nawrocki@samsung.com>
Signed-off-by: Kyungmin Park <kyungmin.park@samsung.com>
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>

1 files changed, 47 insertions, 0 deletions

diff --git a/drivers/media/video/s5p-fimc/fimc-capture.c b/drivers/media/video/s5p-fimc/fimc-capture.c
index adbbb63fd526..7fafd1228fbc 100644
--- a/drivers/media/video/s5p-fimc/fimc-capture.c
+++ b/drivers/media/video/s5p-fimc/fimc-capture.c
@@ -1076,6 +1076,53 @@ static const struct media_entity_operations fimc_sd_media_ops = {
         .link_setup = fimc_link_setup,
 };
 
+/**
+ * fimc_sensor_notify - v4l2_device notification from a sensor subdev
+ * @sd: pointer to a subdev generating the notification
+ * @notification: the notification type, must be S5P_FIMC_TX_END_NOTIFY
+ * @arg: pointer to an u32 type integer that stores the frame payload value
+ *
+ * The End Of Frame notification sent by sensor subdev in its still capture
+ * mode. If there is only a single VSYNC generated by the sensor at the
+ * beginning of a frame transmission, FIMC does not issue the LastIrq
+ * (end of frame) interrupt. And this notification is used to complete the
+ * frame capture and returning a buffer to user-space. Subdev drivers should
+ * call this notification from their last 'End of frame capture' interrupt.
+ */
+void fimc_sensor_notify(struct v4l2_subdev *sd, unsigned int notification,
+                        void *arg)
+{
+        struct fimc_sensor_info *sensor;
+        struct fimc_vid_buffer *buf;
+        struct fimc_md *fmd;
+        struct fimc_dev *fimc;
+        unsigned long flags;
+
+        if (sd == NULL)
+                return;
+
+        sensor = v4l2_get_subdev_hostdata(sd);
+        fmd = entity_to_fimc_mdev(&sd->entity);
+
+        spin_lock_irqsave(&fmd->slock, flags);
+        fimc = sensor ? sensor->host : NULL;
+
+        if (fimc && arg && notification == S5P_FIMC_TX_END_NOTIFY &&
+            test_bit(ST_CAPT_PEND, &fimc->state)) {
+                unsigned long irq_flags;
+                spin_lock_irqsave(&fimc->slock, irq_flags);
+                if (!list_empty(&fimc->vid_cap.active_buf_q)) {
+                        buf = list_entry(fimc->vid_cap.active_buf_q.next,
+                                         struct fimc_vid_buffer, list);
+                        vb2_set_plane_payload(&buf->vb, 0, *((u32 *)arg));
+                }
+                fimc_capture_irq_handler(fimc, true);
+                fimc_deactivate_capture(fimc);
+                spin_unlock_irqrestore(&fimc->slock, irq_flags);
+        }
+        spin_unlock_irqrestore(&fmd->slock, flags);
+}
+
 static int fimc_subdev_enum_mbus_code(struct v4l2_subdev *sd,
                                       struct v4l2_subdev_fh *fh,
                                       struct v4l2_subdev_mbus_code_enum *code)