s5h1420.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800
  1. /*
  2. Driver for Samsung S5H1420 QPSK Demodulator
  3. Copyright (C) 2005 Andrew de Quincey <adq_dvb@lidskialf.net>
  4. This program is free software; you can redistribute it and/or modify
  5. it under the terms of the GNU General Public License as published by
  6. the Free Software Foundation; either version 2 of the License, or
  7. (at your option) any later version.
  8. This program is distributed in the hope that it will be useful,
  9. but WITHOUT ANY WARRANTY; without even the implied warranty of
  10. MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  11. GNU General Public License for more details.
  12. You should have received a copy of the GNU General Public License
  13. along with this program; if not, write to the Free Software
  14. Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  15. */
  16. #include <linux/kernel.h>
  17. #include <linux/module.h>
  18. #include <linux/init.h>
  19. #include <linux/string.h>
  20. #include <linux/slab.h>
  21. #include <linux/delay.h>
  22. #include "dvb_frontend.h"
  23. #include "s5h1420.h"
  24. #define TONE_FREQ 22000
  25. struct s5h1420_state {
  26. struct i2c_adapter* i2c;
  27. struct dvb_frontend_ops ops;
  28. const struct s5h1420_config* config;
  29. struct dvb_frontend frontend;
  30. u8 postlocked:1;
  31. u32 fclk;
  32. u32 tunedfreq;
  33. fe_code_rate_t fec_inner;
  34. u32 symbol_rate;
  35. };
  36. static u32 s5h1420_getsymbolrate(struct s5h1420_state* state);
  37. static int s5h1420_get_tune_settings(struct dvb_frontend* fe, struct dvb_frontend_tune_settings* fesettings);
  38. static int debug = 0;
  39. #define dprintk if (debug) printk
  40. static int s5h1420_writereg (struct s5h1420_state* state, u8 reg, u8 data)
  41. {
  42. u8 buf [] = { reg, data };
  43. struct i2c_msg msg = { .addr = state->config->demod_address, .flags = 0, .buf = buf, .len = 2 };
  44. int err;
  45. if ((err = i2c_transfer (state->i2c, &msg, 1)) != 1) {
  46. dprintk ("%s: writereg error (err == %i, reg == 0x%02x, data == 0x%02x)\n", __FUNCTION__, err, reg, data);
  47. return -EREMOTEIO;
  48. }
  49. return 0;
  50. }
  51. static u8 s5h1420_readreg (struct s5h1420_state* state, u8 reg)
  52. {
  53. int ret;
  54. u8 b0 [] = { reg };
  55. u8 b1 [] = { 0 };
  56. struct i2c_msg msg1 = { .addr = state->config->demod_address, .flags = 0, .buf = b0, .len = 1 };
  57. struct i2c_msg msg2 = { .addr = state->config->demod_address, .flags = I2C_M_RD, .buf = b1, .len = 1 };
  58. if ((ret = i2c_transfer (state->i2c, &msg1, 1)) != 1)
  59. return ret;
  60. if ((ret = i2c_transfer (state->i2c, &msg2, 1)) != 1)
  61. return ret;
  62. return b1[0];
  63. }
  64. static int s5h1420_set_voltage (struct dvb_frontend* fe, fe_sec_voltage_t voltage)
  65. {
  66. struct s5h1420_state* state = fe->demodulator_priv;
  67. switch(voltage) {
  68. case SEC_VOLTAGE_13:
  69. s5h1420_writereg(state, 0x3c, (s5h1420_readreg(state, 0x3c) & 0xfe) | 0x02);
  70. break;
  71. case SEC_VOLTAGE_18:
  72. s5h1420_writereg(state, 0x3c, s5h1420_readreg(state, 0x3c) | 0x03);
  73. break;
  74. case SEC_VOLTAGE_OFF:
  75. s5h1420_writereg(state, 0x3c, s5h1420_readreg(state, 0x3c) & 0xfd);
  76. break;
  77. }
  78. return 0;
  79. }
  80. static int s5h1420_set_tone (struct dvb_frontend* fe, fe_sec_tone_mode_t tone)
  81. {
  82. struct s5h1420_state* state = fe->demodulator_priv;
  83. switch(tone) {
  84. case SEC_TONE_ON:
  85. s5h1420_writereg(state, 0x3b, (s5h1420_readreg(state, 0x3b) & 0x74) | 0x08);
  86. break;
  87. case SEC_TONE_OFF:
  88. s5h1420_writereg(state, 0x3b, (s5h1420_readreg(state, 0x3b) & 0x74) | 0x01);
  89. break;
  90. }
  91. return 0;
  92. }
  93. static int s5h1420_send_master_cmd (struct dvb_frontend* fe, struct dvb_diseqc_master_cmd* cmd)
  94. {
  95. struct s5h1420_state* state = fe->demodulator_priv;
  96. u8 val;
  97. int i;
  98. unsigned long timeout;
  99. int result = 0;
  100. /* setup for DISEQC */
  101. val = s5h1420_readreg(state, 0x3b);
  102. s5h1420_writereg(state, 0x3b, 0x02);
  103. msleep(15);
  104. /* write the DISEQC command bytes */
  105. for(i=0; i< cmd->msg_len; i++) {
  106. s5h1420_writereg(state, 0x3c + i, cmd->msg[i]);
  107. }
  108. /* kick off transmission */
  109. s5h1420_writereg(state, 0x3b, s5h1420_readreg(state, 0x3b) | ((cmd->msg_len-1) << 4) | 0x08);
  110. /* wait for transmission to complete */
  111. timeout = jiffies + ((100*HZ) / 1000);
  112. while(time_before(jiffies, timeout)) {
  113. if (s5h1420_readreg(state, 0x3b) & 0x08)
  114. break;
  115. msleep(5);
  116. }
  117. if (time_after(jiffies, timeout))
  118. result = -ETIMEDOUT;
  119. /* restore original settings */
  120. s5h1420_writereg(state, 0x3b, val);
  121. msleep(15);
  122. return result;
  123. }
  124. static int s5h1420_recv_slave_reply (struct dvb_frontend* fe, struct dvb_diseqc_slave_reply* reply)
  125. {
  126. struct s5h1420_state* state = fe->demodulator_priv;
  127. u8 val;
  128. int i;
  129. int length;
  130. unsigned long timeout;
  131. int result = 0;
  132. /* setup for DISEQC recieve */
  133. val = s5h1420_readreg(state, 0x3b);
  134. s5h1420_writereg(state, 0x3b, 0x82); /* FIXME: guess - do we need to set DIS_RDY(0x08) in receive mode? */
  135. msleep(15);
  136. /* wait for reception to complete */
  137. timeout = jiffies + ((reply->timeout*HZ) / 1000);
  138. while(time_before(jiffies, timeout)) {
  139. if (!(s5h1420_readreg(state, 0x3b) & 0x80)) /* FIXME: do we test DIS_RDY(0x08) or RCV_EN(0x80)? */
  140. break;
  141. msleep(5);
  142. }
  143. if (time_after(jiffies, timeout)) {
  144. result = -ETIMEDOUT;
  145. goto exit;
  146. }
  147. /* check error flag - FIXME: not sure what this does - docs do not describe
  148. * beyond "error flag for diseqc receive data :( */
  149. if (s5h1420_readreg(state, 0x49)) {
  150. result = -EIO;
  151. goto exit;
  152. }
  153. /* check length */
  154. length = (s5h1420_readreg(state, 0x3b) & 0x70) >> 4;
  155. if (length > sizeof(reply->msg)) {
  156. result = -EOVERFLOW;
  157. goto exit;
  158. }
  159. reply->msg_len = length;
  160. /* extract data */
  161. for(i=0; i< length; i++) {
  162. reply->msg[i] = s5h1420_readreg(state, 0x3c + i);
  163. }
  164. exit:
  165. /* restore original settings */
  166. s5h1420_writereg(state, 0x3b, val);
  167. msleep(15);
  168. return result;
  169. }
  170. static int s5h1420_send_burst (struct dvb_frontend* fe, fe_sec_mini_cmd_t minicmd)
  171. {
  172. struct s5h1420_state* state = fe->demodulator_priv;
  173. u8 val;
  174. int result = 0;
  175. unsigned long timeout;
  176. /* setup for tone burst */
  177. val = s5h1420_readreg(state, 0x3b);
  178. s5h1420_writereg(state, 0x3b, (s5h1420_readreg(state, 0x3b) & 0x70) | 0x01);
  179. /* set value for B position if requested */
  180. if (minicmd == SEC_MINI_B) {
  181. s5h1420_writereg(state, 0x3b, s5h1420_readreg(state, 0x3b) | 0x04);
  182. }
  183. msleep(15);
  184. /* start transmission */
  185. s5h1420_writereg(state, 0x3b, s5h1420_readreg(state, 0x3b) | 0x08);
  186. /* wait for transmission to complete */
  187. timeout = jiffies + ((20*HZ) / 1000);
  188. while(time_before(jiffies, timeout)) {
  189. if (!(s5h1420_readreg(state, 0x3b) & 0x08))
  190. break;
  191. msleep(5);
  192. }
  193. if (time_after(jiffies, timeout))
  194. result = -ETIMEDOUT;
  195. /* restore original settings */
  196. s5h1420_writereg(state, 0x3b, val);
  197. msleep(15);
  198. return result;
  199. }
  200. static fe_status_t s5h1420_get_status_bits(struct s5h1420_state* state)
  201. {
  202. u8 val;
  203. fe_status_t status = 0;
  204. val = s5h1420_readreg(state, 0x14);
  205. if (val & 0x02)
  206. status |= FE_HAS_SIGNAL; // FIXME: not sure if this is right
  207. if (val & 0x01)
  208. status |= FE_HAS_CARRIER; // FIXME: not sure if this is right
  209. val = s5h1420_readreg(state, 0x36);
  210. if (val & 0x01)
  211. status |= FE_HAS_VITERBI;
  212. if (val & 0x20)
  213. status |= FE_HAS_SYNC;
  214. if (status == (FE_HAS_SIGNAL|FE_HAS_CARRIER|FE_HAS_VITERBI|FE_HAS_SYNC))
  215. status |= FE_HAS_LOCK;
  216. return status;
  217. }
  218. static int s5h1420_read_status(struct dvb_frontend* fe, fe_status_t* status)
  219. {
  220. struct s5h1420_state* state = fe->demodulator_priv;
  221. u8 val;
  222. if (status == NULL)
  223. return -EINVAL;
  224. /* determine lock state */
  225. *status = s5h1420_get_status_bits(state);
  226. /* fix for FEC 5/6 inversion issue - if it doesn't quite lock, invert the inversion,
  227. wait a bit and check again */
  228. if (*status == (FE_HAS_SIGNAL|FE_HAS_CARRIER|FE_HAS_VITERBI)) {
  229. val = s5h1420_readreg(state, 0x32);
  230. if ((val & 0x07) == 0x03) {
  231. if (val & 0x08)
  232. s5h1420_writereg(state, 0x31, 0x13);
  233. else
  234. s5h1420_writereg(state, 0x31, 0x1b);
  235. /* wait a bit then update lock status */
  236. mdelay(200);
  237. *status = s5h1420_get_status_bits(state);
  238. }
  239. }
  240. /* perform post lock setup */
  241. if ((*status & FE_HAS_LOCK) && (!state->postlocked)) {
  242. /* calculate the data rate */
  243. u32 tmp = s5h1420_getsymbolrate(state);
  244. switch(s5h1420_readreg(state, 0x32) & 0x07) {
  245. case 0:
  246. tmp = (tmp * 2 * 1) / 2;
  247. break;
  248. case 1:
  249. tmp = (tmp * 2 * 2) / 3;
  250. break;
  251. case 2:
  252. tmp = (tmp * 2 * 3) / 4;
  253. break;
  254. case 3:
  255. tmp = (tmp * 2 * 5) / 6;
  256. break;
  257. case 4:
  258. tmp = (tmp * 2 * 6) / 7;
  259. break;
  260. case 5:
  261. tmp = (tmp * 2 * 7) / 8;
  262. break;
  263. }
  264. tmp = state->fclk / tmp;
  265. /* set the MPEG_CLK_INTL for the calculated data rate */
  266. if (tmp < 4)
  267. val = 0x00;
  268. else if (tmp < 8)
  269. val = 0x01;
  270. else if (tmp < 12)
  271. val = 0x02;
  272. else if (tmp < 16)
  273. val = 0x03;
  274. else if (tmp < 24)
  275. val = 0x04;
  276. else if (tmp < 32)
  277. val = 0x05;
  278. else
  279. val = 0x06;
  280. s5h1420_writereg(state, 0x22, val);
  281. /* DC freeze */
  282. s5h1420_writereg(state, 0x1f, s5h1420_readreg(state, 0x1f) | 0x01);
  283. /* kicker disable + remove DC offset */
  284. s5h1420_writereg(state, 0x05, s5h1420_readreg(state, 0x05) & 0x6f);
  285. /* post-lock processing has been done! */
  286. state->postlocked = 1;
  287. }
  288. return 0;
  289. }
  290. static int s5h1420_read_ber(struct dvb_frontend* fe, u32* ber)
  291. {
  292. struct s5h1420_state* state = fe->demodulator_priv;
  293. s5h1420_writereg(state, 0x46, 0x1d);
  294. mdelay(25);
  295. return (s5h1420_readreg(state, 0x48) << 8) | s5h1420_readreg(state, 0x47);
  296. }
  297. static int s5h1420_read_signal_strength(struct dvb_frontend* fe, u16* strength)
  298. {
  299. struct s5h1420_state* state = fe->demodulator_priv;
  300. u8 val = 0xff - s5h1420_readreg(state, 0x15);
  301. return (int) ((val << 8) | val);
  302. }
  303. static int s5h1420_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks)
  304. {
  305. struct s5h1420_state* state = fe->demodulator_priv;
  306. s5h1420_writereg(state, 0x46, 0x1f);
  307. mdelay(25);
  308. return (s5h1420_readreg(state, 0x48) << 8) | s5h1420_readreg(state, 0x47);
  309. }
  310. static void s5h1420_reset(struct s5h1420_state* state)
  311. {
  312. s5h1420_writereg (state, 0x01, 0x08);
  313. s5h1420_writereg (state, 0x01, 0x00);
  314. udelay(10);
  315. }
  316. static void s5h1420_setsymbolrate(struct s5h1420_state* state, struct dvb_frontend_parameters *p)
  317. {
  318. u64 val;
  319. val = (p->u.qpsk.symbol_rate / 1000) * (1<<24);
  320. if (p->u.qpsk.symbol_rate <= 21000000) {
  321. val *= 2;
  322. }
  323. do_div(val, (state->fclk / 1000));
  324. s5h1420_writereg(state, 0x09, s5h1420_readreg(state, 0x09) & 0x7f);
  325. s5h1420_writereg(state, 0x11, val >> 16);
  326. s5h1420_writereg(state, 0x12, val >> 8);
  327. s5h1420_writereg(state, 0x13, val & 0xff);
  328. s5h1420_writereg(state, 0x09, s5h1420_readreg(state, 0x09) | 0x80);
  329. }
  330. static u32 s5h1420_getsymbolrate(struct s5h1420_state* state)
  331. {
  332. u64 val;
  333. int sampling = 2;
  334. if (s5h1420_readreg(state, 0x05) & 0x2)
  335. sampling = 1;
  336. s5h1420_writereg(state, 0x06, s5h1420_readreg(state, 0x06) | 0x08);
  337. val = s5h1420_readreg(state, 0x11) << 16;
  338. val |= s5h1420_readreg(state, 0x12) << 8;
  339. val |= s5h1420_readreg(state, 0x13);
  340. s5h1420_writereg(state, 0x06, s5h1420_readreg(state, 0x06) & 0xf7);
  341. val *= (state->fclk / 1000);
  342. do_div(val, ((1<<24) * sampling));
  343. return (u32) (val * 1000);
  344. }
  345. static void s5h1420_setfreqoffset(struct s5h1420_state* state, int freqoffset)
  346. {
  347. int val;
  348. /* remember freqoffset is in kHz, but the chip wants the offset in Hz, so
  349. * divide fclk by 1000000 to get the correct value. */
  350. val = -(int) ((freqoffset * (1<<24)) / (state->fclk / 1000000));
  351. s5h1420_writereg(state, 0x09, s5h1420_readreg(state, 0x09) & 0xbf);
  352. s5h1420_writereg(state, 0x0e, val >> 16);
  353. s5h1420_writereg(state, 0x0f, val >> 8);
  354. s5h1420_writereg(state, 0x10, val & 0xff);
  355. s5h1420_writereg(state, 0x09, s5h1420_readreg(state, 0x09) | 0x40);
  356. }
  357. static int s5h1420_getfreqoffset(struct s5h1420_state* state)
  358. {
  359. int val;
  360. s5h1420_writereg(state, 0x06, s5h1420_readreg(state, 0x06) | 0x08);
  361. val = s5h1420_readreg(state, 0x0e) << 16;
  362. val |= s5h1420_readreg(state, 0x0f) << 8;
  363. val |= s5h1420_readreg(state, 0x10);
  364. s5h1420_writereg(state, 0x06, s5h1420_readreg(state, 0x06) & 0xf7);
  365. if (val & 0x800000)
  366. val |= 0xff000000;
  367. /* remember freqoffset is in kHz, but the chip wants the offset in Hz, so
  368. * divide fclk by 1000000 to get the correct value. */
  369. val = - ((val * (state->fclk/1000000)) / (1<<24));
  370. return val;
  371. }
  372. static void s5h1420_setfec(struct s5h1420_state* state, struct dvb_frontend_parameters *p)
  373. {
  374. if ((p->u.qpsk.fec_inner == FEC_AUTO) || (p->inversion == INVERSION_AUTO)) {
  375. s5h1420_writereg(state, 0x31, 0x00);
  376. s5h1420_writereg(state, 0x30, 0x3f);
  377. } else {
  378. switch(p->u.qpsk.fec_inner) {
  379. case FEC_1_2:
  380. s5h1420_writereg(state, 0x31, 0x10);
  381. s5h1420_writereg(state, 0x30, 0x01);
  382. break;
  383. case FEC_2_3:
  384. s5h1420_writereg(state, 0x31, 0x11);
  385. s5h1420_writereg(state, 0x30, 0x02);
  386. break;
  387. case FEC_3_4:
  388. s5h1420_writereg(state, 0x31, 0x12);
  389. s5h1420_writereg(state, 0x30, 0x04);
  390. break;
  391. case FEC_5_6:
  392. s5h1420_writereg(state, 0x31, 0x13);
  393. s5h1420_writereg(state, 0x30, 0x08);
  394. break;
  395. case FEC_6_7:
  396. s5h1420_writereg(state, 0x31, 0x14);
  397. s5h1420_writereg(state, 0x30, 0x10);
  398. break;
  399. case FEC_7_8:
  400. s5h1420_writereg(state, 0x31, 0x15);
  401. s5h1420_writereg(state, 0x30, 0x20);
  402. break;
  403. default:
  404. return;
  405. }
  406. }
  407. }
  408. static fe_code_rate_t s5h1420_getfec(struct s5h1420_state* state)
  409. {
  410. switch(s5h1420_readreg(state, 0x32) & 0x07) {
  411. case 0:
  412. return FEC_1_2;
  413. case 1:
  414. return FEC_2_3;
  415. case 2:
  416. return FEC_3_4;
  417. case 3:
  418. return FEC_5_6;
  419. case 4:
  420. return FEC_6_7;
  421. case 5:
  422. return FEC_7_8;
  423. }
  424. return FEC_NONE;
  425. }
  426. static void s5h1420_setinversion(struct s5h1420_state* state, struct dvb_frontend_parameters *p)
  427. {
  428. if ((p->u.qpsk.fec_inner == FEC_AUTO) || (p->inversion == INVERSION_AUTO)) {
  429. s5h1420_writereg(state, 0x31, 0x00);
  430. s5h1420_writereg(state, 0x30, 0x3f);
  431. } else {
  432. u8 tmp = s5h1420_readreg(state, 0x31) & 0xf7;
  433. tmp |= 0x10;
  434. if (p->inversion == INVERSION_ON)
  435. tmp |= 0x80;
  436. s5h1420_writereg(state, 0x31, tmp);
  437. }
  438. }
  439. static fe_spectral_inversion_t s5h1420_getinversion(struct s5h1420_state* state)
  440. {
  441. if (s5h1420_readreg(state, 0x32) & 0x08)
  442. return INVERSION_ON;
  443. return INVERSION_OFF;
  444. }
  445. static int s5h1420_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p)
  446. {
  447. struct s5h1420_state* state = fe->demodulator_priv;
  448. u32 frequency_delta;
  449. struct dvb_frontend_tune_settings fesettings;
  450. /* check if we should do a fast-tune */
  451. memcpy(&fesettings.parameters, p, sizeof(struct dvb_frontend_parameters));
  452. s5h1420_get_tune_settings(fe, &fesettings);
  453. frequency_delta = p->frequency - state->tunedfreq;
  454. if ((frequency_delta > -fesettings.max_drift) && (frequency_delta < fesettings.max_drift) &&
  455. (frequency_delta != 0) &&
  456. (state->fec_inner == p->u.qpsk.fec_inner) &&
  457. (state->symbol_rate == p->u.qpsk.symbol_rate)) {
  458. s5h1420_setfreqoffset(state, frequency_delta);
  459. return 0;
  460. }
  461. /* first of all, software reset */
  462. s5h1420_reset(state);
  463. /* set tuner PLL */
  464. if (state->config->pll_set) {
  465. s5h1420_writereg (state, 0x02, s5h1420_readreg(state,0x02) | 1);
  466. state->config->pll_set(fe, p, &state->tunedfreq);
  467. s5h1420_writereg (state, 0x02, s5h1420_readreg(state,0x02) & 0xfe);
  468. }
  469. /* set s5h1420 fclk PLL according to desired symbol rate */
  470. if (p->u.qpsk.symbol_rate > 28000000) {
  471. state->fclk = 88000000;
  472. s5h1420_writereg(state, 0x03, 0x50);
  473. s5h1420_writereg(state, 0x04, 0x40);
  474. s5h1420_writereg(state, 0x05, 0xae);
  475. } else if (p->u.qpsk.symbol_rate > 21000000) {
  476. state->fclk = 59000000;
  477. s5h1420_writereg(state, 0x03, 0x33);
  478. s5h1420_writereg(state, 0x04, 0x40);
  479. s5h1420_writereg(state, 0x05, 0xae);
  480. } else {
  481. state->fclk = 88000000;
  482. s5h1420_writereg(state, 0x03, 0x50);
  483. s5h1420_writereg(state, 0x04, 0x40);
  484. s5h1420_writereg(state, 0x05, 0xac);
  485. }
  486. /* set misc registers */
  487. s5h1420_writereg(state, 0x02, 0x00);
  488. s5h1420_writereg(state, 0x07, 0xb0);
  489. s5h1420_writereg(state, 0x0a, 0x67);
  490. s5h1420_writereg(state, 0x0b, 0x78);
  491. s5h1420_writereg(state, 0x0c, 0x48);
  492. s5h1420_writereg(state, 0x0d, 0x6b);
  493. s5h1420_writereg(state, 0x2e, 0x8e);
  494. s5h1420_writereg(state, 0x35, 0x33);
  495. s5h1420_writereg(state, 0x38, 0x01);
  496. s5h1420_writereg(state, 0x39, 0x7d);
  497. s5h1420_writereg(state, 0x3a, (state->fclk + (TONE_FREQ * 32) - 1) / (TONE_FREQ * 32));
  498. s5h1420_writereg(state, 0x3c, 0x00);
  499. s5h1420_writereg(state, 0x45, 0x61);
  500. s5h1420_writereg(state, 0x46, 0x1d);
  501. /* start QPSK */
  502. s5h1420_writereg(state, 0x05, s5h1420_readreg(state, 0x05) | 1);
  503. /* set the frequency offset to adjust for PLL inaccuracy */
  504. s5h1420_setfreqoffset(state, p->frequency - state->tunedfreq);
  505. /* set the reset of the parameters */
  506. s5h1420_setsymbolrate(state, p);
  507. s5h1420_setinversion(state, p);
  508. s5h1420_setfec(state, p);
  509. state->fec_inner = p->u.qpsk.fec_inner;
  510. state->symbol_rate = p->u.qpsk.symbol_rate;
  511. state->postlocked = 0;
  512. return 0;
  513. }
  514. static int s5h1420_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p)
  515. {
  516. struct s5h1420_state* state = fe->demodulator_priv;
  517. p->frequency = state->tunedfreq + s5h1420_getfreqoffset(state);
  518. p->inversion = s5h1420_getinversion(state);
  519. p->u.qpsk.symbol_rate = s5h1420_getsymbolrate(state);
  520. p->u.qpsk.fec_inner = s5h1420_getfec(state);
  521. return 0;
  522. }
  523. static int s5h1420_get_tune_settings(struct dvb_frontend* fe, struct dvb_frontend_tune_settings* fesettings)
  524. {
  525. if (fesettings->parameters.u.qpsk.symbol_rate > 20000000) {
  526. fesettings->min_delay_ms = 50;
  527. fesettings->step_size = 2000;
  528. fesettings->max_drift = 8000;
  529. } else if (fesettings->parameters.u.qpsk.symbol_rate > 12000000) {
  530. fesettings->min_delay_ms = 100;
  531. fesettings->step_size = 1500;
  532. fesettings->max_drift = 9000;
  533. } else if (fesettings->parameters.u.qpsk.symbol_rate > 8000000) {
  534. fesettings->min_delay_ms = 100;
  535. fesettings->step_size = 1000;
  536. fesettings->max_drift = 8000;
  537. } else if (fesettings->parameters.u.qpsk.symbol_rate > 4000000) {
  538. fesettings->min_delay_ms = 100;
  539. fesettings->step_size = 500;
  540. fesettings->max_drift = 7000;
  541. } else if (fesettings->parameters.u.qpsk.symbol_rate > 2000000) {
  542. fesettings->min_delay_ms = 200;
  543. fesettings->step_size = (fesettings->parameters.u.qpsk.symbol_rate / 8000);
  544. fesettings->max_drift = 14 * fesettings->step_size;
  545. } else {
  546. fesettings->min_delay_ms = 200;
  547. fesettings->step_size = (fesettings->parameters.u.qpsk.symbol_rate / 8000);
  548. fesettings->max_drift = 18 * fesettings->step_size;
  549. }
  550. return 0;
  551. }
  552. static int s5h1420_init (struct dvb_frontend* fe)
  553. {
  554. struct s5h1420_state* state = fe->demodulator_priv;
  555. /* disable power down and do reset */
  556. s5h1420_writereg(state, 0x02, 0x10);
  557. msleep(10);
  558. s5h1420_reset(state);
  559. /* init PLL */
  560. if (state->config->pll_init) {
  561. s5h1420_writereg (state, 0x02, s5h1420_readreg(state,0x02) | 1);
  562. state->config->pll_init(fe);
  563. s5h1420_writereg (state, 0x02, s5h1420_readreg(state,0x02) & 0xfe);
  564. }
  565. return 0;
  566. }
  567. static int s5h1420_sleep(struct dvb_frontend* fe)
  568. {
  569. struct s5h1420_state* state = fe->demodulator_priv;
  570. return s5h1420_writereg(state, 0x02, 0x12);
  571. }
  572. static void s5h1420_release(struct dvb_frontend* fe)
  573. {
  574. struct s5h1420_state* state = fe->demodulator_priv;
  575. kfree(state);
  576. }
  577. static struct dvb_frontend_ops s5h1420_ops;
  578. struct dvb_frontend* s5h1420_attach(const struct s5h1420_config* config, struct i2c_adapter* i2c)
  579. {
  580. struct s5h1420_state* state = NULL;
  581. u8 identity;
  582. /* allocate memory for the internal state */
  583. state = kmalloc(sizeof(struct s5h1420_state), GFP_KERNEL);
  584. if (state == NULL)
  585. goto error;
  586. /* setup the state */
  587. state->config = config;
  588. state->i2c = i2c;
  589. memcpy(&state->ops, &s5h1420_ops, sizeof(struct dvb_frontend_ops));
  590. state->postlocked = 0;
  591. state->fclk = 88000000;
  592. state->tunedfreq = 0;
  593. state->fec_inner = FEC_NONE;
  594. state->symbol_rate = 0;
  595. /* check if the demod is there + identify it */
  596. identity = s5h1420_readreg(state, 0x00);
  597. if (identity != 0x03)
  598. goto error;
  599. /* create dvb_frontend */
  600. state->frontend.ops = &state->ops;
  601. state->frontend.demodulator_priv = state;
  602. return &state->frontend;
  603. error:
  604. kfree(state);
  605. return NULL;
  606. }
  607. static struct dvb_frontend_ops s5h1420_ops = {
  608. .info = {
  609. .name = "Samsung S5H1420 DVB-S",
  610. .type = FE_QPSK,
  611. .frequency_min = 950000,
  612. .frequency_max = 2150000,
  613. .frequency_stepsize = 125, /* kHz for QPSK frontends */
  614. .frequency_tolerance = 29500,
  615. .symbol_rate_min = 1000000,
  616. .symbol_rate_max = 45000000,
  617. /* .symbol_rate_tolerance = ???,*/
  618. .caps = FE_CAN_INVERSION_AUTO |
  619. FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 |
  620. FE_CAN_FEC_5_6 | FE_CAN_FEC_6_7 | FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO |
  621. FE_CAN_QPSK
  622. },
  623. .release = s5h1420_release,
  624. .init = s5h1420_init,
  625. .sleep = s5h1420_sleep,
  626. .set_frontend = s5h1420_set_frontend,
  627. .get_frontend = s5h1420_get_frontend,
  628. .get_tune_settings = s5h1420_get_tune_settings,
  629. .read_status = s5h1420_read_status,
  630. .read_ber = s5h1420_read_ber,
  631. .read_signal_strength = s5h1420_read_signal_strength,
  632. .read_ucblocks = s5h1420_read_ucblocks,
  633. .diseqc_send_master_cmd = s5h1420_send_master_cmd,
  634. .diseqc_recv_slave_reply = s5h1420_recv_slave_reply,
  635. .diseqc_send_burst = s5h1420_send_burst,
  636. .set_tone = s5h1420_set_tone,
  637. .set_voltage = s5h1420_set_voltage,
  638. };
  639. module_param(debug, int, 0644);
  640. MODULE_DESCRIPTION("Samsung S5H1420 DVB-S Demodulator driver");
  641. MODULE_AUTHOR("Andrew de Quincey");
  642. MODULE_LICENSE("GPL");
  643. EXPORT_SYMBOL(s5h1420_attach);