Merge master.kernel.org:/pub/scm/linux/kernel/git/davej/x86
[linux-2.6] / drivers / media / video / ovcamchip / ov6x20.c
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_HW_SMBUS_OV511:
168                 rc = ov_write_regvals(c, regvals_init_6x20_511);
169                 break;
170         case 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 = kzalloc(sizeof *s, GFP_KERNEL);
182         if (!s)
183                 return -ENOMEM;
184
185         s->auto_brt = 1;
186         s->auto_exp = 1;
187
188         return rc;
189 }
190
191 static int ov6x20_free(struct i2c_client *c)
192 {
193         struct ovcamchip *ov = i2c_get_clientdata(c);
194
195         kfree(ov->spriv);
196         return 0;
197 }
198
199 static int ov6x20_set_control(struct i2c_client *c,
200                               struct ovcamchip_control *ctl)
201 {
202         struct ovcamchip *ov = i2c_get_clientdata(c);
203         struct ov6x20 *s = ov->spriv;
204         int rc;
205         int v = ctl->value;
206
207         switch (ctl->id) {
208         case OVCAMCHIP_CID_CONT:
209                 rc = ov_write(c, REG_CNT, v >> 8);
210                 break;
211         case OVCAMCHIP_CID_BRIGHT:
212                 rc = ov_write(c, REG_BRT, v >> 8);
213                 break;
214         case OVCAMCHIP_CID_SAT:
215                 rc = ov_write(c, REG_SAT, v >> 8);
216                 break;
217         case OVCAMCHIP_CID_HUE:
218                 rc = ov_write(c, REG_RED, 0xFF - (v >> 8));
219                 if (rc < 0)
220                         goto out;
221
222                 rc = ov_write(c, REG_BLUE, v >> 8);
223                 break;
224         case OVCAMCHIP_CID_EXP:
225                 rc = ov_write(c, REG_EXP, v);
226                 break;
227         case OVCAMCHIP_CID_FREQ:
228         {
229                 int sixty = (v == 60);
230
231                 rc = ov_write(c, 0x2b, sixty?0xa8:0x28);
232                 if (rc < 0)
233                         goto out;
234
235                 rc = ov_write(c, 0x2a, sixty?0x84:0xa4);
236                 break;
237         }
238         case OVCAMCHIP_CID_BANDFILT:
239                 rc = ov_write_mask(c, 0x2d, v?0x04:0x00, 0x04);
240                 s->bandfilt = v;
241                 break;
242         case OVCAMCHIP_CID_AUTOBRIGHT:
243                 rc = ov_write_mask(c, 0x2d, v?0x10:0x00, 0x10);
244                 s->auto_brt = v;
245                 break;
246         case OVCAMCHIP_CID_AUTOEXP:
247                 rc = ov_write_mask(c, 0x13, v?0x01:0x00, 0x01);
248                 s->auto_exp = v;
249                 break;
250         case OVCAMCHIP_CID_BACKLIGHT:
251         {
252                 rc = ov_write_mask(c, 0x4e, v?0xe0:0xc0, 0xe0);
253                 if (rc < 0)
254                         goto out;
255
256                 rc = ov_write_mask(c, 0x29, v?0x08:0x00, 0x08);
257                 if (rc < 0)
258                         goto out;
259
260                 rc = ov_write_mask(c, 0x0e, v?0x80:0x00, 0x80);
261                 s->backlight = v;
262                 break;
263         }
264         case OVCAMCHIP_CID_MIRROR:
265                 rc = ov_write_mask(c, 0x12, v?0x40:0x00, 0x40);
266                 s->mirror = v;
267                 break;
268         default:
269                 DDEBUG(2, &c->dev, "control not supported: %d", ctl->id);
270                 return -EPERM;
271         }
272
273 out:
274         DDEBUG(3, &c->dev, "id=%d, arg=%d, rc=%d", ctl->id, v, rc);
275         return rc;
276 }
277
278 static int ov6x20_get_control(struct i2c_client *c,
279                               struct ovcamchip_control *ctl)
280 {
281         struct ovcamchip *ov = i2c_get_clientdata(c);
282         struct ov6x20 *s = ov->spriv;
283         int rc = 0;
284         unsigned char val = 0;
285
286         switch (ctl->id) {
287         case OVCAMCHIP_CID_CONT:
288                 rc = ov_read(c, REG_CNT, &val);
289                 ctl->value = val << 8;
290                 break;
291         case OVCAMCHIP_CID_BRIGHT:
292                 rc = ov_read(c, REG_BRT, &val);
293                 ctl->value = val << 8;
294                 break;
295         case OVCAMCHIP_CID_SAT:
296                 rc = ov_read(c, REG_SAT, &val);
297                 ctl->value = val << 8;
298                 break;
299         case OVCAMCHIP_CID_HUE:
300                 rc = ov_read(c, REG_BLUE, &val);
301                 ctl->value = val << 8;
302                 break;
303         case OVCAMCHIP_CID_EXP:
304                 rc = ov_read(c, REG_EXP, &val);
305                 ctl->value = val;
306                 break;
307         case OVCAMCHIP_CID_BANDFILT:
308                 ctl->value = s->bandfilt;
309                 break;
310         case OVCAMCHIP_CID_AUTOBRIGHT:
311                 ctl->value = s->auto_brt;
312                 break;
313         case OVCAMCHIP_CID_AUTOEXP:
314                 ctl->value = s->auto_exp;
315                 break;
316         case OVCAMCHIP_CID_BACKLIGHT:
317                 ctl->value = s->backlight;
318                 break;
319         case OVCAMCHIP_CID_MIRROR:
320                 ctl->value = s->mirror;
321                 break;
322         default:
323                 DDEBUG(2, &c->dev, "control not supported: %d", ctl->id);
324                 return -EPERM;
325         }
326
327         DDEBUG(3, &c->dev, "id=%d, arg=%d, rc=%d", ctl->id, ctl->value, rc);
328         return rc;
329 }
330
331 static int ov6x20_mode_init(struct i2c_client *c, struct ovcamchip_window *win)
332 {
333         /******** QCIF-specific regs ********/
334
335         ov_write(c, 0x14, win->quarter?0x24:0x04);
336
337         /******** Palette-specific regs ********/
338
339         /* OV518 needs 8 bit multiplexed in color mode, and 16 bit in B&W */
340         if (c->adapter->id == I2C_HW_SMBUS_OV518) {
341                 if (win->format == VIDEO_PALETTE_GREY)
342                         ov_write_mask(c, 0x13, 0x00, 0x20);
343                 else
344                         ov_write_mask(c, 0x13, 0x20, 0x20);
345         } else {
346                 if (win->format == VIDEO_PALETTE_GREY)
347                         ov_write_mask(c, 0x13, 0x20, 0x20);
348                 else
349                         ov_write_mask(c, 0x13, 0x00, 0x20);
350         }
351
352         /******** Clock programming ********/
353
354         /* The OV6620 needs special handling. This prevents the
355          * severe banding that normally occurs */
356
357         /* Clock down */
358         ov_write(c, 0x2a, 0x04);
359
360         ov_write(c, 0x11, win->clockdiv);
361
362         ov_write(c, 0x2a, 0x84);
363         /* This next setting is critical. It seems to improve
364          * the gain or the contrast. The "reserved" bits seem
365          * to have some effect in this case. */
366         ov_write(c, 0x2d, 0x85); /* FIXME: This messes up banding filter */
367
368         return 0;
369 }
370
371 static int ov6x20_set_window(struct i2c_client *c, struct ovcamchip_window *win)
372 {
373         int ret, hwscale, vwscale;
374
375         ret = ov6x20_mode_init(c, win);
376         if (ret < 0)
377                 return ret;
378
379         if (win->quarter) {
380                 hwscale = 0;
381                 vwscale = 0;
382         } else {
383                 hwscale = 1;
384                 vwscale = 1;    /* The datasheet says 0; it's wrong */
385         }
386
387         ov_write(c, 0x17, HWSBASE + (win->x >> hwscale));
388         ov_write(c, 0x18, HWEBASE + ((win->x + win->width) >> hwscale));
389         ov_write(c, 0x19, VWSBASE + (win->y >> vwscale));
390         ov_write(c, 0x1a, VWEBASE + ((win->y + win->height) >> vwscale));
391
392         return 0;
393 }
394
395 static int ov6x20_command(struct i2c_client *c, unsigned int cmd, void *arg)
396 {
397         switch (cmd) {
398         case OVCAMCHIP_CMD_S_CTRL:
399                 return ov6x20_set_control(c, arg);
400         case OVCAMCHIP_CMD_G_CTRL:
401                 return ov6x20_get_control(c, arg);
402         case OVCAMCHIP_CMD_S_MODE:
403                 return ov6x20_set_window(c, arg);
404         default:
405                 DDEBUG(2, &c->dev, "command not supported: %d", cmd);
406                 return -ENOIOCTLCMD;
407         }
408 }
409
410 struct ovcamchip_ops ov6x20_ops = {
411         .init    =      ov6x20_init,
412         .free    =      ov6x20_free,
413         .command =      ov6x20_command,
414 };