1 | // SPDX-License-Identifier: GPL-2.0-or-later |
2 | /* |
3 | * Silicon Labs Si2146/2147/2148/2157/2158 silicon tuner driver |
4 | * |
5 | * Copyright (C) 2014 Antti Palosaari <crope@iki.fi> |
6 | */ |
7 | |
8 | #include "si2157_priv.h" |
9 | |
10 | static const struct dvb_tuner_ops si2157_ops; |
11 | |
12 | static int tuner_lock_debug; |
13 | module_param(tuner_lock_debug, int, 0644); |
14 | MODULE_PARM_DESC(tuner_lock_debug, "if set, signal lock is briefly waited on after setting params" ); |
15 | |
16 | /* execute firmware command */ |
17 | static int si2157_cmd_execute(struct i2c_client *client, struct si2157_cmd *cmd) |
18 | { |
19 | struct si2157_dev *dev = i2c_get_clientdata(client); |
20 | int ret; |
21 | unsigned long timeout; |
22 | |
23 | mutex_lock(&dev->i2c_mutex); |
24 | |
25 | if (cmd->wlen) { |
26 | /* write cmd and args for firmware */ |
27 | ret = i2c_master_send(client, buf: cmd->args, count: cmd->wlen); |
28 | if (ret < 0) { |
29 | goto err_mutex_unlock; |
30 | } else if (ret != cmd->wlen) { |
31 | ret = -EREMOTEIO; |
32 | goto err_mutex_unlock; |
33 | } |
34 | } |
35 | |
36 | if (cmd->rlen) { |
37 | /* wait cmd execution terminate */ |
38 | #define TIMEOUT 80 |
39 | timeout = jiffies + msecs_to_jiffies(TIMEOUT); |
40 | while (!time_after(jiffies, timeout)) { |
41 | ret = i2c_master_recv(client, buf: cmd->args, count: cmd->rlen); |
42 | if (ret < 0) { |
43 | goto err_mutex_unlock; |
44 | } else if (ret != cmd->rlen) { |
45 | ret = -EREMOTEIO; |
46 | goto err_mutex_unlock; |
47 | } |
48 | |
49 | /* firmware ready? */ |
50 | if ((cmd->args[0] >> 7) & 0x01) |
51 | break; |
52 | } |
53 | |
54 | dev_dbg(&client->dev, "cmd execution took %d ms, status=%x\n" , |
55 | jiffies_to_msecs(jiffies) - |
56 | (jiffies_to_msecs(timeout) - TIMEOUT), |
57 | cmd->args[0]); |
58 | |
59 | if (!((cmd->args[0] >> 7) & 0x01)) { |
60 | ret = -ETIMEDOUT; |
61 | goto err_mutex_unlock; |
62 | } |
63 | /* check error status bit */ |
64 | if (cmd->args[0] & 0x40) { |
65 | ret = -EAGAIN; |
66 | goto err_mutex_unlock; |
67 | } |
68 | } |
69 | |
70 | mutex_unlock(lock: &dev->i2c_mutex); |
71 | return 0; |
72 | |
73 | err_mutex_unlock: |
74 | mutex_unlock(lock: &dev->i2c_mutex); |
75 | dev_dbg(&client->dev, "failed=%d\n" , ret); |
76 | return ret; |
77 | } |
78 | |
79 | static const struct si2157_tuner_info si2157_tuners[] = { |
80 | { SI2141, 0x60, false, SI2141_60_FIRMWARE, SI2141_A10_FIRMWARE }, |
81 | { SI2141, 0x61, false, SI2141_61_FIRMWARE, SI2141_A10_FIRMWARE }, |
82 | { SI2146, 0x11, false, SI2146_11_FIRMWARE, NULL }, |
83 | { SI2147, 0x50, false, SI2147_50_FIRMWARE, NULL }, |
84 | { SI2148, 0x32, true, SI2148_32_FIRMWARE, SI2158_A20_FIRMWARE }, |
85 | { SI2148, 0x33, true, SI2148_33_FIRMWARE, SI2158_A20_FIRMWARE }, |
86 | { SI2157, 0x50, false, SI2157_50_FIRMWARE, SI2157_A30_FIRMWARE }, |
87 | { SI2158, 0x50, false, SI2158_50_FIRMWARE, SI2158_A20_FIRMWARE }, |
88 | { SI2158, 0x51, false, SI2158_51_FIRMWARE, SI2158_A20_FIRMWARE }, |
89 | { SI2177, 0x50, false, SI2177_50_FIRMWARE, SI2157_A30_FIRMWARE }, |
90 | }; |
91 | |
92 | static int si2157_load_firmware(struct dvb_frontend *fe, |
93 | const char *fw_name) |
94 | { |
95 | struct i2c_client *client = fe->tuner_priv; |
96 | const struct firmware *fw; |
97 | int ret, len, remaining; |
98 | struct si2157_cmd cmd; |
99 | |
100 | /* request the firmware, this will block and timeout */ |
101 | ret = firmware_request_nowarn(fw: &fw, name: fw_name, device: &client->dev); |
102 | if (ret) |
103 | return ret; |
104 | |
105 | /* firmware should be n chunks of 17 bytes */ |
106 | if (fw->size % 17 != 0) { |
107 | dev_err(&client->dev, "firmware file '%s' is invalid\n" , |
108 | fw_name); |
109 | ret = -EINVAL; |
110 | goto err_release_firmware; |
111 | } |
112 | |
113 | dev_info(&client->dev, "downloading firmware from file '%s'\n" , |
114 | fw_name); |
115 | |
116 | for (remaining = fw->size; remaining > 0; remaining -= 17) { |
117 | len = fw->data[fw->size - remaining]; |
118 | if (len > SI2157_ARGLEN) { |
119 | dev_err(&client->dev, "Bad firmware length\n" ); |
120 | ret = -EINVAL; |
121 | goto err_release_firmware; |
122 | } |
123 | memcpy(cmd.args, &fw->data[(fw->size - remaining) + 1], len); |
124 | cmd.wlen = len; |
125 | cmd.rlen = 1; |
126 | ret = si2157_cmd_execute(client, cmd: &cmd); |
127 | if (ret) { |
128 | dev_err(&client->dev, "firmware download failed %d\n" , |
129 | ret); |
130 | goto err_release_firmware; |
131 | } |
132 | } |
133 | |
134 | err_release_firmware: |
135 | release_firmware(fw); |
136 | |
137 | return ret; |
138 | } |
139 | |
140 | static int si2157_find_and_load_firmware(struct dvb_frontend *fe) |
141 | { |
142 | struct i2c_client *client = fe->tuner_priv; |
143 | struct si2157_dev *dev = i2c_get_clientdata(client); |
144 | const char *fw_alt_name = NULL; |
145 | unsigned char part_id, rom_id; |
146 | const char *fw_name = NULL; |
147 | struct si2157_cmd cmd; |
148 | bool required = true; |
149 | int ret, i; |
150 | |
151 | if (dev->dont_load_firmware) { |
152 | dev_info(&client->dev, |
153 | "device is buggy, skipping firmware download\n" ); |
154 | return 0; |
155 | } |
156 | |
157 | /* query chip revision */ |
158 | memcpy(cmd.args, "\x02" , 1); |
159 | cmd.wlen = 1; |
160 | cmd.rlen = 13; |
161 | ret = si2157_cmd_execute(client, cmd: &cmd); |
162 | if (ret) |
163 | return ret; |
164 | |
165 | part_id = cmd.args[2]; |
166 | rom_id = cmd.args[12]; |
167 | |
168 | for (i = 0; i < ARRAY_SIZE(si2157_tuners); i++) { |
169 | if (si2157_tuners[i].part_id != part_id) |
170 | continue; |
171 | required = si2157_tuners[i].required; |
172 | fw_alt_name = si2157_tuners[i].fw_alt_name; |
173 | |
174 | /* Both part and rom ID match */ |
175 | if (si2157_tuners[i].rom_id == rom_id) { |
176 | fw_name = si2157_tuners[i].fw_name; |
177 | break; |
178 | } |
179 | } |
180 | |
181 | if (required && !fw_name && !fw_alt_name) { |
182 | dev_err(&client->dev, |
183 | "unknown chip version Si21%d-%c%c%c ROM 0x%02x\n" , |
184 | part_id, cmd.args[1], cmd.args[3], cmd.args[4], rom_id); |
185 | return -EINVAL; |
186 | } |
187 | |
188 | /* Update the part id based on device's report */ |
189 | dev->part_id = part_id; |
190 | |
191 | dev_info(&client->dev, |
192 | "found a 'Silicon Labs Si21%d-%c%c%c ROM 0x%02x'\n" , |
193 | part_id, cmd.args[1], cmd.args[3], cmd.args[4], rom_id); |
194 | |
195 | if (fw_name) |
196 | ret = si2157_load_firmware(fe, fw_name); |
197 | else |
198 | ret = -ENOENT; |
199 | |
200 | /* Try alternate name, if any */ |
201 | if (ret == -ENOENT && fw_alt_name) |
202 | ret = si2157_load_firmware(fe, fw_name: fw_alt_name); |
203 | |
204 | if (ret == -ENOENT) { |
205 | if (!required) { |
206 | dev_info(&client->dev, "Using ROM firmware.\n" ); |
207 | return 0; |
208 | } |
209 | dev_err(&client->dev, "Can't continue without a firmware.\n" ); |
210 | } else if (ret < 0) { |
211 | dev_err(&client->dev, "error %d when loading firmware\n" , ret); |
212 | } |
213 | return ret; |
214 | } |
215 | |
216 | static int si2157_init(struct dvb_frontend *fe) |
217 | { |
218 | struct dtv_frontend_properties *c = &fe->dtv_property_cache; |
219 | struct i2c_client *client = fe->tuner_priv; |
220 | struct si2157_dev *dev = i2c_get_clientdata(client); |
221 | unsigned int xtal_trim; |
222 | struct si2157_cmd cmd; |
223 | int ret; |
224 | |
225 | dev_dbg(&client->dev, "\n" ); |
226 | |
227 | /* Try to get Xtal trim property, to verify tuner still running */ |
228 | memcpy(cmd.args, "\x15\x00\x02\x04" , 4); |
229 | cmd.wlen = 4; |
230 | cmd.rlen = 4; |
231 | ret = si2157_cmd_execute(client, cmd: &cmd); |
232 | |
233 | xtal_trim = cmd.args[2] | (cmd.args[3] << 8); |
234 | |
235 | if (ret == 0 && xtal_trim < 16) |
236 | goto warm; |
237 | |
238 | dev->if_frequency = 0; /* we no longer know current tuner state */ |
239 | |
240 | /* power up */ |
241 | if (dev->part_id == SI2146) { |
242 | /* clock_mode = XTAL, clock_freq = 24MHz */ |
243 | memcpy(cmd.args, "\xc0\x05\x01\x00\x00\x0b\x00\x00\x01" , 9); |
244 | cmd.wlen = 9; |
245 | } else if (dev->part_id == SI2141) { |
246 | /* clock_mode: XTAL, xout enabled */ |
247 | memcpy(cmd.args, "\xc0\x00\x0d\x0e\x00\x01\x01\x01\x01\x03" , 10); |
248 | cmd.wlen = 10; |
249 | } else { |
250 | memcpy(cmd.args, "\xc0\x00\x0c\x00\x00\x01\x01\x01\x01\x01\x01\x02\x00\x00\x01" , 15); |
251 | cmd.wlen = 15; |
252 | } |
253 | cmd.rlen = 1; |
254 | ret = si2157_cmd_execute(client, cmd: &cmd); |
255 | if (ret && (dev->part_id != SI2141 || ret != -EAGAIN)) |
256 | goto err; |
257 | |
258 | /* Si2141 needs a wake up command */ |
259 | if (dev->part_id == SI2141) { |
260 | memcpy(cmd.args, "\xc0\x08\x01\x02\x00\x00\x01" , 7); |
261 | cmd.wlen = 7; |
262 | ret = si2157_cmd_execute(client, cmd: &cmd); |
263 | if (ret) |
264 | goto err; |
265 | } |
266 | |
267 | /* Try to load the firmware */ |
268 | ret = si2157_find_and_load_firmware(fe); |
269 | if (ret < 0) |
270 | goto err; |
271 | |
272 | /* reboot the tuner with new firmware? */ |
273 | memcpy(cmd.args, "\x01\x01" , 2); |
274 | cmd.wlen = 2; |
275 | cmd.rlen = 1; |
276 | ret = si2157_cmd_execute(client, cmd: &cmd); |
277 | if (ret) |
278 | goto err; |
279 | |
280 | /* query firmware version */ |
281 | memcpy(cmd.args, "\x11" , 1); |
282 | cmd.wlen = 1; |
283 | cmd.rlen = 10; |
284 | ret = si2157_cmd_execute(client, cmd: &cmd); |
285 | if (ret) |
286 | goto err; |
287 | |
288 | dev_info(&client->dev, "firmware version: %c.%c.%d\n" , |
289 | cmd.args[6], cmd.args[7], cmd.args[8]); |
290 | |
291 | /* enable tuner status flags */ |
292 | memcpy(cmd.args, "\x14\x00\x01\x05\x01\x00" , 6); |
293 | cmd.wlen = 6; |
294 | cmd.rlen = 1; |
295 | ret = si2157_cmd_execute(client, cmd: &cmd); |
296 | if (ret) |
297 | goto err; |
298 | |
299 | memcpy(cmd.args, "\x14\x00\x01\x06\x01\x00" , 6); |
300 | cmd.wlen = 6; |
301 | cmd.rlen = 1; |
302 | ret = si2157_cmd_execute(client, cmd: &cmd); |
303 | if (ret) |
304 | goto err; |
305 | |
306 | memcpy(cmd.args, "\x14\x00\x01\x07\x01\x00" , 6); |
307 | cmd.wlen = 6; |
308 | cmd.rlen = 1; |
309 | ret = si2157_cmd_execute(client, cmd: &cmd); |
310 | if (ret) |
311 | goto err; |
312 | warm: |
313 | /* init statistics in order signal app which are supported */ |
314 | c->strength.len = 1; |
315 | c->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE; |
316 | /* start statistics polling */ |
317 | schedule_delayed_work(dwork: &dev->stat_work, delay: msecs_to_jiffies(m: 1000)); |
318 | |
319 | dev->active = true; |
320 | return 0; |
321 | |
322 | err: |
323 | dev_dbg(&client->dev, "failed=%d\n" , ret); |
324 | return ret; |
325 | } |
326 | |
327 | static int si2157_sleep(struct dvb_frontend *fe) |
328 | { |
329 | struct i2c_client *client = fe->tuner_priv; |
330 | struct si2157_dev *dev = i2c_get_clientdata(client); |
331 | int ret; |
332 | struct si2157_cmd cmd; |
333 | |
334 | dev_dbg(&client->dev, "\n" ); |
335 | |
336 | dev->active = false; |
337 | |
338 | /* stop statistics polling */ |
339 | cancel_delayed_work_sync(dwork: &dev->stat_work); |
340 | |
341 | /* standby */ |
342 | memcpy(cmd.args, "\x16\x00" , 2); |
343 | cmd.wlen = 2; |
344 | cmd.rlen = 1; |
345 | ret = si2157_cmd_execute(client, cmd: &cmd); |
346 | if (ret) |
347 | goto err; |
348 | |
349 | return 0; |
350 | err: |
351 | dev_dbg(&client->dev, "failed=%d\n" , ret); |
352 | return ret; |
353 | } |
354 | |
355 | static int si2157_tune_wait(struct i2c_client *client, u8 is_digital) |
356 | { |
357 | #define TUN_TIMEOUT 40 |
358 | #define DIG_TIMEOUT 30 |
359 | #define ANALOG_TIMEOUT 150 |
360 | struct si2157_dev *dev = i2c_get_clientdata(client); |
361 | int ret; |
362 | unsigned long timeout; |
363 | unsigned long start_time; |
364 | u8 wait_status; |
365 | u8 tune_lock_mask; |
366 | |
367 | if (is_digital) |
368 | tune_lock_mask = 0x04; |
369 | else |
370 | tune_lock_mask = 0x02; |
371 | |
372 | mutex_lock(&dev->i2c_mutex); |
373 | |
374 | /* wait tuner command complete */ |
375 | start_time = jiffies; |
376 | timeout = start_time + msecs_to_jiffies(TUN_TIMEOUT); |
377 | while (1) { |
378 | ret = i2c_master_recv(client, buf: &wait_status, |
379 | count: sizeof(wait_status)); |
380 | if (ret < 0) { |
381 | goto err_mutex_unlock; |
382 | } else if (ret != sizeof(wait_status)) { |
383 | ret = -EREMOTEIO; |
384 | goto err_mutex_unlock; |
385 | } |
386 | |
387 | if (time_after(jiffies, timeout)) |
388 | break; |
389 | |
390 | /* tuner done? */ |
391 | if ((wait_status & 0x81) == 0x81) |
392 | break; |
393 | usleep_range(min: 5000, max: 10000); |
394 | } |
395 | |
396 | dev_dbg(&client->dev, "tuning took %d ms, status=0x%x\n" , |
397 | jiffies_to_msecs(jiffies) - jiffies_to_msecs(start_time), |
398 | wait_status); |
399 | |
400 | /* if we tuned ok, wait a bit for tuner lock */ |
401 | if (tuner_lock_debug && (wait_status & 0x81) == 0x81) { |
402 | if (is_digital) |
403 | timeout = jiffies + msecs_to_jiffies(DIG_TIMEOUT); |
404 | else |
405 | timeout = jiffies + msecs_to_jiffies(ANALOG_TIMEOUT); |
406 | |
407 | while (!time_after(jiffies, timeout)) { |
408 | ret = i2c_master_recv(client, buf: &wait_status, |
409 | count: sizeof(wait_status)); |
410 | if (ret < 0) { |
411 | goto err_mutex_unlock; |
412 | } else if (ret != sizeof(wait_status)) { |
413 | ret = -EREMOTEIO; |
414 | goto err_mutex_unlock; |
415 | } |
416 | |
417 | /* tuner locked? */ |
418 | if (wait_status & tune_lock_mask) |
419 | break; |
420 | usleep_range(min: 5000, max: 10000); |
421 | } |
422 | |
423 | dev_dbg(&client->dev, "tuning+lock took %d ms, status=0x%x\n" , |
424 | jiffies_to_msecs(jiffies) - jiffies_to_msecs(start_time), |
425 | wait_status); |
426 | } |
427 | |
428 | if ((wait_status & 0xc0) != 0x80) { |
429 | ret = -ETIMEDOUT; |
430 | goto err_mutex_unlock; |
431 | } |
432 | |
433 | mutex_unlock(lock: &dev->i2c_mutex); |
434 | return 0; |
435 | |
436 | err_mutex_unlock: |
437 | mutex_unlock(lock: &dev->i2c_mutex); |
438 | dev_err(&client->dev, "failed=%d\n" , ret); |
439 | return ret; |
440 | } |
441 | |
442 | static int si2157_set_params(struct dvb_frontend *fe) |
443 | { |
444 | struct i2c_client *client = fe->tuner_priv; |
445 | struct si2157_dev *dev = i2c_get_clientdata(client); |
446 | struct dtv_frontend_properties *c = &fe->dtv_property_cache; |
447 | int ret; |
448 | struct si2157_cmd cmd; |
449 | u8 bw, delivery_system; |
450 | u32 bandwidth; |
451 | u32 if_frequency = 5000000; |
452 | |
453 | dev_dbg(&client->dev, |
454 | "delivery_system=%d frequency=%u bandwidth_hz=%u\n" , |
455 | c->delivery_system, c->frequency, c->bandwidth_hz); |
456 | |
457 | if (!dev->active) { |
458 | ret = -EAGAIN; |
459 | goto err; |
460 | } |
461 | |
462 | if (SUPPORTS_1700KHz(dev) && c->bandwidth_hz <= 1700000) { |
463 | bandwidth = 1700000; |
464 | bw = 9; |
465 | } else if (c->bandwidth_hz <= 6000000) { |
466 | bandwidth = 6000000; |
467 | bw = 6; |
468 | } else if (SUPPORTS_1700KHz(dev) && c->bandwidth_hz <= 6100000) { |
469 | bandwidth = 6100000; |
470 | bw = 10; |
471 | } else if (c->bandwidth_hz <= 7000000) { |
472 | bandwidth = 7000000; |
473 | bw = 7; |
474 | } else { |
475 | bandwidth = 8000000; |
476 | bw = 8; |
477 | } |
478 | |
479 | switch (c->delivery_system) { |
480 | case SYS_ATSC: |
481 | delivery_system = 0x00; |
482 | if_frequency = 3250000; |
483 | break; |
484 | case SYS_DVBC_ANNEX_B: |
485 | delivery_system = 0x10; |
486 | if_frequency = 4000000; |
487 | break; |
488 | case SYS_DVBT: |
489 | case SYS_DVBT2: /* it seems DVB-T and DVB-T2 both are 0x20 here */ |
490 | delivery_system = 0x20; |
491 | break; |
492 | case SYS_DVBC_ANNEX_A: |
493 | case SYS_DVBC_ANNEX_C: |
494 | delivery_system = 0x30; |
495 | break; |
496 | case SYS_ISDBT: |
497 | delivery_system = 0x40; |
498 | break; |
499 | case SYS_DTMB: |
500 | delivery_system = 0x60; |
501 | break; |
502 | default: |
503 | ret = -EINVAL; |
504 | goto err; |
505 | } |
506 | |
507 | memcpy(cmd.args, "\x14\x00\x03\x07\x00\x00" , 6); |
508 | cmd.args[4] = delivery_system | bw; |
509 | if (dev->inversion) |
510 | cmd.args[5] = 0x01; |
511 | cmd.wlen = 6; |
512 | cmd.rlen = 4; |
513 | ret = si2157_cmd_execute(client, cmd: &cmd); |
514 | if (ret) |
515 | goto err; |
516 | |
517 | /* On SI2146, set DTV AGC source to DLIF_AGC_3DB */ |
518 | if (dev->part_id == SI2146) |
519 | memcpy(cmd.args, "\x14\x00\x02\x07\x00\x01" , 6); |
520 | else |
521 | memcpy(cmd.args, "\x14\x00\x02\x07\x00\x00" , 6); |
522 | cmd.args[4] = dev->if_port; |
523 | cmd.wlen = 6; |
524 | cmd.rlen = 4; |
525 | ret = si2157_cmd_execute(client, cmd: &cmd); |
526 | if (ret) |
527 | goto err; |
528 | |
529 | /* set digital if frequency if needed */ |
530 | if (if_frequency != dev->if_frequency) { |
531 | memcpy(cmd.args, "\x14\x00\x06\x07" , 4); |
532 | cmd.args[4] = (if_frequency / 1000) & 0xff; |
533 | cmd.args[5] = ((if_frequency / 1000) >> 8) & 0xff; |
534 | cmd.wlen = 6; |
535 | cmd.rlen = 4; |
536 | ret = si2157_cmd_execute(client, cmd: &cmd); |
537 | if (ret) |
538 | goto err; |
539 | |
540 | dev->if_frequency = if_frequency; |
541 | } |
542 | |
543 | /* set digital frequency */ |
544 | memcpy(cmd.args, "\x41\x00\x00\x00\x00\x00\x00\x00" , 8); |
545 | cmd.args[4] = (c->frequency >> 0) & 0xff; |
546 | cmd.args[5] = (c->frequency >> 8) & 0xff; |
547 | cmd.args[6] = (c->frequency >> 16) & 0xff; |
548 | cmd.args[7] = (c->frequency >> 24) & 0xff; |
549 | cmd.wlen = 8; |
550 | cmd.rlen = 1; |
551 | ret = si2157_cmd_execute(client, cmd: &cmd); |
552 | if (ret) |
553 | goto err; |
554 | |
555 | dev->bandwidth = bandwidth; |
556 | dev->frequency = c->frequency; |
557 | |
558 | si2157_tune_wait(client, is_digital: 1); /* wait to complete, ignore any errors */ |
559 | |
560 | return 0; |
561 | err: |
562 | dev->bandwidth = 0; |
563 | dev->frequency = 0; |
564 | dev->if_frequency = 0; |
565 | dev_dbg(&client->dev, "failed=%d\n" , ret); |
566 | return ret; |
567 | } |
568 | |
569 | static int si2157_set_analog_params(struct dvb_frontend *fe, |
570 | struct analog_parameters *params) |
571 | { |
572 | struct i2c_client *client = fe->tuner_priv; |
573 | struct si2157_dev *dev = i2c_get_clientdata(client); |
574 | char *std; /* for debugging */ |
575 | int ret; |
576 | struct si2157_cmd cmd; |
577 | u32 bandwidth = 0; |
578 | u32 if_frequency = 0; |
579 | u32 freq = 0; |
580 | u64 tmp_lval = 0; |
581 | u8 system = 0; |
582 | u8 color = 0; /* 0=NTSC/PAL, 0x10=SECAM */ |
583 | u8 invert_analog = 1; /* analog tuner spectrum; 0=normal, 1=inverted */ |
584 | |
585 | if (!SUPPORTS_ATV_IF(dev)) { |
586 | dev_info(&client->dev, "Analog tuning not supported yet for Si21%d\n" , |
587 | dev->part_id); |
588 | ret = -EINVAL; |
589 | goto err; |
590 | } |
591 | |
592 | if (!dev->active) |
593 | si2157_init(fe); |
594 | |
595 | if (!dev->active) { |
596 | ret = -EAGAIN; |
597 | goto err; |
598 | } |
599 | if (params->mode == V4L2_TUNER_RADIO) { |
600 | /* |
601 | * std = "fm"; |
602 | * bandwidth = 1700000; //best can do for FM, AGC will be a mess though |
603 | * if_frequency = 1250000; //HVR-225x(saa7164), HVR-12xx(cx23885) |
604 | * if_frequency = 6600000; //HVR-9xx(cx231xx) |
605 | * if_frequency = 5500000; //HVR-19xx(pvrusb2) |
606 | */ |
607 | dev_err(&client->dev, "si2157 does not currently support FM radio\n" ); |
608 | ret = -EINVAL; |
609 | goto err; |
610 | } |
611 | tmp_lval = params->frequency * 625LL; |
612 | do_div(tmp_lval, 10); /* convert to HZ */ |
613 | freq = (u32)tmp_lval; |
614 | |
615 | if (freq < 1000000) /* is freq in KHz */ |
616 | freq = freq * 1000; |
617 | dev->frequency = freq; |
618 | |
619 | /* if_frequency values based on tda187271C2 */ |
620 | if (params->std & (V4L2_STD_B | V4L2_STD_GH)) { |
621 | if (freq >= 470000000) { |
622 | std = "palGH" ; |
623 | bandwidth = 8000000; |
624 | if_frequency = 6000000; |
625 | system = 1; |
626 | if (params->std & |
627 | (V4L2_STD_SECAM_G | V4L2_STD_SECAM_H)) { |
628 | std = "secamGH" ; |
629 | color = 0x10; |
630 | } |
631 | } else { |
632 | std = "palB" ; |
633 | bandwidth = 7000000; |
634 | if_frequency = 6000000; |
635 | system = 0; |
636 | if (params->std & V4L2_STD_SECAM_B) { |
637 | std = "secamB" ; |
638 | color = 0x10; |
639 | } |
640 | } |
641 | } else if (params->std & V4L2_STD_MN) { |
642 | std = "MN" ; |
643 | bandwidth = 6000000; |
644 | if_frequency = 5400000; |
645 | system = 2; |
646 | } else if (params->std & V4L2_STD_PAL_I) { |
647 | std = "palI" ; |
648 | bandwidth = 8000000; |
649 | if_frequency = 7250000; /* TODO: does not work yet */ |
650 | system = 4; |
651 | } else if (params->std & V4L2_STD_DK) { |
652 | std = "palDK" ; |
653 | bandwidth = 8000000; |
654 | if_frequency = 6900000; /* TODO: does not work yet */ |
655 | system = 5; |
656 | if (params->std & V4L2_STD_SECAM_DK) { |
657 | std = "secamDK" ; |
658 | color = 0x10; |
659 | } |
660 | } else if (params->std & V4L2_STD_SECAM_L) { |
661 | std = "secamL" ; |
662 | bandwidth = 8000000; |
663 | if_frequency = 6750000; /* TODO: untested */ |
664 | system = 6; |
665 | color = 0x10; |
666 | } else if (params->std & V4L2_STD_SECAM_LC) { |
667 | std = "secamL'" ; |
668 | bandwidth = 7000000; |
669 | if_frequency = 1250000; /* TODO: untested */ |
670 | system = 7; |
671 | color = 0x10; |
672 | } else { |
673 | std = "unknown" ; |
674 | } |
675 | /* calc channel center freq */ |
676 | freq = freq - 1250000 + (bandwidth / 2); |
677 | |
678 | dev_dbg(&client->dev, |
679 | "mode=%d system=%u std='%s' params->frequency=%u center freq=%u if=%u bandwidth=%u\n" , |
680 | params->mode, system, std, params->frequency, |
681 | freq, if_frequency, bandwidth); |
682 | |
683 | /* set analog IF port */ |
684 | memcpy(cmd.args, "\x14\x00\x03\x06\x08\x02" , 6); |
685 | /* in using dev->if_port, we assume analog and digital IF's */ |
686 | /* are always on different ports */ |
687 | /* assumes if_port definition is 0 or 1 for digital out */ |
688 | cmd.args[4] = (dev->if_port == 1) ? 8 : 10; |
689 | /* Analog AGC assumed external */ |
690 | cmd.args[5] = (dev->if_port == 1) ? 2 : 1; |
691 | cmd.wlen = 6; |
692 | cmd.rlen = 4; |
693 | ret = si2157_cmd_execute(client, cmd: &cmd); |
694 | if (ret) |
695 | goto err; |
696 | |
697 | /* set analog IF output config */ |
698 | memcpy(cmd.args, "\x14\x00\x0d\x06\x94\x64" , 6); |
699 | cmd.wlen = 6; |
700 | cmd.rlen = 4; |
701 | ret = si2157_cmd_execute(client, cmd: &cmd); |
702 | if (ret) |
703 | goto err; |
704 | |
705 | /* make this distinct from a digital IF */ |
706 | dev->if_frequency = if_frequency | 1; |
707 | |
708 | /* calc and set tuner analog if center frequency */ |
709 | if_frequency = if_frequency + 1250000 - (bandwidth / 2); |
710 | dev_dbg(&client->dev, "IF Ctr freq=%d\n" , if_frequency); |
711 | |
712 | memcpy(cmd.args, "\x14\x00\x0C\x06" , 4); |
713 | cmd.args[4] = (if_frequency / 1000) & 0xff; |
714 | cmd.args[5] = ((if_frequency / 1000) >> 8) & 0xff; |
715 | cmd.wlen = 6; |
716 | cmd.rlen = 4; |
717 | ret = si2157_cmd_execute(client, cmd: &cmd); |
718 | if (ret) |
719 | goto err; |
720 | |
721 | /* set analog AGC config */ |
722 | memcpy(cmd.args, "\x14\x00\x07\x06\x32\xc8" , 6); |
723 | cmd.wlen = 6; |
724 | cmd.rlen = 4; |
725 | ret = si2157_cmd_execute(client, cmd: &cmd); |
726 | if (ret) |
727 | goto err; |
728 | |
729 | /* set analog video mode */ |
730 | memcpy(cmd.args, "\x14\x00\x04\x06\x00\x00" , 6); |
731 | cmd.args[4] = system | color; |
732 | /* can use dev->inversion if assumed applies to both digital/analog */ |
733 | if (invert_analog) |
734 | cmd.args[5] |= 0x02; |
735 | cmd.wlen = 6; |
736 | cmd.rlen = 1; |
737 | ret = si2157_cmd_execute(client, cmd: &cmd); |
738 | if (ret) |
739 | goto err; |
740 | |
741 | /* set analog frequency */ |
742 | memcpy(cmd.args, "\x41\x01\x00\x00\x00\x00\x00\x00" , 8); |
743 | cmd.args[4] = (freq >> 0) & 0xff; |
744 | cmd.args[5] = (freq >> 8) & 0xff; |
745 | cmd.args[6] = (freq >> 16) & 0xff; |
746 | cmd.args[7] = (freq >> 24) & 0xff; |
747 | cmd.wlen = 8; |
748 | cmd.rlen = 1; |
749 | ret = si2157_cmd_execute(client, cmd: &cmd); |
750 | if (ret) |
751 | goto err; |
752 | |
753 | dev->bandwidth = bandwidth; |
754 | |
755 | si2157_tune_wait(client, is_digital: 0); /* wait to complete, ignore any errors */ |
756 | |
757 | return 0; |
758 | err: |
759 | dev->bandwidth = 0; |
760 | dev->frequency = 0; |
761 | dev->if_frequency = 0; |
762 | dev_dbg(&client->dev, "failed=%d\n" , ret); |
763 | return ret; |
764 | } |
765 | |
766 | static int si2157_get_frequency(struct dvb_frontend *fe, u32 *frequency) |
767 | { |
768 | struct i2c_client *client = fe->tuner_priv; |
769 | struct si2157_dev *dev = i2c_get_clientdata(client); |
770 | |
771 | *frequency = dev->frequency; |
772 | dev_dbg(&client->dev, "freq=%u\n" , dev->frequency); |
773 | return 0; |
774 | } |
775 | |
776 | static int si2157_get_bandwidth(struct dvb_frontend *fe, u32 *bandwidth) |
777 | { |
778 | struct i2c_client *client = fe->tuner_priv; |
779 | struct si2157_dev *dev = i2c_get_clientdata(client); |
780 | |
781 | *bandwidth = dev->bandwidth; |
782 | dev_dbg(&client->dev, "bandwidth=%u\n" , dev->bandwidth); |
783 | return 0; |
784 | } |
785 | |
786 | static int si2157_get_if_frequency(struct dvb_frontend *fe, u32 *frequency) |
787 | { |
788 | struct i2c_client *client = fe->tuner_priv; |
789 | struct si2157_dev *dev = i2c_get_clientdata(client); |
790 | |
791 | *frequency = dev->if_frequency & ~1; /* strip analog IF indicator bit */ |
792 | dev_dbg(&client->dev, "if_frequency=%u\n" , *frequency); |
793 | return 0; |
794 | } |
795 | |
796 | static int si2157_get_rf_strength(struct dvb_frontend *fe, u16 *) |
797 | { |
798 | struct i2c_client *client = fe->tuner_priv; |
799 | struct dtv_frontend_properties *c = &fe->dtv_property_cache; |
800 | struct si2157_cmd cmd; |
801 | int ret; |
802 | int strength; |
803 | |
804 | dev_dbg(&client->dev, "\n" ); |
805 | |
806 | memcpy(cmd.args, "\x42\x00" , 2); |
807 | cmd.wlen = 2; |
808 | cmd.rlen = 12; |
809 | ret = si2157_cmd_execute(client, cmd: &cmd); |
810 | if (ret) |
811 | goto err; |
812 | |
813 | c->strength.stat[0].scale = FE_SCALE_DECIBEL; |
814 | c->strength.stat[0].svalue = (s8)cmd.args[3] * 1000; |
815 | |
816 | /* normalize values based on Silicon Labs reference |
817 | * add 100, then anything > 80 is 100% signal |
818 | */ |
819 | strength = (s8)cmd.args[3] + 100; |
820 | strength = clamp_val(strength, 0, 80); |
821 | *rssi = (u16)(strength * 0xffff / 80); |
822 | |
823 | dev_dbg(&client->dev, "strength=%d rssi=%u\n" , |
824 | (s8)cmd.args[3], *rssi); |
825 | |
826 | return 0; |
827 | err: |
828 | dev_dbg(&client->dev, "failed=%d\n" , ret); |
829 | return ret; |
830 | } |
831 | |
832 | static const struct dvb_tuner_ops si2157_ops = { |
833 | .info = { |
834 | .name = "Silicon Labs Si2141/Si2146/2147/2148/2157/2158" , |
835 | .frequency_min_hz = 42 * MHz, |
836 | .frequency_max_hz = 870 * MHz, |
837 | }, |
838 | |
839 | .init = si2157_init, |
840 | .sleep = si2157_sleep, |
841 | .set_params = si2157_set_params, |
842 | .set_analog_params = si2157_set_analog_params, |
843 | .get_frequency = si2157_get_frequency, |
844 | .get_bandwidth = si2157_get_bandwidth, |
845 | .get_if_frequency = si2157_get_if_frequency, |
846 | |
847 | .get_rf_strength = si2157_get_rf_strength, |
848 | }; |
849 | |
850 | static void si2157_stat_work(struct work_struct *work) |
851 | { |
852 | struct si2157_dev *dev = container_of(work, struct si2157_dev, stat_work.work); |
853 | struct dvb_frontend *fe = dev->fe; |
854 | struct i2c_client *client = fe->tuner_priv; |
855 | struct dtv_frontend_properties *c = &fe->dtv_property_cache; |
856 | struct si2157_cmd cmd; |
857 | int ret; |
858 | |
859 | dev_dbg(&client->dev, "\n" ); |
860 | |
861 | memcpy(cmd.args, "\x42\x00" , 2); |
862 | cmd.wlen = 2; |
863 | cmd.rlen = 12; |
864 | ret = si2157_cmd_execute(client, cmd: &cmd); |
865 | if (ret) |
866 | goto err; |
867 | |
868 | c->strength.stat[0].scale = FE_SCALE_DECIBEL; |
869 | c->strength.stat[0].svalue = (s8) cmd.args[3] * 1000; |
870 | |
871 | schedule_delayed_work(dwork: &dev->stat_work, delay: msecs_to_jiffies(m: 2000)); |
872 | return; |
873 | err: |
874 | c->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE; |
875 | dev_dbg(&client->dev, "failed=%d\n" , ret); |
876 | } |
877 | |
878 | static int si2157_probe(struct i2c_client *client) |
879 | { |
880 | const struct i2c_device_id *id = i2c_client_get_device_id(client); |
881 | struct si2157_config *cfg = client->dev.platform_data; |
882 | struct dvb_frontend *fe = cfg->fe; |
883 | struct si2157_dev *dev; |
884 | struct si2157_cmd cmd; |
885 | int ret; |
886 | |
887 | dev = kzalloc(size: sizeof(*dev), GFP_KERNEL); |
888 | if (!dev) { |
889 | ret = -ENOMEM; |
890 | dev_err(&client->dev, "kzalloc() failed\n" ); |
891 | goto err; |
892 | } |
893 | |
894 | i2c_set_clientdata(client, data: dev); |
895 | dev->fe = cfg->fe; |
896 | dev->inversion = cfg->inversion; |
897 | dev->dont_load_firmware = cfg->dont_load_firmware; |
898 | dev->if_port = cfg->if_port; |
899 | dev->part_id = (u8)id->driver_data; |
900 | dev->if_frequency = 5000000; /* default value of property 0x0706 */ |
901 | mutex_init(&dev->i2c_mutex); |
902 | INIT_DELAYED_WORK(&dev->stat_work, si2157_stat_work); |
903 | |
904 | /* check if the tuner is there */ |
905 | cmd.wlen = 0; |
906 | cmd.rlen = 1; |
907 | ret = si2157_cmd_execute(client, cmd: &cmd); |
908 | if (ret && ret != -EAGAIN) |
909 | goto err_kfree; |
910 | |
911 | memcpy(&fe->ops.tuner_ops, &si2157_ops, sizeof(struct dvb_tuner_ops)); |
912 | fe->tuner_priv = client; |
913 | |
914 | #ifdef CONFIG_MEDIA_CONTROLLER |
915 | if (cfg->mdev) { |
916 | dev->mdev = cfg->mdev; |
917 | |
918 | dev->ent.name = KBUILD_MODNAME; |
919 | dev->ent.function = MEDIA_ENT_F_TUNER; |
920 | |
921 | dev->pad[SI2157_PAD_RF_INPUT].flags = MEDIA_PAD_FL_SINK; |
922 | dev->pad[SI2157_PAD_RF_INPUT].sig_type = PAD_SIGNAL_ANALOG; |
923 | dev->pad[SI2157_PAD_VID_OUT].flags = MEDIA_PAD_FL_SOURCE; |
924 | dev->pad[SI2157_PAD_VID_OUT].sig_type = PAD_SIGNAL_ANALOG; |
925 | dev->pad[SI2157_PAD_AUD_OUT].flags = MEDIA_PAD_FL_SOURCE; |
926 | dev->pad[SI2157_PAD_AUD_OUT].sig_type = PAD_SIGNAL_AUDIO; |
927 | |
928 | ret = media_entity_pads_init(entity: &dev->ent, num_pads: SI2157_NUM_PADS, |
929 | pads: &dev->pad[0]); |
930 | |
931 | if (ret) |
932 | goto err_kfree; |
933 | |
934 | ret = media_device_register_entity(mdev: cfg->mdev, entity: &dev->ent); |
935 | if (ret) { |
936 | media_entity_cleanup(entity: &dev->ent); |
937 | goto err_kfree; |
938 | } |
939 | } |
940 | #endif |
941 | |
942 | dev_info(&client->dev, "Silicon Labs Si21%d successfully attached\n" , |
943 | dev->part_id); |
944 | |
945 | return 0; |
946 | |
947 | err_kfree: |
948 | kfree(objp: dev); |
949 | err: |
950 | dev_dbg(&client->dev, "failed=%d\n" , ret); |
951 | return ret; |
952 | } |
953 | |
954 | static void si2157_remove(struct i2c_client *client) |
955 | { |
956 | struct si2157_dev *dev = i2c_get_clientdata(client); |
957 | struct dvb_frontend *fe = dev->fe; |
958 | |
959 | dev_dbg(&client->dev, "\n" ); |
960 | |
961 | /* stop statistics polling */ |
962 | cancel_delayed_work_sync(dwork: &dev->stat_work); |
963 | |
964 | #ifdef CONFIG_MEDIA_CONTROLLER_DVB |
965 | if (dev->mdev) |
966 | media_device_unregister_entity(entity: &dev->ent); |
967 | #endif |
968 | |
969 | memset(&fe->ops.tuner_ops, 0, sizeof(struct dvb_tuner_ops)); |
970 | fe->tuner_priv = NULL; |
971 | kfree(objp: dev); |
972 | } |
973 | |
974 | /* |
975 | * The part_id used here will only be used on buggy devices that don't |
976 | * accept firmware uploads. Non-buggy devices should just use "si2157" for |
977 | * all SiLabs TER tuners, as the driver should auto-detect it. |
978 | */ |
979 | static const struct i2c_device_id si2157_id_table[] = { |
980 | {"si2157" , SI2157}, |
981 | {"si2146" , SI2146}, |
982 | {"si2141" , SI2141}, |
983 | {"si2177" , SI2177}, |
984 | {} |
985 | }; |
986 | MODULE_DEVICE_TABLE(i2c, si2157_id_table); |
987 | |
988 | static struct i2c_driver si2157_driver = { |
989 | .driver = { |
990 | .name = "si2157" , |
991 | .suppress_bind_attrs = true, |
992 | }, |
993 | .probe = si2157_probe, |
994 | .remove = si2157_remove, |
995 | .id_table = si2157_id_table, |
996 | }; |
997 | |
998 | module_i2c_driver(si2157_driver); |
999 | |
1000 | MODULE_DESCRIPTION("Silicon Labs Si2141/Si2146/2147/2148/2157/2158 silicon tuner driver" ); |
1001 | MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>" ); |
1002 | MODULE_LICENSE("GPL" ); |
1003 | MODULE_FIRMWARE(SI2158_A20_FIRMWARE); |
1004 | MODULE_FIRMWARE(SI2141_A10_FIRMWARE); |
1005 | MODULE_FIRMWARE(SI2157_A30_FIRMWARE); |
1006 | MODULE_FIRMWARE(SI2141_60_FIRMWARE); |
1007 | MODULE_FIRMWARE(SI2141_61_FIRMWARE); |
1008 | MODULE_FIRMWARE(SI2146_11_FIRMWARE); |
1009 | MODULE_FIRMWARE(SI2147_50_FIRMWARE); |
1010 | MODULE_FIRMWARE(SI2148_32_FIRMWARE); |
1011 | MODULE_FIRMWARE(SI2148_33_FIRMWARE); |
1012 | MODULE_FIRMWARE(SI2157_50_FIRMWARE); |
1013 | MODULE_FIRMWARE(SI2158_50_FIRMWARE); |
1014 | MODULE_FIRMWARE(SI2158_51_FIRMWARE); |
1015 | MODULE_FIRMWARE(SI2177_50_FIRMWARE); |
1016 | |