diff options
Diffstat (limited to 'drivers/media/video/gspca/gl860/gl860-ov9655.c')
-rw-r--r-- | drivers/media/video/gspca/gl860/gl860-ov9655.c | 336 |
1 files changed, 336 insertions, 0 deletions
diff --git a/drivers/media/video/gspca/gl860/gl860-ov9655.c b/drivers/media/video/gspca/gl860/gl860-ov9655.c new file mode 100644 index 00000000000..5ae9619d72a --- /dev/null +++ b/drivers/media/video/gspca/gl860/gl860-ov9655.c | |||
@@ -0,0 +1,336 @@ | |||
1 | /* Subdriver for the GL860 chip with the OV9655 sensor | ||
2 | * Author Olivier LORIN, from logs done by Simon (Sur3) and Almighurt | ||
3 | * on dsd's weblog | ||
4 | * | ||
5 | * This program is free software; you can redistribute it and/or modify | ||
6 | * it under the terms of the GNU General Public License as published by | ||
7 | * the Free Software Foundation; either version 2 of the License, or | ||
8 | * any later version. | ||
9 | * | ||
10 | * This program is distributed in the hope that it will be useful, | ||
11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
13 | * GNU General Public License for more details. | ||
14 | * | ||
15 | * You should have received a copy of the GNU General Public License | ||
16 | * along with this program. If not, see <http://www.gnu.org/licenses/>. | ||
17 | */ | ||
18 | |||
19 | /* Sensor : OV9655 */ | ||
20 | |||
21 | #include "gl860.h" | ||
22 | |||
23 | static struct validx tbl_init_at_startup[] = { | ||
24 | {0x0000, 0x0000}, {0x0010, 0x0010}, {0x0008, 0x00c0}, {0x0001, 0x00c1}, | ||
25 | {0x0001, 0x00c2}, {0x0020, 0x0006}, {0x006a, 0x000d}, | ||
26 | |||
27 | {0x0040, 0x0000}, | ||
28 | }; | ||
29 | |||
30 | static struct validx tbl_commmon[] = { | ||
31 | {0x0041, 0x0000}, {0x006a, 0x0007}, {0x0063, 0x0006}, {0x006a, 0x000d}, | ||
32 | {0x0000, 0x00c0}, {0x0010, 0x0010}, {0x0001, 0x00c1}, {0x0041, 0x00c2}, | ||
33 | {0x0004, 0x00d8}, {0x0012, 0x0004}, {0x0000, 0x0058}, {0x0040, 0x0000}, | ||
34 | {0x00f3, 0x0006}, {0x0058, 0x0000}, {0x0048, 0x0000}, {0x0061, 0x0000}, | ||
35 | }; | ||
36 | |||
37 | static s32 tbl_length[] = {12, 56, 52, 54, 56, 42, 32, 12}; | ||
38 | |||
39 | static u8 *tbl_640[] = { | ||
40 | "\x00\x40\x07\x6a\x06\xf3\x0d\x6a" "\x10\x10\xc1\x01" | ||
41 | , | ||
42 | "\x12\x80\x00\x00\x01\x98\x02\x80" "\x03\x12\x04\x03\x0b\x57\x0e\x61" | ||
43 | "\x0f\x42\x11\x01\x12\x60\x13\x00" "\x14\x3a\x16\x24\x17\x14\x18\x00" | ||
44 | "\x19\x01\x1a\x3d\x1e\x04\x24\x3c" "\x25\x36\x26\x72\x27\x08\x28\x08" | ||
45 | "\x29\x15\x2a\x00\x2b\x00\x2c\x08" | ||
46 | , | ||
47 | "\x32\xff\x33\x00\x34\x3d\x35\x00" "\x36\xfa\x38\x72\x39\x57\x3a\x00" | ||
48 | "\x3b\x0c\x3d\x99\x3e\x0c\x3f\xc1" "\x40\xc0\x41\x00\x42\xc0\x43\x0a" | ||
49 | "\x44\xf0\x45\x46\x46\x62\x47\x2a" "\x48\x3c\x4a\xee\x4b\xe7\x4c\xe7" | ||
50 | "\x4d\xe7\x4e\xe7" | ||
51 | , | ||
52 | "\x4f\x98\x50\x98\x51\x00\x52\x28" "\x53\x70\x54\x98\x58\x1a\x59\x85" | ||
53 | "\x5a\xa9\x5b\x64\x5c\x84\x5d\x53" "\x5e\x0e\x5f\xf0\x60\xf0\x61\xf0" | ||
54 | "\x62\x00\x63\x00\x64\x02\x65\x20" "\x66\x00\x69\x0a\x6b\x5a\x6c\x04" | ||
55 | "\x6d\x55\x6e\x00\x6f\x9d" | ||
56 | , | ||
57 | "\x70\x15\x71\x78\x72\x00\x73\x00" "\x74\x3a\x75\x35\x76\x01\x77\x02" | ||
58 | "\x7a\x24\x7b\x04\x7c\x07\x7d\x10" "\x7e\x28\x7f\x36\x80\x44\x81\x52" | ||
59 | "\x82\x60\x83\x6c\x84\x78\x85\x8c" "\x86\x9e\x87\xbb\x88\xd2\x89\xe5" | ||
60 | "\x8a\x23\x8c\x8d\x90\x7c\x91\x7b" | ||
61 | , | ||
62 | "\x9d\x02\x9e\x02\x9f\x74\xa0\x73" "\xa1\x40\xa4\x50\xa5\x68\xa6\x70" | ||
63 | "\xa8\xc1\xa9\xef\xaa\x92\xab\x04" "\xac\x80\xad\x80\xae\x80\xaf\x80" | ||
64 | "\xb2\xf2\xb3\x20\xb4\x20\xb5\x00" "\xb6\xaf" | ||
65 | , | ||
66 | "\xbb\xae\xbc\x4f\xbd\x4e\xbe\x6a" "\xbf\x68\xc0\xaa\xc1\xc0\xc2\x01" | ||
67 | "\xc3\x4e\xc6\x85\xc7\x81\xc9\xe0" "\xca\xe8\xcb\xf0\xcc\xd8\xcd\x93" | ||
68 | , | ||
69 | "\xd0\x01\xd1\x08\xd2\xe0\xd3\x01" "\xd4\x10\xd5\x80" | ||
70 | }; | ||
71 | |||
72 | static u8 *tbl_1280[] = { | ||
73 | "\x00\x40\x07\x6a\x06\xf3\x0d\x6a" "\x10\x10\xc1\x01" | ||
74 | , | ||
75 | "\x12\x80\x00\x00\x01\x98\x02\x80" "\x03\x12\x04\x01\x0b\x57\x0e\x61" | ||
76 | "\x0f\x42\x11\x00\x12\x00\x13\x00" "\x14\x3a\x16\x24\x17\x1b\x18\xbb" | ||
77 | "\x19\x01\x1a\x81\x1e\x04\x24\x3c" "\x25\x36\x26\x72\x27\x08\x28\x08" | ||
78 | "\x29\x15\x2a\x00\x2b\x00\x2c\x08" | ||
79 | , | ||
80 | "\x32\xa4\x33\x00\x34\x3d\x35\x00" "\x36\xf8\x38\x72\x39\x57\x3a\x00" | ||
81 | "\x3b\x0c\x3d\x99\x3e\x0c\x3f\xc2" "\x40\xc0\x41\x00\x42\xc0\x43\x0a" | ||
82 | "\x44\xf0\x45\x46\x46\x62\x47\x2a" "\x48\x3c\x4a\xec\x4b\xe8\x4c\xe8" | ||
83 | "\x4d\xe8\x4e\xe8" | ||
84 | , | ||
85 | "\x4f\x98\x50\x98\x51\x00\x52\x28" "\x53\x70\x54\x98\x58\x1a\x59\x85" | ||
86 | "\x5a\xa9\x5b\x64\x5c\x84\x5d\x53" "\x5e\x0e\x5f\xf0\x60\xf0\x61\xf0" | ||
87 | "\x62\x00\x63\x00\x64\x02\x65\x20" "\x66\x00\x69\x02\x6b\x5a\x6c\x04" | ||
88 | "\x6d\x55\x6e\x00\x6f\x9d" | ||
89 | , | ||
90 | "\x70\x08\x71\x78\x72\x00\x73\x01" "\x74\x3a\x75\x35\x76\x01\x77\x02" | ||
91 | "\x7a\x24\x7b\x04\x7c\x07\x7d\x10" "\x7e\x28\x7f\x36\x80\x44\x81\x52" | ||
92 | "\x82\x60\x83\x6c\x84\x78\x85\x8c" "\x86\x9e\x87\xbb\x88\xd2\x89\xe5" | ||
93 | "\x8a\x23\x8c\x0d\x90\x90\x91\x90" | ||
94 | , | ||
95 | "\x9d\x02\x9e\x02\x9f\x94\xa0\x94" "\xa1\x01\xa4\x50\xa5\x68\xa6\x70" | ||
96 | "\xa8\xc1\xa9\xef\xaa\x92\xab\x04" "\xac\x80\xad\x80\xae\x80\xaf\x80" | ||
97 | "\xb2\xf2\xb3\x20\xb4\x20\xb5\x00" "\xb6\xaf" | ||
98 | , | ||
99 | "\xbb\xae\xbc\x38\xbd\x39\xbe\x01" "\xbf\x01\xc0\xe2\xc1\xc0\xc2\x01" | ||
100 | "\xc3\x4e\xc6\x85\xc7\x81\xc9\xe0" "\xca\xe8\xcb\xf0\xcc\xd8\xcd\x93" | ||
101 | , | ||
102 | "\xd0\x21\xd1\x18\xd2\xe0\xd3\x01" "\xd4\x28\xd5\x00" | ||
103 | }; | ||
104 | |||
105 | static u8 c04[] = {0x04}; | ||
106 | static u8 dat_post1[] = "\x04\x00\x10\x20\xa1\x00\x00\x02"; | ||
107 | static u8 dat_post2[] = "\x10\x10\xc1\x02"; | ||
108 | static u8 dat_post3[] = "\x04\x00\x10\x7c\xa1\x00\x00\x04"; | ||
109 | static u8 dat_post4[] = "\x10\x02\xc1\x06"; | ||
110 | static u8 dat_post5[] = "\x04\x00\x10\x7b\xa1\x00\x00\x08"; | ||
111 | static u8 dat_post6[] = "\x10\x10\xc1\x05"; | ||
112 | static u8 dat_post7[] = "\x04\x00\x10\x7c\xa1\x00\x00\x08"; | ||
113 | static u8 dat_post8[] = "\x04\x00\x10\x7c\xa1\x00\x00\x09"; | ||
114 | |||
115 | static struct validx tbl_init_post_alt[] = { | ||
116 | {0x6032, 0x00ff}, {0x6032, 0x00ff}, {0x6032, 0x00ff}, {0x603c, 0x00ff}, | ||
117 | {0x6003, 0x00ff}, {0x6032, 0x00ff}, {0x6032, 0x00ff}, {0x6001, 0x00ff}, | ||
118 | {0x6000, 0x801e}, | ||
119 | {0xffff, 0xffff}, | ||
120 | {0x6004, 0x001e}, {0x6000, 0x801e}, | ||
121 | {0xffff, 0xffff}, | ||
122 | {0x6004, 0x001e}, {0x6012, 0x0003}, {0x6000, 0x801e}, | ||
123 | {0xffff, 0xffff}, | ||
124 | {0x6004, 0x001e}, {0x6000, 0x801e}, | ||
125 | {0xffff, 0xffff}, | ||
126 | {0x6004, 0x001e}, {0x6012, 0x0003}, | ||
127 | {0xffff, 0xffff}, | ||
128 | {0x6000, 0x801e}, | ||
129 | {0xffff, 0xffff}, | ||
130 | {0x6004, 0x001e}, {0x6000, 0x801e}, | ||
131 | {0xffff, 0xffff}, | ||
132 | {0x6004, 0x001e}, {0x6012, 0x0003}, {0x6000, 0x801e}, | ||
133 | {0xffff, 0xffff}, | ||
134 | {0x6004, 0x001e}, {0x6000, 0x801e}, | ||
135 | {0xffff, 0xffff}, | ||
136 | {0x6004, 0x001e}, {0x6012, 0x0003}, | ||
137 | {0xffff, 0xffff}, | ||
138 | {0x6000, 0x801e}, | ||
139 | {0xffff, 0xffff}, | ||
140 | {0x6004, 0x001e}, {0x6000, 0x801e}, | ||
141 | {0xffff, 0xffff}, | ||
142 | {0x6004, 0x001e}, {0x6012, 0x0003}, | ||
143 | }; | ||
144 | |||
145 | static int ov9655_init_at_startup(struct gspca_dev *gspca_dev); | ||
146 | static int ov9655_configure_alt(struct gspca_dev *gspca_dev); | ||
147 | static int ov9655_init_pre_alt(struct gspca_dev *gspca_dev); | ||
148 | static int ov9655_init_post_alt(struct gspca_dev *gspca_dev); | ||
149 | static void ov9655_post_unset_alt(struct gspca_dev *gspca_dev); | ||
150 | static int ov9655_camera_settings(struct gspca_dev *gspca_dev); | ||
151 | /*==========================================================================*/ | ||
152 | |||
153 | void ov9655_init_settings(struct gspca_dev *gspca_dev) | ||
154 | { | ||
155 | struct sd *sd = (struct sd *) gspca_dev; | ||
156 | |||
157 | sd->vcur.backlight = 0; | ||
158 | sd->vcur.brightness = 128; | ||
159 | sd->vcur.sharpness = 0; | ||
160 | sd->vcur.contrast = 0; | ||
161 | sd->vcur.gamma = 0; | ||
162 | sd->vcur.hue = 0; | ||
163 | sd->vcur.saturation = 0; | ||
164 | sd->vcur.whitebal = 0; | ||
165 | |||
166 | sd->vmax.backlight = 0; | ||
167 | sd->vmax.brightness = 255; | ||
168 | sd->vmax.sharpness = 0; | ||
169 | sd->vmax.contrast = 0; | ||
170 | sd->vmax.gamma = 0; | ||
171 | sd->vmax.hue = 0 + 1; | ||
172 | sd->vmax.saturation = 0; | ||
173 | sd->vmax.whitebal = 0; | ||
174 | sd->vmax.mirror = 0; | ||
175 | sd->vmax.flip = 0; | ||
176 | sd->vmax.AC50Hz = 0; | ||
177 | |||
178 | sd->dev_camera_settings = ov9655_camera_settings; | ||
179 | sd->dev_init_at_startup = ov9655_init_at_startup; | ||
180 | sd->dev_configure_alt = ov9655_configure_alt; | ||
181 | sd->dev_init_pre_alt = ov9655_init_pre_alt; | ||
182 | sd->dev_post_unset_alt = ov9655_post_unset_alt; | ||
183 | } | ||
184 | |||
185 | /*==========================================================================*/ | ||
186 | |||
187 | static int ov9655_init_at_startup(struct gspca_dev *gspca_dev) | ||
188 | { | ||
189 | fetch_validx(gspca_dev, tbl_init_at_startup, | ||
190 | ARRAY_SIZE(tbl_init_at_startup)); | ||
191 | fetch_validx(gspca_dev, tbl_commmon, ARRAY_SIZE(tbl_commmon)); | ||
192 | /* ctrl_out(gspca_dev, 0x40, 11, 0x0000, 0x0000, 0, NULL);*/ | ||
193 | |||
194 | return 0; | ||
195 | } | ||
196 | |||
197 | static int ov9655_init_pre_alt(struct gspca_dev *gspca_dev) | ||
198 | { | ||
199 | struct sd *sd = (struct sd *) gspca_dev; | ||
200 | |||
201 | sd->vold.brightness = -1; | ||
202 | sd->vold.hue = -1; | ||
203 | |||
204 | fetch_validx(gspca_dev, tbl_commmon, ARRAY_SIZE(tbl_commmon)); | ||
205 | |||
206 | ov9655_init_post_alt(gspca_dev); | ||
207 | |||
208 | return 0; | ||
209 | } | ||
210 | |||
211 | static int ov9655_init_post_alt(struct gspca_dev *gspca_dev) | ||
212 | { | ||
213 | s32 reso = gspca_dev->cam.cam_mode[(s32) gspca_dev->curr_mode].priv; | ||
214 | s32 n; /* reserved for FETCH functions */ | ||
215 | s32 i; | ||
216 | u8 **tbl; | ||
217 | |||
218 | ctrl_out(gspca_dev, 0x40, 5, 0x0001, 0x0000, 0, NULL); | ||
219 | |||
220 | tbl = (reso == IMAGE_640) ? tbl_640 : tbl_1280; | ||
221 | |||
222 | ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200, | ||
223 | tbl_length[0], tbl[0]); | ||
224 | for (i = 1; i < 7; i++) | ||
225 | ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, | ||
226 | tbl_length[i], tbl[i]); | ||
227 | ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200, | ||
228 | tbl_length[7], tbl[7]); | ||
229 | |||
230 | n = fetch_validx(gspca_dev, tbl_init_post_alt, | ||
231 | ARRAY_SIZE(tbl_init_post_alt)); | ||
232 | |||
233 | ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04); | ||
234 | keep_on_fetching_validx(gspca_dev, tbl_init_post_alt, | ||
235 | ARRAY_SIZE(tbl_init_post_alt), n); | ||
236 | ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04); | ||
237 | keep_on_fetching_validx(gspca_dev, tbl_init_post_alt, | ||
238 | ARRAY_SIZE(tbl_init_post_alt), n); | ||
239 | ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04); | ||
240 | keep_on_fetching_validx(gspca_dev, tbl_init_post_alt, | ||
241 | ARRAY_SIZE(tbl_init_post_alt), n); | ||
242 | ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04); | ||
243 | keep_on_fetching_validx(gspca_dev, tbl_init_post_alt, | ||
244 | ARRAY_SIZE(tbl_init_post_alt), n); | ||
245 | ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_post1); | ||
246 | keep_on_fetching_validx(gspca_dev, tbl_init_post_alt, | ||
247 | ARRAY_SIZE(tbl_init_post_alt), n); | ||
248 | |||
249 | ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04); | ||
250 | keep_on_fetching_validx(gspca_dev, tbl_init_post_alt, | ||
251 | ARRAY_SIZE(tbl_init_post_alt), n); | ||
252 | ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04); | ||
253 | keep_on_fetching_validx(gspca_dev, tbl_init_post_alt, | ||
254 | ARRAY_SIZE(tbl_init_post_alt), n); | ||
255 | ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04); | ||
256 | keep_on_fetching_validx(gspca_dev, tbl_init_post_alt, | ||
257 | ARRAY_SIZE(tbl_init_post_alt), n); | ||
258 | ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04); | ||
259 | keep_on_fetching_validx(gspca_dev, tbl_init_post_alt, | ||
260 | ARRAY_SIZE(tbl_init_post_alt), n); | ||
261 | ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_post1); | ||
262 | keep_on_fetching_validx(gspca_dev, tbl_init_post_alt, | ||
263 | ARRAY_SIZE(tbl_init_post_alt), n); | ||
264 | |||
265 | ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04); | ||
266 | keep_on_fetching_validx(gspca_dev, tbl_init_post_alt, | ||
267 | ARRAY_SIZE(tbl_init_post_alt), n); | ||
268 | ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04); | ||
269 | keep_on_fetching_validx(gspca_dev, tbl_init_post_alt, | ||
270 | ARRAY_SIZE(tbl_init_post_alt), n); | ||
271 | |||
272 | ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_post1); | ||
273 | |||
274 | ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200, 4, dat_post2); | ||
275 | ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_post3); | ||
276 | |||
277 | ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200, 4, dat_post4); | ||
278 | ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_post5); | ||
279 | |||
280 | ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200, 4, dat_post6); | ||
281 | ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_post7); | ||
282 | |||
283 | ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_post8); | ||
284 | |||
285 | ov9655_camera_settings(gspca_dev); | ||
286 | |||
287 | return 0; | ||
288 | } | ||
289 | |||
290 | static int ov9655_configure_alt(struct gspca_dev *gspca_dev) | ||
291 | { | ||
292 | s32 reso = gspca_dev->cam.cam_mode[(s32) gspca_dev->curr_mode].priv; | ||
293 | |||
294 | switch (reso) { | ||
295 | case IMAGE_640: | ||
296 | gspca_dev->alt = 1 + 1; | ||
297 | break; | ||
298 | |||
299 | default: | ||
300 | gspca_dev->alt = 1 + 1; | ||
301 | break; | ||
302 | } | ||
303 | return 0; | ||
304 | } | ||
305 | |||
306 | static int ov9655_camera_settings(struct gspca_dev *gspca_dev) | ||
307 | { | ||
308 | struct sd *sd = (struct sd *) gspca_dev; | ||
309 | |||
310 | u8 dat_bright[] = "\x04\x00\x10\x7c\xa1\x00\x00\x70"; | ||
311 | |||
312 | s32 bright = sd->vcur.brightness; | ||
313 | s32 hue = sd->vcur.hue; | ||
314 | |||
315 | if (bright != sd->vold.brightness) { | ||
316 | sd->vold.brightness = bright; | ||
317 | if (bright < 0 || bright > sd->vmax.brightness) | ||
318 | bright = 0; | ||
319 | |||
320 | dat_bright[3] = bright; | ||
321 | ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_bright); | ||
322 | } | ||
323 | |||
324 | if (hue != sd->vold.hue) { | ||
325 | sd->vold.hue = hue; | ||
326 | sd->swapRB = (hue != 0); | ||
327 | } | ||
328 | |||
329 | return 0; | ||
330 | } | ||
331 | |||
332 | static void ov9655_post_unset_alt(struct gspca_dev *gspca_dev) | ||
333 | { | ||
334 | ctrl_out(gspca_dev, 0x40, 5, 0x0000, 0x0000, 0, NULL); | ||
335 | ctrl_out(gspca_dev, 0x40, 1, 0x0061, 0x0000, 0, NULL); | ||
336 | } | ||