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 | ||
5add9a6f | 634 | if (priv->ctrl.mts) |
e0f0b37a CP |
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); |
cca83798 MCC |
737 | if (rc == -ENOENT) |
738 | rc = load_firmware(fe, new_fw.type & ~F8MHZ, &new_fw.id); | |
739 | ||
ab0b9fc6 | 740 | if (rc < 0) |
e0f0b37a CP |
741 | goto fail; |
742 | ||
743 | skip_std_specific: | |
744 | if (priv->cur_fw.scode_table == new_fw.scode_table && | |
745 | priv->cur_fw.scode_nr == new_fw.scode_nr) { | |
746 | tuner_dbg("SCODE firmware already loaded.\n"); | |
747 | goto check_device; | |
748 | } | |
6cb45879 | 749 | |
f380e1d2 | 750 | /* Load SCODE firmware, if exists */ |
e0f0b37a | 751 | tuner_dbg("Trying to load scode %d\n", new_fw.scode_nr); |
f380e1d2 | 752 | |
e0f0b37a CP |
753 | rc = load_scode(fe, new_fw.type | new_fw.scode_table, |
754 | &new_fw.id, new_fw.scode_nr); | |
43efe702 | 755 | |
e0f0b37a | 756 | check_device: |
8bf799a6 CP |
757 | if (xc2028_get_reg(priv, 0x0004, &version) < 0 || |
758 | xc2028_get_reg(priv, 0x0008, &hwmodel) < 0) { | |
759 | tuner_err("Unable to read tuner registers.\n"); | |
760 | goto fail; | |
761 | } | |
80b52208 MCC |
762 | |
763 | tuner_info("Device is Xceive %d version %d.%d, " | |
764 | "firmware version %d.%d\n", | |
765 | hwmodel, (version & 0xf000) >> 12, (version & 0xf00) >> 8, | |
766 | (version & 0xf0) >> 4, version & 0xf); | |
6cb45879 | 767 | |
8bf799a6 CP |
768 | /* Check firmware version against what we downloaded. */ |
769 | if (priv->firm_version != ((version & 0xf0) << 4 | (version & 0x0f))) { | |
770 | tuner_err("Incorrect readback of firmware version.\n"); | |
771 | goto fail; | |
772 | } | |
773 | ||
774 | /* Check that the tuner hardware model remains consistent over time. */ | |
775 | if (priv->hwmodel == 0 && (hwmodel == 2028 || hwmodel == 3028)) { | |
776 | priv->hwmodel = hwmodel; | |
777 | priv->hwvers = version & 0xff00; | |
778 | } else if (priv->hwmodel == 0 || priv->hwmodel != hwmodel || | |
779 | priv->hwvers != (version & 0xff00)) { | |
780 | tuner_err("Read invalid device hardware information - tuner " | |
781 | "hung?\n"); | |
782 | goto fail; | |
783 | } | |
784 | ||
e0f0b37a CP |
785 | memcpy(&priv->cur_fw, &new_fw, sizeof(priv->cur_fw)); |
786 | ||
787 | /* | |
788 | * By setting BASE in cur_fw.type only after successfully loading all | |
789 | * firmwares, we can: | |
790 | * 1. Identify that BASE firmware with type=0 has been loaded; | |
791 | * 2. Tell whether BASE firmware was just changed the next time through. | |
792 | */ | |
793 | priv->cur_fw.type |= BASE; | |
6cb45879 MCC |
794 | |
795 | return 0; | |
e0f0b37a CP |
796 | |
797 | fail: | |
798 | memset(&priv->cur_fw, 0, sizeof(priv->cur_fw)); | |
8bf799a6 CP |
799 | if (!is_retry) { |
800 | msleep(50); | |
801 | is_retry = 1; | |
802 | tuner_dbg("Retrying firmware load\n"); | |
803 | goto retry; | |
804 | } | |
805 | ||
e0f0b37a CP |
806 | if (rc == -ENOENT) |
807 | rc = -EINVAL; | |
808 | return rc; | |
6cb45879 MCC |
809 | } |
810 | ||
215b95ba | 811 | static int xc2028_signal(struct dvb_frontend *fe, u16 *strength) |
6cb45879 | 812 | { |
215b95ba | 813 | struct xc2028_data *priv = fe->tuner_priv; |
7d58d111 CP |
814 | u16 frq_lock, signal = 0; |
815 | int rc; | |
3b20532c | 816 | |
83fb340b | 817 | tuner_dbg("%s called\n", __FUNCTION__); |
6cb45879 | 818 | |
215b95ba | 819 | mutex_lock(&priv->lock); |
6cb45879 | 820 | |
80b52208 | 821 | /* Sync Lock Indicator */ |
7d58d111 CP |
822 | rc = xc2028_get_reg(priv, 0x0002, &frq_lock); |
823 | if (rc < 0 || frq_lock == 0) | |
3b20532c | 824 | goto ret; |
6cb45879 MCC |
825 | |
826 | /* Frequency is locked. Return signal quality */ | |
827 | ||
80b52208 | 828 | /* Get SNR of the video signal */ |
7d58d111 CP |
829 | rc = xc2028_get_reg(priv, 0x0040, &signal); |
830 | if (rc < 0) | |
831 | signal = -frq_lock; | |
3b20532c MCC |
832 | |
833 | ret: | |
215b95ba MCC |
834 | mutex_unlock(&priv->lock); |
835 | ||
836 | *strength = signal; | |
6cb45879 | 837 | |
7d58d111 | 838 | return rc; |
6cb45879 MCC |
839 | } |
840 | ||
841 | #define DIV 15625 | |
842 | ||
ab0b9fc6 MCC |
843 | static int generic_set_tv_freq(struct dvb_frontend *fe, u32 freq /* in Hz */ , |
844 | enum tuner_mode new_mode, | |
845 | v4l2_std_id std, fe_bandwidth_t bandwidth) | |
6cb45879 | 846 | { |
215b95ba | 847 | struct xc2028_data *priv = fe->tuner_priv; |
ab0b9fc6 | 848 | int rc = -EINVAL; |
2ce4b3aa | 849 | unsigned char buf[4]; |
ab0b9fc6 | 850 | u32 div, offset = 0; |
6cb45879 | 851 | |
83fb340b | 852 | tuner_dbg("%s called\n", __FUNCTION__); |
215b95ba | 853 | |
de3fe21b MCC |
854 | mutex_lock(&priv->lock); |
855 | ||
2ce4b3aa | 856 | tuner_dbg("should set frequency %d kHz\n", freq / 1000); |
6cb45879 | 857 | |
ab0b9fc6 | 858 | if (check_firmware(fe, new_mode, std, bandwidth) < 0) |
3b20532c | 859 | goto ret; |
2e4160ca | 860 | |
2800ae9c MCC |
861 | /* On some cases xc2028 can disable video output, if |
862 | * very weak signals are received. By sending a soft | |
863 | * reset, this is re-enabled. So, it is better to always | |
864 | * send a soft reset before changing channels, to be sure | |
865 | * that xc2028 will be in a safe state. | |
866 | * Maybe this might also be needed for DTV. | |
867 | */ | |
868 | if (new_mode != T_DIGITAL_TV) | |
869 | rc = send_seq(priv, {0x00, 0x00}); | |
870 | ||
a44f1c43 | 871 | if (new_mode == T_DIGITAL_TV) { |
d4e76681 | 872 | offset = 2750000; |
e0f0b37a | 873 | if (priv->cur_fw.type & DTV7) |
a44f1c43 CP |
874 | offset -= 500000; |
875 | } | |
2e4160ca | 876 | |
ab0b9fc6 | 877 | div = (freq - offset + DIV / 2) / DIV; |
2e4160ca | 878 | |
6cb45879 | 879 | /* CMD= Set frequency */ |
06fd82dc | 880 | if (priv->firm_version < 0x0202) |
47cc5b78 CP |
881 | rc = send_seq(priv, {0x00, 0x02, 0x00, 0x00}); |
882 | else | |
883 | rc = send_seq(priv, {0x80, 0x02, 0x00, 0x00}); | |
884 | if (rc < 0) | |
885 | goto ret; | |
de3fe21b | 886 | |
215b95ba | 887 | rc = priv->tuner_callback(priv->video_dev, XC2028_RESET_CLK, 1); |
ab0b9fc6 | 888 | if (rc < 0) |
215b95ba | 889 | goto ret; |
6cb45879 MCC |
890 | |
891 | msleep(10); | |
701672eb | 892 | |
ab0b9fc6 MCC |
893 | buf[0] = 0xff & (div >> 24); |
894 | buf[1] = 0xff & (div >> 16); | |
895 | buf[2] = 0xff & (div >> 8); | |
896 | buf[3] = 0xff & (div); | |
6cb45879 | 897 | |
47cc5b78 | 898 | rc = i2c_send(priv, buf, sizeof(buf)); |
ab0b9fc6 | 899 | if (rc < 0) |
3b20532c | 900 | goto ret; |
6cb45879 MCC |
901 | msleep(100); |
902 | ||
ab0b9fc6 | 903 | priv->frequency = freq; |
215b95ba | 904 | |
2ce4b3aa CP |
905 | tuner_dbg("divisor= %02x %02x %02x %02x (freq=%d.%03d)\n", |
906 | buf[0], buf[1], buf[2], buf[3], | |
907 | freq / 1000000, (freq % 1000000) / 1000); | |
3b20532c | 908 | |
ab0b9fc6 | 909 | rc = 0; |
6cb45879 | 910 | |
215b95ba MCC |
911 | ret: |
912 | mutex_unlock(&priv->lock); | |
6cb45879 | 913 | |
215b95ba | 914 | return rc; |
701672eb ML |
915 | } |
916 | ||
215b95ba | 917 | static int xc2028_set_tv_freq(struct dvb_frontend *fe, |
ab0b9fc6 | 918 | struct analog_parameters *p) |
6cb45879 | 919 | { |
215b95ba | 920 | struct xc2028_data *priv = fe->tuner_priv; |
c71d4bc5 MCC |
921 | fe_bandwidth_t bw; |
922 | ||
a5e9fe14 MCC |
923 | /* if std is not defined, choose one */ |
924 | if (!p->std) | |
925 | p->std = V4L2_STD_MN; | |
926 | ||
927 | /* PAL/M, PAL/N, PAL/Nc and NTSC variants should use 6MHz firmware */ | |
c71d4bc5 MCC |
928 | if (p->std & V4L2_STD_MN) |
929 | bw = BANDWIDTH_6_MHZ; | |
930 | else | |
931 | bw = BANDWIDTH_8_MHZ; | |
6cb45879 | 932 | |
83fb340b | 933 | tuner_dbg("%s called\n", __FUNCTION__); |
6cb45879 | 934 | |
ab0b9fc6 | 935 | return generic_set_tv_freq(fe, 62500l * p->frequency, T_ANALOG_TV, |
c71d4bc5 | 936 | p->std, bw); |
215b95ba | 937 | } |
6cb45879 | 938 | |
215b95ba MCC |
939 | static int xc2028_set_params(struct dvb_frontend *fe, |
940 | struct dvb_frontend_parameters *p) | |
6cb45879 | 941 | { |
215b95ba | 942 | struct xc2028_data *priv = fe->tuner_priv; |
6cb45879 | 943 | |
83fb340b | 944 | tuner_dbg("%s called\n", __FUNCTION__); |
701672eb | 945 | |
215b95ba MCC |
946 | /* FIXME: Only OFDM implemented */ |
947 | if (fe->ops.info.type != FE_OFDM) { | |
83fb340b | 948 | tuner_err("DTV type not implemented.\n"); |
215b95ba | 949 | return -EINVAL; |
6cb45879 | 950 | } |
6cb45879 | 951 | |
215b95ba | 952 | return generic_set_tv_freq(fe, p->frequency, T_DIGITAL_TV, |
ab0b9fc6 MCC |
953 | 0 /* NOT USED */, |
954 | p->u.ofdm.bandwidth); | |
6cb45879 | 955 | |
6cb45879 | 956 | } |
701672eb | 957 | |
45819c38 CP |
958 | static int xc2028_sleep(struct dvb_frontend *fe) |
959 | { | |
960 | struct xc2028_data *priv = fe->tuner_priv; | |
961 | int rc = 0; | |
962 | ||
963 | tuner_dbg("%s called\n", __FUNCTION__); | |
964 | ||
965 | mutex_lock(&priv->lock); | |
966 | ||
967 | if (priv->firm_version < 0x0202) | |
968 | rc = send_seq(priv, {0x00, 0x08, 0x00, 0x00}); | |
969 | else | |
970 | rc = send_seq(priv, {0x80, 0x08, 0x00, 0x00}); | |
971 | ||
972 | priv->cur_fw.type = 0; /* need firmware reload */ | |
973 | ||
974 | mutex_unlock(&priv->lock); | |
975 | ||
976 | return rc; | |
977 | } | |
978 | ||
979 | ||
215b95ba | 980 | static int xc2028_dvb_release(struct dvb_frontend *fe) |
701672eb | 981 | { |
215b95ba MCC |
982 | struct xc2028_data *priv = fe->tuner_priv; |
983 | ||
83fb340b | 984 | tuner_dbg("%s called\n", __FUNCTION__); |
701672eb | 985 | |
aa501be9 CP |
986 | mutex_lock(&xc2028_list_mutex); |
987 | ||
215b95ba | 988 | priv->count--; |
701672eb | 989 | |
de3fe21b | 990 | if (!priv->count) { |
1808a698 MCC |
991 | list_del(&priv->xc2028_list); |
992 | ||
ab0b9fc6 | 993 | kfree(priv->ctrl.fname); |
de3fe21b MCC |
994 | |
995 | free_firmware(priv); | |
ab0b9fc6 | 996 | kfree(priv); |
06fd82dc | 997 | fe->tuner_priv = NULL; |
de3fe21b | 998 | } |
701672eb | 999 | |
aa501be9 CP |
1000 | mutex_unlock(&xc2028_list_mutex); |
1001 | ||
701672eb ML |
1002 | return 0; |
1003 | } | |
1004 | ||
215b95ba | 1005 | static int xc2028_get_frequency(struct dvb_frontend *fe, u32 *frequency) |
701672eb | 1006 | { |
215b95ba | 1007 | struct xc2028_data *priv = fe->tuner_priv; |
701672eb | 1008 | |
83fb340b | 1009 | tuner_dbg("%s called\n", __FUNCTION__); |
701672eb | 1010 | |
215b95ba | 1011 | *frequency = priv->frequency; |
701672eb ML |
1012 | |
1013 | return 0; | |
1014 | } | |
1015 | ||
ab0b9fc6 | 1016 | static int xc2028_set_config(struct dvb_frontend *fe, void *priv_cfg) |
de3fe21b MCC |
1017 | { |
1018 | struct xc2028_data *priv = fe->tuner_priv; | |
1019 | struct xc2028_ctrl *p = priv_cfg; | |
0a196b6f | 1020 | int rc = 0; |
de3fe21b | 1021 | |
83fb340b | 1022 | tuner_dbg("%s called\n", __FUNCTION__); |
de3fe21b | 1023 | |
06fd82dc CP |
1024 | mutex_lock(&priv->lock); |
1025 | ||
0a196b6f CP |
1026 | kfree(priv->ctrl.fname); |
1027 | free_firmware(priv); | |
de3fe21b | 1028 | |
0a196b6f CP |
1029 | memcpy(&priv->ctrl, p, sizeof(priv->ctrl)); |
1030 | priv->ctrl.fname = NULL; | |
de3fe21b | 1031 | |
0a196b6f CP |
1032 | if (p->fname) { |
1033 | priv->ctrl.fname = kstrdup(p->fname, GFP_KERNEL); | |
1034 | if (priv->ctrl.fname == NULL) | |
1035 | rc = -ENOMEM; | |
de3fe21b MCC |
1036 | } |
1037 | ||
0a196b6f CP |
1038 | if (priv->ctrl.max_len < 9) |
1039 | priv->ctrl.max_len = 13; | |
352fae1d | 1040 | |
06fd82dc CP |
1041 | mutex_unlock(&priv->lock); |
1042 | ||
0a196b6f | 1043 | return rc; |
de3fe21b MCC |
1044 | } |
1045 | ||
215b95ba | 1046 | static const struct dvb_tuner_ops xc2028_dvb_tuner_ops = { |
701672eb | 1047 | .info = { |
ab0b9fc6 MCC |
1048 | .name = "Xceive XC3028", |
1049 | .frequency_min = 42000000, | |
1050 | .frequency_max = 864000000, | |
1051 | .frequency_step = 50000, | |
1052 | }, | |
701672eb | 1053 | |
de3fe21b | 1054 | .set_config = xc2028_set_config, |
215b95ba MCC |
1055 | .set_analog_params = xc2028_set_tv_freq, |
1056 | .release = xc2028_dvb_release, | |
1057 | .get_frequency = xc2028_get_frequency, | |
1058 | .get_rf_strength = xc2028_signal, | |
1059 | .set_params = xc2028_set_params, | |
45819c38 | 1060 | .sleep = xc2028_sleep, |
701672eb | 1061 | |
701672eb ML |
1062 | }; |
1063 | ||
a37b4c9b | 1064 | void *xc2028_attach(struct dvb_frontend *fe, struct xc2028_config *cfg) |
701672eb | 1065 | { |
215b95ba | 1066 | struct xc2028_data *priv; |
a37b4c9b | 1067 | void *video_dev; |
701672eb | 1068 | |
83fb340b | 1069 | if (debug) |
3157ecef | 1070 | printk(KERN_DEBUG PREFIX ": Xcv2028/3028 init called!\n"); |
701672eb | 1071 | |
71a2ee37 | 1072 | if (NULL == cfg || NULL == cfg->video_dev) |
a37b4c9b | 1073 | return NULL; |
215b95ba | 1074 | |
a37b4c9b | 1075 | if (!fe) { |
3157ecef | 1076 | printk(KERN_ERR PREFIX ": No frontend!\n"); |
a37b4c9b | 1077 | return NULL; |
215b95ba MCC |
1078 | } |
1079 | ||
a37b4c9b ML |
1080 | video_dev = cfg->video_dev; |
1081 | ||
aa501be9 CP |
1082 | mutex_lock(&xc2028_list_mutex); |
1083 | ||
215b95ba | 1084 | list_for_each_entry(priv, &xc2028_list, xc2028_list) { |
a37b4c9b ML |
1085 | if (priv->video_dev == cfg->video_dev) { |
1086 | video_dev = NULL; | |
1087 | break; | |
1088 | } | |
215b95ba MCC |
1089 | } |
1090 | ||
a37b4c9b | 1091 | if (video_dev) { |
215b95ba | 1092 | priv = kzalloc(sizeof(*priv), GFP_KERNEL); |
aa501be9 CP |
1093 | if (priv == NULL) { |
1094 | mutex_unlock(&xc2028_list_mutex); | |
a37b4c9b | 1095 | return NULL; |
aa501be9 | 1096 | } |
3b20532c | 1097 | |
a37b4c9b ML |
1098 | priv->i2c_props.addr = cfg->i2c_addr; |
1099 | priv->i2c_props.adap = cfg->i2c_adap; | |
215b95ba | 1100 | priv->video_dev = video_dev; |
a37b4c9b | 1101 | priv->tuner_callback = cfg->callback; |
0a196b6f | 1102 | priv->ctrl.max_len = 13; |
de3fe21b | 1103 | |
215b95ba MCC |
1104 | mutex_init(&priv->lock); |
1105 | ||
ab0b9fc6 | 1106 | list_add_tail(&priv->xc2028_list, &xc2028_list); |
215b95ba | 1107 | } |
a37b4c9b ML |
1108 | |
1109 | fe->tuner_priv = priv; | |
1808a698 | 1110 | priv->count++; |
215b95ba MCC |
1111 | |
1112 | memcpy(&fe->ops.tuner_ops, &xc2028_dvb_tuner_ops, | |
ab0b9fc6 | 1113 | sizeof(xc2028_dvb_tuner_ops)); |
215b95ba MCC |
1114 | |
1115 | tuner_info("type set to %s\n", "XCeive xc2028/xc3028 tuner"); | |
1116 | ||
71a2ee37 MCC |
1117 | if (cfg->ctrl) |
1118 | xc2028_set_config(fe, cfg->ctrl); | |
1119 | ||
aa501be9 CP |
1120 | mutex_unlock(&xc2028_list_mutex); |
1121 | ||
a37b4c9b | 1122 | return fe; |
215b95ba | 1123 | } |
a37b4c9b | 1124 | |
701672eb ML |
1125 | EXPORT_SYMBOL(xc2028_attach); |
1126 | ||
215b95ba | 1127 | MODULE_DESCRIPTION("Xceive xc2028/xc3028 tuner driver"); |
983d214e | 1128 | MODULE_AUTHOR("Michel Ludwig <michel.ludwig@gmail.com>"); |
215b95ba MCC |
1129 | MODULE_AUTHOR("Mauro Carvalho Chehab <mchehab@infradead.org>"); |
1130 | MODULE_LICENSE("GPL"); |