Commit | Line | Data |
---|---|---|
6cb45879 MCC |
1 | /* tuner-xc2028 |
2 | * | |
3 | * Copyright (c) 2007 Mauro Carvalho Chehab (mchehab@infradead.org) | |
983d214e | 4 | * |
701672eb ML |
5 | * Copyright (c) 2007 Michel Ludwig (michel.ludwig@gmail.com) |
6 | * - frontend interface | |
983d214e | 7 | * |
6cb45879 MCC |
8 | * This code is placed under the terms of the GNU General Public License v2 |
9 | */ | |
10 | ||
11 | #include <linux/i2c.h> | |
12 | #include <asm/div64.h> | |
13 | #include <linux/firmware.h> | |
ab0b9fc6 | 14 | #include <linux/videodev2.h> |
6cb45879 | 15 | #include <linux/delay.h> |
701672eb | 16 | #include <media/tuner.h> |
3b20532c | 17 | #include <linux/mutex.h> |
215b95ba | 18 | #include "tuner-i2c.h" |
6cb45879 | 19 | #include "tuner-xc2028.h" |
de3fe21b | 20 | #include "tuner-xc2028-types.h" |
6cb45879 | 21 | |
701672eb ML |
22 | #include <linux/dvb/frontend.h> |
23 | #include "dvb_frontend.h" | |
24 | ||
ef8c1888 | 25 | |
9dd659de | 26 | #define PREFIX "xc2028" |
215b95ba | 27 | |
83fb340b MCC |
28 | static int debug; |
29 | module_param(debug, int, 0644); | |
30 | MODULE_PARM_DESC(debug, "enable verbose debug messages"); | |
31 | ||
a82200fb MCC |
32 | static char audio_std[8]; |
33 | module_param_string(audio_std, audio_std, sizeof(audio_std), 0); | |
34 | MODULE_PARM_DESC(audio_std, | |
35 | "Audio standard. XC3028 audio decoder explicitly " | |
36 | "needs to know what audio\n" | |
37 | "standard is needed for some video standards with audio A2 or NICAM.\n" | |
38 | "The valid values are:\n" | |
39 | "A2\n" | |
40 | "A2/A\n" | |
41 | "A2/B\n" | |
42 | "NICAM\n" | |
43 | "NICAM/A\n" | |
44 | "NICAM/B\n"); | |
45 | ||
215b95ba | 46 | static LIST_HEAD(xc2028_list); |
aa501be9 CP |
47 | static DEFINE_MUTEX(xc2028_list_mutex); |
48 | ||
de3fe21b MCC |
49 | /* struct for storing firmware table */ |
50 | struct firmware_description { | |
51 | unsigned int type; | |
52 | v4l2_std_id id; | |
53 | unsigned char *ptr; | |
54 | unsigned int size; | |
55 | }; | |
6cb45879 | 56 | |
e0f0b37a CP |
57 | struct firmware_properties { |
58 | unsigned int type; | |
59 | v4l2_std_id id; | |
60 | v4l2_std_id std_req; | |
61 | unsigned int scode_table; | |
62 | int scode_nr; | |
63 | }; | |
64 | ||
6cb45879 | 65 | struct xc2028_data { |
215b95ba MCC |
66 | struct list_head xc2028_list; |
67 | struct tuner_i2c_props i2c_props; | |
68 | int (*tuner_callback) (void *dev, | |
69 | int command, int arg); | |
215b95ba MCC |
70 | void *video_dev; |
71 | int count; | |
de3fe21b MCC |
72 | __u32 frequency; |
73 | ||
74 | struct firmware_description *firm; | |
75 | int firm_size; | |
06fd82dc | 76 | __u16 firm_version; |
de3fe21b | 77 | |
8bf799a6 CP |
78 | __u16 hwmodel; |
79 | __u16 hwvers; | |
80 | ||
de3fe21b | 81 | struct xc2028_ctrl ctrl; |
215b95ba | 82 | |
e0f0b37a | 83 | struct firmware_properties cur_fw; |
215b95ba MCC |
84 | |
85 | struct mutex lock; | |
6cb45879 MCC |
86 | }; |
87 | ||
47cc5b78 CP |
88 | #define i2c_send(priv, buf, size) ({ \ |
89 | int _rc; \ | |
90 | _rc = tuner_i2c_xfer_send(&priv->i2c_props, buf, size); \ | |
91 | if (size != _rc) \ | |
92 | tuner_info("i2c output error: rc = %d (should be %d)\n",\ | |
93 | _rc, (int)size); \ | |
94 | _rc; \ | |
95 | }) | |
96 | ||
97 | #define i2c_rcv(priv, buf, size) ({ \ | |
98 | int _rc; \ | |
99 | _rc = tuner_i2c_xfer_recv(&priv->i2c_props, buf, size); \ | |
100 | if (size != _rc) \ | |
83fb340b | 101 | tuner_err("i2c input error: rc = %d (should be %d)\n", \ |
47cc5b78 CP |
102 | _rc, (int)size); \ |
103 | _rc; \ | |
104 | }) | |
ab0b9fc6 | 105 | |
7d58d111 CP |
106 | #define i2c_send_recv(priv, obuf, osize, ibuf, isize) ({ \ |
107 | int _rc; \ | |
108 | _rc = tuner_i2c_xfer_send_recv(&priv->i2c_props, obuf, osize, \ | |
109 | ibuf, isize); \ | |
110 | if (isize != _rc) \ | |
111 | tuner_err("i2c input error: rc = %d (should be %d)\n", \ | |
112 | _rc, (int)isize); \ | |
113 | _rc; \ | |
114 | }) | |
115 | ||
47cc5b78 | 116 | #define send_seq(priv, data...) ({ \ |
215b95ba | 117 | static u8 _val[] = data; \ |
47cc5b78 | 118 | int _rc; \ |
6cb45879 | 119 | if (sizeof(_val) != \ |
47cc5b78 | 120 | (_rc = tuner_i2c_xfer_send(&priv->i2c_props, \ |
215b95ba | 121 | _val, sizeof(_val)))) { \ |
47cc5b78 CP |
122 | tuner_err("Error on line %d: %d\n", __LINE__, _rc); \ |
123 | } else \ | |
124 | msleep(10); \ | |
125 | _rc; \ | |
126 | }) | |
6cb45879 | 127 | |
7d58d111 | 128 | static unsigned int xc2028_get_reg(struct xc2028_data *priv, u16 reg, u16 *val) |
6cb45879 | 129 | { |
b873e1a3 | 130 | unsigned char buf[2]; |
7d58d111 | 131 | unsigned char ibuf[2]; |
215b95ba | 132 | |
7d58d111 | 133 | tuner_dbg("%s %04x called\n", __FUNCTION__, reg); |
6cb45879 | 134 | |
7d58d111 | 135 | buf[0] = reg >> 8; |
80b52208 | 136 | buf[1] = (unsigned char) reg; |
6cb45879 | 137 | |
7d58d111 CP |
138 | if (i2c_send_recv(priv, buf, 2, ibuf, 2) != 2) |
139 | return -EIO; | |
6cb45879 | 140 | |
7d58d111 CP |
141 | *val = (ibuf[1]) | (ibuf[0] << 8); |
142 | return 0; | |
6cb45879 MCC |
143 | } |
144 | ||
43efe702 MCC |
145 | void dump_firm_type(unsigned int type) |
146 | { | |
147 | if (type & BASE) | |
148 | printk("BASE "); | |
f380e1d2 MCC |
149 | if (type & INIT1) |
150 | printk("INIT1 "); | |
43efe702 MCC |
151 | if (type & F8MHZ) |
152 | printk("F8MHZ "); | |
153 | if (type & MTS) | |
154 | printk("MTS "); | |
155 | if (type & D2620) | |
156 | printk("D2620 "); | |
157 | if (type & D2633) | |
158 | printk("D2633 "); | |
159 | if (type & DTV6) | |
160 | printk("DTV6 "); | |
161 | if (type & QAM) | |
162 | printk("QAM "); | |
163 | if (type & DTV7) | |
164 | printk("DTV7 "); | |
165 | if (type & DTV78) | |
166 | printk("DTV78 "); | |
167 | if (type & DTV8) | |
168 | printk("DTV8 "); | |
169 | if (type & FM) | |
170 | printk("FM "); | |
171 | if (type & INPUT1) | |
172 | printk("INPUT1 "); | |
173 | if (type & LCD) | |
174 | printk("LCD "); | |
175 | if (type & NOGD) | |
176 | printk("NOGD "); | |
177 | if (type & MONO) | |
178 | printk("MONO "); | |
179 | if (type & ATSC) | |
180 | printk("ATSC "); | |
181 | if (type & IF) | |
182 | printk("IF "); | |
183 | if (type & LG60) | |
184 | printk("LG60 "); | |
185 | if (type & ATI638) | |
186 | printk("ATI638 "); | |
187 | if (type & OREN538) | |
188 | printk("OREN538 "); | |
189 | if (type & OREN36) | |
190 | printk("OREN36 "); | |
191 | if (type & TOYOTA388) | |
192 | printk("TOYOTA388 "); | |
193 | if (type & TOYOTA794) | |
194 | printk("TOYOTA794 "); | |
195 | if (type & DIBCOM52) | |
196 | printk("DIBCOM52 "); | |
197 | if (type & ZARLINK456) | |
198 | printk("ZARLINK456 "); | |
199 | if (type & CHINA) | |
200 | printk("CHINA "); | |
201 | if (type & F6MHZ) | |
202 | printk("F6MHZ "); | |
203 | if (type & INPUT2) | |
204 | printk("INPUT2 "); | |
205 | if (type & SCODE) | |
206 | printk("SCODE "); | |
207 | } | |
208 | ||
ef8c1888 | 209 | static v4l2_std_id parse_audio_std_option(void) |
a82200fb | 210 | { |
e155d908 | 211 | if (strcasecmp(audio_std, "A2") == 0) |
a82200fb | 212 | return V4L2_STD_A2; |
e155d908 | 213 | if (strcasecmp(audio_std, "A2/A") == 0) |
a82200fb | 214 | return V4L2_STD_A2_A; |
e155d908 | 215 | if (strcasecmp(audio_std, "A2/B") == 0) |
a82200fb | 216 | return V4L2_STD_A2_B; |
e155d908 | 217 | if (strcasecmp(audio_std, "NICAM") == 0) |
a82200fb | 218 | return V4L2_STD_NICAM; |
e155d908 | 219 | if (strcasecmp(audio_std, "NICAM/A") == 0) |
a82200fb | 220 | return V4L2_STD_NICAM_A; |
e155d908 | 221 | if (strcasecmp(audio_std, "NICAM/B") == 0) |
a82200fb MCC |
222 | return V4L2_STD_NICAM_B; |
223 | ||
224 | return 0; | |
225 | } | |
226 | ||
ab0b9fc6 | 227 | static void free_firmware(struct xc2028_data *priv) |
6cb45879 | 228 | { |
de3fe21b MCC |
229 | int i; |
230 | ||
231 | if (!priv->firm) | |
232 | return; | |
233 | ||
ab0b9fc6 MCC |
234 | for (i = 0; i < priv->firm_size; i++) |
235 | kfree(priv->firm[i].ptr); | |
236 | ||
de3fe21b MCC |
237 | kfree(priv->firm); |
238 | ||
ab0b9fc6 | 239 | priv->firm = NULL; |
06fd82dc | 240 | priv->firm_size = 0; |
e0f0b37a CP |
241 | |
242 | memset(&priv->cur_fw, 0, sizeof(priv->cur_fw)); | |
de3fe21b MCC |
243 | } |
244 | ||
ab0b9fc6 | 245 | static int load_all_firmwares(struct dvb_frontend *fe) |
de3fe21b MCC |
246 | { |
247 | struct xc2028_data *priv = fe->tuner_priv; | |
ab0b9fc6 | 248 | const struct firmware *fw = NULL; |
6cb45879 | 249 | unsigned char *p, *endp; |
ab0b9fc6 MCC |
250 | int rc = 0; |
251 | int n, n_array; | |
de3fe21b | 252 | char name[33]; |
6cb45879 | 253 | |
83fb340b | 254 | tuner_dbg("%s called\n", __FUNCTION__); |
215b95ba | 255 | |
06fd82dc | 256 | tuner_dbg("Reading firmware %s\n", priv->ctrl.fname); |
a37b4c9b ML |
257 | rc = request_firmware(&fw, priv->ctrl.fname, |
258 | &priv->i2c_props.adap->dev); | |
6cb45879 | 259 | if (rc < 0) { |
ab0b9fc6 | 260 | if (rc == -ENOENT) |
83fb340b | 261 | tuner_err("Error: firmware %s not found.\n", |
de3fe21b | 262 | priv->ctrl.fname); |
2e4160ca | 263 | else |
83fb340b | 264 | tuner_err("Error %d while requesting firmware %s \n", |
de3fe21b | 265 | rc, priv->ctrl.fname); |
2e4160ca | 266 | |
6cb45879 MCC |
267 | return rc; |
268 | } | |
ab0b9fc6 MCC |
269 | p = fw->data; |
270 | endp = p + fw->size; | |
6cb45879 | 271 | |
06fd82dc CP |
272 | if (fw->size < sizeof(name) - 1 + 2 + 2) { |
273 | tuner_err("Error: firmware file %s has invalid size!\n", | |
274 | priv->ctrl.fname); | |
275 | goto corrupt; | |
6cb45879 | 276 | } |
de3fe21b | 277 | |
ab0b9fc6 MCC |
278 | memcpy(name, p, sizeof(name) - 1); |
279 | name[sizeof(name) - 1] = 0; | |
280 | p += sizeof(name) - 1; | |
de3fe21b | 281 | |
06fd82dc | 282 | priv->firm_version = le16_to_cpu(*(__u16 *) p); |
de3fe21b MCC |
283 | p += 2; |
284 | ||
ab0b9fc6 | 285 | n_array = le16_to_cpu(*(__u16 *) p); |
de3fe21b MCC |
286 | p += 2; |
287 | ||
06fd82dc CP |
288 | tuner_info("Loading %d firmware images from %s, type: %s, ver %d.%d\n", |
289 | n_array, priv->ctrl.fname, name, | |
290 | priv->firm_version >> 8, priv->firm_version & 0xff); | |
de3fe21b | 291 | |
ab0b9fc6 | 292 | priv->firm = kzalloc(sizeof(*priv->firm) * n_array, GFP_KERNEL); |
06fd82dc CP |
293 | if (priv->firm == NULL) { |
294 | tuner_err("Not enough memory to load firmware file.\n"); | |
ab0b9fc6 | 295 | rc = -ENOMEM; |
06fd82dc | 296 | goto err; |
6cb45879 | 297 | } |
de3fe21b | 298 | priv->firm_size = n_array; |
06fd82dc | 299 | |
ab0b9fc6 MCC |
300 | n = -1; |
301 | while (p < endp) { | |
de3fe21b MCC |
302 | __u32 type, size; |
303 | v4l2_std_id id; | |
304 | ||
305 | n++; | |
306 | if (n >= n_array) { | |
06fd82dc CP |
307 | tuner_err("More firmware images in file than " |
308 | "were expected!\n"); | |
de3fe21b MCC |
309 | goto corrupt; |
310 | } | |
311 | ||
312 | /* Checks if there's enough bytes to read */ | |
ab0b9fc6 | 313 | if (p + sizeof(type) + sizeof(id) + sizeof(size) > endp) { |
83fb340b | 314 | tuner_err("Firmware header is incomplete!\n"); |
de3fe21b MCC |
315 | goto corrupt; |
316 | } | |
317 | ||
ab0b9fc6 | 318 | type = le32_to_cpu(*(__u32 *) p); |
de3fe21b MCC |
319 | p += sizeof(type); |
320 | ||
ab0b9fc6 | 321 | id = le64_to_cpu(*(v4l2_std_id *) p); |
de3fe21b MCC |
322 | p += sizeof(id); |
323 | ||
2fc580ff | 324 | size = le32_to_cpu(*(__u32 *) p); |
de3fe21b MCC |
325 | p += sizeof(size); |
326 | ||
ab0b9fc6 | 327 | if ((!size) || (size + p > endp)) { |
83fb340b | 328 | tuner_err("Firmware type "); |
43efe702 | 329 | dump_firm_type(type); |
ef8c1888 MCC |
330 | printk("(%x), id %llx is corrupted " |
331 | "(size=%d, expected %d)\n", | |
91240dd9 | 332 | type, (unsigned long long)id, |
ef8c1888 | 333 | (unsigned)(endp - p), size); |
de3fe21b MCC |
334 | goto corrupt; |
335 | } | |
336 | ||
ab0b9fc6 | 337 | priv->firm[n].ptr = kzalloc(size, GFP_KERNEL); |
06fd82dc CP |
338 | if (priv->firm[n].ptr == NULL) { |
339 | tuner_err("Not enough memory to load firmware file.\n"); | |
ab0b9fc6 | 340 | rc = -ENOMEM; |
de3fe21b MCC |
341 | goto err; |
342 | } | |
06fd82dc CP |
343 | tuner_dbg("Reading firmware type "); |
344 | if (debug) { | |
345 | dump_firm_type(type); | |
346 | printk("(%x), id %llx, size=%d.\n", | |
347 | type, (unsigned long long)id, size); | |
348 | } | |
de3fe21b MCC |
349 | |
350 | memcpy(priv->firm[n].ptr, p, size); | |
351 | priv->firm[n].type = type; | |
352 | priv->firm[n].id = id; | |
353 | priv->firm[n].size = size; | |
354 | ||
355 | p += size; | |
356 | } | |
357 | ||
ab0b9fc6 | 358 | if (n + 1 != priv->firm_size) { |
83fb340b | 359 | tuner_err("Firmware file is incomplete!\n"); |
de3fe21b MCC |
360 | goto corrupt; |
361 | } | |
362 | ||
363 | goto done; | |
364 | ||
365 | corrupt: | |
ab0b9fc6 | 366 | rc = -EINVAL; |
83fb340b | 367 | tuner_err("Error: firmware file is corrupted!\n"); |
de3fe21b MCC |
368 | |
369 | err: | |
06fd82dc | 370 | tuner_info("Releasing partially loaded firmware file.\n"); |
de3fe21b MCC |
371 | free_firmware(priv); |
372 | ||
373 | done: | |
374 | release_firmware(fw); | |
06fd82dc CP |
375 | if (rc == 0) |
376 | tuner_dbg("Firmware files loaded.\n"); | |
de3fe21b MCC |
377 | |
378 | return rc; | |
379 | } | |
380 | ||
f380e1d2 MCC |
381 | static int seek_firmware(struct dvb_frontend *fe, unsigned int type, |
382 | v4l2_std_id *id) | |
de3fe21b MCC |
383 | { |
384 | struct xc2028_data *priv = fe->tuner_priv; | |
b1535293 | 385 | int i, best_i = -1, best_nr_matches = 0; |
de3fe21b | 386 | |
b1535293 CP |
387 | tuner_dbg("%s called, want type=", __FUNCTION__); |
388 | if (debug) { | |
389 | dump_firm_type(type); | |
390 | printk("(%x), id %016llx.\n", type, (unsigned long long)*id); | |
391 | } | |
de3fe21b MCC |
392 | |
393 | if (!priv->firm) { | |
83fb340b | 394 | tuner_err("Error! firmware not loaded\n"); |
de3fe21b MCC |
395 | return -EINVAL; |
396 | } | |
397 | ||
f380e1d2 | 398 | if (((type & ~SCODE) == 0) && (*id == 0)) |
ab0b9fc6 | 399 | *id = V4L2_STD_PAL; |
de3fe21b | 400 | |
e0f0b37a CP |
401 | if (type & BASE) |
402 | type &= BASE_TYPES; | |
403 | else if (type & SCODE) | |
404 | type &= SCODE_TYPES; | |
405 | else if (type & DTV_TYPES) | |
11a9eff9 CP |
406 | type &= DTV_TYPES; |
407 | else if (type & STD_SPECIFIC_TYPES) | |
408 | type &= STD_SPECIFIC_TYPES; | |
e0f0b37a | 409 | |
de3fe21b | 410 | /* Seek for exact match */ |
ab0b9fc6 MCC |
411 | for (i = 0; i < priv->firm_size; i++) { |
412 | if ((type == priv->firm[i].type) && (*id == priv->firm[i].id)) | |
de3fe21b MCC |
413 | goto found; |
414 | } | |
415 | ||
416 | /* Seek for generic video standard match */ | |
ab0b9fc6 | 417 | for (i = 0; i < priv->firm_size; i++) { |
b1535293 CP |
418 | v4l2_std_id match_mask; |
419 | int nr_matches; | |
420 | ||
421 | if (type != priv->firm[i].type) | |
422 | continue; | |
423 | ||
424 | match_mask = *id & priv->firm[i].id; | |
425 | if (!match_mask) | |
426 | continue; | |
427 | ||
428 | if ((*id & match_mask) == *id) | |
429 | goto found; /* Supports all the requested standards */ | |
430 | ||
431 | nr_matches = hweight64(match_mask); | |
432 | if (nr_matches > best_nr_matches) { | |
433 | best_nr_matches = nr_matches; | |
434 | best_i = i; | |
435 | } | |
436 | } | |
437 | ||
438 | if (best_nr_matches > 0) { | |
439 | tuner_dbg("Selecting best matching firmware (%d bits) for " | |
440 | "type=", best_nr_matches); | |
441 | dump_firm_type(type); | |
442 | printk("(%x), id %016llx:\n", type, (unsigned long long)*id); | |
443 | i = best_i; | |
444 | goto found; | |
de3fe21b MCC |
445 | } |
446 | ||
447 | /*FIXME: Would make sense to seek for type "hint" match ? */ | |
448 | ||
b1535293 | 449 | i = -ENOENT; |
f380e1d2 | 450 | goto ret; |
de3fe21b MCC |
451 | |
452 | found: | |
453 | *id = priv->firm[i].id; | |
de3fe21b | 454 | |
f380e1d2 | 455 | ret: |
b1535293 | 456 | tuner_dbg("%s firmware for type=", (i < 0) ? "Can't find" : "Found"); |
83fb340b MCC |
457 | if (debug) { |
458 | dump_firm_type(type); | |
91240dd9 | 459 | printk("(%x), id %016llx.\n", type, (unsigned long long)*id); |
83fb340b | 460 | } |
f380e1d2 MCC |
461 | return i; |
462 | } | |
463 | ||
464 | static int load_firmware(struct dvb_frontend *fe, unsigned int type, | |
465 | v4l2_std_id *id) | |
466 | { | |
467 | struct xc2028_data *priv = fe->tuner_priv; | |
468 | int pos, rc; | |
0a196b6f | 469 | unsigned char *p, *endp, buf[priv->ctrl.max_len]; |
f380e1d2 | 470 | |
83fb340b | 471 | tuner_dbg("%s called\n", __FUNCTION__); |
f380e1d2 MCC |
472 | |
473 | pos = seek_firmware(fe, type, id); | |
474 | if (pos < 0) | |
475 | return pos; | |
476 | ||
83fb340b | 477 | tuner_info("Loading firmware for type="); |
b1535293 CP |
478 | dump_firm_type(priv->firm[pos].type); |
479 | printk("(%x), id %016llx.\n", priv->firm[pos].type, | |
480 | (unsigned long long)*id); | |
83fb340b | 481 | |
f380e1d2 | 482 | p = priv->firm[pos].ptr; |
f380e1d2 | 483 | endp = p + priv->firm[pos].size; |
6cb45879 | 484 | |
ab0b9fc6 | 485 | while (p < endp) { |
de3fe21b MCC |
486 | __u16 size; |
487 | ||
488 | /* Checks if there's enough bytes to read */ | |
ab0b9fc6 | 489 | if (p + sizeof(size) > endp) { |
83fb340b | 490 | tuner_err("Firmware chunk size is wrong\n"); |
de3fe21b MCC |
491 | return -EINVAL; |
492 | } | |
493 | ||
ab0b9fc6 | 494 | size = le16_to_cpu(*(__u16 *) p); |
de3fe21b MCC |
495 | p += sizeof(size); |
496 | ||
497 | if (size == 0xffff) | |
498 | return 0; | |
499 | ||
500 | if (!size) { | |
6cb45879 | 501 | /* Special callback command received */ |
215b95ba | 502 | rc = priv->tuner_callback(priv->video_dev, |
ab0b9fc6 MCC |
503 | XC2028_TUNER_RESET, 0); |
504 | if (rc < 0) { | |
83fb340b | 505 | tuner_err("Error at RESET code %d\n", |
ab0b9fc6 | 506 | (*p) & 0x7f); |
de3fe21b | 507 | return -EINVAL; |
6cb45879 | 508 | } |
6cb45879 MCC |
509 | continue; |
510 | } | |
5403bbae ML |
511 | if (size >= 0xff00) { |
512 | switch (size) { | |
513 | case 0xff00: | |
514 | rc = priv->tuner_callback(priv->video_dev, | |
515 | XC2028_RESET_CLK, 0); | |
516 | if (rc < 0) { | |
517 | tuner_err("Error at RESET code %d\n", | |
518 | (*p) & 0x7f); | |
519 | return -EINVAL; | |
520 | } | |
b32f9fb9 | 521 | break; |
5403bbae ML |
522 | default: |
523 | tuner_info("Invalid RESET code %d\n", | |
524 | size & 0x7f); | |
525 | return -EINVAL; | |
526 | ||
527 | } | |
2d4c0ac6 | 528 | continue; |
5403bbae | 529 | } |
de3fe21b MCC |
530 | |
531 | /* Checks for a sleep command */ | |
532 | if (size & 0x8000) { | |
ab0b9fc6 | 533 | msleep(size & 0x7fff); |
de3fe21b | 534 | continue; |
6cb45879 MCC |
535 | } |
536 | ||
de3fe21b | 537 | if ((size + p > endp)) { |
83fb340b | 538 | tuner_err("missing bytes: need %d, have %d\n", |
ab0b9fc6 | 539 | size, (int)(endp - p)); |
de3fe21b MCC |
540 | return -EINVAL; |
541 | } | |
6cb45879 | 542 | |
de3fe21b | 543 | buf[0] = *p; |
6cb45879 | 544 | p++; |
de3fe21b | 545 | size--; |
6cb45879 | 546 | |
de3fe21b | 547 | /* Sends message chunks */ |
ab0b9fc6 | 548 | while (size > 0) { |
0a196b6f CP |
549 | int len = (size < priv->ctrl.max_len - 1) ? |
550 | size : priv->ctrl.max_len - 1; | |
6cb45879 | 551 | |
ab0b9fc6 | 552 | memcpy(buf + 1, p, len); |
6cb45879 | 553 | |
47cc5b78 | 554 | rc = i2c_send(priv, buf, len + 1); |
ab0b9fc6 | 555 | if (rc < 0) { |
83fb340b | 556 | tuner_err("%d returned from send\n", rc); |
de3fe21b MCC |
557 | return -EINVAL; |
558 | } | |
559 | ||
560 | p += len; | |
561 | size -= len; | |
562 | } | |
563 | } | |
43efe702 | 564 | return 0; |
6cb45879 MCC |
565 | } |
566 | ||
f380e1d2 MCC |
567 | static int load_scode(struct dvb_frontend *fe, unsigned int type, |
568 | v4l2_std_id *id, int scode) | |
569 | { | |
570 | struct xc2028_data *priv = fe->tuner_priv; | |
571 | int pos, rc; | |
572 | unsigned char *p; | |
573 | ||
83fb340b | 574 | tuner_dbg("%s called\n", __FUNCTION__); |
f380e1d2 MCC |
575 | |
576 | pos = seek_firmware(fe, type, id); | |
577 | if (pos < 0) | |
578 | return pos; | |
579 | ||
580 | p = priv->firm[pos].ptr; | |
581 | ||
d7b22c5c CP |
582 | /* 16 SCODE entries per file; each SCODE entry is 12 bytes and |
583 | * has a 2-byte size header in the firmware format. */ | |
584 | if (priv->firm[pos].size != 14 * 16 || scode >= 16 || | |
585 | le16_to_cpu(*(__u16 *)(p + 14 * scode)) != 12) | |
f380e1d2 MCC |
586 | return -EINVAL; |
587 | ||
d7b22c5c CP |
588 | tuner_info("Loading SCODE for type="); |
589 | dump_firm_type(priv->firm[pos].type); | |
590 | printk("(%x), id %016llx.\n", priv->firm[pos].type, | |
591 | (unsigned long long)*id); | |
592 | ||
06fd82dc | 593 | if (priv->firm_version < 0x0202) |
47cc5b78 CP |
594 | rc = send_seq(priv, {0x20, 0x00, 0x00, 0x00}); |
595 | else | |
596 | rc = send_seq(priv, {0xa0, 0x00, 0x00, 0x00}); | |
597 | if (rc < 0) | |
598 | return -EIO; | |
f380e1d2 | 599 | |
d7b22c5c | 600 | rc = i2c_send(priv, p + 14 * scode + 2, 12); |
47cc5b78 CP |
601 | if (rc < 0) |
602 | return -EIO; | |
f380e1d2 | 603 | |
47cc5b78 CP |
604 | rc = send_seq(priv, {0x00, 0x8c}); |
605 | if (rc < 0) | |
606 | return -EIO; | |
f380e1d2 MCC |
607 | |
608 | return 0; | |
609 | } | |
610 | ||
215b95ba | 611 | static int check_firmware(struct dvb_frontend *fe, enum tuner_mode new_mode, |
ab0b9fc6 | 612 | v4l2_std_id std, fe_bandwidth_t bandwidth) |
6cb45879 | 613 | { |
215b95ba | 614 | struct xc2028_data *priv = fe->tuner_priv; |
8bf799a6 | 615 | int rc = 0, is_retry = 0; |
e0f0b37a CP |
616 | unsigned int type = 0; |
617 | struct firmware_properties new_fw; | |
7d58d111 | 618 | u16 version, hwmodel; |
47bd5bc6 | 619 | v4l2_std_id std0; |
6cb45879 | 620 | |
83fb340b | 621 | tuner_dbg("%s called\n", __FUNCTION__); |
6cb45879 | 622 | |
de3fe21b | 623 | if (!priv->firm) { |
a37b4c9b ML |
624 | if (!priv->ctrl.fname) { |
625 | tuner_info("xc2028/3028 firmware name not set!\n"); | |
de3fe21b | 626 | return -EINVAL; |
a37b4c9b | 627 | } |
de3fe21b | 628 | |
ab0b9fc6 MCC |
629 | rc = load_all_firmwares(fe); |
630 | if (rc < 0) | |
de3fe21b MCC |
631 | return rc; |
632 | } | |
633 | ||
e0f0b37a CP |
634 | if (priv->ctrl.type == XC2028_FIRM_MTS) |
635 | type |= MTS; | |
636 | if (bandwidth == BANDWIDTH_7_MHZ || bandwidth == BANDWIDTH_8_MHZ) | |
637 | type |= F8MHZ; | |
701672eb | 638 | |
e0f0b37a | 639 | /* FIXME: How to load FM and FM|INPUT1 firmwares? */ |
701672eb | 640 | |
e0f0b37a | 641 | if (new_mode == T_DIGITAL_TV) { |
59a636e5 CP |
642 | if (priv->ctrl.d2633) |
643 | type |= D2633; | |
644 | else | |
645 | type |= D2620; | |
de3fe21b | 646 | |
ab0b9fc6 | 647 | switch (bandwidth) { |
de3fe21b MCC |
648 | case BANDWIDTH_8_MHZ: |
649 | type |= DTV8; | |
701672eb | 650 | break; |
de3fe21b MCC |
651 | case BANDWIDTH_7_MHZ: |
652 | type |= DTV7; | |
701672eb | 653 | break; |
de3fe21b MCC |
654 | case BANDWIDTH_6_MHZ: |
655 | /* FIXME: Should allow select also ATSC */ | |
43efe702 | 656 | type |= DTV6 | QAM; |
701672eb | 657 | break; |
de3fe21b | 658 | default: |
83fb340b | 659 | tuner_err("error: bandwidth not supported.\n"); |
701672eb | 660 | }; |
6cb45879 MCC |
661 | } |
662 | ||
8bf799a6 | 663 | retry: |
e0f0b37a CP |
664 | new_fw.type = type; |
665 | new_fw.id = std; | |
666 | new_fw.std_req = std; | |
667 | new_fw.scode_table = SCODE | priv->ctrl.scode_table; | |
668 | new_fw.scode_nr = 0; | |
669 | ||
670 | tuner_dbg("checking firmware, user requested type="); | |
671 | if (debug) { | |
672 | dump_firm_type(new_fw.type); | |
673 | printk("(%x), id %016llx, scode_tbl ", new_fw.type, | |
674 | (unsigned long long)new_fw.std_req); | |
675 | dump_firm_type(priv->ctrl.scode_table); | |
676 | printk("(%x), scode_nr %d\n", priv->ctrl.scode_table, | |
677 | new_fw.scode_nr); | |
678 | } | |
679 | ||
680 | /* No need to reload base firmware if it matches */ | |
681 | if (((BASE | new_fw.type) & BASE_TYPES) == | |
682 | (priv->cur_fw.type & BASE_TYPES)) { | |
683 | tuner_dbg("BASE firmware not changed.\n"); | |
684 | goto skip_base; | |
685 | } | |
686 | ||
687 | /* Updating BASE - forget about all currently loaded firmware */ | |
688 | memset(&priv->cur_fw, 0, sizeof(priv->cur_fw)); | |
689 | ||
690 | /* Reset is needed before loading firmware */ | |
691 | rc = priv->tuner_callback(priv->video_dev, | |
692 | XC2028_TUNER_RESET, 0); | |
693 | if (rc < 0) | |
694 | goto fail; | |
695 | ||
47bd5bc6 CP |
696 | /* BASE firmwares are all std0 */ |
697 | std0 = 0; | |
698 | rc = load_firmware(fe, BASE | new_fw.type, &std0); | |
e0f0b37a CP |
699 | if (rc < 0) { |
700 | tuner_err("Error %d while loading base firmware\n", | |
701 | rc); | |
702 | goto fail; | |
703 | } | |
5403bbae | 704 | |
de3fe21b | 705 | /* Load INIT1, if needed */ |
83fb340b | 706 | tuner_dbg("Load init1 firmware, if exists\n"); |
de3fe21b | 707 | |
47bd5bc6 | 708 | rc = load_firmware(fe, BASE | INIT1 | new_fw.type, &std0); |
1ad0b796 CP |
709 | if (rc == -ENOENT) |
710 | rc = load_firmware(fe, (BASE | INIT1 | new_fw.type) & ~F8MHZ, | |
711 | &std0); | |
e0f0b37a CP |
712 | if (rc < 0 && rc != -ENOENT) { |
713 | tuner_err("Error %d while loading init1 firmware\n", | |
714 | rc); | |
715 | goto fail; | |
716 | } | |
de3fe21b | 717 | |
e0f0b37a CP |
718 | skip_base: |
719 | /* | |
720 | * No need to reload standard specific firmware if base firmware | |
721 | * was not reloaded and requested video standards have not changed. | |
de3fe21b | 722 | */ |
e0f0b37a CP |
723 | if (priv->cur_fw.type == (BASE | new_fw.type) && |
724 | priv->cur_fw.std_req == std) { | |
83fb340b | 725 | tuner_dbg("Std-specific firmware already loaded.\n"); |
e0f0b37a | 726 | goto skip_std_specific; |
2e4160ca | 727 | } |
6cb45879 | 728 | |
e0f0b37a CP |
729 | /* Reloading std-specific firmware forces a SCODE update */ |
730 | priv->cur_fw.scode_table = 0; | |
731 | ||
a82200fb | 732 | /* Add audio hack to std mask */ |
e0f0b37a CP |
733 | if (new_mode == T_ANALOG_TV) |
734 | new_fw.id |= parse_audio_std_option(); | |
a82200fb | 735 | |
e0f0b37a | 736 | rc = load_firmware(fe, new_fw.type, &new_fw.id); |
ab0b9fc6 | 737 | if (rc < 0) |
e0f0b37a CP |
738 | goto fail; |
739 | ||
740 | skip_std_specific: | |
741 | if (priv->cur_fw.scode_table == new_fw.scode_table && | |
742 | priv->cur_fw.scode_nr == new_fw.scode_nr) { | |
743 | tuner_dbg("SCODE firmware already loaded.\n"); | |
744 | goto check_device; | |
745 | } | |
6cb45879 | 746 | |
f380e1d2 | 747 | /* Load SCODE firmware, if exists */ |
e0f0b37a | 748 | tuner_dbg("Trying to load scode %d\n", new_fw.scode_nr); |
f380e1d2 | 749 | |
e0f0b37a CP |
750 | rc = load_scode(fe, new_fw.type | new_fw.scode_table, |
751 | &new_fw.id, new_fw.scode_nr); | |
43efe702 | 752 | |
e0f0b37a | 753 | check_device: |
8bf799a6 CP |
754 | if (xc2028_get_reg(priv, 0x0004, &version) < 0 || |
755 | xc2028_get_reg(priv, 0x0008, &hwmodel) < 0) { | |
756 | tuner_err("Unable to read tuner registers.\n"); | |
757 | goto fail; | |
758 | } | |
80b52208 MCC |
759 | |
760 | tuner_info("Device is Xceive %d version %d.%d, " | |
761 | "firmware version %d.%d\n", | |
762 | hwmodel, (version & 0xf000) >> 12, (version & 0xf00) >> 8, | |
763 | (version & 0xf0) >> 4, version & 0xf); | |
6cb45879 | 764 | |
8bf799a6 CP |
765 | /* Check firmware version against what we downloaded. */ |
766 | if (priv->firm_version != ((version & 0xf0) << 4 | (version & 0x0f))) { | |
767 | tuner_err("Incorrect readback of firmware version.\n"); | |
768 | goto fail; | |
769 | } | |
770 | ||
771 | /* Check that the tuner hardware model remains consistent over time. */ | |
772 | if (priv->hwmodel == 0 && (hwmodel == 2028 || hwmodel == 3028)) { | |
773 | priv->hwmodel = hwmodel; | |
774 | priv->hwvers = version & 0xff00; | |
775 | } else if (priv->hwmodel == 0 || priv->hwmodel != hwmodel || | |
776 | priv->hwvers != (version & 0xff00)) { | |
777 | tuner_err("Read invalid device hardware information - tuner " | |
778 | "hung?\n"); | |
779 | goto fail; | |
780 | } | |
781 | ||
e0f0b37a CP |
782 | memcpy(&priv->cur_fw, &new_fw, sizeof(priv->cur_fw)); |
783 | ||
784 | /* | |
785 | * By setting BASE in cur_fw.type only after successfully loading all | |
786 | * firmwares, we can: | |
787 | * 1. Identify that BASE firmware with type=0 has been loaded; | |
788 | * 2. Tell whether BASE firmware was just changed the next time through. | |
789 | */ | |
790 | priv->cur_fw.type |= BASE; | |
6cb45879 MCC |
791 | |
792 | return 0; | |
e0f0b37a CP |
793 | |
794 | fail: | |
795 | memset(&priv->cur_fw, 0, sizeof(priv->cur_fw)); | |
8bf799a6 CP |
796 | if (!is_retry) { |
797 | msleep(50); | |
798 | is_retry = 1; | |
799 | tuner_dbg("Retrying firmware load\n"); | |
800 | goto retry; | |
801 | } | |
802 | ||
e0f0b37a CP |
803 | if (rc == -ENOENT) |
804 | rc = -EINVAL; | |
805 | return rc; | |
6cb45879 MCC |
806 | } |
807 | ||
215b95ba | 808 | static int xc2028_signal(struct dvb_frontend *fe, u16 *strength) |
6cb45879 | 809 | { |
215b95ba | 810 | struct xc2028_data *priv = fe->tuner_priv; |
7d58d111 CP |
811 | u16 frq_lock, signal = 0; |
812 | int rc; | |
3b20532c | 813 | |
83fb340b | 814 | tuner_dbg("%s called\n", __FUNCTION__); |
6cb45879 | 815 | |
215b95ba | 816 | mutex_lock(&priv->lock); |
6cb45879 | 817 | |
80b52208 | 818 | /* Sync Lock Indicator */ |
7d58d111 CP |
819 | rc = xc2028_get_reg(priv, 0x0002, &frq_lock); |
820 | if (rc < 0 || frq_lock == 0) | |
3b20532c | 821 | goto ret; |
6cb45879 MCC |
822 | |
823 | /* Frequency is locked. Return signal quality */ | |
824 | ||
80b52208 | 825 | /* Get SNR of the video signal */ |
7d58d111 CP |
826 | rc = xc2028_get_reg(priv, 0x0040, &signal); |
827 | if (rc < 0) | |
828 | signal = -frq_lock; | |
3b20532c MCC |
829 | |
830 | ret: | |
215b95ba MCC |
831 | mutex_unlock(&priv->lock); |
832 | ||
833 | *strength = signal; | |
6cb45879 | 834 | |
7d58d111 | 835 | return rc; |
6cb45879 MCC |
836 | } |
837 | ||
838 | #define DIV 15625 | |
839 | ||
ab0b9fc6 MCC |
840 | static int generic_set_tv_freq(struct dvb_frontend *fe, u32 freq /* in Hz */ , |
841 | enum tuner_mode new_mode, | |
842 | v4l2_std_id std, fe_bandwidth_t bandwidth) | |
6cb45879 | 843 | { |
215b95ba | 844 | struct xc2028_data *priv = fe->tuner_priv; |
ab0b9fc6 | 845 | int rc = -EINVAL; |
2ce4b3aa | 846 | unsigned char buf[4]; |
ab0b9fc6 | 847 | u32 div, offset = 0; |
6cb45879 | 848 | |
83fb340b | 849 | tuner_dbg("%s called\n", __FUNCTION__); |
215b95ba | 850 | |
de3fe21b MCC |
851 | mutex_lock(&priv->lock); |
852 | ||
d4e76681 | 853 | /* HACK: It seems that specific firmware need to be reloaded |
e0f0b37a CP |
854 | when watching analog TV and freq is changed */ |
855 | if (new_mode != T_DIGITAL_TV) | |
856 | priv->cur_fw.type = 0; | |
215b95ba | 857 | |
2ce4b3aa | 858 | tuner_dbg("should set frequency %d kHz\n", freq / 1000); |
6cb45879 | 859 | |
ab0b9fc6 | 860 | if (check_firmware(fe, new_mode, std, bandwidth) < 0) |
3b20532c | 861 | goto ret; |
2e4160ca | 862 | |
a44f1c43 | 863 | if (new_mode == T_DIGITAL_TV) { |
d4e76681 | 864 | offset = 2750000; |
e0f0b37a | 865 | if (priv->cur_fw.type & DTV7) |
a44f1c43 CP |
866 | offset -= 500000; |
867 | } | |
2e4160ca | 868 | |
ab0b9fc6 | 869 | div = (freq - offset + DIV / 2) / DIV; |
2e4160ca | 870 | |
6cb45879 | 871 | /* CMD= Set frequency */ |
06fd82dc | 872 | if (priv->firm_version < 0x0202) |
47cc5b78 CP |
873 | rc = send_seq(priv, {0x00, 0x02, 0x00, 0x00}); |
874 | else | |
875 | rc = send_seq(priv, {0x80, 0x02, 0x00, 0x00}); | |
876 | if (rc < 0) | |
877 | goto ret; | |
de3fe21b | 878 | |
215b95ba | 879 | rc = priv->tuner_callback(priv->video_dev, XC2028_RESET_CLK, 1); |
ab0b9fc6 | 880 | if (rc < 0) |
215b95ba | 881 | goto ret; |
6cb45879 MCC |
882 | |
883 | msleep(10); | |
701672eb | 884 | |
ab0b9fc6 MCC |
885 | buf[0] = 0xff & (div >> 24); |
886 | buf[1] = 0xff & (div >> 16); | |
887 | buf[2] = 0xff & (div >> 8); | |
888 | buf[3] = 0xff & (div); | |
6cb45879 | 889 | |
47cc5b78 | 890 | rc = i2c_send(priv, buf, sizeof(buf)); |
ab0b9fc6 | 891 | if (rc < 0) |
3b20532c | 892 | goto ret; |
6cb45879 MCC |
893 | msleep(100); |
894 | ||
ab0b9fc6 | 895 | priv->frequency = freq; |
215b95ba | 896 | |
2ce4b3aa CP |
897 | tuner_dbg("divisor= %02x %02x %02x %02x (freq=%d.%03d)\n", |
898 | buf[0], buf[1], buf[2], buf[3], | |
899 | freq / 1000000, (freq % 1000000) / 1000); | |
3b20532c | 900 | |
ab0b9fc6 | 901 | rc = 0; |
6cb45879 | 902 | |
215b95ba MCC |
903 | ret: |
904 | mutex_unlock(&priv->lock); | |
6cb45879 | 905 | |
215b95ba | 906 | return rc; |
701672eb ML |
907 | } |
908 | ||
215b95ba | 909 | static int xc2028_set_tv_freq(struct dvb_frontend *fe, |
ab0b9fc6 | 910 | struct analog_parameters *p) |
6cb45879 | 911 | { |
215b95ba | 912 | struct xc2028_data *priv = fe->tuner_priv; |
c71d4bc5 MCC |
913 | fe_bandwidth_t bw; |
914 | ||
915 | /* FIXME: Maybe there are more 6 MHz video standards */ | |
916 | if (p->std & V4L2_STD_MN) | |
917 | bw = BANDWIDTH_6_MHZ; | |
918 | else | |
919 | bw = BANDWIDTH_8_MHZ; | |
6cb45879 | 920 | |
83fb340b | 921 | tuner_dbg("%s called\n", __FUNCTION__); |
6cb45879 | 922 | |
ab0b9fc6 | 923 | return generic_set_tv_freq(fe, 62500l * p->frequency, T_ANALOG_TV, |
c71d4bc5 | 924 | p->std, bw); |
215b95ba | 925 | } |
6cb45879 | 926 | |
215b95ba MCC |
927 | static int xc2028_set_params(struct dvb_frontend *fe, |
928 | struct dvb_frontend_parameters *p) | |
6cb45879 | 929 | { |
215b95ba | 930 | struct xc2028_data *priv = fe->tuner_priv; |
6cb45879 | 931 | |
83fb340b | 932 | tuner_dbg("%s called\n", __FUNCTION__); |
701672eb | 933 | |
215b95ba MCC |
934 | /* FIXME: Only OFDM implemented */ |
935 | if (fe->ops.info.type != FE_OFDM) { | |
83fb340b | 936 | tuner_err("DTV type not implemented.\n"); |
215b95ba | 937 | return -EINVAL; |
6cb45879 | 938 | } |
6cb45879 | 939 | |
215b95ba | 940 | return generic_set_tv_freq(fe, p->frequency, T_DIGITAL_TV, |
ab0b9fc6 MCC |
941 | 0 /* NOT USED */, |
942 | p->u.ofdm.bandwidth); | |
6cb45879 | 943 | |
6cb45879 | 944 | } |
701672eb | 945 | |
45819c38 CP |
946 | static int xc2028_sleep(struct dvb_frontend *fe) |
947 | { | |
948 | struct xc2028_data *priv = fe->tuner_priv; | |
949 | int rc = 0; | |
950 | ||
951 | tuner_dbg("%s called\n", __FUNCTION__); | |
952 | ||
953 | mutex_lock(&priv->lock); | |
954 | ||
955 | if (priv->firm_version < 0x0202) | |
956 | rc = send_seq(priv, {0x00, 0x08, 0x00, 0x00}); | |
957 | else | |
958 | rc = send_seq(priv, {0x80, 0x08, 0x00, 0x00}); | |
959 | ||
960 | priv->cur_fw.type = 0; /* need firmware reload */ | |
961 | ||
962 | mutex_unlock(&priv->lock); | |
963 | ||
964 | return rc; | |
965 | } | |
966 | ||
967 | ||
215b95ba | 968 | static int xc2028_dvb_release(struct dvb_frontend *fe) |
701672eb | 969 | { |
215b95ba MCC |
970 | struct xc2028_data *priv = fe->tuner_priv; |
971 | ||
83fb340b | 972 | tuner_dbg("%s called\n", __FUNCTION__); |
701672eb | 973 | |
aa501be9 CP |
974 | mutex_lock(&xc2028_list_mutex); |
975 | ||
215b95ba | 976 | priv->count--; |
701672eb | 977 | |
de3fe21b | 978 | if (!priv->count) { |
1808a698 MCC |
979 | list_del(&priv->xc2028_list); |
980 | ||
ab0b9fc6 | 981 | kfree(priv->ctrl.fname); |
de3fe21b MCC |
982 | |
983 | free_firmware(priv); | |
ab0b9fc6 | 984 | kfree(priv); |
06fd82dc | 985 | fe->tuner_priv = NULL; |
de3fe21b | 986 | } |
701672eb | 987 | |
aa501be9 CP |
988 | mutex_unlock(&xc2028_list_mutex); |
989 | ||
701672eb ML |
990 | return 0; |
991 | } | |
992 | ||
215b95ba | 993 | static int xc2028_get_frequency(struct dvb_frontend *fe, u32 *frequency) |
701672eb | 994 | { |
215b95ba | 995 | struct xc2028_data *priv = fe->tuner_priv; |
701672eb | 996 | |
83fb340b | 997 | tuner_dbg("%s called\n", __FUNCTION__); |
701672eb | 998 | |
215b95ba | 999 | *frequency = priv->frequency; |
701672eb ML |
1000 | |
1001 | return 0; | |
1002 | } | |
1003 | ||
ab0b9fc6 | 1004 | static int xc2028_set_config(struct dvb_frontend *fe, void *priv_cfg) |
de3fe21b MCC |
1005 | { |
1006 | struct xc2028_data *priv = fe->tuner_priv; | |
1007 | struct xc2028_ctrl *p = priv_cfg; | |
0a196b6f | 1008 | int rc = 0; |
de3fe21b | 1009 | |
83fb340b | 1010 | tuner_dbg("%s called\n", __FUNCTION__); |
de3fe21b | 1011 | |
06fd82dc CP |
1012 | mutex_lock(&priv->lock); |
1013 | ||
0a196b6f CP |
1014 | kfree(priv->ctrl.fname); |
1015 | free_firmware(priv); | |
de3fe21b | 1016 | |
0a196b6f CP |
1017 | memcpy(&priv->ctrl, p, sizeof(priv->ctrl)); |
1018 | priv->ctrl.fname = NULL; | |
de3fe21b | 1019 | |
0a196b6f CP |
1020 | if (p->fname) { |
1021 | priv->ctrl.fname = kstrdup(p->fname, GFP_KERNEL); | |
1022 | if (priv->ctrl.fname == NULL) | |
1023 | rc = -ENOMEM; | |
de3fe21b MCC |
1024 | } |
1025 | ||
0a196b6f CP |
1026 | if (priv->ctrl.max_len < 9) |
1027 | priv->ctrl.max_len = 13; | |
352fae1d | 1028 | |
06fd82dc CP |
1029 | mutex_unlock(&priv->lock); |
1030 | ||
0a196b6f | 1031 | return rc; |
de3fe21b MCC |
1032 | } |
1033 | ||
215b95ba | 1034 | static const struct dvb_tuner_ops xc2028_dvb_tuner_ops = { |
701672eb | 1035 | .info = { |
ab0b9fc6 MCC |
1036 | .name = "Xceive XC3028", |
1037 | .frequency_min = 42000000, | |
1038 | .frequency_max = 864000000, | |
1039 | .frequency_step = 50000, | |
1040 | }, | |
701672eb | 1041 | |
de3fe21b | 1042 | .set_config = xc2028_set_config, |
215b95ba MCC |
1043 | .set_analog_params = xc2028_set_tv_freq, |
1044 | .release = xc2028_dvb_release, | |
1045 | .get_frequency = xc2028_get_frequency, | |
1046 | .get_rf_strength = xc2028_signal, | |
1047 | .set_params = xc2028_set_params, | |
45819c38 | 1048 | .sleep = xc2028_sleep, |
701672eb | 1049 | |
701672eb ML |
1050 | }; |
1051 | ||
a37b4c9b | 1052 | void *xc2028_attach(struct dvb_frontend *fe, struct xc2028_config *cfg) |
701672eb | 1053 | { |
215b95ba | 1054 | struct xc2028_data *priv; |
a37b4c9b | 1055 | void *video_dev; |
701672eb | 1056 | |
83fb340b | 1057 | if (debug) |
3157ecef | 1058 | printk(KERN_DEBUG PREFIX ": Xcv2028/3028 init called!\n"); |
701672eb | 1059 | |
a37b4c9b ML |
1060 | if (NULL == cfg->video_dev) |
1061 | return NULL; | |
215b95ba | 1062 | |
a37b4c9b | 1063 | if (!fe) { |
3157ecef | 1064 | printk(KERN_ERR PREFIX ": No frontend!\n"); |
a37b4c9b | 1065 | return NULL; |
215b95ba MCC |
1066 | } |
1067 | ||
a37b4c9b ML |
1068 | video_dev = cfg->video_dev; |
1069 | ||
aa501be9 CP |
1070 | mutex_lock(&xc2028_list_mutex); |
1071 | ||
215b95ba | 1072 | list_for_each_entry(priv, &xc2028_list, xc2028_list) { |
a37b4c9b ML |
1073 | if (priv->video_dev == cfg->video_dev) { |
1074 | video_dev = NULL; | |
1075 | break; | |
1076 | } | |
215b95ba MCC |
1077 | } |
1078 | ||
a37b4c9b | 1079 | if (video_dev) { |
215b95ba | 1080 | priv = kzalloc(sizeof(*priv), GFP_KERNEL); |
aa501be9 CP |
1081 | if (priv == NULL) { |
1082 | mutex_unlock(&xc2028_list_mutex); | |
a37b4c9b | 1083 | return NULL; |
aa501be9 | 1084 | } |
3b20532c | 1085 | |
a37b4c9b ML |
1086 | priv->i2c_props.addr = cfg->i2c_addr; |
1087 | priv->i2c_props.adap = cfg->i2c_adap; | |
215b95ba | 1088 | priv->video_dev = video_dev; |
a37b4c9b | 1089 | priv->tuner_callback = cfg->callback; |
0a196b6f | 1090 | priv->ctrl.max_len = 13; |
de3fe21b | 1091 | |
215b95ba MCC |
1092 | mutex_init(&priv->lock); |
1093 | ||
ab0b9fc6 | 1094 | list_add_tail(&priv->xc2028_list, &xc2028_list); |
215b95ba | 1095 | } |
a37b4c9b ML |
1096 | |
1097 | fe->tuner_priv = priv; | |
1808a698 | 1098 | priv->count++; |
215b95ba MCC |
1099 | |
1100 | memcpy(&fe->ops.tuner_ops, &xc2028_dvb_tuner_ops, | |
ab0b9fc6 | 1101 | sizeof(xc2028_dvb_tuner_ops)); |
215b95ba MCC |
1102 | |
1103 | tuner_info("type set to %s\n", "XCeive xc2028/xc3028 tuner"); | |
1104 | ||
aa501be9 CP |
1105 | mutex_unlock(&xc2028_list_mutex); |
1106 | ||
a37b4c9b | 1107 | return fe; |
215b95ba | 1108 | } |
a37b4c9b | 1109 | |
701672eb ML |
1110 | EXPORT_SYMBOL(xc2028_attach); |
1111 | ||
215b95ba | 1112 | MODULE_DESCRIPTION("Xceive xc2028/xc3028 tuner driver"); |
983d214e | 1113 | MODULE_AUTHOR("Michel Ludwig <michel.ludwig@gmail.com>"); |
215b95ba MCC |
1114 | MODULE_AUTHOR("Mauro Carvalho Chehab <mchehab@infradead.org>"); |
1115 | MODULE_LICENSE("GPL"); |