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