3 * @author Nicolas VIVIEN
6 * @brief Device specific functions
8 * @note Copyright (C) Nicolas VIVIEN
12 * This program is free software; you can redistribute it and/or modify
13 * it under the terms of the GNU General Public License as published by
14 * the Free Software Foundation; either version 2 of the License, or
17 * This program is distributed in the hope that it will be useful,
18 * but WITHOUT ANY WARRANTY; without even the implied warranty of
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 * GNU General Public License for more details.
22 * You should have received a copy of the GNU General Public License
23 * along with this program; if not, write to the Free Software
24 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
27 #include <linux/errno.h>
28 #include <linux/string.h>
32 #include "sn9c20x-bridge.h"
33 #include "omnivision.h"
36 int (*sn_probes
[])(struct usb_sn9c20x
*dev
) = {
42 struct sn9c20x_video_mode sn9c20x_modes
[SN9C20X_N_MODES
] = {
46 .scale
= SN9C20X_1_4_SCALE
,
47 .window
= {65, 48, 1024, 768}
52 .scale
= SN9C20X_1_4_SCALE
,
53 .window
= {0, 0, 640, 480}
58 .scale
= SN9C20X_1_2_SCALE
,
59 .window
= {145, 96, 704, 576}
64 .scale
= SN9C20X_1_2_SCALE
,
65 .window
= {0, 0, 640, 480}
70 .scale
= SN9C20X_NO_SCALE
,
71 .window
= {145, 96, 704, 576}
76 .scale
= SN9C20X_NO_SCALE
,
77 .window
= {0, 0, 640, 480}
81 struct sn9c20x_video_format sn9c20x_fmts
[SN9C20X_N_FMTS
] = {
83 .pix_fmt
= V4L2_PIX_FMT_SBGGR8
,
84 .desc
= "Bayer 8bit (BGGR)",
86 .set_format
= sn9c20x_set_raw
,
89 .pix_fmt
= V4L2_PIX_FMT_YUV420
,
90 .desc
= "I420 (YUV 4:2:0)",
92 .set_format
= sn9c20x_set_yuv420
,
95 .pix_fmt
= V4L2_PIX_FMT_YUYV
,
96 .desc
= "YUYV (YUV 4:2:0)",
98 .set_format
= sn9c20x_set_yuv422
,
101 .pix_fmt
= V4L2_PIX_FMT_JPEG
,
102 .desc
= "JPEG (YUV 4:2:2)",
104 .set_format
= sn9c20x_set_jpeg
,
108 int sn9c20x_initialize_sensor(struct usb_sn9c20x
*dev
)
113 dev
->camera
.min_yavg
= 60;
114 dev
->camera
.max_yavg
= 150;
115 dev
->camera
.min_stable_yavg
= 70;
116 dev
->camera
.max_stable_yavg
= 140;
118 /* Probe sensor first if sensor set to probe*/
119 if (dev
->camera
.sensor
== PROBE_SENSOR
) {
120 for (i
= 0; i
< ARRAY_SIZE(sn_probes
); i
++) {
121 ret
= sn_probes
[i
](dev
);
124 dev
->camera
.sensor
= ret
;
128 switch (dev
->camera
.sensor
) {
130 sn9c20x_write_i2c_array(dev
, soi968_init
, 0);
131 dev
->camera
.set_exposure
= soi968_set_exposure
;
132 dev
->camera
.set_auto_exposure
= soi968_set_autoexposure
;
133 dev
->camera
.set_gain
= soi968_set_gain
;
134 dev
->camera
.set_auto_gain
= ov_set_autogain
;
135 dev
->camera
.button_detect
= soi968_button_detect
;
136 dev
->camera
.hstart
= 60;
137 dev
->camera
.vstart
= 11;
138 UDIA_INFO("Detected SOI968 Sensor.\n");
141 sn9c20x_write_i2c_array(dev
, ov9650_init
, 0);
142 dev
->camera
.hstart
= 1;
143 dev
->camera
.vstart
= 7;
144 dev
->camera
.set_hvflip
= ov965x_set_hvflip
;
145 dev
->camera
.set_exposure
= ov_set_exposure
;
146 dev
->camera
.set_auto_gain
= ov_set_autogain
;
147 dev
->camera
.flip_detect
= ov965x_flip_detect
;
148 UDIA_INFO("Detected OV9650 Sensor.\n");
151 sn9c20x_write_i2c_array(dev
, ov9655_init
, 0);
152 dev
->camera
.set_exposure
= ov_set_exposure
;
153 dev
->camera
.set_auto_gain
= ov_set_autogain
;
154 dev
->camera
.hstart
= 0;
155 dev
->camera
.vstart
= 7;
156 UDIA_INFO("Detected OV9655 Sensor.\n");
159 sn9c20x_write_i2c_array(dev
, ov7670_init
, 0);
160 dev
->camera
.set_exposure
= ov_set_exposure
;
161 dev
->camera
.set_auto_gain
= ov_set_autogain
;
162 dev
->camera
.flip_detect
= ov7670_flip_detect
;
163 dev
->camera
.hstart
= 0;
164 dev
->camera
.vstart
= 1;
165 UDIA_INFO("Detected OV7670 Sensor.\n");
168 sn9c20x_write_i2c_array(dev
, ov7660_init
, 0);
169 dev
->camera
.set_exposure
= ov_set_exposure
;
170 dev
->camera
.set_auto_gain
= ov_set_autogain
;
171 dev
->camera
.hstart
= 1;
172 dev
->camera
.vstart
= 1;
173 UDIA_INFO("Detected OV7660 Sensor.\n");
176 sn9c20x_write_i2c_array(dev
, mt9v111_init
, 1);
177 dev
->camera
.set_hvflip
= mt9v111_set_hvflip
;
178 dev
->camera
.set_exposure
= mt9v111_set_exposure
;
179 dev
->camera
.set_auto_exposure
= mt9v111_set_autoexposure
;
180 dev
->camera
.hstart
= 2;
181 dev
->camera
.vstart
= 2;
182 UDIA_INFO("Detected MT9V111 Sensor.\n");
185 sn9c20x_write_i2c_array(dev
, mt9v112_init
, 1);
186 dev
->camera
.hstart
= 6;
187 dev
->camera
.vstart
= 2;
188 UDIA_INFO("Detected MT9V112 Sensor.\n");
191 sn9c20x_write_i2c_array(dev
, mt9m111_init
, 1);
192 dev
->camera
.hstart
= 6;
193 dev
->camera
.vstart
= 2;
194 UDIA_INFO("Detected MT9M111 Sensor.\n");
197 sn9c20x_write_i2c_array(dev
, mt9v011_init
, 1);
198 dev
->camera
.set_hvflip
= mt9v011_set_hvflip
;
199 dev
->camera
.set_exposure
= mt9v011_set_exposure
;
200 dev
->camera
.hstart
= 2;
201 dev
->camera
.vstart
= 2;
202 UDIA_INFO("Detected MT9V011 Sensor.\n");
205 sn9c20x_write_i2c_array(dev
, mt9m001_init
, 1);
206 dev
->camera
.hstart
= 2;
207 dev
->camera
.vstart
= 2;
208 UDIA_INFO("Detected MT9M001 Sensor.\n");
211 dev
->camera
.i2c_flags
|= SN9C20X_I2C_400KHZ
;
212 sn9c20x_write_i2c_array(dev
, hv7131r_init
, 0);
213 dev
->camera
.set_hvflip
= hv7131r_set_hvflip
;
214 dev
->camera
.set_gain
= hv7131r_set_gain
;
215 dev
->camera
.set_exposure
= hv7131r_set_exposure
;
216 dev
->camera
.hstart
= 0;
217 dev
->camera
.vstart
= 1;
218 UDIA_INFO("Detected HV7131R Sensor.\n");
222 UDIA_INFO("Unsupported sensor.\n");
229 * @brief Wrapper function to detect hardware states
231 * @param dev Pointer to device structure
235 int dev_sn9c20x_call_constantly(struct usb_sn9c20x
*dev
)
238 /* Know to be broken, temporarely disabled */
239 /*dev_sn9c20x_flip_detection(dev);*/
240 dev_sn9c20x_button_detection(dev
);
241 if (!dev
->camera
.set_auto_exposure
&&
242 dev
->vsettings
.auto_exposure
== V4L2_EXPOSURE_AUTO
) {
243 dev_sn9c20x_perform_soft_ae(dev
);
250 * @brief Wrapper function to detect a flipped sensor
252 * @param dev Pointer to device structure
254 * @returns 0 or negative error value
257 int dev_sn9c20x_flip_detection(struct usb_sn9c20x
*dev
)
260 if (dev
&& dev
->camera
.flip_detect
)
261 ret
= dev
->camera
.flip_detect(dev
);
266 * @brief Wrapper function to detect a pushed button
268 * @param dev Pointer to device structure
270 * @returns 0 or negative error value
273 int dev_sn9c20x_button_detection(struct usb_sn9c20x
*dev
)
276 if (dev
&& dev
->camera
.button_detect
)
277 ret
= dev
->camera
.button_detect(dev
);
282 * @brief Perform software autoexposure
286 * @returns 0 or negative error value
288 * @author Vasily Khoruzhick
290 int dev_sn9c20x_perform_soft_ae(struct usb_sn9c20x
*dev
)
293 static int old_yavg
= -1;
294 int koef
= 100, new_exp
, i
;
298 if (!dev
->camera
.set_exposure
)
300 yavg
= atomic_read(&dev
->camera
.yavg
);
302 UDIA_INFO("Sensor YAVG: %d\n", yavg
);
304 /* Can't get YAVG - we have nothing to do */
308 /* Image is too dark */
309 if (yavg
< dev
->camera
.min_yavg
) {
310 /* yavg can't be 0 - in that way new_exp == infinity */
313 if (old_yavg
!= -1) {
314 /* Previous correction was made to make image darker,
315 * but we made it too dark. Calculating our error
316 * and taking it into account.
317 * Usually error is 0.7 - 2, so we multiply it by 100
319 if (old_yavg
> dev
->camera
.max_yavg
)
320 koef
= 100 * dev
->camera
.
321 min_stable_yavg
/ yavg
;
326 /* Calculating new exposure value. We assuming that
327 * exposure linearly depends on YAVG, but we taking
328 * our calculated error into account */
329 new_exp
= (dev
->camera
.min_stable_yavg
330 * dev
->vsettings
.exposure
* 100) / (yavg
* koef
);
332 /* Exposure can't be more than 0xff or less than 0x1 */
340 /* Applying new exposure */
341 dev
->vsettings
.exposure
= new_exp
;
342 dev
->camera
.set_exposure(dev
);
345 /* Image is too bright */
346 else if (yavg
> dev
->camera
.max_yavg
) {
347 /* yavg can't be 0 - in that way new_exp == infinity */
350 if (old_yavg
!= -1) {
352 /* Previous correction was made to make image brighter,
353 * but we made it too bright. Calculating our error
354 * and taking it into account.
355 * Usually error is 0.7 - 2, so we multiply it by 100
357 if (old_yavg
< dev
->camera
.min_yavg
)
358 koef
= 100 * yavg
/ dev
->camera
.
364 /* Calculating new exposure value. We assuming that
365 * exposure linearly depends on YAVG, but we taking
366 * our calculated error into account */
367 new_exp
= (koef
* dev
->camera
.max_stable_yavg
368 * dev
->vsettings
.exposure
) / (yavg
* 100);
370 /* Exposure can't be more than 0xff or less than 0x1 */
378 /* Applying new exposure */
379 dev
->vsettings
.exposure
= new_exp
;
380 dev
->camera
.set_exposure(dev
);