1 /* Subdriver for the GL860 chip with the OV2640 sensor
2 * Author Olivier LORIN, from Malmostoso's logs
3 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; either version 2 of the License, or
7 * any later version.
8 *
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
13 *
14 * You should have received a copy of the GNU General Public License
15 * along with this program. If not, see <http://www.gnu.org/licenses/>.
16 */
17
18 /* Sensor : OV2640 */
19
20 #include "gl860.h"
21
22 static u8 dat_init1[] = "\x00\x41\x07\x6a\x06\x61\x0d\x6a" "\x10\x10\xc1\x01";
23
24 static u8 c61[] = {0x61}; /* expected */
25 static u8 c51[] = {0x51}; /* expected */
26 static u8 c50[] = {0x50}; /* expected */
27 static u8 c28[] = {0x28}; /* expected */
28 static u8 ca8[] = {0xa8}; /* expected */
29
30 static u8 dat_post[] =
31 "\x00\x41\x07\x6a\x06\xef\x0d\x6a" "\x10\x10\xc1\x01";
32
33 static u8 dat_640[] = "\xd0\x01\xd1\x08\xd2\xe0\xd3\x02\xd4\x10\xd5\x81";
34 static u8 dat_800[] = "\xd0\x01\xd1\x10\xd2\x58\xd3\x02\xd4\x18\xd5\x21";
35 static u8 dat_1280[] = "\xd0\x01\xd1\x18\xd2\xc0\xd3\x02\xd4\x28\xd5\x01";
36 static u8 dat_1600[] = "\xd0\x01\xd1\x20\xd2\xb0\xd3\x02\xd4\x30\xd5\x41";
37
38 static struct validx tbl_init_at_startup[] = {
39 {0x0000, 0x0000}, {0x0010, 0x0010}, {0x0008, 0x00c0}, {0x0001, 0x00c1},
40 {0x0001, 0x00c2}, {0x0020, 0x0006}, {0x006a, 0x000d},
41 {0x0050, 0x0000}, {0x0041, 0x0000}, {0x006a, 0x0007}, {0x0061, 0x0006},
42 {0x006a, 0x000d}, {0x0000, 0x00c0}, {0x0010, 0x0010}, {0x0001, 0x00c1},
43 {0x0041, 0x00c2}, {0x0004, 0x00d8}, {0x0012, 0x0004}, {0x0000, 0x0058},
44 {0x0041, 0x0000}, {0x0061, 0x0000},
45 };
46
47 static struct validx tbl_common[] = {
48 {0x6000, 0x00ff}, {0x60ff, 0x002c}, {0x60df, 0x002e}, {0x6001, 0x00ff},
49 {0x6080, 0x0012}, {0x6000, 0x0000}, {0x6000, 0x0045}, {0x6000, 0x0010},
50 {0x6035, 0x003c}, {0x6000, 0x0011}, {0x6028, 0x0004}, {0x60e5, 0x0013},
51 {0x6088, 0x0014}, {0x600c, 0x002c}, {0x6078, 0x0033}, {0x60f7, 0x003b},
52 {0x6000, 0x003e}, {0x6011, 0x0043}, {0x6010, 0x0016}, {0x6082, 0x0039},
53 {0x6088, 0x0035}, {0x600a, 0x0022}, {0x6040, 0x0037}, {0x6000, 0x0023},
54 {0x60a0, 0x0034}, {0x601a, 0x0036}, {0x6002, 0x0006}, {0x60c0, 0x0007},
55 {0x60b7, 0x000d}, {0x6001, 0x000e}, {0x6000, 0x004c}, {0x6081, 0x004a},
56 {0x6099, 0x0021}, {0x6002, 0x0009}, {0x603e, 0x0024}, {0x6034, 0x0025},
57 {0x6081, 0x0026}, {0x6000, 0x0000}, {0x6000, 0x0045}, {0x6000, 0x0010},
58 {0x6000, 0x005c}, {0x6000, 0x0063}, {0x6000, 0x007c}, {0x6070, 0x0061},
59 {0x6080, 0x0062}, {0x6080, 0x0020}, {0x6030, 0x0028}, {0x6000, 0x006c},
60 {0x6000, 0x006e}, {0x6002, 0x0070}, {0x6094, 0x0071}, {0x60c1, 0x0073},
61 {0x6034, 0x003d}, {0x6057, 0x005a}, {0x60bb, 0x004f}, {0x609c, 0x0050},
62 {0x6080, 0x006d}, {0x6002, 0x0039}, {0x6033, 0x003a}, {0x60f1, 0x003b},
63 {0x6031, 0x003c}, {0x6000, 0x00ff}, {0x6014, 0x00e0}, {0x60ff, 0x0076},
64 {0x60a0, 0x0033}, {0x6020, 0x0042}, {0x6018, 0x0043}, {0x6000, 0x004c},
65 {0x60d0, 0x0087}, {0x600f, 0x0088}, {0x6003, 0x00d7}, {0x6010, 0x00d9},
66 {0x6005, 0x00da}, {0x6082, 0x00d3}, {0x60c0, 0x00f9}, {0x6006, 0x0044},
67 {0x6007, 0x00d1}, {0x6002, 0x00d2}, {0x6000, 0x00d2}, {0x6011, 0x00d8},
68 {0x6008, 0x00c8}, {0x6080, 0x00c9}, {0x6008, 0x007c}, {0x6020, 0x007d},
69 {0x6020, 0x007d}, {0x6000, 0x0090}, {0x600e, 0x0091}, {0x601a, 0x0091},
70 {0x6031, 0x0091}, {0x605a, 0x0091}, {0x6069, 0x0091}, {0x6075, 0x0091},
71 {0x607e, 0x0091}, {0x6088, 0x0091}, {0x608f, 0x0091}, {0x6096, 0x0091},
72 {0x60a3, 0x0091}, {0x60af, 0x0091}, {0x60c4, 0x0091}, {0x60d7, 0x0091},
73 {0x60e8, 0x0091}, {0x6020, 0x0091}, {0x6000, 0x0092}, {0x6006, 0x0093},
74 {0x60e3, 0x0093}, {0x6005, 0x0093}, {0x6005, 0x0093}, {0x6000, 0x0093},
75 {0x6004, 0x0093}, {0x6000, 0x0093}, {0x6000, 0x0093}, {0x6000, 0x0093},
76 {0x6000, 0x0093}, {0x6000, 0x0093}, {0x6000, 0x0093}, {0x6000, 0x0093},
77 {0x6000, 0x0096}, {0x6008, 0x0097}, {0x6019, 0x0097}, {0x6002, 0x0097},
78 {0x600c, 0x0097}, {0x6024, 0x0097}, {0x6030, 0x0097}, {0x6028, 0x0097},
79 {0x6026, 0x0097}, {0x6002, 0x0097}, {0x6098, 0x0097}, {0x6080, 0x0097},
80 {0x6000, 0x0097}, {0x6000, 0x0097}, {0x60ed, 0x00c3}, {0x609a, 0x00c4},
81 {0x6000, 0x00a4}, {0x6011, 0x00c5}, {0x6051, 0x00c6}, {0x6010, 0x00c7},
82 {0x6066, 0x00b6}, {0x60a5, 0x00b8}, {0x6064, 0x00b7}, {0x607c, 0x00b9},
83 {0x60af, 0x00b3}, {0x6097, 0x00b4}, {0x60ff, 0x00b5}, {0x60c5, 0x00b0},
84 {0x6094, 0x00b1}, {0x600f, 0x00b2}, {0x605c, 0x00c4}, {0x6000, 0x00a8},
85 {0x60c8, 0x00c0}, {0x6096, 0x00c1}, {0x601d, 0x0086}, {0x6000, 0x0050},
86 {0x6090, 0x0051}, {0x6018, 0x0052}, {0x6000, 0x0053}, {0x6000, 0x0054},
87 {0x6088, 0x0055}, {0x6000, 0x0057}, {0x6090, 0x005a}, {0x6018, 0x005b},
88 {0x6005, 0x005c}, {0x60ed, 0x00c3}, {0x6000, 0x007f}, {0x6005, 0x00da},
89 {0x601f, 0x00e5}, {0x6067, 0x00e1}, {0x6000, 0x00e0}, {0x60ff, 0x00dd},
90 {0x6000, 0x0005}, {0x6001, 0x00ff}, {0x6000, 0x0000}, {0x6000, 0x0045},
91 {0x6000, 0x0010},
92 };
93
94 static struct validx tbl_sensor_settings_common1[] = {
95 {0x0041, 0x0000}, {0x006a, 0x0007}, {0x00ef, 0x0006}, {0x006a, 0x000d},
96 {0x0000, 0x00c0}, {0x0010, 0x0010}, {0x0001, 0x00c1}, {0x0041, 0x00c2},
97 {0x0004, 0x00d8}, {0x0012, 0x0004}, {0x0000, 0x0058}, {0x0041, 0x0000},
98 {50, 0xffff},
99 {0x0061, 0x0000},
100 {0xffff, 0xffff},
101 {0x6000, 0x00ff}, {0x6000, 0x007c}, {0x6007, 0x007d},
102 {30, 0xffff},
103 {0x0040, 0x0000},
104 };
105
106 static struct validx tbl_sensor_settings_common2[] = {
107 {0x6001, 0x00ff}, {0x6038, 0x000c},
108 {10, 0xffff},
109 {0x6000, 0x0011},
110 };
111
112 static struct validx tbl_640[] = {
113 {0x6000, 0x00ff}, {0x60f1, 0x00dd}, {0x6004, 0x00e0}, {0x6067, 0x00e1},
114 {0x6004, 0x00da}, {0x6000, 0x00ff}, {0x60f1, 0x00dd}, {0x6004, 0x00e0},
115 {0x6001, 0x00ff}, {0x6000, 0x0012}, {0x6000, 0x0011}, {0x6011, 0x0017},
116 {0x6075, 0x0018}, {0x6001, 0x0019}, {0x6097, 0x001a}, {0x6036, 0x0032},
117 {0x60bb, 0x004f}, {0x6057, 0x005a}, {0x609c, 0x0050}, {0x6080, 0x006d},
118 {0x6092, 0x0026}, {0x60ff, 0x0020}, {0x6000, 0x0027}, {0x6000, 0x00ff},
119 {0x60c8, 0x00c0}, {0x6096, 0x00c1}, {0x6000, 0x008c}, {0x603d, 0x0086},
120 {0x6089, 0x0050}, {0x6090, 0x0051}, {0x602c, 0x0052}, {0x6000, 0x0053},
121 {0x6000, 0x0054}, {0x6088, 0x0055}, {0x6000, 0x0057}, {0x60a0, 0x005a},
122 {0x6078, 0x005b}, {0x6000, 0x005c}, {0x6004, 0x00d3}, {0x6000, 0x00e0},
123 {0x60ff, 0x00dd}, {0x60a1, 0x005a},
124 };
125
126 static struct validx tbl_800[] = {
127 {0x6000, 0x00ff}, {0x60f1, 0x00dd}, {0x6004, 0x00e0}, {0x6067, 0x00e1},
128 {0x6004, 0x00da}, {0x6000, 0x00ff}, {0x60f1, 0x00dd}, {0x6004, 0x00e0},
129 {0x6001, 0x00ff}, {0x6040, 0x0012}, {0x6000, 0x0011}, {0x6011, 0x0017},
130 {0x6043, 0x0018}, {0x6000, 0x0019}, {0x604b, 0x001a}, {0x6009, 0x0032},
131 {0x60ca, 0x004f}, {0x60a8, 0x0050}, {0x6000, 0x006d}, {0x6038, 0x003d},
132 {0x60c8, 0x0035}, {0x6000, 0x0022}, {0x6092, 0x0026}, {0x60ff, 0x0020},
133 {0x6000, 0x0027}, {0x6000, 0x00ff}, {0x6064, 0x00c0}, {0x604b, 0x00c1},
134 {0x6000, 0x008c}, {0x601d, 0x0086}, {0x6082, 0x00d3}, {0x6000, 0x00e0},
135 {0x60ff, 0x00dd}, {0x6020, 0x008c}, {0x6001, 0x00ff}, {0x6044, 0x0018},
136 };
137
138 static struct validx tbl_big1[] = {
139 {0x0002, 0x00c1}, {0x6000, 0x00ff}, {0x60f1, 0x00dd}, {0x6004, 0x00e0},
140 {0x6001, 0x00ff}, {0x6000, 0x0012}, {0x6000, 0x0000}, {0x6000, 0x0045},
141 {0x6000, 0x0010}, {0x6000, 0x0011}, {0x6011, 0x0017}, {0x6075, 0x0018},
142 {0x6001, 0x0019}, {0x6097, 0x001a}, {0x6036, 0x0032}, {0x60bb, 0x004f},
143 {0x609c, 0x0050}, {0x6057, 0x005a}, {0x6080, 0x006d}, {0x6043, 0x000f},
144 {0x608f, 0x0003}, {0x6005, 0x007c}, {0x6081, 0x0026}, {0x6000, 0x00ff},
145 {0x60c8, 0x00c0}, {0x6096, 0x00c1}, {0x6000, 0x008c},
146 };
147
148 static struct validx tbl_big2[] = {
149 {0x603d, 0x0086}, {0x6000, 0x0050}, {0x6090, 0x0051}, {0x602c, 0x0052},
150 {0x6000, 0x0053}, {0x6000, 0x0054}, {0x6088, 0x0055}, {0x6000, 0x0057},
151 {0x6040, 0x005a}, {0x60f0, 0x005b}, {0x6001, 0x005c}, {0x6082, 0x00d3},
152 {0x6000, 0x008e},
153 };
154
155 static struct validx tbl_big3[] = {
156 {0x6004, 0x00da}, {0x6000, 0x00e0}, {0x6067, 0x00e1}, {0x60ff, 0x00dd},
157 {0x6001, 0x00ff}, {0x6000, 0x00ff}, {0x60f1, 0x00dd}, {0x6004, 0x00e0},
158 {0x6001, 0x00ff}, {0x6000, 0x0011}, {0x6000, 0x00ff}, {0x6010, 0x00c7},
159 {0x6000, 0x0092}, {0x6006, 0x0093}, {0x60e3, 0x0093}, {0x6005, 0x0093},
160 {0x6005, 0x0093}, {0x60ed, 0x00c3}, {0x6000, 0x00a4}, {0x60d0, 0x0087},
161 {0x6003, 0x0096}, {0x600c, 0x0097}, {0x6024, 0x0097}, {0x6030, 0x0097},
162 {0x6028, 0x0097}, {0x6026, 0x0097}, {0x6002, 0x0097}, {0x6001, 0x00ff},
163 {0x6043, 0x000f}, {0x608f, 0x0003}, {0x6000, 0x002d}, {0x6000, 0x002e},
164 {0x600a, 0x0022}, {0x6002, 0x0070}, {0x6008, 0x0014}, {0x6048, 0x0014},
165 {0x6000, 0x00ff}, {0x6000, 0x00e0}, {0x60ff, 0x00dd},
166 };
167
168 static struct validx tbl_post_unset_alt[] = {
169 {0x006a, 0x000d}, {0x6001, 0x00ff}, {0x6081, 0x0026}, {0x6000, 0x0000},
170 {0x6000, 0x0045}, {0x6000, 0x0010}, {0x6068, 0x000d},
171 {50, 0xffff},
172 {0x0021, 0x0000},
173 };
174
175 static int ov2640_init_at_startup(struct gspca_dev *gspca_dev);
176 static int ov2640_configure_alt(struct gspca_dev *gspca_dev);
177 static int ov2640_init_pre_alt(struct gspca_dev *gspca_dev);
178 static int ov2640_init_post_alt(struct gspca_dev *gspca_dev);
179 static void ov2640_post_unset_alt(struct gspca_dev *gspca_dev);
180 static int ov2640_camera_settings(struct gspca_dev *gspca_dev);
181 /*==========================================================================*/
182
ov2640_init_settings(struct gspca_dev * gspca_dev)183 void ov2640_init_settings(struct gspca_dev *gspca_dev)
184 {
185 struct sd *sd = (struct sd *) gspca_dev;
186
187 sd->vcur.backlight = 32;
188 sd->vcur.brightness = 0;
189 sd->vcur.sharpness = 6;
190 sd->vcur.contrast = 0;
191 sd->vcur.gamma = 32;
192 sd->vcur.hue = 0;
193 sd->vcur.saturation = 128;
194 sd->vcur.whitebal = 64;
195 sd->vcur.mirror = 0;
196 sd->vcur.flip = 0;
197
198 sd->vmax.backlight = 64;
199 sd->vmax.brightness = 255;
200 sd->vmax.sharpness = 31;
201 sd->vmax.contrast = 255;
202 sd->vmax.gamma = 64;
203 sd->vmax.hue = 254 + 2;
204 sd->vmax.saturation = 255;
205 sd->vmax.whitebal = 128;
206 sd->vmax.mirror = 1;
207 sd->vmax.flip = 1;
208 sd->vmax.AC50Hz = 0;
209
210 sd->dev_camera_settings = ov2640_camera_settings;
211 sd->dev_init_at_startup = ov2640_init_at_startup;
212 sd->dev_configure_alt = ov2640_configure_alt;
213 sd->dev_init_pre_alt = ov2640_init_pre_alt;
214 sd->dev_post_unset_alt = ov2640_post_unset_alt;
215 }
216
217 /*==========================================================================*/
218
common(struct gspca_dev * gspca_dev)219 static void common(struct gspca_dev *gspca_dev)
220 {
221 fetch_validx(gspca_dev, tbl_common, ARRAY_SIZE(tbl_common));
222 }
223
ov2640_init_at_startup(struct gspca_dev * gspca_dev)224 static int ov2640_init_at_startup(struct gspca_dev *gspca_dev)
225 {
226 fetch_validx(gspca_dev, tbl_init_at_startup,
227 ARRAY_SIZE(tbl_init_at_startup));
228
229 ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200, 12, dat_init1);
230
231 common(gspca_dev);
232
233 ctrl_in(gspca_dev, 0xc0, 2, 0x0000, 0x0006, 1, c61);
234
235 ctrl_out(gspca_dev, 0x40, 1, 0x00ef, 0x0006, 0, NULL);
236
237 ctrl_in(gspca_dev, 0xc0, 2, 0x0000, 0x0000, 1, c51);
238
239 ctrl_out(gspca_dev, 0x40, 1, 0x0051, 0x0000, 0, NULL);
240 /* ctrl_out(gspca_dev, 0x40, 11, 0x0000, 0x0000, 0, NULL); */
241
242 return 0;
243 }
244
ov2640_init_pre_alt(struct gspca_dev * gspca_dev)245 static int ov2640_init_pre_alt(struct gspca_dev *gspca_dev)
246 {
247 struct sd *sd = (struct sd *) gspca_dev;
248
249 sd->mirrorMask = 0;
250
251 sd->vold.backlight = -1;
252 sd->vold.brightness = -1;
253 sd->vold.sharpness = -1;
254 sd->vold.contrast = -1;
255 sd->vold.saturation = -1;
256 sd->vold.gamma = -1;
257 sd->vold.hue = -1;
258 sd->vold.whitebal = -1;
259 sd->vold.mirror = -1;
260 sd->vold.flip = -1;
261
262 ov2640_init_post_alt(gspca_dev);
263
264 return 0;
265 }
266
ov2640_init_post_alt(struct gspca_dev * gspca_dev)267 static int ov2640_init_post_alt(struct gspca_dev *gspca_dev)
268 {
269 s32 reso = gspca_dev->cam.cam_mode[(s32) gspca_dev->curr_mode].priv;
270 s32 n; /* reserved for FETCH functions */
271
272 ctrl_out(gspca_dev, 0x40, 5, 0x0001, 0x0000, 0, NULL);
273
274 n = fetch_validx(gspca_dev, tbl_sensor_settings_common1,
275 ARRAY_SIZE(tbl_sensor_settings_common1));
276 ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200, 12, dat_post);
277 common(gspca_dev);
278 keep_on_fetching_validx(gspca_dev, tbl_sensor_settings_common1,
279 ARRAY_SIZE(tbl_sensor_settings_common1), n);
280
281 switch (reso) {
282 case IMAGE_640:
283 n = fetch_validx(gspca_dev, tbl_640, ARRAY_SIZE(tbl_640));
284 ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200, 12, dat_640);
285 break;
286
287 case IMAGE_800:
288 n = fetch_validx(gspca_dev, tbl_800, ARRAY_SIZE(tbl_800));
289 ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200, 12, dat_800);
290 break;
291
292 case IMAGE_1600:
293 case IMAGE_1280:
294 n = fetch_validx(gspca_dev, tbl_big1, ARRAY_SIZE(tbl_big1));
295
296 if (reso == IMAGE_1280) {
297 n = fetch_validx(gspca_dev, tbl_big2,
298 ARRAY_SIZE(tbl_big2));
299 } else {
300 ctrl_out(gspca_dev, 0x40, 1, 0x601d, 0x0086, 0, NULL);
301 ctrl_out(gspca_dev, 0x40, 1, 0x6001, 0x00d7, 0, NULL);
302 ctrl_out(gspca_dev, 0x40, 1, 0x6082, 0x00d3, 0, NULL);
303 }
304
305 n = fetch_validx(gspca_dev, tbl_big3, ARRAY_SIZE(tbl_big3));
306
307 if (reso == IMAGE_1280) {
308 ctrl_out(gspca_dev, 0x40, 1, 0x6001, 0x00ff, 0, NULL);
309 ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200,
310 12, dat_1280);
311 } else {
312 ctrl_out(gspca_dev, 0x40, 1, 0x6020, 0x008c, 0, NULL);
313 ctrl_out(gspca_dev, 0x40, 1, 0x6001, 0x00ff, 0, NULL);
314 ctrl_out(gspca_dev, 0x40, 1, 0x6076, 0x0018, 0, NULL);
315 ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200,
316 12, dat_1600);
317 }
318 break;
319 }
320
321 n = fetch_validx(gspca_dev, tbl_sensor_settings_common2,
322 ARRAY_SIZE(tbl_sensor_settings_common2));
323
324 ov2640_camera_settings(gspca_dev);
325
326 return 0;
327 }
328
ov2640_configure_alt(struct gspca_dev * gspca_dev)329 static int ov2640_configure_alt(struct gspca_dev *gspca_dev)
330 {
331 s32 reso = gspca_dev->cam.cam_mode[(s32) gspca_dev->curr_mode].priv;
332
333 switch (reso) {
334 case IMAGE_640:
335 gspca_dev->alt = 3 + 1;
336 break;
337
338 case IMAGE_800:
339 case IMAGE_1280:
340 case IMAGE_1600:
341 gspca_dev->alt = 1 + 1;
342 break;
343 }
344 return 0;
345 }
346
ov2640_camera_settings(struct gspca_dev * gspca_dev)347 static int ov2640_camera_settings(struct gspca_dev *gspca_dev)
348 {
349 struct sd *sd = (struct sd *) gspca_dev;
350
351 s32 backlight = sd->vcur.backlight;
352 s32 bright = sd->vcur.brightness;
353 s32 sharp = sd->vcur.sharpness;
354 s32 gam = sd->vcur.gamma;
355 s32 cntr = sd->vcur.contrast;
356 s32 sat = sd->vcur.saturation;
357 s32 hue = sd->vcur.hue;
358 s32 wbal = sd->vcur.whitebal;
359 s32 mirror = (((sd->vcur.mirror > 0) ^ sd->mirrorMask) == 0);
360 s32 flip = (((sd->vcur.flip > 0) ^ sd->mirrorMask) == 0);
361
362 if (backlight != sd->vold.backlight) {
363 /* No sd->vold.backlight=backlight; (to be done again later) */
364 if (backlight < 0 || backlight > sd->vmax.backlight)
365 backlight = 0;
366
367 ctrl_out(gspca_dev, 0x40, 1, 0x6001 , 0x00ff,
368 0, NULL);
369 ctrl_out(gspca_dev, 0x40, 1, 0x601e + backlight , 0x0024,
370 0, NULL);
371 ctrl_out(gspca_dev, 0x40, 1, 0x601e + backlight - 10, 0x0025,
372 0, NULL);
373 }
374
375 if (bright != sd->vold.brightness) {
376 sd->vold.brightness = bright;
377 if (bright < 0 || bright > sd->vmax.brightness)
378 bright = 0;
379
380 ctrl_out(gspca_dev, 0x40, 1, 0x6000 , 0x00ff, 0, NULL);
381 ctrl_out(gspca_dev, 0x40, 1, 0x6009 , 0x007c, 0, NULL);
382 ctrl_out(gspca_dev, 0x40, 1, 0x6000 + bright, 0x007d, 0, NULL);
383 }
384
385 if (wbal != sd->vold.whitebal) {
386 sd->vold.whitebal = wbal;
387 if (wbal < 0 || wbal > sd->vmax.whitebal)
388 wbal = 0;
389
390 ctrl_out(gspca_dev, 0x40, 1, 0x6000 , 0x00ff, 0, NULL);
391 ctrl_out(gspca_dev, 0x40, 1, 0x6003 , 0x007c, 0, NULL);
392 ctrl_out(gspca_dev, 0x40, 1, 0x6000 + wbal, 0x007d, 0, NULL);
393 }
394
395 if (cntr != sd->vold.contrast) {
396 sd->vold.contrast = cntr;
397 if (cntr < 0 || cntr > sd->vmax.contrast)
398 cntr = 0;
399
400 ctrl_out(gspca_dev, 0x40, 1, 0x6000 , 0x00ff, 0, NULL);
401 ctrl_out(gspca_dev, 0x40, 1, 0x6007 , 0x007c, 0, NULL);
402 ctrl_out(gspca_dev, 0x40, 1, 0x6000 + cntr, 0x007d, 0, NULL);
403 }
404
405 if (sat != sd->vold.saturation) {
406 sd->vold.saturation = sat;
407 if (sat < 0 || sat > sd->vmax.saturation)
408 sat = 0;
409
410 ctrl_out(gspca_dev, 0x40, 1, 0x6000 , 0x00ff, 0, NULL);
411 ctrl_out(gspca_dev, 0x40, 1, 0x6001 , 0x007c, 0, NULL);
412 ctrl_out(gspca_dev, 0x40, 1, 0x6000 + sat, 0x007d, 0, NULL);
413 }
414
415 if (sharp != sd->vold.sharpness) {
416 sd->vold.sharpness = sharp;
417 if (sharp < 0 || sharp > sd->vmax.sharpness)
418 sharp = 0;
419
420 ctrl_out(gspca_dev, 0x40, 1, 0x6000 , 0x00ff, 0, NULL);
421 ctrl_out(gspca_dev, 0x40, 1, 0x6001 , 0x0092, 0, NULL);
422 ctrl_out(gspca_dev, 0x40, 1, 0x60c0 + sharp, 0x0093, 0, NULL);
423 }
424
425 if (hue != sd->vold.hue) {
426 sd->vold.hue = hue;
427 if (hue < 0 || hue > sd->vmax.hue)
428 hue = 0;
429
430 ctrl_out(gspca_dev, 0x40, 1, 0x6000 , 0x00ff, 0, NULL);
431 ctrl_out(gspca_dev, 0x40, 1, 0x6002 , 0x007c, 0, NULL);
432 ctrl_out(gspca_dev, 0x40, 1, 0x6000 + hue * (hue < 255), 0x007d,
433 0, NULL);
434 if (hue >= 255)
435 sd->swapRB = 1;
436 else
437 sd->swapRB = 0;
438 }
439
440 if (gam != sd->vold.gamma) {
441 sd->vold.gamma = gam;
442 if (gam < 0 || gam > sd->vmax.gamma)
443 gam = 0;
444
445 ctrl_out(gspca_dev, 0x40, 1, 0x6000 , 0x00ff, 0, NULL);
446 ctrl_out(gspca_dev, 0x40, 1, 0x6008 , 0x007c, 0, NULL);
447 ctrl_out(gspca_dev, 0x40, 1, 0x6000 + gam, 0x007d, 0, NULL);
448 }
449
450 if (mirror != sd->vold.mirror || flip != sd->vold.flip) {
451 sd->vold.mirror = mirror;
452 sd->vold.flip = flip;
453
454 mirror = 0x80 * mirror;
455 ctrl_out(gspca_dev, 0x40, 1, 0x6001, 0x00ff, 0, NULL);
456 ctrl_out(gspca_dev, 0x40, 1, 0x6000, 0x8004, 0, NULL);
457 ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x8004, 1, c28);
458 ctrl_out(gspca_dev, 0x40, 1, 0x6028 + mirror, 0x0004, 0, NULL);
459
460 flip = 0x50 * flip + mirror;
461 ctrl_out(gspca_dev, 0x40, 1, 0x6001, 0x00ff, 0, NULL);
462 ctrl_out(gspca_dev, 0x40, 1, 0x6000, 0x8004, 0, NULL);
463 ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x8004, 1, ca8);
464 ctrl_out(gspca_dev, 0x40, 1, 0x6028 + flip, 0x0004, 0, NULL);
465
466 ctrl_in(gspca_dev, 0xc0, 2, 0x0000, 0x0000, 1, c50);
467 }
468
469 if (backlight != sd->vold.backlight) {
470 sd->vold.backlight = backlight;
471
472 ctrl_out(gspca_dev, 0x40, 1, 0x6001 , 0x00ff,
473 0, NULL);
474 ctrl_out(gspca_dev, 0x40, 1, 0x601e + backlight , 0x0024,
475 0, NULL);
476 ctrl_out(gspca_dev, 0x40, 1, 0x601e + backlight - 10, 0x0025,
477 0, NULL);
478 }
479
480 return 0;
481 }
482
ov2640_post_unset_alt(struct gspca_dev * gspca_dev)483 static void ov2640_post_unset_alt(struct gspca_dev *gspca_dev)
484 {
485 ctrl_out(gspca_dev, 0x40, 5, 0x0000, 0x0000, 0, NULL);
486 msleep(20);
487 fetch_validx(gspca_dev, tbl_post_unset_alt,
488 ARRAY_SIZE(tbl_post_unset_alt));
489 }
490