i2c/m5mols/m5mols_capture.c

0001 // SPDX-License-Identifier: GPL-2.0-or-later
0002
0003 /*
0004  * The Capture code for Fujitsu M-5MOLS ISP
0005  *
0006  * Copyright (C) 2011 Samsung Electronics Co., Ltd.
0007  * Author: HeungJun Kim <riverful.kim@samsung.com>
0008  *
0009  * Copyright (C) 2009 Samsung Electronics Co., Ltd.
0010  * Author: Dongsoo Nathaniel Kim <dongsoo45.kim@samsung.com>
0011  */
0012
0013 #include <linux/i2c.h>
0014 #include <linux/slab.h>
0015 #include <linux/irq.h>
0016 #include <linux/interrupt.h>
0017 #include <linux/delay.h>
0018 #include <linux/regulator/consumer.h>
0019 #include <linux/videodev2.h>
0020 #include <media/v4l2-ctrls.h>
0021 #include <media/v4l2-device.h>
0022 #include <media/v4l2-subdev.h>
0023 #include <media/i2c/m5mols.h>
0024 #include <media/drv-intf/exynos-fimc.h>
0025
0026 #include "m5mols.h"
0027 #include "m5mols_reg.h"
0028
0029 /**
0030  * m5mols_read_rational - I2C read of a rational number
0031  * @sd: sub-device, as pointed by struct v4l2_subdev
0032  * @addr_num: numerator register
0033  * @addr_den: denominator register
0034  * @val: place to store the division result
0035  *
0036  * Read numerator and denominator from registers @addr_num and @addr_den
0037  * respectively and return the division result in @val.
0038  */
0039 static int m5mols_read_rational(struct v4l2_subdev *sd, u32 addr_num,
0040                 u32 addr_den, u32 *val)
0041 {
0042     u32 num, den;
0043
0044     int ret = m5mols_read_u32(sd, addr_num, &num);
0045     if (!ret)
0046         ret = m5mols_read_u32(sd, addr_den, &den);
0047     if (ret)
0048         return ret;
0049     *val = den == 0 ? 0 : num / den;
0050     return ret;
0051 }
0052
0053 /**
0054  * m5mols_capture_info - Gather captured image information
0055  * @info: M-5MOLS driver data structure
0056  *
0057  * For now it gathers only EXIF information and file size.
0058  */
0059 static int m5mols_capture_info(struct m5mols_info *info)
0060 {
0061     struct m5mols_exif *exif = &info->cap.exif;
0062     struct v4l2_subdev *sd = &info->sd;
0063     int ret;
0064
0065     ret = m5mols_read_rational(sd, EXIF_INFO_EXPTIME_NU,
0066                    EXIF_INFO_EXPTIME_DE, &exif->exposure_time);
0067     if (ret)
0068         return ret;
0069     ret = m5mols_read_rational(sd, EXIF_INFO_TV_NU, EXIF_INFO_TV_DE,
0070                    &exif->shutter_speed);
0071     if (ret)
0072         return ret;
0073     ret = m5mols_read_rational(sd, EXIF_INFO_AV_NU, EXIF_INFO_AV_DE,
0074                    &exif->aperture);
0075     if (ret)
0076         return ret;
0077     ret = m5mols_read_rational(sd, EXIF_INFO_BV_NU, EXIF_INFO_BV_DE,
0078                    &exif->brightness);
0079     if (ret)
0080         return ret;
0081     ret = m5mols_read_rational(sd, EXIF_INFO_EBV_NU, EXIF_INFO_EBV_DE,
0082                    &exif->exposure_bias);
0083     if (ret)
0084         return ret;
0085
0086     ret = m5mols_read_u16(sd, EXIF_INFO_ISO, &exif->iso_speed);
0087     if (!ret)
0088         ret = m5mols_read_u16(sd, EXIF_INFO_FLASH, &exif->flash);
0089     if (!ret)
0090         ret = m5mols_read_u16(sd, EXIF_INFO_SDR, &exif->sdr);
0091     if (!ret)
0092         ret = m5mols_read_u16(sd, EXIF_INFO_QVAL, &exif->qval);
0093     if (ret)
0094         return ret;
0095
0096     if (!ret)
0097         ret = m5mols_read_u32(sd, CAPC_IMAGE_SIZE, &info->cap.main);
0098     if (!ret)
0099         ret = m5mols_read_u32(sd, CAPC_THUMB_SIZE, &info->cap.thumb);
0100     if (!ret)
0101         info->cap.total = info->cap.main + info->cap.thumb;
0102
0103     return ret;
0104 }
0105
0106 int m5mols_start_capture(struct m5mols_info *info)
0107 {
0108     unsigned int framesize = info->cap.buf_size - M5MOLS_JPEG_TAGS_SIZE;
0109     struct v4l2_subdev *sd = &info->sd;
0110     int ret;
0111
0112     /*
0113      * Synchronize the controls, set the capture frame resolution and color
0114      * format. The frame capture is initiated during switching from Monitor
0115      * to Capture mode.
0116      */
0117     ret = m5mols_set_mode(info, REG_MONITOR);
0118     if (!ret)
0119         ret = m5mols_restore_controls(info);
0120     if (!ret)
0121         ret = m5mols_write(sd, CAPP_YUVOUT_MAIN, REG_JPEG);
0122     if (!ret)
0123         ret = m5mols_write(sd, CAPP_MAIN_IMAGE_SIZE, info->resolution);
0124     if (!ret)
0125         ret = m5mols_write(sd, CAPP_JPEG_SIZE_MAX, framesize);
0126     if (!ret)
0127         ret = m5mols_set_mode(info, REG_CAPTURE);
0128     if (!ret)
0129         /* Wait until a frame is captured to ISP internal memory */
0130         ret = m5mols_wait_interrupt(sd, REG_INT_CAPTURE, 2000);
0131     if (ret)
0132         return ret;
0133
0134     /*
0135      * Initiate the captured data transfer to a MIPI-CSI receiver.
0136      */
0137     ret = m5mols_write(sd, CAPC_SEL_FRAME, 1);
0138     if (!ret)
0139         ret = m5mols_write(sd, CAPC_START, REG_CAP_START_MAIN);
0140     if (!ret) {
0141         bool captured = false;
0142         unsigned int size;
0143
0144         /* Wait for the capture completion interrupt */
0145         ret = m5mols_wait_interrupt(sd, REG_INT_CAPTURE, 2000);
0146         if (!ret) {
0147             captured = true;
0148             ret = m5mols_capture_info(info);
0149         }
0150         size = captured ? info->cap.main : 0;
0151         v4l2_dbg(1, m5mols_debug, sd, "%s: size: %d, thumb.: %d B\n",
0152              __func__, size, info->cap.thumb);
0153
0154         v4l2_subdev_notify(sd, S5P_FIMC_TX_END_NOTIFY, &size);
0155     }
0156
0157     return ret;
0158 }