diff options
author | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
commit | 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch) | |
tree | 0bba044c4ce775e45a88a51686b5d9f90697ea9d /drivers/media/video/ovcamchip/ov6x20.c |
Linux-2.6.12-rc2v2.6.12-rc2
Initial git repository build. I'm not bothering with the full history,
even though we have it. We can create a separate "historical" git
archive of that later if we want to, and in the meantime it's about
3.2GB when imported into git - space that would just make the early
git days unnecessarily complicated, when we don't have a lot of good
infrastructure for it.
Let it rip!
Diffstat (limited to 'drivers/media/video/ovcamchip/ov6x20.c')
-rw-r--r-- | drivers/media/video/ovcamchip/ov6x20.c | 415 |
1 files changed, 415 insertions, 0 deletions
diff --git a/drivers/media/video/ovcamchip/ov6x20.c b/drivers/media/video/ovcamchip/ov6x20.c new file mode 100644 index 000000000000..3433619ad93f --- /dev/null +++ b/drivers/media/video/ovcamchip/ov6x20.c | |||
@@ -0,0 +1,415 @@ | |||
1 | /* OmniVision OV6620/OV6120 Camera Chip Support Code | ||
2 | * | ||
3 | * Copyright (c) 1999-2004 Mark McClelland <mark@alpha.dyndns.org> | ||
4 | * http://alpha.dyndns.org/ov511/ | ||
5 | * | ||
6 | * This program is free software; you can redistribute it and/or modify it | ||
7 | * under the terms of the GNU General Public License as published by the | ||
8 | * Free Software Foundation; either version 2 of the License, or (at your | ||
9 | * option) any later version. NO WARRANTY OF ANY KIND is expressed or implied. | ||
10 | */ | ||
11 | |||
12 | #define DEBUG | ||
13 | |||
14 | #include <linux/slab.h> | ||
15 | #include "ovcamchip_priv.h" | ||
16 | |||
17 | /* Registers */ | ||
18 | #define REG_GAIN 0x00 /* gain [5:0] */ | ||
19 | #define REG_BLUE 0x01 /* blue gain */ | ||
20 | #define REG_RED 0x02 /* red gain */ | ||
21 | #define REG_SAT 0x03 /* saturation */ | ||
22 | #define REG_CNT 0x05 /* Y contrast */ | ||
23 | #define REG_BRT 0x06 /* Y brightness */ | ||
24 | #define REG_WB_BLUE 0x0C /* WB blue ratio [5:0] */ | ||
25 | #define REG_WB_RED 0x0D /* WB red ratio [5:0] */ | ||
26 | #define REG_EXP 0x10 /* exposure */ | ||
27 | |||
28 | /* Window parameters */ | ||
29 | #define HWSBASE 0x38 | ||
30 | #define HWEBASE 0x3A | ||
31 | #define VWSBASE 0x05 | ||
32 | #define VWEBASE 0x06 | ||
33 | |||
34 | struct ov6x20 { | ||
35 | int auto_brt; | ||
36 | int auto_exp; | ||
37 | int backlight; | ||
38 | int bandfilt; | ||
39 | int mirror; | ||
40 | }; | ||
41 | |||
42 | /* Initial values for use with OV511/OV511+ cameras */ | ||
43 | static struct ovcamchip_regvals regvals_init_6x20_511[] = { | ||
44 | { 0x12, 0x80 }, /* reset */ | ||
45 | { 0x11, 0x01 }, | ||
46 | { 0x03, 0x60 }, | ||
47 | { 0x05, 0x7f }, /* For when autoadjust is off */ | ||
48 | { 0x07, 0xa8 }, | ||
49 | { 0x0c, 0x24 }, | ||
50 | { 0x0d, 0x24 }, | ||
51 | { 0x0f, 0x15 }, /* COMS */ | ||
52 | { 0x10, 0x75 }, /* AEC Exposure time */ | ||
53 | { 0x12, 0x24 }, /* Enable AGC and AWB */ | ||
54 | { 0x14, 0x04 }, | ||
55 | { 0x16, 0x03 }, | ||
56 | { 0x26, 0xb2 }, /* BLC enable */ | ||
57 | /* 0x28: 0x05 Selects RGB format if RGB on */ | ||
58 | { 0x28, 0x05 }, | ||
59 | { 0x2a, 0x04 }, /* Disable framerate adjust */ | ||
60 | { 0x2d, 0x99 }, | ||
61 | { 0x33, 0xa0 }, /* Color Processing Parameter */ | ||
62 | { 0x34, 0xd2 }, /* Max A/D range */ | ||
63 | { 0x38, 0x8b }, | ||
64 | { 0x39, 0x40 }, | ||
65 | |||
66 | { 0x3c, 0x39 }, /* Enable AEC mode changing */ | ||
67 | { 0x3c, 0x3c }, /* Change AEC mode */ | ||
68 | { 0x3c, 0x24 }, /* Disable AEC mode changing */ | ||
69 | |||
70 | { 0x3d, 0x80 }, | ||
71 | /* These next two registers (0x4a, 0x4b) are undocumented. They | ||
72 | * control the color balance */ | ||
73 | { 0x4a, 0x80 }, | ||
74 | { 0x4b, 0x80 }, | ||
75 | { 0x4d, 0xd2 }, /* This reduces noise a bit */ | ||
76 | { 0x4e, 0xc1 }, | ||
77 | { 0x4f, 0x04 }, | ||
78 | { 0xff, 0xff }, /* END MARKER */ | ||
79 | }; | ||
80 | |||
81 | /* Initial values for use with OV518 cameras */ | ||
82 | static struct ovcamchip_regvals regvals_init_6x20_518[] = { | ||
83 | { 0x12, 0x80 }, /* Do a reset */ | ||
84 | { 0x03, 0xc0 }, /* Saturation */ | ||
85 | { 0x05, 0x8a }, /* Contrast */ | ||
86 | { 0x0c, 0x24 }, /* AWB blue */ | ||
87 | { 0x0d, 0x24 }, /* AWB red */ | ||
88 | { 0x0e, 0x8d }, /* Additional 2x gain */ | ||
89 | { 0x0f, 0x25 }, /* Black expanding level = 1.3V */ | ||
90 | { 0x11, 0x01 }, /* Clock div. */ | ||
91 | { 0x12, 0x24 }, /* Enable AGC and AWB */ | ||
92 | { 0x13, 0x01 }, /* (default) */ | ||
93 | { 0x14, 0x80 }, /* Set reserved bit 7 */ | ||
94 | { 0x15, 0x01 }, /* (default) */ | ||
95 | { 0x16, 0x03 }, /* (default) */ | ||
96 | { 0x17, 0x38 }, /* (default) */ | ||
97 | { 0x18, 0xea }, /* (default) */ | ||
98 | { 0x19, 0x04 }, | ||
99 | { 0x1a, 0x93 }, | ||
100 | { 0x1b, 0x00 }, /* (default) */ | ||
101 | { 0x1e, 0xc4 }, /* (default) */ | ||
102 | { 0x1f, 0x04 }, /* (default) */ | ||
103 | { 0x20, 0x20 }, /* Enable 1st stage aperture correction */ | ||
104 | { 0x21, 0x10 }, /* Y offset */ | ||
105 | { 0x22, 0x88 }, /* U offset */ | ||
106 | { 0x23, 0xc0 }, /* Set XTAL power level */ | ||
107 | { 0x24, 0x53 }, /* AEC bright ratio */ | ||
108 | { 0x25, 0x7a }, /* AEC black ratio */ | ||
109 | { 0x26, 0xb2 }, /* BLC enable */ | ||
110 | { 0x27, 0xa2 }, /* Full output range */ | ||
111 | { 0x28, 0x01 }, /* (default) */ | ||
112 | { 0x29, 0x00 }, /* (default) */ | ||
113 | { 0x2a, 0x84 }, /* (default) */ | ||
114 | { 0x2b, 0xa8 }, /* Set custom frame rate */ | ||
115 | { 0x2c, 0xa0 }, /* (reserved) */ | ||
116 | { 0x2d, 0x95 }, /* Enable banding filter */ | ||
117 | { 0x2e, 0x88 }, /* V offset */ | ||
118 | { 0x33, 0x22 }, /* Luminance gamma on */ | ||
119 | { 0x34, 0xc7 }, /* A/D bias */ | ||
120 | { 0x36, 0x12 }, /* (reserved) */ | ||
121 | { 0x37, 0x63 }, /* (reserved) */ | ||
122 | { 0x38, 0x8b }, /* Quick AEC/AEB */ | ||
123 | { 0x39, 0x00 }, /* (default) */ | ||
124 | { 0x3a, 0x0f }, /* (default) */ | ||
125 | { 0x3b, 0x3c }, /* (default) */ | ||
126 | { 0x3c, 0x5c }, /* AEC controls */ | ||
127 | { 0x3d, 0x80 }, /* Drop 1 (bad) frame when AEC change */ | ||
128 | { 0x3e, 0x80 }, /* (default) */ | ||
129 | { 0x3f, 0x02 }, /* (default) */ | ||
130 | { 0x40, 0x10 }, /* (reserved) */ | ||
131 | { 0x41, 0x10 }, /* (reserved) */ | ||
132 | { 0x42, 0x00 }, /* (reserved) */ | ||
133 | { 0x43, 0x7f }, /* (reserved) */ | ||
134 | { 0x44, 0x80 }, /* (reserved) */ | ||
135 | { 0x45, 0x1c }, /* (reserved) */ | ||
136 | { 0x46, 0x1c }, /* (reserved) */ | ||
137 | { 0x47, 0x80 }, /* (reserved) */ | ||
138 | { 0x48, 0x5f }, /* (reserved) */ | ||
139 | { 0x49, 0x00 }, /* (reserved) */ | ||
140 | { 0x4a, 0x00 }, /* Color balance (undocumented) */ | ||
141 | { 0x4b, 0x80 }, /* Color balance (undocumented) */ | ||
142 | { 0x4c, 0x58 }, /* (reserved) */ | ||
143 | { 0x4d, 0xd2 }, /* U *= .938, V *= .838 */ | ||
144 | { 0x4e, 0xa0 }, /* (default) */ | ||
145 | { 0x4f, 0x04 }, /* UV 3-point average */ | ||
146 | { 0x50, 0xff }, /* (reserved) */ | ||
147 | { 0x51, 0x58 }, /* (reserved) */ | ||
148 | { 0x52, 0xc0 }, /* (reserved) */ | ||
149 | { 0x53, 0x42 }, /* (reserved) */ | ||
150 | { 0x27, 0xa6 }, /* Enable manual offset adj. (reg 21 & 22) */ | ||
151 | { 0x12, 0x20 }, | ||
152 | { 0x12, 0x24 }, | ||
153 | |||
154 | { 0xff, 0xff }, /* END MARKER */ | ||
155 | }; | ||
156 | |||
157 | /* This initializes the OV6x20 camera chip and relevant variables. */ | ||
158 | static int ov6x20_init(struct i2c_client *c) | ||
159 | { | ||
160 | struct ovcamchip *ov = i2c_get_clientdata(c); | ||
161 | struct ov6x20 *s; | ||
162 | int rc; | ||
163 | |||
164 | DDEBUG(4, &c->dev, "entered"); | ||
165 | |||
166 | switch (c->adapter->id) { | ||
167 | case I2C_ALGO_SMBUS | I2C_HW_SMBUS_OV511: | ||
168 | rc = ov_write_regvals(c, regvals_init_6x20_511); | ||
169 | break; | ||
170 | case I2C_ALGO_SMBUS | I2C_HW_SMBUS_OV518: | ||
171 | rc = ov_write_regvals(c, regvals_init_6x20_518); | ||
172 | break; | ||
173 | default: | ||
174 | dev_err(&c->dev, "ov6x20: Unsupported adapter\n"); | ||
175 | rc = -ENODEV; | ||
176 | } | ||
177 | |||
178 | if (rc < 0) | ||
179 | return rc; | ||
180 | |||
181 | ov->spriv = s = kmalloc(sizeof *s, GFP_KERNEL); | ||
182 | if (!s) | ||
183 | return -ENOMEM; | ||
184 | memset(s, 0, sizeof *s); | ||
185 | |||
186 | s->auto_brt = 1; | ||
187 | s->auto_exp = 1; | ||
188 | |||
189 | return rc; | ||
190 | } | ||
191 | |||
192 | static int ov6x20_free(struct i2c_client *c) | ||
193 | { | ||
194 | struct ovcamchip *ov = i2c_get_clientdata(c); | ||
195 | |||
196 | kfree(ov->spriv); | ||
197 | return 0; | ||
198 | } | ||
199 | |||
200 | static int ov6x20_set_control(struct i2c_client *c, | ||
201 | struct ovcamchip_control *ctl) | ||
202 | { | ||
203 | struct ovcamchip *ov = i2c_get_clientdata(c); | ||
204 | struct ov6x20 *s = ov->spriv; | ||
205 | int rc; | ||
206 | int v = ctl->value; | ||
207 | |||
208 | switch (ctl->id) { | ||
209 | case OVCAMCHIP_CID_CONT: | ||
210 | rc = ov_write(c, REG_CNT, v >> 8); | ||
211 | break; | ||
212 | case OVCAMCHIP_CID_BRIGHT: | ||
213 | rc = ov_write(c, REG_BRT, v >> 8); | ||
214 | break; | ||
215 | case OVCAMCHIP_CID_SAT: | ||
216 | rc = ov_write(c, REG_SAT, v >> 8); | ||
217 | break; | ||
218 | case OVCAMCHIP_CID_HUE: | ||
219 | rc = ov_write(c, REG_RED, 0xFF - (v >> 8)); | ||
220 | if (rc < 0) | ||
221 | goto out; | ||
222 | |||
223 | rc = ov_write(c, REG_BLUE, v >> 8); | ||
224 | break; | ||
225 | case OVCAMCHIP_CID_EXP: | ||
226 | rc = ov_write(c, REG_EXP, v); | ||
227 | break; | ||
228 | case OVCAMCHIP_CID_FREQ: | ||
229 | { | ||
230 | int sixty = (v == 60); | ||
231 | |||
232 | rc = ov_write(c, 0x2b, sixty?0xa8:0x28); | ||
233 | if (rc < 0) | ||
234 | goto out; | ||
235 | |||
236 | rc = ov_write(c, 0x2a, sixty?0x84:0xa4); | ||
237 | break; | ||
238 | } | ||
239 | case OVCAMCHIP_CID_BANDFILT: | ||
240 | rc = ov_write_mask(c, 0x2d, v?0x04:0x00, 0x04); | ||
241 | s->bandfilt = v; | ||
242 | break; | ||
243 | case OVCAMCHIP_CID_AUTOBRIGHT: | ||
244 | rc = ov_write_mask(c, 0x2d, v?0x10:0x00, 0x10); | ||
245 | s->auto_brt = v; | ||
246 | break; | ||
247 | case OVCAMCHIP_CID_AUTOEXP: | ||
248 | rc = ov_write_mask(c, 0x13, v?0x01:0x00, 0x01); | ||
249 | s->auto_exp = v; | ||
250 | break; | ||
251 | case OVCAMCHIP_CID_BACKLIGHT: | ||
252 | { | ||
253 | rc = ov_write_mask(c, 0x4e, v?0xe0:0xc0, 0xe0); | ||
254 | if (rc < 0) | ||
255 | goto out; | ||
256 | |||
257 | rc = ov_write_mask(c, 0x29, v?0x08:0x00, 0x08); | ||
258 | if (rc < 0) | ||
259 | goto out; | ||
260 | |||
261 | rc = ov_write_mask(c, 0x0e, v?0x80:0x00, 0x80); | ||
262 | s->backlight = v; | ||
263 | break; | ||
264 | } | ||
265 | case OVCAMCHIP_CID_MIRROR: | ||
266 | rc = ov_write_mask(c, 0x12, v?0x40:0x00, 0x40); | ||
267 | s->mirror = v; | ||
268 | break; | ||
269 | default: | ||
270 | DDEBUG(2, &c->dev, "control not supported: %d", ctl->id); | ||
271 | return -EPERM; | ||
272 | } | ||
273 | |||
274 | out: | ||
275 | DDEBUG(3, &c->dev, "id=%d, arg=%d, rc=%d", ctl->id, v, rc); | ||
276 | return rc; | ||
277 | } | ||
278 | |||
279 | static int ov6x20_get_control(struct i2c_client *c, | ||
280 | struct ovcamchip_control *ctl) | ||
281 | { | ||
282 | struct ovcamchip *ov = i2c_get_clientdata(c); | ||
283 | struct ov6x20 *s = ov->spriv; | ||
284 | int rc = 0; | ||
285 | unsigned char val = 0; | ||
286 | |||
287 | switch (ctl->id) { | ||
288 | case OVCAMCHIP_CID_CONT: | ||
289 | rc = ov_read(c, REG_CNT, &val); | ||
290 | ctl->value = val << 8; | ||
291 | break; | ||
292 | case OVCAMCHIP_CID_BRIGHT: | ||
293 | rc = ov_read(c, REG_BRT, &val); | ||
294 | ctl->value = val << 8; | ||
295 | break; | ||
296 | case OVCAMCHIP_CID_SAT: | ||
297 | rc = ov_read(c, REG_SAT, &val); | ||
298 | ctl->value = val << 8; | ||
299 | break; | ||
300 | case OVCAMCHIP_CID_HUE: | ||
301 | rc = ov_read(c, REG_BLUE, &val); | ||
302 | ctl->value = val << 8; | ||
303 | break; | ||
304 | case OVCAMCHIP_CID_EXP: | ||
305 | rc = ov_read(c, REG_EXP, &val); | ||
306 | ctl->value = val; | ||
307 | break; | ||
308 | case OVCAMCHIP_CID_BANDFILT: | ||
309 | ctl->value = s->bandfilt; | ||
310 | break; | ||
311 | case OVCAMCHIP_CID_AUTOBRIGHT: | ||
312 | ctl->value = s->auto_brt; | ||
313 | break; | ||
314 | case OVCAMCHIP_CID_AUTOEXP: | ||
315 | ctl->value = s->auto_exp; | ||
316 | break; | ||
317 | case OVCAMCHIP_CID_BACKLIGHT: | ||
318 | ctl->value = s->backlight; | ||
319 | break; | ||
320 | case OVCAMCHIP_CID_MIRROR: | ||
321 | ctl->value = s->mirror; | ||
322 | break; | ||
323 | default: | ||
324 | DDEBUG(2, &c->dev, "control not supported: %d", ctl->id); | ||
325 | return -EPERM; | ||
326 | } | ||
327 | |||
328 | DDEBUG(3, &c->dev, "id=%d, arg=%d, rc=%d", ctl->id, ctl->value, rc); | ||
329 | return rc; | ||
330 | } | ||
331 | |||
332 | static int ov6x20_mode_init(struct i2c_client *c, struct ovcamchip_window *win) | ||
333 | { | ||
334 | /******** QCIF-specific regs ********/ | ||
335 | |||
336 | ov_write(c, 0x14, win->quarter?0x24:0x04); | ||
337 | |||
338 | /******** Palette-specific regs ********/ | ||
339 | |||
340 | /* OV518 needs 8 bit multiplexed in color mode, and 16 bit in B&W */ | ||
341 | if (c->adapter->id == (I2C_ALGO_SMBUS | I2C_HW_SMBUS_OV518)) { | ||
342 | if (win->format == VIDEO_PALETTE_GREY) | ||
343 | ov_write_mask(c, 0x13, 0x00, 0x20); | ||
344 | else | ||
345 | ov_write_mask(c, 0x13, 0x20, 0x20); | ||
346 | } else { | ||
347 | if (win->format == VIDEO_PALETTE_GREY) | ||
348 | ov_write_mask(c, 0x13, 0x20, 0x20); | ||
349 | else | ||
350 | ov_write_mask(c, 0x13, 0x00, 0x20); | ||
351 | } | ||
352 | |||
353 | /******** Clock programming ********/ | ||
354 | |||
355 | /* The OV6620 needs special handling. This prevents the | ||
356 | * severe banding that normally occurs */ | ||
357 | |||
358 | /* Clock down */ | ||
359 | ov_write(c, 0x2a, 0x04); | ||
360 | |||
361 | ov_write(c, 0x11, win->clockdiv); | ||
362 | |||
363 | ov_write(c, 0x2a, 0x84); | ||
364 | /* This next setting is critical. It seems to improve | ||
365 | * the gain or the contrast. The "reserved" bits seem | ||
366 | * to have some effect in this case. */ | ||
367 | ov_write(c, 0x2d, 0x85); /* FIXME: This messes up banding filter */ | ||
368 | |||
369 | return 0; | ||
370 | } | ||
371 | |||
372 | static int ov6x20_set_window(struct i2c_client *c, struct ovcamchip_window *win) | ||
373 | { | ||
374 | int ret, hwscale, vwscale; | ||
375 | |||
376 | ret = ov6x20_mode_init(c, win); | ||
377 | if (ret < 0) | ||
378 | return ret; | ||
379 | |||
380 | if (win->quarter) { | ||
381 | hwscale = 0; | ||
382 | vwscale = 0; | ||
383 | } else { | ||
384 | hwscale = 1; | ||
385 | vwscale = 1; /* The datasheet says 0; it's wrong */ | ||
386 | } | ||
387 | |||
388 | ov_write(c, 0x17, HWSBASE + (win->x >> hwscale)); | ||
389 | ov_write(c, 0x18, HWEBASE + ((win->x + win->width) >> hwscale)); | ||
390 | ov_write(c, 0x19, VWSBASE + (win->y >> vwscale)); | ||
391 | ov_write(c, 0x1a, VWEBASE + ((win->y + win->height) >> vwscale)); | ||
392 | |||
393 | return 0; | ||
394 | } | ||
395 | |||
396 | static int ov6x20_command(struct i2c_client *c, unsigned int cmd, void *arg) | ||
397 | { | ||
398 | switch (cmd) { | ||
399 | case OVCAMCHIP_CMD_S_CTRL: | ||
400 | return ov6x20_set_control(c, arg); | ||
401 | case OVCAMCHIP_CMD_G_CTRL: | ||
402 | return ov6x20_get_control(c, arg); | ||
403 | case OVCAMCHIP_CMD_S_MODE: | ||
404 | return ov6x20_set_window(c, arg); | ||
405 | default: | ||
406 | DDEBUG(2, &c->dev, "command not supported: %d", cmd); | ||
407 | return -ENOIOCTLCMD; | ||
408 | } | ||
409 | } | ||
410 | |||
411 | struct ovcamchip_ops ov6x20_ops = { | ||
412 | .init = ov6x20_init, | ||
413 | .free = ov6x20_free, | ||
414 | .command = ov6x20_command, | ||
415 | }; | ||