4 files changed, 59 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)
diff --git a/drivers/media/video/s5p-fimc/fimc-core.h b/drivers/media/video/s5p-fimc/fimc-core.h
index 9b448751f44b..6ec8b37ce41e 100644
--- a/drivers/media/video/s5p-fimc/fimc-core.h
+++ b/drivers/media/video/s5p-fimc/fimc-core.h
@@ -723,6 +723,8 @@ void fimc_unregister_capture_device(struct fimc_dev *fimc);
 int fimc_capture_ctrls_create(struct fimc_dev *fimc);
 int fimc_vid_cap_buf_queue(struct fimc_dev *fimc,
                              struct fimc_vid_buffer *fimc_vb);
+void fimc_sensor_notify(struct v4l2_subdev *sd, unsigned int notification,
+                        void *arg);
 int fimc_capture_suspend(struct fimc_dev *fimc);
 int fimc_capture_resume(struct fimc_dev *fimc);
 int fimc_capture_config_update(struct fimc_ctx *ctx);
diff --git a/drivers/media/video/s5p-fimc/fimc-mdevice.c b/drivers/media/video/s5p-fimc/fimc-mdevice.c
index db17a6fad3e0..cc337b1de913 100644
--- a/drivers/media/video/s5p-fimc/fimc-mdevice.c
+++ b/drivers/media/video/s5p-fimc/fimc-mdevice.c
@@ -759,6 +759,7 @@ static int __devinit fimc_md_probe(struct platform_device *pdev)
 
         v4l2_dev = &fmd->v4l2_dev;
         v4l2_dev->mdev = &fmd->media_dev;
+        v4l2_dev->notify = fimc_sensor_notify;
         snprintf(v4l2_dev->name, sizeof(v4l2_dev->name), "%s",
                  dev_name(&pdev->dev));
 
diff --git a/include/media/s5p_fimc.h b/include/media/s5p_fimc.h
index 086a7aada9d2..2b589042588d 100644
--- a/include/media/s5p_fimc.h
+++ b/include/media/s5p_fimc.h
@@ -60,4 +60,13 @@ struct s5p_platform_fimc {
         struct s5p_fimc_isp_info *isp_info;
         int num_clients;
 };
+
+/*
+ * v4l2_device notification id. This is only for internal use in the kernel.
+ * Sensor subdevs should issue S5P_FIMC_TX_END_NOTIFY notification in single
+ * frame capture mode when there is only one VSYNC pulse issued by the sensor
+ * at begining of the frame transmission.
+ */
+#define S5P_FIMC_TX_END_NOTIFY _IO('e', 0)
+
 #endif /* S5P_FIMC_H_ */