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