af9005-fe.c 36 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503
  1. /* Frontend part of the Linux driver for the Afatech 9005
  2. * USB1.1 DVB-T receiver.
  3. *
  4. * Copyright (C) 2007 Luca Olivetti (luca@ventoso.org)
  5. *
  6. * Thanks to Afatech who kindly provided information.
  7. *
  8. * This program is free software; you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License as published by
  10. * the Free Software Foundation; either version 2 of the License, or
  11. * (at your option) any later version.
  12. *
  13. * This program is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  16. * GNU General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU General Public License
  19. * along with this program; if not, write to the Free Software
  20. * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  21. *
  22. * see Documentation/dvb/README.dvb-usb for more information
  23. */
  24. #include "af9005.h"
  25. #include "af9005-script.h"
  26. #include "mt2060.h"
  27. #include "qt1010.h"
  28. #include <asm/div64.h>
  29. struct af9005_fe_state {
  30. struct dvb_usb_device *d;
  31. struct dvb_frontend *tuner;
  32. fe_status_t stat;
  33. /* retraining parameters */
  34. u32 original_fcw;
  35. u16 original_rf_top;
  36. u16 original_if_top;
  37. u16 original_if_min;
  38. u16 original_aci0_if_top;
  39. u16 original_aci1_if_top;
  40. u16 original_aci0_if_min;
  41. u8 original_if_unplug_th;
  42. u8 original_rf_unplug_th;
  43. u8 original_dtop_if_unplug_th;
  44. u8 original_dtop_rf_unplug_th;
  45. /* statistics */
  46. u32 pre_vit_error_count;
  47. u32 pre_vit_bit_count;
  48. u32 ber;
  49. u32 post_vit_error_count;
  50. u32 post_vit_bit_count;
  51. u32 unc;
  52. u16 abort_count;
  53. int opened;
  54. int strong;
  55. unsigned long next_status_check;
  56. struct dvb_frontend frontend;
  57. };
  58. static int af9005_write_word_agc(struct dvb_usb_device *d, u16 reghi,
  59. u16 reglo, u8 pos, u8 len, u16 value)
  60. {
  61. int ret;
  62. u8 temp;
  63. if ((ret = af9005_write_ofdm_register(d, reglo, (u8) (value & 0xff))))
  64. return ret;
  65. temp = (u8) ((value & 0x0300) >> 8);
  66. return af9005_write_register_bits(d, reghi, pos, len,
  67. (u8) ((value & 0x300) >> 8));
  68. }
  69. static int af9005_read_word_agc(struct dvb_usb_device *d, u16 reghi,
  70. u16 reglo, u8 pos, u8 len, u16 * value)
  71. {
  72. int ret;
  73. u8 temp0, temp1;
  74. if ((ret = af9005_read_ofdm_register(d, reglo, &temp0)))
  75. return ret;
  76. if ((ret = af9005_read_ofdm_register(d, reghi, &temp1)))
  77. return ret;
  78. switch (pos) {
  79. case 0:
  80. *value = ((u16) (temp1 & 0x03) << 8) + (u16) temp0;
  81. break;
  82. case 2:
  83. *value = ((u16) (temp1 & 0x0C) << 6) + (u16) temp0;
  84. break;
  85. case 4:
  86. *value = ((u16) (temp1 & 0x30) << 4) + (u16) temp0;
  87. break;
  88. case 6:
  89. *value = ((u16) (temp1 & 0xC0) << 2) + (u16) temp0;
  90. break;
  91. default:
  92. err("invalid pos in read word agc");
  93. return -EINVAL;
  94. }
  95. return 0;
  96. }
  97. static int af9005_is_fecmon_available(struct dvb_frontend *fe, int *available)
  98. {
  99. struct af9005_fe_state *state = fe->demodulator_priv;
  100. int ret;
  101. u8 temp;
  102. *available = false;
  103. ret = af9005_read_register_bits(state->d, xd_p_fec_vtb_rsd_mon_en,
  104. fec_vtb_rsd_mon_en_pos,
  105. fec_vtb_rsd_mon_en_len, &temp);
  106. if (ret)
  107. return ret;
  108. if (temp & 1) {
  109. ret =
  110. af9005_read_register_bits(state->d,
  111. xd_p_reg_ofsm_read_rbc_en,
  112. reg_ofsm_read_rbc_en_pos,
  113. reg_ofsm_read_rbc_en_len, &temp);
  114. if (ret)
  115. return ret;
  116. if ((temp & 1) == 0)
  117. *available = true;
  118. }
  119. return 0;
  120. }
  121. static int af9005_get_post_vit_err_cw_count(struct dvb_frontend *fe,
  122. u32 * post_err_count,
  123. u32 * post_cw_count,
  124. u16 * abort_count)
  125. {
  126. struct af9005_fe_state *state = fe->demodulator_priv;
  127. int ret;
  128. u32 err_count;
  129. u32 cw_count;
  130. u8 temp, temp0, temp1, temp2;
  131. u16 loc_abort_count;
  132. *post_err_count = 0;
  133. *post_cw_count = 0;
  134. /* check if error bit count is ready */
  135. ret =
  136. af9005_read_register_bits(state->d, xd_r_fec_rsd_ber_rdy,
  137. fec_rsd_ber_rdy_pos, fec_rsd_ber_rdy_len,
  138. &temp);
  139. if (ret)
  140. return ret;
  141. if (!temp) {
  142. deb_info("rsd counter not ready\n");
  143. return 100;
  144. }
  145. /* get abort count */
  146. ret =
  147. af9005_read_ofdm_register(state->d,
  148. xd_r_fec_rsd_abort_packet_cnt_7_0,
  149. &temp0);
  150. if (ret)
  151. return ret;
  152. ret =
  153. af9005_read_ofdm_register(state->d,
  154. xd_r_fec_rsd_abort_packet_cnt_15_8,
  155. &temp1);
  156. if (ret)
  157. return ret;
  158. loc_abort_count = ((u16) temp1 << 8) + temp0;
  159. /* get error count */
  160. ret =
  161. af9005_read_ofdm_register(state->d, xd_r_fec_rsd_bit_err_cnt_7_0,
  162. &temp0);
  163. if (ret)
  164. return ret;
  165. ret =
  166. af9005_read_ofdm_register(state->d, xd_r_fec_rsd_bit_err_cnt_15_8,
  167. &temp1);
  168. if (ret)
  169. return ret;
  170. ret =
  171. af9005_read_ofdm_register(state->d, xd_r_fec_rsd_bit_err_cnt_23_16,
  172. &temp2);
  173. if (ret)
  174. return ret;
  175. err_count = ((u32) temp2 << 16) + ((u32) temp1 << 8) + temp0;
  176. *post_err_count = err_count - (u32) loc_abort_count *8 * 8;
  177. /* get RSD packet number */
  178. ret =
  179. af9005_read_ofdm_register(state->d, xd_p_fec_rsd_packet_unit_7_0,
  180. &temp0);
  181. if (ret)
  182. return ret;
  183. ret =
  184. af9005_read_ofdm_register(state->d, xd_p_fec_rsd_packet_unit_15_8,
  185. &temp1);
  186. if (ret)
  187. return ret;
  188. cw_count = ((u32) temp1 << 8) + temp0;
  189. if (cw_count == 0) {
  190. err("wrong RSD packet count");
  191. return -EIO;
  192. }
  193. deb_info("POST abort count %d err count %d rsd packets %d\n",
  194. loc_abort_count, err_count, cw_count);
  195. *post_cw_count = cw_count - (u32) loc_abort_count;
  196. *abort_count = loc_abort_count;
  197. return 0;
  198. }
  199. static int af9005_get_post_vit_ber(struct dvb_frontend *fe,
  200. u32 * post_err_count, u32 * post_cw_count,
  201. u16 * abort_count)
  202. {
  203. u32 loc_cw_count = 0, loc_err_count;
  204. u16 loc_abort_count;
  205. int ret;
  206. ret =
  207. af9005_get_post_vit_err_cw_count(fe, &loc_err_count, &loc_cw_count,
  208. &loc_abort_count);
  209. if (ret)
  210. return ret;
  211. *post_err_count = loc_err_count;
  212. *post_cw_count = loc_cw_count * 204 * 8;
  213. *abort_count = loc_abort_count;
  214. return 0;
  215. }
  216. static int af9005_get_pre_vit_err_bit_count(struct dvb_frontend *fe,
  217. u32 * pre_err_count,
  218. u32 * pre_bit_count)
  219. {
  220. struct af9005_fe_state *state = fe->demodulator_priv;
  221. u8 temp, temp0, temp1, temp2;
  222. u32 super_frame_count, x, bits;
  223. int ret;
  224. ret =
  225. af9005_read_register_bits(state->d, xd_r_fec_vtb_ber_rdy,
  226. fec_vtb_ber_rdy_pos, fec_vtb_ber_rdy_len,
  227. &temp);
  228. if (ret)
  229. return ret;
  230. if (!temp) {
  231. deb_info("viterbi counter not ready\n");
  232. return 101; /* ERR_APO_VTB_COUNTER_NOT_READY; */
  233. }
  234. ret =
  235. af9005_read_ofdm_register(state->d, xd_r_fec_vtb_err_bit_cnt_7_0,
  236. &temp0);
  237. if (ret)
  238. return ret;
  239. ret =
  240. af9005_read_ofdm_register(state->d, xd_r_fec_vtb_err_bit_cnt_15_8,
  241. &temp1);
  242. if (ret)
  243. return ret;
  244. ret =
  245. af9005_read_ofdm_register(state->d, xd_r_fec_vtb_err_bit_cnt_23_16,
  246. &temp2);
  247. if (ret)
  248. return ret;
  249. *pre_err_count = ((u32) temp2 << 16) + ((u32) temp1 << 8) + temp0;
  250. ret =
  251. af9005_read_ofdm_register(state->d, xd_p_fec_super_frm_unit_7_0,
  252. &temp0);
  253. if (ret)
  254. return ret;
  255. ret =
  256. af9005_read_ofdm_register(state->d, xd_p_fec_super_frm_unit_15_8,
  257. &temp1);
  258. if (ret)
  259. return ret;
  260. super_frame_count = ((u32) temp1 << 8) + temp0;
  261. if (super_frame_count == 0) {
  262. deb_info("super frame count 0\n");
  263. return 102;
  264. }
  265. /* read fft mode */
  266. ret =
  267. af9005_read_register_bits(state->d, xd_g_reg_tpsd_txmod,
  268. reg_tpsd_txmod_pos, reg_tpsd_txmod_len,
  269. &temp);
  270. if (ret)
  271. return ret;
  272. if (temp == 0) {
  273. /* 2K */
  274. x = 1512;
  275. } else if (temp == 1) {
  276. /* 8k */
  277. x = 6048;
  278. } else {
  279. err("Invalid fft mode");
  280. return -EINVAL;
  281. }
  282. /* read constellation mode */
  283. ret =
  284. af9005_read_register_bits(state->d, xd_g_reg_tpsd_const,
  285. reg_tpsd_const_pos, reg_tpsd_const_len,
  286. &temp);
  287. if (ret)
  288. return ret;
  289. switch (temp) {
  290. case 0: /* QPSK */
  291. bits = 2;
  292. break;
  293. case 1: /* QAM_16 */
  294. bits = 4;
  295. break;
  296. case 2: /* QAM_64 */
  297. bits = 6;
  298. break;
  299. default:
  300. err("invalid constellation mode");
  301. return -EINVAL;
  302. }
  303. *pre_bit_count = super_frame_count * 68 * 4 * x * bits;
  304. deb_info("PRE err count %d frame count %d bit count %d\n",
  305. *pre_err_count, super_frame_count, *pre_bit_count);
  306. return 0;
  307. }
  308. static int af9005_reset_pre_viterbi(struct dvb_frontend *fe)
  309. {
  310. struct af9005_fe_state *state = fe->demodulator_priv;
  311. int ret;
  312. /* set super frame count to 1 */
  313. ret =
  314. af9005_write_ofdm_register(state->d, xd_p_fec_super_frm_unit_7_0,
  315. 1 & 0xff);
  316. if (ret)
  317. return ret;
  318. af9005_write_ofdm_register(state->d, xd_p_fec_super_frm_unit_15_8,
  319. 1 >> 8);
  320. if (ret)
  321. return ret;
  322. /* reset pre viterbi error count */
  323. ret =
  324. af9005_write_register_bits(state->d, xd_p_fec_vtb_ber_rst,
  325. fec_vtb_ber_rst_pos, fec_vtb_ber_rst_len,
  326. 1);
  327. return ret;
  328. }
  329. static int af9005_reset_post_viterbi(struct dvb_frontend *fe)
  330. {
  331. struct af9005_fe_state *state = fe->demodulator_priv;
  332. int ret;
  333. /* set packet unit */
  334. ret =
  335. af9005_write_ofdm_register(state->d, xd_p_fec_rsd_packet_unit_7_0,
  336. 10000 & 0xff);
  337. if (ret)
  338. return ret;
  339. ret =
  340. af9005_write_ofdm_register(state->d, xd_p_fec_rsd_packet_unit_15_8,
  341. 10000 >> 8);
  342. if (ret)
  343. return ret;
  344. /* reset post viterbi error count */
  345. ret =
  346. af9005_write_register_bits(state->d, xd_p_fec_rsd_ber_rst,
  347. fec_rsd_ber_rst_pos, fec_rsd_ber_rst_len,
  348. 1);
  349. return ret;
  350. }
  351. static int af9005_get_statistic(struct dvb_frontend *fe)
  352. {
  353. struct af9005_fe_state *state = fe->demodulator_priv;
  354. int ret, fecavailable;
  355. u64 numerator, denominator;
  356. deb_info("GET STATISTIC\n");
  357. ret = af9005_is_fecmon_available(fe, &fecavailable);
  358. if (ret)
  359. return ret;
  360. if (!fecavailable) {
  361. deb_info("fecmon not available\n");
  362. return 0;
  363. }
  364. ret = af9005_get_pre_vit_err_bit_count(fe, &state->pre_vit_error_count,
  365. &state->pre_vit_bit_count);
  366. if (ret == 0) {
  367. af9005_reset_pre_viterbi(fe);
  368. if (state->pre_vit_bit_count > 0) {
  369. /* according to v 0.0.4 of the dvb api ber should be a multiple
  370. of 10E-9 so we have to multiply the error count by
  371. 10E9=1000000000 */
  372. numerator =
  373. (u64) state->pre_vit_error_count * (u64) 1000000000;
  374. denominator = (u64) state->pre_vit_bit_count;
  375. state->ber = do_div(numerator, denominator);
  376. } else {
  377. state->ber = 0xffffffff;
  378. }
  379. }
  380. ret = af9005_get_post_vit_ber(fe, &state->post_vit_error_count,
  381. &state->post_vit_bit_count,
  382. &state->abort_count);
  383. if (ret == 0) {
  384. ret = af9005_reset_post_viterbi(fe);
  385. state->unc += state->abort_count;
  386. if (ret)
  387. return ret;
  388. }
  389. return 0;
  390. }
  391. static int af9005_fe_refresh_state(struct dvb_frontend *fe)
  392. {
  393. struct af9005_fe_state *state = fe->demodulator_priv;
  394. if (time_after(jiffies, state->next_status_check)) {
  395. deb_info("REFRESH STATE\n");
  396. /* statistics */
  397. if (af9005_get_statistic(fe))
  398. err("get_statistic_failed");
  399. state->next_status_check = jiffies + 250 * HZ / 1000;
  400. }
  401. return 0;
  402. }
  403. static int af9005_fe_read_status(struct dvb_frontend *fe, fe_status_t * stat)
  404. {
  405. struct af9005_fe_state *state = fe->demodulator_priv;
  406. u8 temp;
  407. int ret;
  408. if (state->tuner == NULL)
  409. return -ENODEV;
  410. *stat = 0;
  411. ret = af9005_read_register_bits(state->d, xd_p_agc_lock,
  412. agc_lock_pos, agc_lock_len, &temp);
  413. if (ret)
  414. return ret;
  415. if (temp)
  416. *stat |= FE_HAS_SIGNAL;
  417. ret = af9005_read_register_bits(state->d, xd_p_fd_tpsd_lock,
  418. fd_tpsd_lock_pos, fd_tpsd_lock_len,
  419. &temp);
  420. if (ret)
  421. return ret;
  422. if (temp)
  423. *stat |= FE_HAS_CARRIER;
  424. ret = af9005_read_register_bits(state->d,
  425. xd_r_mp2if_sync_byte_locked,
  426. mp2if_sync_byte_locked_pos,
  427. mp2if_sync_byte_locked_pos, &temp);
  428. if (ret)
  429. return ret;
  430. if (temp)
  431. *stat |= FE_HAS_SYNC | FE_HAS_VITERBI | FE_HAS_LOCK;
  432. if (state->opened)
  433. af9005_led_control(state->d, *stat & FE_HAS_LOCK);
  434. ret =
  435. af9005_read_register_bits(state->d, xd_p_reg_strong_sginal_detected,
  436. reg_strong_sginal_detected_pos,
  437. reg_strong_sginal_detected_len, &temp);
  438. if (ret)
  439. return ret;
  440. if (temp != state->strong) {
  441. deb_info("adjust for strong signal %d\n", temp);
  442. state->strong = temp;
  443. }
  444. return 0;
  445. }
  446. static int af9005_fe_read_ber(struct dvb_frontend *fe, u32 * ber)
  447. {
  448. struct af9005_fe_state *state = fe->demodulator_priv;
  449. if (state->tuner == NULL)
  450. return -ENODEV;
  451. af9005_fe_refresh_state(fe);
  452. *ber = state->ber;
  453. return 0;
  454. }
  455. static int af9005_fe_read_unc_blocks(struct dvb_frontend *fe, u32 * unc)
  456. {
  457. struct af9005_fe_state *state = fe->demodulator_priv;
  458. if (state->tuner == NULL)
  459. return -ENODEV;
  460. af9005_fe_refresh_state(fe);
  461. *unc = state->unc;
  462. return 0;
  463. }
  464. static int af9005_fe_read_signal_strength(struct dvb_frontend *fe,
  465. u16 * strength)
  466. {
  467. struct af9005_fe_state *state = fe->demodulator_priv;
  468. int ret;
  469. u8 if_gain, rf_gain;
  470. if (state->tuner == NULL)
  471. return -ENODEV;
  472. ret =
  473. af9005_read_ofdm_register(state->d, xd_r_reg_aagc_rf_gain,
  474. &rf_gain);
  475. if (ret)
  476. return ret;
  477. ret =
  478. af9005_read_ofdm_register(state->d, xd_r_reg_aagc_if_gain,
  479. &if_gain);
  480. if (ret)
  481. return ret;
  482. /* this value has no real meaning, but i don't have the tables that relate
  483. the rf and if gain with the dbm, so I just scale the value */
  484. *strength = (512 - rf_gain - if_gain) << 7;
  485. return 0;
  486. }
  487. static int af9005_fe_read_snr(struct dvb_frontend *fe, u16 * snr)
  488. {
  489. /* the snr can be derived from the ber and the constellation
  490. but I don't think this kind of complex calculations belong
  491. in the driver. I may be wrong.... */
  492. return -ENOSYS;
  493. }
  494. static int af9005_fe_program_cfoe(struct dvb_usb_device *d, fe_bandwidth_t bw)
  495. {
  496. u8 temp0, temp1, temp2, temp3, buf[4];
  497. int ret;
  498. u32 NS_coeff1_2048Nu;
  499. u32 NS_coeff1_8191Nu;
  500. u32 NS_coeff1_8192Nu;
  501. u32 NS_coeff1_8193Nu;
  502. u32 NS_coeff2_2k;
  503. u32 NS_coeff2_8k;
  504. switch (bw) {
  505. case BANDWIDTH_6_MHZ:
  506. NS_coeff1_2048Nu = 0x2ADB6DC;
  507. NS_coeff1_8191Nu = 0xAB7313;
  508. NS_coeff1_8192Nu = 0xAB6DB7;
  509. NS_coeff1_8193Nu = 0xAB685C;
  510. NS_coeff2_2k = 0x156DB6E;
  511. NS_coeff2_8k = 0x55B6DC;
  512. break;
  513. case BANDWIDTH_7_MHZ:
  514. NS_coeff1_2048Nu = 0x3200001;
  515. NS_coeff1_8191Nu = 0xC80640;
  516. NS_coeff1_8192Nu = 0xC80000;
  517. NS_coeff1_8193Nu = 0xC7F9C0;
  518. NS_coeff2_2k = 0x1900000;
  519. NS_coeff2_8k = 0x640000;
  520. break;
  521. case BANDWIDTH_8_MHZ:
  522. NS_coeff1_2048Nu = 0x3924926;
  523. NS_coeff1_8191Nu = 0xE4996E;
  524. NS_coeff1_8192Nu = 0xE49249;
  525. NS_coeff1_8193Nu = 0xE48B25;
  526. NS_coeff2_2k = 0x1C92493;
  527. NS_coeff2_8k = 0x724925;
  528. break;
  529. default:
  530. err("Invalid bandwith %d.", bw);
  531. return -EINVAL;
  532. }
  533. /*
  534. * write NS_coeff1_2048Nu
  535. */
  536. temp0 = (u8) (NS_coeff1_2048Nu & 0x000000FF);
  537. temp1 = (u8) ((NS_coeff1_2048Nu & 0x0000FF00) >> 8);
  538. temp2 = (u8) ((NS_coeff1_2048Nu & 0x00FF0000) >> 16);
  539. temp3 = (u8) ((NS_coeff1_2048Nu & 0x03000000) >> 24);
  540. /* big endian to make 8051 happy */
  541. buf[0] = temp3;
  542. buf[1] = temp2;
  543. buf[2] = temp1;
  544. buf[3] = temp0;
  545. /* cfoe_NS_2k_coeff1_25_24 */
  546. ret = af9005_write_ofdm_register(d, 0xAE00, buf[0]);
  547. if (ret)
  548. return ret;
  549. /* cfoe_NS_2k_coeff1_23_16 */
  550. ret = af9005_write_ofdm_register(d, 0xAE01, buf[1]);
  551. if (ret)
  552. return ret;
  553. /* cfoe_NS_2k_coeff1_15_8 */
  554. ret = af9005_write_ofdm_register(d, 0xAE02, buf[2]);
  555. if (ret)
  556. return ret;
  557. /* cfoe_NS_2k_coeff1_7_0 */
  558. ret = af9005_write_ofdm_register(d, 0xAE03, buf[3]);
  559. if (ret)
  560. return ret;
  561. /*
  562. * write NS_coeff2_2k
  563. */
  564. temp0 = (u8) ((NS_coeff2_2k & 0x0000003F));
  565. temp1 = (u8) ((NS_coeff2_2k & 0x00003FC0) >> 6);
  566. temp2 = (u8) ((NS_coeff2_2k & 0x003FC000) >> 14);
  567. temp3 = (u8) ((NS_coeff2_2k & 0x01C00000) >> 22);
  568. /* big endian to make 8051 happy */
  569. buf[0] = temp3;
  570. buf[1] = temp2;
  571. buf[2] = temp1;
  572. buf[3] = temp0;
  573. ret = af9005_write_ofdm_register(d, 0xAE04, buf[0]);
  574. if (ret)
  575. return ret;
  576. ret = af9005_write_ofdm_register(d, 0xAE05, buf[1]);
  577. if (ret)
  578. return ret;
  579. ret = af9005_write_ofdm_register(d, 0xAE06, buf[2]);
  580. if (ret)
  581. return ret;
  582. ret = af9005_write_ofdm_register(d, 0xAE07, buf[3]);
  583. if (ret)
  584. return ret;
  585. /*
  586. * write NS_coeff1_8191Nu
  587. */
  588. temp0 = (u8) ((NS_coeff1_8191Nu & 0x000000FF));
  589. temp1 = (u8) ((NS_coeff1_8191Nu & 0x0000FF00) >> 8);
  590. temp2 = (u8) ((NS_coeff1_8191Nu & 0x00FFC000) >> 16);
  591. temp3 = (u8) ((NS_coeff1_8191Nu & 0x03000000) >> 24);
  592. /* big endian to make 8051 happy */
  593. buf[0] = temp3;
  594. buf[1] = temp2;
  595. buf[2] = temp1;
  596. buf[3] = temp0;
  597. ret = af9005_write_ofdm_register(d, 0xAE08, buf[0]);
  598. if (ret)
  599. return ret;
  600. ret = af9005_write_ofdm_register(d, 0xAE09, buf[1]);
  601. if (ret)
  602. return ret;
  603. ret = af9005_write_ofdm_register(d, 0xAE0A, buf[2]);
  604. if (ret)
  605. return ret;
  606. ret = af9005_write_ofdm_register(d, 0xAE0B, buf[3]);
  607. if (ret)
  608. return ret;
  609. /*
  610. * write NS_coeff1_8192Nu
  611. */
  612. temp0 = (u8) (NS_coeff1_8192Nu & 0x000000FF);
  613. temp1 = (u8) ((NS_coeff1_8192Nu & 0x0000FF00) >> 8);
  614. temp2 = (u8) ((NS_coeff1_8192Nu & 0x00FFC000) >> 16);
  615. temp3 = (u8) ((NS_coeff1_8192Nu & 0x03000000) >> 24);
  616. /* big endian to make 8051 happy */
  617. buf[0] = temp3;
  618. buf[1] = temp2;
  619. buf[2] = temp1;
  620. buf[3] = temp0;
  621. ret = af9005_write_ofdm_register(d, 0xAE0C, buf[0]);
  622. if (ret)
  623. return ret;
  624. ret = af9005_write_ofdm_register(d, 0xAE0D, buf[1]);
  625. if (ret)
  626. return ret;
  627. ret = af9005_write_ofdm_register(d, 0xAE0E, buf[2]);
  628. if (ret)
  629. return ret;
  630. ret = af9005_write_ofdm_register(d, 0xAE0F, buf[3]);
  631. if (ret)
  632. return ret;
  633. /*
  634. * write NS_coeff1_8193Nu
  635. */
  636. temp0 = (u8) ((NS_coeff1_8193Nu & 0x000000FF));
  637. temp1 = (u8) ((NS_coeff1_8193Nu & 0x0000FF00) >> 8);
  638. temp2 = (u8) ((NS_coeff1_8193Nu & 0x00FFC000) >> 16);
  639. temp3 = (u8) ((NS_coeff1_8193Nu & 0x03000000) >> 24);
  640. /* big endian to make 8051 happy */
  641. buf[0] = temp3;
  642. buf[1] = temp2;
  643. buf[2] = temp1;
  644. buf[3] = temp0;
  645. ret = af9005_write_ofdm_register(d, 0xAE10, buf[0]);
  646. if (ret)
  647. return ret;
  648. ret = af9005_write_ofdm_register(d, 0xAE11, buf[1]);
  649. if (ret)
  650. return ret;
  651. ret = af9005_write_ofdm_register(d, 0xAE12, buf[2]);
  652. if (ret)
  653. return ret;
  654. ret = af9005_write_ofdm_register(d, 0xAE13, buf[3]);
  655. if (ret)
  656. return ret;
  657. /*
  658. * write NS_coeff2_8k
  659. */
  660. temp0 = (u8) ((NS_coeff2_8k & 0x0000003F));
  661. temp1 = (u8) ((NS_coeff2_8k & 0x00003FC0) >> 6);
  662. temp2 = (u8) ((NS_coeff2_8k & 0x003FC000) >> 14);
  663. temp3 = (u8) ((NS_coeff2_8k & 0x01C00000) >> 22);
  664. /* big endian to make 8051 happy */
  665. buf[0] = temp3;
  666. buf[1] = temp2;
  667. buf[2] = temp1;
  668. buf[3] = temp0;
  669. ret = af9005_write_ofdm_register(d, 0xAE14, buf[0]);
  670. if (ret)
  671. return ret;
  672. ret = af9005_write_ofdm_register(d, 0xAE15, buf[1]);
  673. if (ret)
  674. return ret;
  675. ret = af9005_write_ofdm_register(d, 0xAE16, buf[2]);
  676. if (ret)
  677. return ret;
  678. ret = af9005_write_ofdm_register(d, 0xAE17, buf[3]);
  679. return ret;
  680. }
  681. static int af9005_fe_select_bw(struct dvb_usb_device *d, fe_bandwidth_t bw)
  682. {
  683. u8 temp;
  684. switch (bw) {
  685. case BANDWIDTH_6_MHZ:
  686. temp = 0;
  687. break;
  688. case BANDWIDTH_7_MHZ:
  689. temp = 1;
  690. break;
  691. case BANDWIDTH_8_MHZ:
  692. temp = 2;
  693. break;
  694. default:
  695. err("Invalid bandwith %d.", bw);
  696. return -EINVAL;
  697. }
  698. return af9005_write_register_bits(d, xd_g_reg_bw, reg_bw_pos,
  699. reg_bw_len, temp);
  700. }
  701. static int af9005_fe_power(struct dvb_frontend *fe, int on)
  702. {
  703. struct af9005_fe_state *state = fe->demodulator_priv;
  704. u8 temp = on;
  705. int ret;
  706. deb_info("power %s tuner\n", on ? "on" : "off");
  707. ret = af9005_send_command(state->d, 0x03, &temp, 1, NULL, 0);
  708. return ret;
  709. }
  710. static struct mt2060_config af9005_mt2060_config = {
  711. 0xC0
  712. };
  713. static struct qt1010_config af9005_qt1010_config = {
  714. 0xC4
  715. };
  716. static int af9005_fe_init(struct dvb_frontend *fe)
  717. {
  718. struct af9005_fe_state *state = fe->demodulator_priv;
  719. struct dvb_usb_adapter *adap = fe->dvb->priv;
  720. int ret, i, scriptlen;
  721. u8 temp, temp0 = 0, temp1 = 0, temp2 = 0;
  722. u8 buf[2];
  723. u16 if1;
  724. deb_info("in af9005_fe_init\n");
  725. /* reset */
  726. deb_info("reset\n");
  727. if ((ret =
  728. af9005_write_register_bits(state->d, xd_I2C_reg_ofdm_rst_en,
  729. 4, 1, 0x01)))
  730. return ret;
  731. if ((ret = af9005_write_ofdm_register(state->d, APO_REG_RESET, 0)))
  732. return ret;
  733. /* clear ofdm reset */
  734. deb_info("clear ofdm reset\n");
  735. for (i = 0; i < 150; i++) {
  736. if ((ret =
  737. af9005_read_ofdm_register(state->d,
  738. xd_I2C_reg_ofdm_rst, &temp)))
  739. return ret;
  740. if (temp & (regmask[reg_ofdm_rst_len - 1] << reg_ofdm_rst_pos))
  741. break;
  742. msleep(10);
  743. }
  744. if (i == 150)
  745. return -ETIMEDOUT;
  746. /*FIXME in the dump
  747. write B200 A9
  748. write xd_g_reg_ofsm_clk 7
  749. read eepr c6 (2)
  750. read eepr c7 (2)
  751. misc ctrl 3 -> 1
  752. read eepr ca (6)
  753. write xd_g_reg_ofsm_clk 0
  754. write B200 a1
  755. */
  756. ret = af9005_write_ofdm_register(state->d, 0xb200, 0xa9);
  757. if (ret)
  758. return ret;
  759. ret = af9005_write_ofdm_register(state->d, xd_g_reg_ofsm_clk, 0x07);
  760. if (ret)
  761. return ret;
  762. temp = 0x01;
  763. ret = af9005_send_command(state->d, 0x03, &temp, 1, NULL, 0);
  764. if (ret)
  765. return ret;
  766. ret = af9005_write_ofdm_register(state->d, xd_g_reg_ofsm_clk, 0x00);
  767. if (ret)
  768. return ret;
  769. ret = af9005_write_ofdm_register(state->d, 0xb200, 0xa1);
  770. if (ret)
  771. return ret;
  772. temp = regmask[reg_ofdm_rst_len - 1] << reg_ofdm_rst_pos;
  773. if ((ret =
  774. af9005_write_register_bits(state->d, xd_I2C_reg_ofdm_rst,
  775. reg_ofdm_rst_pos, reg_ofdm_rst_len, 1)))
  776. return ret;
  777. if ((ret =
  778. af9005_write_register_bits(state->d, xd_I2C_reg_ofdm_rst,
  779. reg_ofdm_rst_pos, reg_ofdm_rst_len, 0)))
  780. return ret;
  781. if (ret)
  782. return ret;
  783. /* don't know what register aefc is, but this is what the windows driver does */
  784. ret = af9005_write_ofdm_register(state->d, 0xaefc, 0);
  785. if (ret)
  786. return ret;
  787. /* set stand alone chip */
  788. deb_info("set stand alone chip\n");
  789. if ((ret =
  790. af9005_write_register_bits(state->d, xd_p_reg_dca_stand_alone,
  791. reg_dca_stand_alone_pos,
  792. reg_dca_stand_alone_len, 1)))
  793. return ret;
  794. /* set dca upper & lower chip */
  795. deb_info("set dca upper & lower chip\n");
  796. if ((ret =
  797. af9005_write_register_bits(state->d, xd_p_reg_dca_upper_chip,
  798. reg_dca_upper_chip_pos,
  799. reg_dca_upper_chip_len, 0)))
  800. return ret;
  801. if ((ret =
  802. af9005_write_register_bits(state->d, xd_p_reg_dca_lower_chip,
  803. reg_dca_lower_chip_pos,
  804. reg_dca_lower_chip_len, 0)))
  805. return ret;
  806. /* set 2wire master clock to 0x14 (for 60KHz) */
  807. deb_info("set 2wire master clock to 0x14 (for 60KHz)\n");
  808. if ((ret =
  809. af9005_write_ofdm_register(state->d, xd_I2C_i2c_m_period, 0x14)))
  810. return ret;
  811. /* clear dca enable chip */
  812. deb_info("clear dca enable chip\n");
  813. if ((ret =
  814. af9005_write_register_bits(state->d, xd_p_reg_dca_en,
  815. reg_dca_en_pos, reg_dca_en_len, 0)))
  816. return ret;
  817. /* FIXME these are register bits, but I don't know which ones */
  818. ret = af9005_write_ofdm_register(state->d, 0xa16c, 1);
  819. if (ret)
  820. return ret;
  821. ret = af9005_write_ofdm_register(state->d, 0xa3c1, 0);
  822. if (ret)
  823. return ret;
  824. /* init other parameters: program cfoe and select bandwith */
  825. deb_info("program cfoe\n");
  826. if ((ret = af9005_fe_program_cfoe(state->d, BANDWIDTH_6_MHZ)))
  827. return ret;
  828. /* set read-update bit for constellation */
  829. deb_info("set read-update bit for constellation\n");
  830. if ((ret =
  831. af9005_write_register_bits(state->d, xd_p_reg_feq_read_update,
  832. reg_feq_read_update_pos,
  833. reg_feq_read_update_len, 1)))
  834. return ret;
  835. /* sample code has a set MPEG TS code here
  836. but sniffing reveals that it doesn't do it */
  837. /* set read-update bit to 1 for DCA constellation */
  838. deb_info("set read-update bit 1 for DCA constellation\n");
  839. if ((ret =
  840. af9005_write_register_bits(state->d, xd_p_reg_dca_read_update,
  841. reg_dca_read_update_pos,
  842. reg_dca_read_update_len, 1)))
  843. return ret;
  844. /* enable fec monitor */
  845. deb_info("enable fec monitor\n");
  846. if ((ret =
  847. af9005_write_register_bits(state->d, xd_p_fec_vtb_rsd_mon_en,
  848. fec_vtb_rsd_mon_en_pos,
  849. fec_vtb_rsd_mon_en_len, 1)))
  850. return ret;
  851. /* FIXME should be register bits, I don't know which ones */
  852. ret = af9005_write_ofdm_register(state->d, 0xa601, 0);
  853. /* set api_retrain_never_freeze */
  854. deb_info("set api_retrain_never_freeze\n");
  855. if ((ret = af9005_write_ofdm_register(state->d, 0xaefb, 0x01)))
  856. return ret;
  857. /* load init script */
  858. deb_info("load init script\n");
  859. scriptlen = sizeof(script) / sizeof(RegDesc);
  860. for (i = 0; i < scriptlen; i++) {
  861. if ((ret =
  862. af9005_write_register_bits(state->d, script[i].reg,
  863. script[i].pos,
  864. script[i].len, script[i].val)))
  865. return ret;
  866. /* save 3 bytes of original fcw */
  867. if (script[i].reg == 0xae18)
  868. temp2 = script[i].val;
  869. if (script[i].reg == 0xae19)
  870. temp1 = script[i].val;
  871. if (script[i].reg == 0xae1a)
  872. temp0 = script[i].val;
  873. /* save original unplug threshold */
  874. if (script[i].reg == xd_p_reg_unplug_th)
  875. state->original_if_unplug_th = script[i].val;
  876. if (script[i].reg == xd_p_reg_unplug_rf_gain_th)
  877. state->original_rf_unplug_th = script[i].val;
  878. if (script[i].reg == xd_p_reg_unplug_dtop_if_gain_th)
  879. state->original_dtop_if_unplug_th = script[i].val;
  880. if (script[i].reg == xd_p_reg_unplug_dtop_rf_gain_th)
  881. state->original_dtop_rf_unplug_th = script[i].val;
  882. }
  883. state->original_fcw =
  884. ((u32) temp2 << 16) + ((u32) temp1 << 8) + (u32) temp0;
  885. /* save original TOPs */
  886. deb_info("save original TOPs\n");
  887. /* RF TOP */
  888. ret =
  889. af9005_read_word_agc(state->d,
  890. xd_p_reg_aagc_rf_top_numerator_9_8,
  891. xd_p_reg_aagc_rf_top_numerator_7_0, 0, 2,
  892. &state->original_rf_top);
  893. if (ret)
  894. return ret;
  895. /* IF TOP */
  896. ret =
  897. af9005_read_word_agc(state->d,
  898. xd_p_reg_aagc_if_top_numerator_9_8,
  899. xd_p_reg_aagc_if_top_numerator_7_0, 0, 2,
  900. &state->original_if_top);
  901. if (ret)
  902. return ret;
  903. /* ACI 0 IF TOP */
  904. ret =
  905. af9005_read_word_agc(state->d, 0xA60E, 0xA60A, 4, 2,
  906. &state->original_aci0_if_top);
  907. if (ret)
  908. return ret;
  909. /* ACI 1 IF TOP */
  910. ret =
  911. af9005_read_word_agc(state->d, 0xA60E, 0xA60B, 6, 2,
  912. &state->original_aci1_if_top);
  913. if (ret)
  914. return ret;
  915. /* attach tuner and init */
  916. if (state->tuner == NULL) {
  917. /* read tuner and board id from eeprom */
  918. ret = af9005_read_eeprom(adap->dev, 0xc6, buf, 2);
  919. if (ret) {
  920. err("Impossible to read EEPROM\n");
  921. return ret;
  922. }
  923. deb_info("Tuner id %d, board id %d\n", buf[0], buf[1]);
  924. switch (buf[0]) {
  925. case 2: /* MT2060 */
  926. /* read if1 from eeprom */
  927. ret = af9005_read_eeprom(adap->dev, 0xc8, buf, 2);
  928. if (ret) {
  929. err("Impossible to read EEPROM\n");
  930. return ret;
  931. }
  932. if1 = (u16) (buf[0] << 8) + buf[1];
  933. state->tuner =
  934. dvb_attach(mt2060_attach, fe, &adap->dev->i2c_adap,
  935. &af9005_mt2060_config, if1);
  936. if (state->tuner == NULL) {
  937. deb_info("MT2060 attach failed\n");
  938. return -ENODEV;
  939. }
  940. break;
  941. case 3: /* QT1010 */
  942. case 9: /* QT1010B */
  943. state->tuner =
  944. dvb_attach(qt1010_attach, fe, &adap->dev->i2c_adap,
  945. &af9005_qt1010_config);
  946. if (state->tuner == NULL) {
  947. deb_info("QT1010 attach failed\n");
  948. return -ENODEV;
  949. }
  950. break;
  951. default:
  952. err("Unsupported tuner type %d", buf[0]);
  953. return -ENODEV;
  954. }
  955. ret = state->tuner->ops.tuner_ops.init(state->tuner);
  956. if (ret)
  957. return ret;
  958. }
  959. deb_info("profit!\n");
  960. return 0;
  961. }
  962. static int af9005_fe_sleep(struct dvb_frontend *fe)
  963. {
  964. return af9005_fe_power(fe, 0);
  965. }
  966. static int af9005_ts_bus_ctrl(struct dvb_frontend *fe, int acquire)
  967. {
  968. struct af9005_fe_state *state = fe->demodulator_priv;
  969. if (acquire) {
  970. state->opened++;
  971. } else {
  972. state->opened--;
  973. if (!state->opened)
  974. af9005_led_control(state->d, 0);
  975. }
  976. return 0;
  977. }
  978. static int af9005_fe_set_frontend(struct dvb_frontend *fe,
  979. struct dvb_frontend_parameters *fep)
  980. {
  981. struct af9005_fe_state *state = fe->demodulator_priv;
  982. int ret;
  983. u8 temp, temp0, temp1, temp2;
  984. deb_info("af9005_fe_set_frontend freq %d bw %d\n", fep->frequency,
  985. fep->u.ofdm.bandwidth);
  986. if (state->tuner == NULL) {
  987. err("Tuner not attached");
  988. return -ENODEV;
  989. }
  990. deb_info("turn off led\n");
  991. /* not in the log */
  992. ret = af9005_led_control(state->d, 0);
  993. if (ret)
  994. return ret;
  995. /* not sure about the bits */
  996. ret = af9005_write_register_bits(state->d, XD_MP2IF_MISC, 2, 1, 0);
  997. if (ret)
  998. return ret;
  999. /* set FCW to default value */
  1000. deb_info("set FCW to default value\n");
  1001. temp0 = (u8) (state->original_fcw & 0x000000ff);
  1002. temp1 = (u8) ((state->original_fcw & 0x0000ff00) >> 8);
  1003. temp2 = (u8) ((state->original_fcw & 0x00ff0000) >> 16);
  1004. ret = af9005_write_ofdm_register(state->d, 0xae1a, temp0);
  1005. if (ret)
  1006. return ret;
  1007. ret = af9005_write_ofdm_register(state->d, 0xae19, temp1);
  1008. if (ret)
  1009. return ret;
  1010. ret = af9005_write_ofdm_register(state->d, 0xae18, temp2);
  1011. if (ret)
  1012. return ret;
  1013. /* restore original TOPs */
  1014. deb_info("restore original TOPs\n");
  1015. ret =
  1016. af9005_write_word_agc(state->d,
  1017. xd_p_reg_aagc_rf_top_numerator_9_8,
  1018. xd_p_reg_aagc_rf_top_numerator_7_0, 0, 2,
  1019. state->original_rf_top);
  1020. if (ret)
  1021. return ret;
  1022. ret =
  1023. af9005_write_word_agc(state->d,
  1024. xd_p_reg_aagc_if_top_numerator_9_8,
  1025. xd_p_reg_aagc_if_top_numerator_7_0, 0, 2,
  1026. state->original_if_top);
  1027. if (ret)
  1028. return ret;
  1029. ret =
  1030. af9005_write_word_agc(state->d, 0xA60E, 0xA60A, 4, 2,
  1031. state->original_aci0_if_top);
  1032. if (ret)
  1033. return ret;
  1034. ret =
  1035. af9005_write_word_agc(state->d, 0xA60E, 0xA60B, 6, 2,
  1036. state->original_aci1_if_top);
  1037. if (ret)
  1038. return ret;
  1039. /* select bandwith */
  1040. deb_info("select bandwidth");
  1041. ret = af9005_fe_select_bw(state->d, fep->u.ofdm.bandwidth);
  1042. if (ret)
  1043. return ret;
  1044. ret = af9005_fe_program_cfoe(state->d, fep->u.ofdm.bandwidth);
  1045. if (ret)
  1046. return ret;
  1047. /* clear easy mode flag */
  1048. deb_info("clear easy mode flag\n");
  1049. ret = af9005_write_ofdm_register(state->d, 0xaefd, 0);
  1050. if (ret)
  1051. return ret;
  1052. /* set unplug threshold to original value */
  1053. deb_info("set unplug threshold to original value\n");
  1054. ret =
  1055. af9005_write_ofdm_register(state->d, xd_p_reg_unplug_th,
  1056. state->original_if_unplug_th);
  1057. if (ret)
  1058. return ret;
  1059. /* set tuner */
  1060. deb_info("set tuner\n");
  1061. ret = state->tuner->ops.tuner_ops.set_params(state->tuner, fep);
  1062. if (ret)
  1063. return ret;
  1064. /* trigger ofsm */
  1065. deb_info("trigger ofsm\n");
  1066. temp = 0;
  1067. ret = af9005_write_tuner_registers(state->d, 0xffff, &temp, 1);
  1068. if (ret)
  1069. return ret;
  1070. /* clear retrain and freeze flag */
  1071. deb_info("clear retrain and freeze flag\n");
  1072. ret =
  1073. af9005_write_register_bits(state->d,
  1074. xd_p_reg_api_retrain_request,
  1075. reg_api_retrain_request_pos, 2, 0);
  1076. if (ret)
  1077. return ret;
  1078. /* reset pre viterbi and post viterbi registers and statistics */
  1079. af9005_reset_pre_viterbi(fe);
  1080. af9005_reset_post_viterbi(fe);
  1081. state->pre_vit_error_count = 0;
  1082. state->pre_vit_bit_count = 0;
  1083. state->ber = 0;
  1084. state->post_vit_error_count = 0;
  1085. /* state->unc = 0; commented out since it should be ever increasing */
  1086. state->abort_count = 0;
  1087. state->next_status_check = jiffies;
  1088. state->strong = -1;
  1089. return 0;
  1090. }
  1091. static int af9005_fe_get_frontend(struct dvb_frontend *fe,
  1092. struct dvb_frontend_parameters *fep)
  1093. {
  1094. struct af9005_fe_state *state = fe->demodulator_priv;
  1095. int ret;
  1096. u8 temp;
  1097. /* mode */
  1098. ret =
  1099. af9005_read_register_bits(state->d, xd_g_reg_tpsd_const,
  1100. reg_tpsd_const_pos, reg_tpsd_const_len,
  1101. &temp);
  1102. if (ret)
  1103. return ret;
  1104. deb_info("===== fe_get_frontend ==============\n");
  1105. deb_info("CONSTELLATION ");
  1106. switch (temp) {
  1107. case 0:
  1108. fep->u.ofdm.constellation = QPSK;
  1109. deb_info("QPSK\n");
  1110. break;
  1111. case 1:
  1112. fep->u.ofdm.constellation = QAM_16;
  1113. deb_info("QAM_16\n");
  1114. break;
  1115. case 2:
  1116. fep->u.ofdm.constellation = QAM_64;
  1117. deb_info("QAM_64\n");
  1118. break;
  1119. }
  1120. /* tps hierarchy and alpha value */
  1121. ret =
  1122. af9005_read_register_bits(state->d, xd_g_reg_tpsd_hier,
  1123. reg_tpsd_hier_pos, reg_tpsd_hier_len,
  1124. &temp);
  1125. if (ret)
  1126. return ret;
  1127. deb_info("HIERARCHY ");
  1128. switch (temp) {
  1129. case 0:
  1130. fep->u.ofdm.hierarchy_information = HIERARCHY_NONE;
  1131. deb_info("NONE\n");
  1132. break;
  1133. case 1:
  1134. fep->u.ofdm.hierarchy_information = HIERARCHY_1;
  1135. deb_info("1\n");
  1136. break;
  1137. case 2:
  1138. fep->u.ofdm.hierarchy_information = HIERARCHY_2;
  1139. deb_info("2\n");
  1140. break;
  1141. case 3:
  1142. fep->u.ofdm.hierarchy_information = HIERARCHY_4;
  1143. deb_info("4\n");
  1144. break;
  1145. }
  1146. /* high/low priority */
  1147. ret =
  1148. af9005_read_register_bits(state->d, xd_g_reg_dec_pri,
  1149. reg_dec_pri_pos, reg_dec_pri_len, &temp);
  1150. if (ret)
  1151. return ret;
  1152. /* if temp is set = high priority */
  1153. deb_info("PRIORITY %s\n", temp ? "high" : "low");
  1154. /* high coderate */
  1155. ret =
  1156. af9005_read_register_bits(state->d, xd_g_reg_tpsd_hpcr,
  1157. reg_tpsd_hpcr_pos, reg_tpsd_hpcr_len,
  1158. &temp);
  1159. if (ret)
  1160. return ret;
  1161. deb_info("CODERATE HP ");
  1162. switch (temp) {
  1163. case 0:
  1164. fep->u.ofdm.code_rate_HP = FEC_1_2;
  1165. deb_info("FEC_1_2\n");
  1166. break;
  1167. case 1:
  1168. fep->u.ofdm.code_rate_HP = FEC_2_3;
  1169. deb_info("FEC_2_3\n");
  1170. break;
  1171. case 2:
  1172. fep->u.ofdm.code_rate_HP = FEC_3_4;
  1173. deb_info("FEC_3_4\n");
  1174. break;
  1175. case 3:
  1176. fep->u.ofdm.code_rate_HP = FEC_5_6;
  1177. deb_info("FEC_5_6\n");
  1178. break;
  1179. case 4:
  1180. fep->u.ofdm.code_rate_HP = FEC_7_8;
  1181. deb_info("FEC_7_8\n");
  1182. break;
  1183. }
  1184. /* low coderate */
  1185. ret =
  1186. af9005_read_register_bits(state->d, xd_g_reg_tpsd_lpcr,
  1187. reg_tpsd_lpcr_pos, reg_tpsd_lpcr_len,
  1188. &temp);
  1189. if (ret)
  1190. return ret;
  1191. deb_info("CODERATE LP ");
  1192. switch (temp) {
  1193. case 0:
  1194. fep->u.ofdm.code_rate_LP = FEC_1_2;
  1195. deb_info("FEC_1_2\n");
  1196. break;
  1197. case 1:
  1198. fep->u.ofdm.code_rate_LP = FEC_2_3;
  1199. deb_info("FEC_2_3\n");
  1200. break;
  1201. case 2:
  1202. fep->u.ofdm.code_rate_LP = FEC_3_4;
  1203. deb_info("FEC_3_4\n");
  1204. break;
  1205. case 3:
  1206. fep->u.ofdm.code_rate_LP = FEC_5_6;
  1207. deb_info("FEC_5_6\n");
  1208. break;
  1209. case 4:
  1210. fep->u.ofdm.code_rate_LP = FEC_7_8;
  1211. deb_info("FEC_7_8\n");
  1212. break;
  1213. }
  1214. /* guard interval */
  1215. ret =
  1216. af9005_read_register_bits(state->d, xd_g_reg_tpsd_gi,
  1217. reg_tpsd_gi_pos, reg_tpsd_gi_len, &temp);
  1218. if (ret)
  1219. return ret;
  1220. deb_info("GUARD INTERVAL ");
  1221. switch (temp) {
  1222. case 0:
  1223. fep->u.ofdm.guard_interval = GUARD_INTERVAL_1_32;
  1224. deb_info("1_32\n");
  1225. break;
  1226. case 1:
  1227. fep->u.ofdm.guard_interval = GUARD_INTERVAL_1_16;
  1228. deb_info("1_16\n");
  1229. break;
  1230. case 2:
  1231. fep->u.ofdm.guard_interval = GUARD_INTERVAL_1_8;
  1232. deb_info("1_8\n");
  1233. break;
  1234. case 3:
  1235. fep->u.ofdm.guard_interval = GUARD_INTERVAL_1_4;
  1236. deb_info("1_4\n");
  1237. break;
  1238. }
  1239. /* fft */
  1240. ret =
  1241. af9005_read_register_bits(state->d, xd_g_reg_tpsd_txmod,
  1242. reg_tpsd_txmod_pos, reg_tpsd_txmod_len,
  1243. &temp);
  1244. if (ret)
  1245. return ret;
  1246. deb_info("TRANSMISSION MODE ");
  1247. switch (temp) {
  1248. case 0:
  1249. fep->u.ofdm.transmission_mode = TRANSMISSION_MODE_2K;
  1250. deb_info("2K\n");
  1251. break;
  1252. case 1:
  1253. fep->u.ofdm.transmission_mode = TRANSMISSION_MODE_8K;
  1254. deb_info("8K\n");
  1255. break;
  1256. }
  1257. /* bandwidth */
  1258. ret =
  1259. af9005_read_register_bits(state->d, xd_g_reg_bw, reg_bw_pos,
  1260. reg_bw_len, &temp);
  1261. deb_info("BANDWIDTH ");
  1262. switch (temp) {
  1263. case 0:
  1264. fep->u.ofdm.bandwidth = BANDWIDTH_6_MHZ;
  1265. deb_info("6\n");
  1266. break;
  1267. case 1:
  1268. fep->u.ofdm.bandwidth = BANDWIDTH_7_MHZ;
  1269. deb_info("7\n");
  1270. break;
  1271. case 2:
  1272. fep->u.ofdm.bandwidth = BANDWIDTH_8_MHZ;
  1273. deb_info("8\n");
  1274. break;
  1275. }
  1276. return 0;
  1277. }
  1278. static void af9005_fe_release(struct dvb_frontend *fe)
  1279. {
  1280. struct af9005_fe_state *state =
  1281. (struct af9005_fe_state *)fe->demodulator_priv;
  1282. if (state->tuner != NULL && state->tuner->ops.tuner_ops.release != NULL) {
  1283. state->tuner->ops.tuner_ops.release(state->tuner);
  1284. #ifdef CONFIG_DVB_CORE_ATTACH
  1285. symbol_put_addr(state->tuner->ops.tuner_ops.release);
  1286. #endif
  1287. }
  1288. kfree(state);
  1289. }
  1290. static struct dvb_frontend_ops af9005_fe_ops;
  1291. struct dvb_frontend *af9005_fe_attach(struct dvb_usb_device *d)
  1292. {
  1293. struct af9005_fe_state *state = NULL;
  1294. /* allocate memory for the internal state */
  1295. state = kzalloc(sizeof(struct af9005_fe_state), GFP_KERNEL);
  1296. if (state == NULL)
  1297. goto error;
  1298. deb_info("attaching frontend af9005\n");
  1299. state->d = d;
  1300. state->tuner = NULL;
  1301. state->opened = 0;
  1302. memcpy(&state->frontend.ops, &af9005_fe_ops,
  1303. sizeof(struct dvb_frontend_ops));
  1304. state->frontend.demodulator_priv = state;
  1305. return &state->frontend;
  1306. error:
  1307. return NULL;
  1308. }
  1309. static struct dvb_frontend_ops af9005_fe_ops = {
  1310. .info = {
  1311. .name = "AF9005 USB DVB-T",
  1312. .type = FE_OFDM,
  1313. .frequency_min = 44250000,
  1314. .frequency_max = 867250000,
  1315. .frequency_stepsize = 250000,
  1316. .caps = FE_CAN_INVERSION_AUTO |
  1317. FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 |
  1318. FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO |
  1319. FE_CAN_QPSK | FE_CAN_QAM_16 | FE_CAN_QAM_64 |
  1320. FE_CAN_QAM_AUTO | FE_CAN_TRANSMISSION_MODE_AUTO |
  1321. FE_CAN_GUARD_INTERVAL_AUTO | FE_CAN_RECOVER |
  1322. FE_CAN_HIERARCHY_AUTO,
  1323. },
  1324. .release = af9005_fe_release,
  1325. .init = af9005_fe_init,
  1326. .sleep = af9005_fe_sleep,
  1327. .ts_bus_ctrl = af9005_ts_bus_ctrl,
  1328. .set_frontend = af9005_fe_set_frontend,
  1329. .get_frontend = af9005_fe_get_frontend,
  1330. .read_status = af9005_fe_read_status,
  1331. .read_ber = af9005_fe_read_ber,
  1332. .read_signal_strength = af9005_fe_read_signal_strength,
  1333. .read_snr = af9005_fe_read_snr,
  1334. .read_ucblocks = af9005_fe_read_unc_blocks,
  1335. };