LXR linux/drivers/media/i2c/m5mols/m5mols

   1// SPDX-License-Identifier: GPL-2.0-or-later
   2
   3/*
   4 * The Capture code for Fujitsu M-5MOLS ISP
   5 *
   6 * Copyright (C) 2011 Samsung Electronics Co., Ltd.
   7 * Author: HeungJun Kim <riverful.kim@samsung.com>
   8 *
   9 * Copyright (C) 2009 Samsung Electronics Co., Ltd.
  10 * Author: Dongsoo Nathaniel Kim <dongsoo45.kim@samsung.com>
  11 */
  12
  13#include <linux/i2c.h>
  14#include <linux/slab.h>
  15#include <linux/irq.h>
  16#include <linux/interrupt.h>
  17#include <linux/delay.h>
  18#include <linux/gpio.h>
  19#include <linux/regulator/consumer.h>
  20#include <linux/videodev2.h>
  21#include <media/v4l2-ctrls.h>
  22#include <media/v4l2-device.h>
  23#include <media/v4l2-subdev.h>
  24#include <media/i2c/m5mols.h>
  25#include <media/drv-intf/exynos-fimc.h>
  26
  27#include "m5mols.h"
  28#include "m5mols_reg.h"
  29
  30/**
  31 * m5mols_read_rational - I2C read of a rational number
  32 * @sd: sub-device, as pointed by struct v4l2_subdev
  33 * @addr_num: numerator register
  34 * @addr_den: denominator register
  35 * @val: place to store the division result
  36 *
  37 * Read numerator and denominator from registers @addr_num and @addr_den
  38 * respectively and return the division result in @val.
  39 */
  40static int m5mols_read_rational(struct v4l2_subdev *sd, u32 addr_num,
  41                                u32 addr_den, u32 *val)
  42{
  43        u32 num, den;
  44
  45        int ret = m5mols_read_u32(sd, addr_num, &num);
  46        if (!ret)
  47                ret = m5mols_read_u32(sd, addr_den, &den);
  48        if (ret)
  49                return ret;
  50        *val = den == 0 ? 0 : num / den;
  51        return ret;
  52}
  53
  54/**
  55 * m5mols_capture_info - Gather captured image information
  56 * @info: M-5MOLS driver data structure
  57 *
  58 * For now it gathers only EXIF information and file size.
  59 */
  60static int m5mols_capture_info(struct m5mols_info *info)
  61{
  62        struct m5mols_exif *exif = &info->cap.exif;
  63        struct v4l2_subdev *sd = &info->sd;
  64        int ret;
  65
  66        ret = m5mols_read_rational(sd, EXIF_INFO_EXPTIME_NU,
  67                                   EXIF_INFO_EXPTIME_DE, &exif->exposure_time);
  68        if (ret)
  69                return ret;
  70        ret = m5mols_read_rational(sd, EXIF_INFO_TV_NU, EXIF_INFO_TV_DE,
  71                                   &exif->shutter_speed);
  72        if (ret)
  73                return ret;
  74        ret = m5mols_read_rational(sd, EXIF_INFO_AV_NU, EXIF_INFO_AV_DE,
  75                                   &exif->aperture);
  76        if (ret)
  77                return ret;
  78        ret = m5mols_read_rational(sd, EXIF_INFO_BV_NU, EXIF_INFO_BV_DE,
  79                                   &exif->brightness);
  80        if (ret)
  81                return ret;
  82        ret = m5mols_read_rational(sd, EXIF_INFO_EBV_NU, EXIF_INFO_EBV_DE,
  83                                   &exif->exposure_bias);
  84        if (ret)
  85                return ret;
  86
  87        ret = m5mols_read_u16(sd, EXIF_INFO_ISO, &exif->iso_speed);
  88        if (!ret)
  89                ret = m5mols_read_u16(sd, EXIF_INFO_FLASH, &exif->flash);
  90        if (!ret)
  91                ret = m5mols_read_u16(sd, EXIF_INFO_SDR, &exif->sdr);
  92        if (!ret)
  93                ret = m5mols_read_u16(sd, EXIF_INFO_QVAL, &exif->qval);
  94        if (ret)
  95                return ret;
  96
  97        if (!ret)
  98                ret = m5mols_read_u32(sd, CAPC_IMAGE_SIZE, &info->cap.main);
  99        if (!ret)
 100                ret = m5mols_read_u32(sd, CAPC_THUMB_SIZE, &info->cap.thumb);
 101        if (!ret)
 102                info->cap.total = info->cap.main + info->cap.thumb;
 103
 104        return ret;
 105}
 106
 107int m5mols_start_capture(struct m5mols_info *info)
 108{
 109        unsigned int framesize = info->cap.buf_size - M5MOLS_JPEG_TAGS_SIZE;
 110        struct v4l2_subdev *sd = &info->sd;
 111        int ret;
 112
 113        /*
 114         * Synchronize the controls, set the capture frame resolution and color
 115         * format. The frame capture is initiated during switching from Monitor
 116         * to Capture mode.
 117         */
 118        ret = m5mols_set_mode(info, REG_MONITOR);
 119        if (!ret)
 120                ret = m5mols_restore_controls(info);
 121        if (!ret)
 122                ret = m5mols_write(sd, CAPP_YUVOUT_MAIN, REG_JPEG);
 123        if (!ret)
 124                ret = m5mols_write(sd, CAPP_MAIN_IMAGE_SIZE, info->resolution);
 125        if (!ret)
 126                ret = m5mols_write(sd, CAPP_JPEG_SIZE_MAX, framesize);
 127        if (!ret)
 128                ret = m5mols_set_mode(info, REG_CAPTURE);
 129        if (!ret)
 130                /* Wait until a frame is captured to ISP internal memory */
 131                ret = m5mols_wait_interrupt(sd, REG_INT_CAPTURE, 2000);
 132        if (ret)
 133                return ret;
 134
 135        /*
 136         * Initiate the captured data transfer to a MIPI-CSI receiver.
 137         */
 138        ret = m5mols_write(sd, CAPC_SEL_FRAME, 1);
 139        if (!ret)
 140                ret = m5mols_write(sd, CAPC_START, REG_CAP_START_MAIN);
 141        if (!ret) {
 142                bool captured = false;
 143                unsigned int size;
 144
 145                /* Wait for the capture completion interrupt */
 146                ret = m5mols_wait_interrupt(sd, REG_INT_CAPTURE, 2000);
 147                if (!ret) {
 148                        captured = true;
 149                        ret = m5mols_capture_info(info);
 150                }
 151                size = captured ? info->cap.main : 0;
 152                v4l2_dbg(1, m5mols_debug, sd, "%s: size: %d, thumb.: %d B\n",
 153                         __func__, size, info->cap.thumb);
 154
 155                v4l2_subdev_notify(sd, S5P_FIMC_TX_END_NOTIFY, &size);
 156        }
 157
 158        return ret;
 159}
 160