it913x-fe.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892
  1. /*
  2. * Driver for it913x-fe Frontend
  3. *
  4. * with support for on chip it9137 integral tuner
  5. *
  6. * Copyright (C) 2011 Malcolm Priestley (tvboxspy@gmail.com)
  7. * IT9137 Copyright (C) ITE Tech Inc.
  8. *
  9. * This program is free software; you can redistribute it and/or modify
  10. * it under the terms of the GNU General Public License as published by
  11. * the Free Software Foundation; either version 2 of the License, or
  12. * (at your option) any later version.
  13. *
  14. * This program is distributed in the hope that it will be useful,
  15. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  17. *
  18. * GNU General Public License for more details.
  19. *
  20. * You should have received a copy of the GNU General Public License
  21. * along with this program; if not, write to the Free Software
  22. * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.=
  23. */
  24. #include <linux/module.h>
  25. #include <linux/init.h>
  26. #include <linux/slab.h>
  27. #include <linux/types.h>
  28. #include "dvb_frontend.h"
  29. #include "it913x-fe.h"
  30. #include "it913x-fe-priv.h"
  31. static int it913x_debug;
  32. module_param_named(debug, it913x_debug, int, 0644);
  33. MODULE_PARM_DESC(debug, "set debugging level (1=info (or-able)).");
  34. #define dprintk(level, args...) do { \
  35. if (level & it913x_debug) \
  36. printk(KERN_DEBUG "it913x-fe: " args); \
  37. } while (0)
  38. #define deb_info(args...) dprintk(0x01, args)
  39. #define debug_data_snipet(level, name, p) \
  40. dprintk(level, name" (%02x%02x%02x%02x%02x%02x%02x%02x)", \
  41. *p, *(p+1), *(p+2), *(p+3), *(p+4), \
  42. *(p+5), *(p+6), *(p+7));
  43. struct it913x_fe_state {
  44. struct dvb_frontend frontend;
  45. struct i2c_adapter *i2c_adap;
  46. struct ite_config *config;
  47. u8 i2c_addr;
  48. u32 frequency;
  49. u32 crystalFrequency;
  50. u32 adcFrequency;
  51. u8 tuner_type;
  52. struct adctable *table;
  53. fe_status_t it913x_status;
  54. u16 tun_xtal;
  55. u8 tun_fdiv;
  56. u8 tun_clk_mode;
  57. u32 tun_fn_min;
  58. };
  59. static int it913x_read_reg(struct it913x_fe_state *state,
  60. u32 reg, u8 *data, u8 count)
  61. {
  62. int ret;
  63. u8 pro = PRO_DMOD; /* All reads from demodulator */
  64. u8 b[4];
  65. struct i2c_msg msg[2] = {
  66. { .addr = state->i2c_addr + (pro << 1), .flags = 0,
  67. .buf = b, .len = sizeof(b) },
  68. { .addr = state->i2c_addr + (pro << 1), .flags = I2C_M_RD,
  69. .buf = data, .len = count }
  70. };
  71. b[0] = (u8) reg >> 24;
  72. b[1] = (u8)(reg >> 16) & 0xff;
  73. b[2] = (u8)(reg >> 8) & 0xff;
  74. b[3] = (u8) reg & 0xff;
  75. ret = i2c_transfer(state->i2c_adap, msg, 2);
  76. return ret;
  77. }
  78. static int it913x_read_reg_u8(struct it913x_fe_state *state, u32 reg)
  79. {
  80. int ret;
  81. u8 b[1];
  82. ret = it913x_read_reg(state, reg, &b[0], sizeof(b));
  83. return (ret < 0) ? -ENODEV : b[0];
  84. }
  85. static int it913x_write(struct it913x_fe_state *state,
  86. u8 pro, u32 reg, u8 buf[], u8 count)
  87. {
  88. u8 b[256];
  89. struct i2c_msg msg[1] = {
  90. { .addr = state->i2c_addr + (pro << 1), .flags = 0,
  91. .buf = b, .len = count + 4 }
  92. };
  93. int ret;
  94. b[0] = (u8) reg >> 24;
  95. b[1] = (u8)(reg >> 16) & 0xff;
  96. b[2] = (u8)(reg >> 8) & 0xff;
  97. b[3] = (u8) reg & 0xff;
  98. memcpy(&b[4], buf, count);
  99. ret = i2c_transfer(state->i2c_adap, msg, 1);
  100. if (ret < 0)
  101. return -EIO;
  102. return 0;
  103. }
  104. static int it913x_write_reg(struct it913x_fe_state *state,
  105. u8 pro, u32 reg, u32 data)
  106. {
  107. int ret;
  108. u8 b[4];
  109. u8 s;
  110. b[0] = data >> 24;
  111. b[1] = (data >> 16) & 0xff;
  112. b[2] = (data >> 8) & 0xff;
  113. b[3] = data & 0xff;
  114. /* expand write as needed */
  115. if (data < 0x100)
  116. s = 3;
  117. else if (data < 0x1000)
  118. s = 2;
  119. else if (data < 0x100000)
  120. s = 1;
  121. else
  122. s = 0;
  123. ret = it913x_write(state, pro, reg, &b[s], sizeof(b) - s);
  124. return ret;
  125. }
  126. static int it913x_fe_script_loader(struct it913x_fe_state *state,
  127. struct it913xset *loadscript)
  128. {
  129. int ret, i;
  130. if (loadscript == NULL)
  131. return -EINVAL;
  132. for (i = 0; i < 1000; ++i) {
  133. if (loadscript[i].pro == 0xff)
  134. break;
  135. ret = it913x_write(state, loadscript[i].pro,
  136. loadscript[i].address,
  137. loadscript[i].reg, loadscript[i].count);
  138. if (ret < 0)
  139. return -ENODEV;
  140. }
  141. return 0;
  142. }
  143. static int it913x_init_tuner(struct it913x_fe_state *state)
  144. {
  145. int ret, i, reg;
  146. u8 val, nv_val;
  147. u8 nv[] = {48, 32, 24, 16, 12, 8, 6, 4, 2};
  148. u8 b[2];
  149. reg = it913x_read_reg_u8(state, 0xec86);
  150. switch (reg) {
  151. case 0:
  152. state->tun_clk_mode = reg;
  153. state->tun_xtal = 2000;
  154. state->tun_fdiv = 3;
  155. val = 16;
  156. break;
  157. case -ENODEV:
  158. return -ENODEV;
  159. case 1:
  160. default:
  161. state->tun_clk_mode = reg;
  162. state->tun_xtal = 640;
  163. state->tun_fdiv = 1;
  164. val = 6;
  165. break;
  166. }
  167. reg = it913x_read_reg_u8(state, 0xed03);
  168. if (reg < 0)
  169. return -ENODEV;
  170. else if (reg < sizeof(nv))
  171. nv_val = nv[reg];
  172. else
  173. nv_val = 2;
  174. for (i = 0; i < 50; i++) {
  175. ret = it913x_read_reg(state, 0xed23, &b[0], sizeof(b));
  176. reg = (b[1] << 8) + b[0];
  177. if (reg > 0)
  178. break;
  179. if (ret < 0)
  180. return -ENODEV;
  181. udelay(2000);
  182. }
  183. state->tun_fn_min = state->tun_xtal * reg;
  184. state->tun_fn_min /= (state->tun_fdiv * nv_val);
  185. deb_info("Tuner fn_min %d", state->tun_fn_min);
  186. if (state->config->chip_ver > 1)
  187. msleep(50);
  188. else {
  189. for (i = 0; i < 50; i++) {
  190. reg = it913x_read_reg_u8(state, 0xec82);
  191. if (reg > 0)
  192. break;
  193. if (reg < 0)
  194. return -ENODEV;
  195. udelay(2000);
  196. }
  197. }
  198. return it913x_write_reg(state, PRO_DMOD, 0xed81, val);
  199. }
  200. static int it9137_set_tuner(struct it913x_fe_state *state,
  201. enum fe_bandwidth bandwidth, u32 frequency_m)
  202. {
  203. struct it913xset *set_tuner = set_it9137_template;
  204. int ret, reg;
  205. u32 frequency = frequency_m / 1000;
  206. u32 freq, temp_f, tmp;
  207. u16 iqik_m_cal;
  208. u16 n_div;
  209. u8 n;
  210. u8 l_band;
  211. u8 lna_band;
  212. u8 bw;
  213. deb_info("Tuner Frequency %d Bandwidth %d", frequency, bandwidth);
  214. if (frequency >= 51000 && frequency <= 440000) {
  215. l_band = 0;
  216. lna_band = 0;
  217. } else if (frequency > 440000 && frequency <= 484000) {
  218. l_band = 1;
  219. lna_band = 1;
  220. } else if (frequency > 484000 && frequency <= 533000) {
  221. l_band = 1;
  222. lna_band = 2;
  223. } else if (frequency > 533000 && frequency <= 587000) {
  224. l_band = 1;
  225. lna_band = 3;
  226. } else if (frequency > 587000 && frequency <= 645000) {
  227. l_band = 1;
  228. lna_band = 4;
  229. } else if (frequency > 645000 && frequency <= 710000) {
  230. l_band = 1;
  231. lna_band = 5;
  232. } else if (frequency > 710000 && frequency <= 782000) {
  233. l_band = 1;
  234. lna_band = 6;
  235. } else if (frequency > 782000 && frequency <= 860000) {
  236. l_band = 1;
  237. lna_band = 7;
  238. } else if (frequency > 1450000 && frequency <= 1492000) {
  239. l_band = 1;
  240. lna_band = 0;
  241. } else if (frequency > 1660000 && frequency <= 1685000) {
  242. l_band = 1;
  243. lna_band = 1;
  244. } else
  245. return -EINVAL;
  246. set_tuner[0].reg[0] = lna_band;
  247. if (bandwidth == BANDWIDTH_5_MHZ)
  248. bw = 0;
  249. else if (bandwidth == BANDWIDTH_6_MHZ)
  250. bw = 2;
  251. else if (bandwidth == BANDWIDTH_7_MHZ)
  252. bw = 4;
  253. else if (bandwidth == BANDWIDTH_8_MHZ)
  254. bw = 6;
  255. else
  256. bw = 6;
  257. set_tuner[1].reg[0] = bw;
  258. set_tuner[2].reg[0] = 0xa0 | (l_band << 3);
  259. if (frequency > 53000 && frequency <= 74000) {
  260. n_div = 48;
  261. n = 0;
  262. } else if (frequency > 74000 && frequency <= 111000) {
  263. n_div = 32;
  264. n = 1;
  265. } else if (frequency > 111000 && frequency <= 148000) {
  266. n_div = 24;
  267. n = 2;
  268. } else if (frequency > 148000 && frequency <= 222000) {
  269. n_div = 16;
  270. n = 3;
  271. } else if (frequency > 222000 && frequency <= 296000) {
  272. n_div = 12;
  273. n = 4;
  274. } else if (frequency > 296000 && frequency <= 445000) {
  275. n_div = 8;
  276. n = 5;
  277. } else if (frequency > 445000 && frequency <= state->tun_fn_min) {
  278. n_div = 6;
  279. n = 6;
  280. } else if (frequency > state->tun_fn_min && frequency <= 950000) {
  281. n_div = 4;
  282. n = 7;
  283. } else if (frequency > 1450000 && frequency <= 1680000) {
  284. n_div = 2;
  285. n = 0;
  286. } else
  287. return -EINVAL;
  288. reg = it913x_read_reg_u8(state, 0xed81);
  289. iqik_m_cal = (u16)reg * n_div;
  290. if (reg < 0x20) {
  291. if (state->tun_clk_mode == 0)
  292. iqik_m_cal = (iqik_m_cal * 9) >> 5;
  293. else
  294. iqik_m_cal >>= 1;
  295. } else {
  296. iqik_m_cal = 0x40 - iqik_m_cal;
  297. if (state->tun_clk_mode == 0)
  298. iqik_m_cal = ~((iqik_m_cal * 9) >> 5);
  299. else
  300. iqik_m_cal = ~(iqik_m_cal >> 1);
  301. }
  302. temp_f = frequency * (u32)n_div * (u32)state->tun_fdiv;
  303. freq = temp_f / state->tun_xtal;
  304. tmp = freq * state->tun_xtal;
  305. if ((temp_f - tmp) >= (state->tun_xtal >> 1))
  306. freq++;
  307. freq += (u32) n << 13;
  308. /* Frequency OMEGA_IQIK_M_CAL_MID*/
  309. temp_f = freq + (u32)iqik_m_cal;
  310. set_tuner[3].reg[0] = temp_f & 0xff;
  311. set_tuner[4].reg[0] = (temp_f >> 8) & 0xff;
  312. deb_info("High Frequency = %04x", temp_f);
  313. /* Lower frequency */
  314. set_tuner[5].reg[0] = freq & 0xff;
  315. set_tuner[6].reg[0] = (freq >> 8) & 0xff;
  316. deb_info("low Frequency = %04x", freq);
  317. ret = it913x_fe_script_loader(state, set_tuner);
  318. return (ret < 0) ? -ENODEV : 0;
  319. }
  320. static int it913x_fe_select_bw(struct it913x_fe_state *state,
  321. enum fe_bandwidth bandwidth, u32 adcFrequency)
  322. {
  323. int ret, i;
  324. u8 buffer[256];
  325. u32 coeff[8];
  326. u16 bfsfcw_fftinx_ratio;
  327. u16 fftinx_bfsfcw_ratio;
  328. u8 count;
  329. u8 bw;
  330. u8 adcmultiplier;
  331. deb_info("Bandwidth %d Adc %d", bandwidth, adcFrequency);
  332. if (bandwidth == BANDWIDTH_5_MHZ)
  333. bw = 3;
  334. else if (bandwidth == BANDWIDTH_6_MHZ)
  335. bw = 0;
  336. else if (bandwidth == BANDWIDTH_7_MHZ)
  337. bw = 1;
  338. else if (bandwidth == BANDWIDTH_8_MHZ)
  339. bw = 2;
  340. else
  341. bw = 2;
  342. ret = it913x_write_reg(state, PRO_DMOD, REG_BW, bw);
  343. if (state->table == NULL)
  344. return -EINVAL;
  345. /* In write order */
  346. coeff[0] = state->table[bw].coeff_1_2048;
  347. coeff[1] = state->table[bw].coeff_2_2k;
  348. coeff[2] = state->table[bw].coeff_1_8191;
  349. coeff[3] = state->table[bw].coeff_1_8192;
  350. coeff[4] = state->table[bw].coeff_1_8193;
  351. coeff[5] = state->table[bw].coeff_2_8k;
  352. coeff[6] = state->table[bw].coeff_1_4096;
  353. coeff[7] = state->table[bw].coeff_2_4k;
  354. bfsfcw_fftinx_ratio = state->table[bw].bfsfcw_fftinx_ratio;
  355. fftinx_bfsfcw_ratio = state->table[bw].fftinx_bfsfcw_ratio;
  356. /* ADC multiplier */
  357. ret = it913x_read_reg_u8(state, ADC_X_2);
  358. if (ret < 0)
  359. return -EINVAL;
  360. adcmultiplier = ret;
  361. count = 0;
  362. /* Build Buffer for COEFF Registers */
  363. for (i = 0; i < 8; i++) {
  364. if (adcmultiplier == 1)
  365. coeff[i] /= 2;
  366. buffer[count++] = (coeff[i] >> 24) & 0x3;
  367. buffer[count++] = (coeff[i] >> 16) & 0xff;
  368. buffer[count++] = (coeff[i] >> 8) & 0xff;
  369. buffer[count++] = coeff[i] & 0xff;
  370. }
  371. /* bfsfcw_fftinx_ratio register 0x21-0x22 */
  372. buffer[count++] = bfsfcw_fftinx_ratio & 0xff;
  373. buffer[count++] = (bfsfcw_fftinx_ratio >> 8) & 0xff;
  374. /* fftinx_bfsfcw_ratio register 0x23-0x24 */
  375. buffer[count++] = fftinx_bfsfcw_ratio & 0xff;
  376. buffer[count++] = (fftinx_bfsfcw_ratio >> 8) & 0xff;
  377. /* start at COEFF_1_2048 and write through to fftinx_bfsfcw_ratio*/
  378. ret = it913x_write(state, PRO_DMOD, COEFF_1_2048, buffer, count);
  379. for (i = 0; i < 42; i += 8)
  380. debug_data_snipet(0x1, "Buffer", &buffer[i]);
  381. return ret;
  382. }
  383. static int it913x_fe_read_status(struct dvb_frontend *fe, fe_status_t *status)
  384. {
  385. struct it913x_fe_state *state = fe->demodulator_priv;
  386. int ret, i;
  387. fe_status_t old_status = state->it913x_status;
  388. *status = 0;
  389. if (state->it913x_status == 0) {
  390. ret = it913x_read_reg_u8(state, EMPTY_CHANNEL_STATUS);
  391. if (ret == 0x1) {
  392. *status |= FE_HAS_SIGNAL;
  393. for (i = 0; i < 40; i++) {
  394. ret = it913x_read_reg_u8(state, MP2IF_SYNC_LK);
  395. if (ret == 0x1)
  396. break;
  397. msleep(25);
  398. }
  399. if (ret == 0x1)
  400. *status |= FE_HAS_CARRIER
  401. | FE_HAS_VITERBI
  402. | FE_HAS_SYNC;
  403. state->it913x_status = *status;
  404. }
  405. }
  406. if (state->it913x_status & FE_HAS_SYNC) {
  407. ret = it913x_read_reg_u8(state, TPSD_LOCK);
  408. if (ret == 0x1)
  409. *status |= FE_HAS_LOCK
  410. | state->it913x_status;
  411. else
  412. state->it913x_status = 0;
  413. if (old_status != state->it913x_status)
  414. ret = it913x_write_reg(state, PRO_LINK, GPIOH3_O, ret);
  415. }
  416. return 0;
  417. }
  418. static int it913x_fe_read_signal_strength(struct dvb_frontend *fe,
  419. u16 *strength)
  420. {
  421. struct it913x_fe_state *state = fe->demodulator_priv;
  422. int ret = it913x_read_reg_u8(state, SIGNAL_LEVEL);
  423. /*SIGNAL_LEVEL always returns 100%! so using FE_HAS_SIGNAL as switch*/
  424. if (state->it913x_status & FE_HAS_SIGNAL)
  425. ret = (ret * 0xff) / 0x64;
  426. else
  427. ret = 0x0;
  428. ret |= ret << 0x8;
  429. *strength = ret;
  430. return 0;
  431. }
  432. static int it913x_fe_read_snr(struct dvb_frontend *fe, u16* snr)
  433. {
  434. struct it913x_fe_state *state = fe->demodulator_priv;
  435. int ret = it913x_read_reg_u8(state, SIGNAL_QUALITY);
  436. ret = (ret * 0xff) / 0x64;
  437. ret |= (ret << 0x8);
  438. *snr = ~ret;
  439. return 0;
  440. }
  441. static int it913x_fe_read_ber(struct dvb_frontend *fe, u32 *ber)
  442. {
  443. *ber = 0;
  444. return 0;
  445. }
  446. static int it913x_fe_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks)
  447. {
  448. *ucblocks = 0;
  449. return 0;
  450. }
  451. static int it913x_fe_get_frontend(struct dvb_frontend *fe,
  452. struct dvb_frontend_parameters *p)
  453. {
  454. struct it913x_fe_state *state = fe->demodulator_priv;
  455. int ret;
  456. u8 reg[8];
  457. ret = it913x_read_reg(state, REG_TPSD_TX_MODE, reg, sizeof(reg));
  458. if (reg[3] < 3)
  459. p->u.ofdm.constellation = fe_con[reg[3]];
  460. if (reg[0] < 3)
  461. p->u.ofdm.transmission_mode = fe_mode[reg[0]];
  462. if (reg[1] < 4)
  463. p->u.ofdm.guard_interval = fe_gi[reg[1]];
  464. if (reg[2] < 4)
  465. p->u.ofdm.hierarchy_information = fe_hi[reg[2]];
  466. p->u.ofdm.code_rate_HP = (reg[6] < 6) ? fe_code[reg[6]] : FEC_NONE;
  467. p->u.ofdm.code_rate_LP = (reg[7] < 6) ? fe_code[reg[7]] : FEC_NONE;
  468. return 0;
  469. }
  470. static int it913x_fe_set_frontend(struct dvb_frontend *fe,
  471. struct dvb_frontend_parameters *p)
  472. {
  473. struct it913x_fe_state *state = fe->demodulator_priv;
  474. int ret, i;
  475. u8 empty_ch, last_ch;
  476. state->it913x_status = 0;
  477. /* Set bw*/
  478. ret = it913x_fe_select_bw(state, p->u.ofdm.bandwidth,
  479. state->adcFrequency);
  480. /* Training Mode Off */
  481. ret = it913x_write_reg(state, PRO_LINK, TRAINING_MODE, 0x0);
  482. /* Clear Empty Channel */
  483. ret = it913x_write_reg(state, PRO_DMOD, EMPTY_CHANNEL_STATUS, 0x0);
  484. /* Clear bits */
  485. ret = it913x_write_reg(state, PRO_DMOD, MP2IF_SYNC_LK, 0x0);
  486. /* LED on */
  487. ret = it913x_write_reg(state, PRO_LINK, GPIOH3_O, 0x1);
  488. /* Select Band*/
  489. if ((p->frequency >= 51000000) && (p->frequency <= 230000000))
  490. i = 0;
  491. else if ((p->frequency >= 350000000) && (p->frequency <= 900000000))
  492. i = 1;
  493. else if ((p->frequency >= 1450000000) && (p->frequency <= 1680000000))
  494. i = 2;
  495. else
  496. return -EOPNOTSUPP;
  497. ret = it913x_write_reg(state, PRO_DMOD, FREE_BAND, i);
  498. deb_info("Frontend Set Tuner Type %02x", state->tuner_type);
  499. switch (state->tuner_type) {
  500. case IT9135_38:
  501. case IT9135_51:
  502. case IT9135_52:
  503. case IT9135_60:
  504. case IT9135_61:
  505. case IT9135_62:
  506. ret = it9137_set_tuner(state,
  507. p->u.ofdm.bandwidth, p->frequency);
  508. break;
  509. default:
  510. if (fe->ops.tuner_ops.set_params) {
  511. fe->ops.tuner_ops.set_params(fe, p);
  512. if (fe->ops.i2c_gate_ctrl)
  513. fe->ops.i2c_gate_ctrl(fe, 0);
  514. }
  515. break;
  516. }
  517. /* LED off */
  518. ret = it913x_write_reg(state, PRO_LINK, GPIOH3_O, 0x0);
  519. /* Trigger ofsm */
  520. ret = it913x_write_reg(state, PRO_DMOD, TRIGGER_OFSM, 0x0);
  521. last_ch = 2;
  522. for (i = 0; i < 40; ++i) {
  523. empty_ch = it913x_read_reg_u8(state, EMPTY_CHANNEL_STATUS);
  524. if (last_ch == 1 && empty_ch == 1)
  525. break;
  526. if (last_ch == 2 && empty_ch == 2)
  527. return 0;
  528. last_ch = empty_ch;
  529. msleep(25);
  530. }
  531. for (i = 0; i < 40; ++i) {
  532. if (it913x_read_reg_u8(state, D_TPSD_LOCK) == 1)
  533. break;
  534. msleep(25);
  535. }
  536. state->frequency = p->frequency;
  537. return 0;
  538. }
  539. static int it913x_fe_suspend(struct it913x_fe_state *state)
  540. {
  541. int ret, i;
  542. u8 b;
  543. ret = it913x_write_reg(state, PRO_DMOD, SUSPEND_FLAG, 0x1);
  544. ret |= it913x_write_reg(state, PRO_DMOD, TRIGGER_OFSM, 0x0);
  545. for (i = 0; i < 128; i++) {
  546. ret = it913x_read_reg(state, SUSPEND_FLAG, &b, 1);
  547. if (ret < 0)
  548. return -ENODEV;
  549. if (b == 0)
  550. break;
  551. }
  552. ret |= it913x_write_reg(state, PRO_DMOD, AFE_MEM0, 0x8);
  553. /* Turn LED off */
  554. ret |= it913x_write_reg(state, PRO_LINK, GPIOH3_O, 0x0);
  555. ret |= it913x_fe_script_loader(state, it9137_tuner_off);
  556. return (ret < 0) ? -ENODEV : 0;
  557. }
  558. /* Power sequence */
  559. /* Power Up Tuner on -> Frontend suspend off -> Tuner clk on */
  560. /* Power Down Frontend suspend on -> Tuner clk off -> Tuner off */
  561. static int it913x_fe_sleep(struct dvb_frontend *fe)
  562. {
  563. struct it913x_fe_state *state = fe->demodulator_priv;
  564. return it913x_fe_suspend(state);
  565. }
  566. static u32 compute_div(u32 a, u32 b, u32 x)
  567. {
  568. u32 res = 0;
  569. u32 c = 0;
  570. u32 i = 0;
  571. if (a > b) {
  572. c = a / b;
  573. a = a - c * b;
  574. }
  575. for (i = 0; i < x; i++) {
  576. if (a >= b) {
  577. res += 1;
  578. a -= b;
  579. }
  580. a <<= 1;
  581. res <<= 1;
  582. }
  583. res = (c << x) + res;
  584. return res;
  585. }
  586. static int it913x_fe_start(struct it913x_fe_state *state)
  587. {
  588. struct it913xset *set_lna;
  589. struct it913xset *set_mode;
  590. int ret;
  591. u8 adf = (state->config->adf & 0xf);
  592. u32 adc, xtal;
  593. u8 b[4];
  594. if (state->config->chip_ver == 1)
  595. ret = it913x_init_tuner(state);
  596. if (adf < 10) {
  597. state->crystalFrequency = fe_clockTable[adf].xtal ;
  598. state->table = fe_clockTable[adf].table;
  599. state->adcFrequency = state->table->adcFrequency;
  600. adc = compute_div(state->adcFrequency, 1000000ul, 19ul);
  601. xtal = compute_div(state->crystalFrequency, 1000000ul, 19ul);
  602. } else
  603. return -EINVAL;
  604. deb_info("Xtal Freq :%d Adc Freq :%d Adc %08x Xtal %08x",
  605. state->crystalFrequency, state->adcFrequency, adc, xtal);
  606. /* Set LED indicator on GPIOH3 */
  607. ret = it913x_write_reg(state, PRO_LINK, GPIOH3_EN, 0x1);
  608. ret |= it913x_write_reg(state, PRO_LINK, GPIOH3_ON, 0x1);
  609. ret |= it913x_write_reg(state, PRO_LINK, GPIOH3_O, 0x1);
  610. ret |= it913x_write_reg(state, PRO_LINK, 0xf641, state->tuner_type);
  611. ret |= it913x_write_reg(state, PRO_DMOD, 0xf5ca, 0x01);
  612. ret |= it913x_write_reg(state, PRO_DMOD, 0xf715, 0x01);
  613. b[0] = xtal & 0xff;
  614. b[1] = (xtal >> 8) & 0xff;
  615. b[2] = (xtal >> 16) & 0xff;
  616. b[3] = (xtal >> 24);
  617. ret |= it913x_write(state, PRO_DMOD, XTAL_CLK, b , 4);
  618. b[0] = adc & 0xff;
  619. b[1] = (adc >> 8) & 0xff;
  620. b[2] = (adc >> 16) & 0xff;
  621. ret |= it913x_write(state, PRO_DMOD, ADC_FREQ, b, 3);
  622. if (ret < 0)
  623. return -ENODEV;
  624. /* v1 or v2 tuner script */
  625. if (state->config->chip_ver > 1)
  626. ret = it913x_fe_script_loader(state, it9135_v2);
  627. else
  628. ret = it913x_fe_script_loader(state, it9135_v1);
  629. if (ret < 0)
  630. return ret;
  631. /* LNA Scripts */
  632. switch (state->tuner_type) {
  633. case IT9135_51:
  634. set_lna = it9135_51;
  635. break;
  636. case IT9135_52:
  637. set_lna = it9135_52;
  638. break;
  639. case IT9135_60:
  640. set_lna = it9135_60;
  641. break;
  642. case IT9135_61:
  643. set_lna = it9135_61;
  644. break;
  645. case IT9135_62:
  646. set_lna = it9135_62;
  647. break;
  648. case IT9135_38:
  649. default:
  650. set_lna = it9135_38;
  651. }
  652. ret = it913x_fe_script_loader(state, set_lna);
  653. if (ret < 0)
  654. return ret;
  655. if (state->config->chip_ver == 2) {
  656. ret = it913x_write_reg(state, PRO_DMOD, TRIGGER_OFSM, 0x1);
  657. ret |= it913x_write_reg(state, PRO_LINK, PADODPU, 0x0);
  658. ret |= it913x_write_reg(state, PRO_LINK, AGC_O_D, 0x0);
  659. ret |= it913x_init_tuner(state);
  660. }
  661. if (ret < 0)
  662. return -ENODEV;
  663. /* Always solo frontend */
  664. set_mode = set_solo_fe;
  665. ret |= it913x_fe_script_loader(state, set_mode);
  666. ret |= it913x_fe_suspend(state);
  667. return (ret < 0) ? -ENODEV : 0;
  668. }
  669. static int it913x_fe_init(struct dvb_frontend *fe)
  670. {
  671. struct it913x_fe_state *state = fe->demodulator_priv;
  672. int ret = 0;
  673. /* Power Up Tuner - common all versions */
  674. ret = it913x_write_reg(state, PRO_DMOD, 0xec40, 0x1);
  675. ret |= it913x_write_reg(state, PRO_DMOD, AFE_MEM0, 0x0);
  676. ret |= it913x_fe_script_loader(state, init_1);
  677. ret |= it913x_write_reg(state, PRO_DMOD, 0xfba8, 0x0);
  678. return (ret < 0) ? -ENODEV : 0;
  679. }
  680. static void it913x_fe_release(struct dvb_frontend *fe)
  681. {
  682. struct it913x_fe_state *state = fe->demodulator_priv;
  683. kfree(state);
  684. }
  685. static struct dvb_frontend_ops it913x_fe_ofdm_ops;
  686. struct dvb_frontend *it913x_fe_attach(struct i2c_adapter *i2c_adap,
  687. u8 i2c_addr, struct ite_config *config)
  688. {
  689. struct it913x_fe_state *state = NULL;
  690. int ret;
  691. /* allocate memory for the internal state */
  692. state = kzalloc(sizeof(struct it913x_fe_state), GFP_KERNEL);
  693. if (state == NULL)
  694. return NULL;
  695. if (config == NULL)
  696. goto error;
  697. state->i2c_adap = i2c_adap;
  698. state->i2c_addr = i2c_addr;
  699. state->config = config;
  700. switch (state->config->tuner_id_0) {
  701. case IT9135_51:
  702. case IT9135_52:
  703. case IT9135_60:
  704. case IT9135_61:
  705. case IT9135_62:
  706. state->tuner_type = state->config->tuner_id_0;
  707. break;
  708. default:
  709. case IT9135_38:
  710. state->tuner_type = IT9135_38;
  711. }
  712. ret = it913x_fe_start(state);
  713. if (ret < 0)
  714. goto error;
  715. /* create dvb_frontend */
  716. memcpy(&state->frontend.ops, &it913x_fe_ofdm_ops,
  717. sizeof(struct dvb_frontend_ops));
  718. state->frontend.demodulator_priv = state;
  719. return &state->frontend;
  720. error:
  721. kfree(state);
  722. return NULL;
  723. }
  724. EXPORT_SYMBOL(it913x_fe_attach);
  725. static struct dvb_frontend_ops it913x_fe_ofdm_ops = {
  726. .info = {
  727. .name = "it913x-fe DVB-T",
  728. .type = FE_OFDM,
  729. .frequency_min = 51000000,
  730. .frequency_max = 1680000000,
  731. .frequency_stepsize = 62500,
  732. .caps = FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 |
  733. FE_CAN_FEC_4_5 | FE_CAN_FEC_5_6 | FE_CAN_FEC_6_7 |
  734. FE_CAN_FEC_7_8 | FE_CAN_FEC_8_9 | FE_CAN_FEC_AUTO |
  735. FE_CAN_QAM_16 | FE_CAN_QAM_64 | FE_CAN_QAM_AUTO |
  736. FE_CAN_TRANSMISSION_MODE_AUTO |
  737. FE_CAN_GUARD_INTERVAL_AUTO |
  738. FE_CAN_HIERARCHY_AUTO,
  739. },
  740. .release = it913x_fe_release,
  741. .init = it913x_fe_init,
  742. .sleep = it913x_fe_sleep,
  743. .set_frontend = it913x_fe_set_frontend,
  744. .get_frontend = it913x_fe_get_frontend,
  745. .read_status = it913x_fe_read_status,
  746. .read_signal_strength = it913x_fe_read_signal_strength,
  747. .read_snr = it913x_fe_read_snr,
  748. .read_ber = it913x_fe_read_ber,
  749. .read_ucblocks = it913x_fe_read_ucblocks,
  750. };
  751. MODULE_DESCRIPTION("it913x Frontend and it9137 tuner");
  752. MODULE_AUTHOR("Malcolm Priestley tvboxspy@gmail.com");
  753. MODULE_VERSION("1.09");
  754. MODULE_LICENSE("GPL");