1 files changed, 189 insertions, 0 deletions

diff --git a/drivers/media/video/m5mols/m5mols_capture.c b/drivers/media/video/m5mols/m5mols_capture.c
new file mode 100644
index 00000000000..3248ac80571
--- /dev/null
+++ b/drivers/media/video/m5mols/m5mols_capture.c
@@ -0,0 +1,189 @@
+/*
+ * The Capture code for Fujitsu M-5MOLS ISP
+ *
+ * Copyright (C) 2011 Samsung Electronics Co., Ltd.
+ * Author: HeungJun Kim <riverful.kim@samsung.com>
+ *
+ * Copyright (C) 2009 Samsung Electronics Co., Ltd.
+ * Author: Dongsoo Nathaniel Kim <dongsoo45.kim@samsung.com>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ */
+
+#include <linux/i2c.h>
+#include <linux/slab.h>
+#include <linux/irq.h>
+#include <linux/interrupt.h>
+#include <linux/delay.h>
+#include <linux/gpio.h>
+#include <linux/regulator/consumer.h>
+#include <linux/videodev2.h>
+#include <media/v4l2-ctrls.h>
+#include <media/v4l2-device.h>
+#include <media/v4l2-subdev.h>
+#include <media/m5mols.h>
+
+#include "m5mols.h"
+#include "m5mols_reg.h"
+
+static int m5mols_capture_error_handler(struct m5mols_info *info,
+                                        int timeout)
+{
+        int ret;
+
+        /* Disable all interrupts and clear relevant interrupt staus bits */
+        ret = m5mols_write(&info->sd, SYSTEM_INT_ENABLE,
+                           info->interrupt & ~(REG_INT_CAPTURE));
+        if (ret)
+                return ret;
+
+        if (timeout == 0)
+                return -ETIMEDOUT;
+
+        return 0;
+}
+/**
+ * m5mols_read_rational - I2C read of a rational number
+ *
+ * Read numerator and denominator from registers @addr_num and @addr_den
+ * respectively and return the division result in @val.
+ */
+static int m5mols_read_rational(struct v4l2_subdev *sd, u32 addr_num,
+                                u32 addr_den, u32 *val)
+{
+        u32 num, den;
+
+        int ret = m5mols_read_u32(sd, addr_num, &num);
+        if (!ret)
+                ret = m5mols_read_u32(sd, addr_den, &den);
+        if (ret)
+                return ret;
+        *val = den == 0 ? 0 : num / den;
+        return ret;
+}
+
+/**
+ * m5mols_capture_info - Gather captured image information
+ *
+ * For now it gathers only EXIF information and file size.
+ */
+static int m5mols_capture_info(struct m5mols_info *info)
+{
+        struct m5mols_exif *exif = &info->cap.exif;
+        struct v4l2_subdev *sd = &info->sd;
+        int ret;
+
+        ret = m5mols_read_rational(sd, EXIF_INFO_EXPTIME_NU,
+                                   EXIF_INFO_EXPTIME_DE, &exif->exposure_time);
+        if (ret)
+                return ret;
+        ret = m5mols_read_rational(sd, EXIF_INFO_TV_NU, EXIF_INFO_TV_DE,
+                                   &exif->shutter_speed);
+        if (ret)
+                return ret;
+        ret = m5mols_read_rational(sd, EXIF_INFO_AV_NU, EXIF_INFO_AV_DE,
+                                   &exif->aperture);
+        if (ret)
+                return ret;
+        ret = m5mols_read_rational(sd, EXIF_INFO_BV_NU, EXIF_INFO_BV_DE,
+                                   &exif->brightness);
+        if (ret)
+                return ret;
+        ret = m5mols_read_rational(sd, EXIF_INFO_EBV_NU, EXIF_INFO_EBV_DE,
+                                   &exif->exposure_bias);
+        if (ret)
+                return ret;
+
+        ret = m5mols_read_u16(sd, EXIF_INFO_ISO, &exif->iso_speed);
+        if (!ret)
+                ret = m5mols_read_u16(sd, EXIF_INFO_FLASH, &exif->flash);
+        if (!ret)
+                ret = m5mols_read_u16(sd, EXIF_INFO_SDR, &exif->sdr);
+        if (!ret)
+                ret = m5mols_read_u16(sd, EXIF_INFO_QVAL, &exif->qval);
+        if (ret)
+                return ret;
+
+        if (!ret)
+                ret = m5mols_read_u32(sd, CAPC_IMAGE_SIZE, &info->cap.main);
+        if (!ret)
+                ret = m5mols_read_u32(sd, CAPC_THUMB_SIZE, &info->cap.thumb);
+        if (!ret)
+                info->cap.total = info->cap.main + info->cap.thumb;
+
+        return ret;
+}
+
+int m5mols_start_capture(struct m5mols_info *info)
+{
+        struct v4l2_subdev *sd = &info->sd;
+        u8 resolution = info->resolution;
+        int timeout;
+        int ret;
+
+        /*
+         * Preparing capture. Setting control & interrupt before entering
+         * capture mode
+         *
+         * 1) change to MONITOR mode for operating control & interrupt
+         * 2) set controls (considering v4l2_control value & lock 3A)
+         * 3) set interrupt
+         * 4) change to CAPTURE mode
+         */
+        ret = m5mols_mode(info, REG_MONITOR);
+        if (!ret)
+                ret = m5mols_sync_controls(info);
+        if (!ret)
+                ret = m5mols_lock_3a(info, true);
+        if (!ret)
+                ret = m5mols_enable_interrupt(sd, REG_INT_CAPTURE);
+        if (!ret)
+                ret = m5mols_mode(info, REG_CAPTURE);
+        if (!ret) {
+                /* Wait for capture interrupt, after changing capture mode */
+                timeout = wait_event_interruptible_timeout(info->irq_waitq,
+                                           test_bit(ST_CAPT_IRQ, &info->flags),
+                                           msecs_to_jiffies(2000));
+                if (test_and_clear_bit(ST_CAPT_IRQ, &info->flags))
+                        ret = m5mols_capture_error_handler(info, timeout);
+        }
+        if (!ret)
+                ret = m5mols_lock_3a(info, false);
+        if (ret)
+                return ret;
+        /*
+         * Starting capture. Setting capture frame count and resolution and
+         * the format(available format: JPEG, Bayer RAW, YUV).
+         *
+         * 1) select single or multi(enable to 25), format, size
+         * 2) set interrupt
+         * 3) start capture(for main image, now)
+         * 4) get information
+         * 5) notify file size to v4l2 device(e.g, to s5p-fimc v4l2 device)
+         */
+        ret = m5mols_write(sd, CAPC_SEL_FRAME, 1);
+        if (!ret)
+                ret = m5mols_write(sd, CAPP_YUVOUT_MAIN, REG_JPEG);
+        if (!ret)
+                ret = m5mols_write(sd, CAPP_MAIN_IMAGE_SIZE, resolution);
+        if (!ret)
+                ret = m5mols_enable_interrupt(sd, REG_INT_CAPTURE);
+        if (!ret)
+                ret = m5mols_write(sd, CAPC_START, REG_CAP_START_MAIN);
+        if (!ret) {
+                /* Wait for the capture completion interrupt */
+                timeout = wait_event_interruptible_timeout(info->irq_waitq,
+                                           test_bit(ST_CAPT_IRQ, &info->flags),
+                                           msecs_to_jiffies(2000));
+                if (test_and_clear_bit(ST_CAPT_IRQ, &info->flags)) {
+                        ret = m5mols_capture_info(info);
+                        if (!ret)
+                                v4l2_subdev_notify(sd, 0, &info->cap.total);
+                }
+        }
+
+        return m5mols_capture_error_handler(info, timeout);
+}