si2157.c 25 KB

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