Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
hd29l2.c
Go to the documentation of this file.
1 /*
2  * HDIC HD29L2 DMB-TH demodulator driver
3  *
4  * Copyright (C) 2011 Metropolia University of Applied Sciences, Electria R&D
5  *
6  * Author: Antti Palosaari <[email protected]>
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 
23 #include "hd29l2_priv.h"
24 
25 /* write multiple registers */
26 static int hd29l2_wr_regs(struct hd29l2_priv *priv, u8 reg, u8 *val, int len)
27 {
28  int ret;
29  u8 buf[2 + len];
30  struct i2c_msg msg[1] = {
31  {
32  .addr = priv->cfg.i2c_addr,
33  .flags = 0,
34  .len = sizeof(buf),
35  .buf = buf,
36  }
37  };
38 
39  buf[0] = 0x00;
40  buf[1] = reg;
41  memcpy(&buf[2], val, len);
42 
43  ret = i2c_transfer(priv->i2c, msg, 1);
44  if (ret == 1) {
45  ret = 0;
46  } else {
47  dev_warn(&priv->i2c->dev,
48  "%s: i2c wr failed=%d reg=%02x len=%d\n",
49  KBUILD_MODNAME, ret, reg, len);
50  ret = -EREMOTEIO;
51  }
52 
53  return ret;
54 }
55 
56 /* read multiple registers */
57 static int hd29l2_rd_regs(struct hd29l2_priv *priv, u8 reg, u8 *val, int len)
58 {
59  int ret;
60  u8 buf[2] = { 0x00, reg };
61  struct i2c_msg msg[2] = {
62  {
63  .addr = priv->cfg.i2c_addr,
64  .flags = 0,
65  .len = 2,
66  .buf = buf,
67  }, {
68  .addr = priv->cfg.i2c_addr,
69  .flags = I2C_M_RD,
70  .len = len,
71  .buf = val,
72  }
73  };
74 
75  ret = i2c_transfer(priv->i2c, msg, 2);
76  if (ret == 2) {
77  ret = 0;
78  } else {
79  dev_warn(&priv->i2c->dev,
80  "%s: i2c rd failed=%d reg=%02x len=%d\n",
81  KBUILD_MODNAME, ret, reg, len);
82  ret = -EREMOTEIO;
83  }
84 
85  return ret;
86 }
87 
88 /* write single register */
89 static int hd29l2_wr_reg(struct hd29l2_priv *priv, u8 reg, u8 val)
90 {
91  return hd29l2_wr_regs(priv, reg, &val, 1);
92 }
93 
94 /* read single register */
95 static int hd29l2_rd_reg(struct hd29l2_priv *priv, u8 reg, u8 *val)
96 {
97  return hd29l2_rd_regs(priv, reg, val, 1);
98 }
99 
100 /* write single register with mask */
101 static int hd29l2_wr_reg_mask(struct hd29l2_priv *priv, u8 reg, u8 val, u8 mask)
102 {
103  int ret;
104  u8 tmp;
105 
106  /* no need for read if whole reg is written */
107  if (mask != 0xff) {
108  ret = hd29l2_rd_regs(priv, reg, &tmp, 1);
109  if (ret)
110  return ret;
111 
112  val &= mask;
113  tmp &= ~mask;
114  val |= tmp;
115  }
116 
117  return hd29l2_wr_regs(priv, reg, &val, 1);
118 }
119 
120 /* read single register with mask */
121 int hd29l2_rd_reg_mask(struct hd29l2_priv *priv, u8 reg, u8 *val, u8 mask)
122 {
123  int ret, i;
124  u8 tmp;
125 
126  ret = hd29l2_rd_regs(priv, reg, &tmp, 1);
127  if (ret)
128  return ret;
129 
130  tmp &= mask;
131 
132  /* find position of the first bit */
133  for (i = 0; i < 8; i++) {
134  if ((mask >> i) & 0x01)
135  break;
136  }
137  *val = tmp >> i;
138 
139  return 0;
140 }
141 
142 static int hd29l2_soft_reset(struct hd29l2_priv *priv)
143 {
144  int ret;
145  u8 tmp;
146 
147  ret = hd29l2_rd_reg(priv, 0x26, &tmp);
148  if (ret)
149  goto err;
150 
151  ret = hd29l2_wr_reg(priv, 0x26, 0x0d);
152  if (ret)
153  goto err;
154 
155  usleep_range(10000, 20000);
156 
157  ret = hd29l2_wr_reg(priv, 0x26, tmp);
158  if (ret)
159  goto err;
160 
161  return 0;
162 err:
163  dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
164  return ret;
165 }
166 
167 static int hd29l2_i2c_gate_ctrl(struct dvb_frontend *fe, int enable)
168 {
169  int ret, i;
170  struct hd29l2_priv *priv = fe->demodulator_priv;
171  u8 tmp;
172 
173  dev_dbg(&priv->i2c->dev, "%s: enable=%d\n", __func__, enable);
174 
175  /* set tuner address for demod */
176  if (!priv->tuner_i2c_addr_programmed && enable) {
177  /* no need to set tuner address every time, once is enough */
178  ret = hd29l2_wr_reg(priv, 0x9d, priv->cfg.tuner_i2c_addr << 1);
179  if (ret)
180  goto err;
181 
182  priv->tuner_i2c_addr_programmed = true;
183  }
184 
185  /* open / close gate */
186  ret = hd29l2_wr_reg(priv, 0x9f, enable);
187  if (ret)
188  goto err;
189 
190  /* wait demod ready */
191  for (i = 10; i; i--) {
192  ret = hd29l2_rd_reg(priv, 0x9e, &tmp);
193  if (ret)
194  goto err;
195 
196  if (tmp == enable)
197  break;
198 
199  usleep_range(5000, 10000);
200  }
201 
202  dev_dbg(&priv->i2c->dev, "%s: loop=%d\n", __func__, i);
203 
204  return ret;
205 err:
206  dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
207  return ret;
208 }
209 
210 static int hd29l2_read_status(struct dvb_frontend *fe, fe_status_t *status)
211 {
212  int ret;
213  struct hd29l2_priv *priv = fe->demodulator_priv;
214  u8 buf[2];
215 
216  *status = 0;
217 
218  ret = hd29l2_rd_reg(priv, 0x05, &buf[0]);
219  if (ret)
220  goto err;
221 
222  if (buf[0] & 0x01) {
223  /* full lock */
226  } else {
227  ret = hd29l2_rd_reg(priv, 0x0d, &buf[1]);
228  if (ret)
229  goto err;
230 
231  if ((buf[1] & 0xfe) == 0x78)
232  /* partial lock */
233  *status |= FE_HAS_SIGNAL | FE_HAS_CARRIER |
235  }
236 
237  priv->fe_status = *status;
238 
239  return 0;
240 err:
241  dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
242  return ret;
243 }
244 
245 static int hd29l2_read_snr(struct dvb_frontend *fe, u16 *snr)
246 {
247  int ret;
248  struct hd29l2_priv *priv = fe->demodulator_priv;
249  u8 buf[2];
250  u16 tmp;
251 
252  if (!(priv->fe_status & FE_HAS_LOCK)) {
253  *snr = 0;
254  ret = 0;
255  goto err;
256  }
257 
258  ret = hd29l2_rd_regs(priv, 0x0b, buf, 2);
259  if (ret)
260  goto err;
261 
262  tmp = (buf[0] << 8) | buf[1];
263 
264  /* report SNR in dB * 10 */
265  #define LOG10_20736_24 72422627 /* log10(20736) << 24 */
266  if (tmp)
267  *snr = (LOG10_20736_24 - intlog10(tmp)) / ((1 << 24) / 100);
268  else
269  *snr = 0;
270 
271  return 0;
272 err:
273  dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
274  return ret;
275 }
276 
277 static int hd29l2_read_signal_strength(struct dvb_frontend *fe, u16 *strength)
278 {
279  int ret;
280  struct hd29l2_priv *priv = fe->demodulator_priv;
281  u8 buf[2];
282  u16 tmp;
283 
284  *strength = 0;
285 
286  ret = hd29l2_rd_regs(priv, 0xd5, buf, 2);
287  if (ret)
288  goto err;
289 
290  tmp = buf[0] << 8 | buf[1];
291  tmp = ~tmp & 0x0fff;
292 
293  /* scale value to 0x0000-0xffff from 0x0000-0x0fff */
294  *strength = tmp * 0xffff / 0x0fff;
295 
296  return 0;
297 err:
298  dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
299  return ret;
300 }
301 
302 static int hd29l2_read_ber(struct dvb_frontend *fe, u32 *ber)
303 {
304  int ret;
305  struct hd29l2_priv *priv = fe->demodulator_priv;
306  u8 buf[2];
307 
308  if (!(priv->fe_status & FE_HAS_SYNC)) {
309  *ber = 0;
310  ret = 0;
311  goto err;
312  }
313 
314  ret = hd29l2_rd_regs(priv, 0xd9, buf, 2);
315  if (ret) {
316  *ber = 0;
317  goto err;
318  }
319 
320  /* LDPC BER */
321  *ber = ((buf[0] & 0x0f) << 8) | buf[1];
322 
323  return 0;
324 err:
325  dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
326  return ret;
327 }
328 
329 static int hd29l2_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks)
330 {
331  /* no way to read? */
332  *ucblocks = 0;
333  return 0;
334 }
335 
336 static enum dvbfe_search hd29l2_search(struct dvb_frontend *fe)
337 {
338  int ret, i;
339  struct hd29l2_priv *priv = fe->demodulator_priv;
341  u8 tmp, buf[3];
342  u8 modulation, carrier, guard_interval, interleave, code_rate;
343  u64 num64;
344  u32 if_freq, if_ctl;
345  bool auto_mode;
346 
347  dev_dbg(&priv->i2c->dev, "%s: delivery_system=%d frequency=%d " \
348  "bandwidth_hz=%d modulation=%d inversion=%d " \
349  "fec_inner=%d guard_interval=%d\n", __func__,
351  c->modulation, c->inversion, c->fec_inner,
352  c->guard_interval);
353 
354  /* as for now we detect always params automatically */
355  auto_mode = true;
356 
357  /* program tuner */
358  if (fe->ops.tuner_ops.set_params)
359  fe->ops.tuner_ops.set_params(fe);
360 
361  /* get and program IF */
362  if (fe->ops.tuner_ops.get_if_frequency)
363  fe->ops.tuner_ops.get_if_frequency(fe, &if_freq);
364  else
365  if_freq = 0;
366 
367  if (if_freq) {
368  /* normal IF */
369 
370  /* calc IF control value */
371  num64 = if_freq;
372  num64 *= 0x800000;
373  num64 = div_u64(num64, HD29L2_XTAL);
374  num64 -= 0x800000;
375  if_ctl = num64;
376 
377  tmp = 0xfc; /* tuner type normal */
378  } else {
379  /* zero IF */
380  if_ctl = 0;
381  tmp = 0xfe; /* tuner type Zero-IF */
382  }
383 
384  buf[0] = ((if_ctl >> 0) & 0xff);
385  buf[1] = ((if_ctl >> 8) & 0xff);
386  buf[2] = ((if_ctl >> 16) & 0xff);
387 
388  /* program IF control */
389  ret = hd29l2_wr_regs(priv, 0x14, buf, 3);
390  if (ret)
391  goto err;
392 
393  /* program tuner type */
394  ret = hd29l2_wr_reg(priv, 0xab, tmp);
395  if (ret)
396  goto err;
397 
398  dev_dbg(&priv->i2c->dev, "%s: if_freq=%d if_ctl=%x\n",
399  __func__, if_freq, if_ctl);
400 
401  if (auto_mode) {
402  /*
403  * use auto mode
404  */
405 
406  /* disable quick mode */
407  ret = hd29l2_wr_reg_mask(priv, 0xac, 0 << 7, 0x80);
408  if (ret)
409  goto err;
410 
411  ret = hd29l2_wr_reg_mask(priv, 0x82, 1 << 1, 0x02);
412  if (ret)
413  goto err;
414 
415  /* enable auto mode */
416  ret = hd29l2_wr_reg_mask(priv, 0x7d, 1 << 6, 0x40);
417  if (ret)
418  goto err;
419 
420  ret = hd29l2_wr_reg_mask(priv, 0x81, 1 << 3, 0x08);
421  if (ret)
422  goto err;
423 
424  /* soft reset */
425  ret = hd29l2_soft_reset(priv);
426  if (ret)
427  goto err;
428 
429  /* detect modulation */
430  for (i = 30; i; i--) {
431  msleep(100);
432 
433  ret = hd29l2_rd_reg(priv, 0x0d, &tmp);
434  if (ret)
435  goto err;
436 
437  if ((((tmp & 0xf0) >= 0x10) &&
438  ((tmp & 0x0f) == 0x08)) || (tmp >= 0x2c))
439  break;
440  }
441 
442  dev_dbg(&priv->i2c->dev, "%s: loop=%d\n", __func__, i);
443 
444  if (i == 0)
445  /* detection failed */
447 
448  /* read modulation */
449  ret = hd29l2_rd_reg_mask(priv, 0x7d, &modulation, 0x07);
450  if (ret)
451  goto err;
452  } else {
453  /*
454  * use manual mode
455  */
456 
457  modulation = HD29L2_QAM64;
458  carrier = HD29L2_CARRIER_MULTI;
459  guard_interval = HD29L2_PN945;
460  interleave = HD29L2_INTERLEAVER_420;
461  code_rate = HD29L2_CODE_RATE_08;
462 
463  tmp = (code_rate << 3) | modulation;
464  ret = hd29l2_wr_reg_mask(priv, 0x7d, tmp, 0x5f);
465  if (ret)
466  goto err;
467 
468  tmp = (carrier << 2) | guard_interval;
469  ret = hd29l2_wr_reg_mask(priv, 0x81, tmp, 0x0f);
470  if (ret)
471  goto err;
472 
473  tmp = interleave;
474  ret = hd29l2_wr_reg_mask(priv, 0x82, tmp, 0x03);
475  if (ret)
476  goto err;
477  }
478 
479  /* ensure modulation validy */
480  /* 0=QAM4_NR, 1=QAM4, 2=QAM16, 3=QAM32, 4=QAM64 */
481  if (modulation > (ARRAY_SIZE(reg_mod_vals_tab[0].val) - 1)) {
482  dev_dbg(&priv->i2c->dev, "%s: modulation=%d not valid\n",
483  __func__, modulation);
484  goto err;
485  }
486 
487  /* program registers according to modulation */
488  for (i = 0; i < ARRAY_SIZE(reg_mod_vals_tab); i++) {
489  ret = hd29l2_wr_reg(priv, reg_mod_vals_tab[i].reg,
490  reg_mod_vals_tab[i].val[modulation]);
491  if (ret)
492  goto err;
493  }
494 
495  /* read guard interval */
496  ret = hd29l2_rd_reg_mask(priv, 0x81, &guard_interval, 0x03);
497  if (ret)
498  goto err;
499 
500  /* read carrier mode */
501  ret = hd29l2_rd_reg_mask(priv, 0x81, &carrier, 0x04);
502  if (ret)
503  goto err;
504 
505  dev_dbg(&priv->i2c->dev,
506  "%s: modulation=%d guard_interval=%d carrier=%d\n",
507  __func__, modulation, guard_interval, carrier);
508 
509  if ((carrier == HD29L2_CARRIER_MULTI) && (modulation == HD29L2_QAM64) &&
510  (guard_interval == HD29L2_PN945)) {
511  dev_dbg(&priv->i2c->dev, "%s: C=3780 && QAM64 && PN945\n",
512  __func__);
513 
514  ret = hd29l2_wr_reg(priv, 0x42, 0x33);
515  if (ret)
516  goto err;
517 
518  ret = hd29l2_wr_reg(priv, 0xdd, 0x01);
519  if (ret)
520  goto err;
521  }
522 
523  usleep_range(10000, 20000);
524 
525  /* soft reset */
526  ret = hd29l2_soft_reset(priv);
527  if (ret)
528  goto err;
529 
530  /* wait demod lock */
531  for (i = 30; i; i--) {
532  msleep(100);
533 
534  /* read lock bit */
535  ret = hd29l2_rd_reg_mask(priv, 0x05, &tmp, 0x01);
536  if (ret)
537  goto err;
538 
539  if (tmp)
540  break;
541  }
542 
543  dev_dbg(&priv->i2c->dev, "%s: loop=%d\n", __func__, i);
544 
545  if (i == 0)
547 
549 err:
550  dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
552 }
553 
554 static int hd29l2_get_frontend_algo(struct dvb_frontend *fe)
555 {
556  return DVBFE_ALGO_CUSTOM;
557 }
558 
559 static int hd29l2_get_frontend(struct dvb_frontend *fe)
560 {
561  int ret;
562  struct hd29l2_priv *priv = fe->demodulator_priv;
564  u8 buf[3];
565  u32 if_ctl;
566  char *str_constellation, *str_code_rate, *str_constellation_code_rate,
567  *str_guard_interval, *str_carrier, *str_guard_interval_carrier,
568  *str_interleave, *str_interleave_;
569 
570  ret = hd29l2_rd_reg(priv, 0x7d, &buf[0]);
571  if (ret)
572  goto err;
573 
574  ret = hd29l2_rd_regs(priv, 0x81, &buf[1], 2);
575  if (ret)
576  goto err;
577 
578  /* constellation, 0x7d[2:0] */
579  switch ((buf[0] >> 0) & 0x07) {
580  case 0: /* QAM4NR */
581  str_constellation = "QAM4NR";
582  c->modulation = QAM_AUTO; /* FIXME */
583  break;
584  case 1: /* QAM4 */
585  str_constellation = "QAM4";
586  c->modulation = QPSK; /* FIXME */
587  break;
588  case 2:
589  str_constellation = "QAM16";
590  c->modulation = QAM_16;
591  break;
592  case 3:
593  str_constellation = "QAM32";
594  c->modulation = QAM_32;
595  break;
596  case 4:
597  str_constellation = "QAM64";
598  c->modulation = QAM_64;
599  break;
600  default:
601  str_constellation = "?";
602  }
603 
604  /* LDPC code rate, 0x7d[4:3] */
605  switch ((buf[0] >> 3) & 0x03) {
606  case 0: /* 0.4 */
607  str_code_rate = "0.4";
608  c->fec_inner = FEC_AUTO; /* FIXME */
609  break;
610  case 1: /* 0.6 */
611  str_code_rate = "0.6";
612  c->fec_inner = FEC_3_5;
613  break;
614  case 2: /* 0.8 */
615  str_code_rate = "0.8";
616  c->fec_inner = FEC_4_5;
617  break;
618  default:
619  str_code_rate = "?";
620  }
621 
622  /* constellation & code rate set, 0x7d[6] */
623  switch ((buf[0] >> 6) & 0x01) {
624  case 0:
625  str_constellation_code_rate = "manual";
626  break;
627  case 1:
628  str_constellation_code_rate = "auto";
629  break;
630  default:
631  str_constellation_code_rate = "?";
632  }
633 
634  /* frame header, 0x81[1:0] */
635  switch ((buf[1] >> 0) & 0x03) {
636  case 0: /* PN945 */
637  str_guard_interval = "PN945";
638  c->guard_interval = GUARD_INTERVAL_AUTO; /* FIXME */
639  break;
640  case 1: /* PN595 */
641  str_guard_interval = "PN595";
642  c->guard_interval = GUARD_INTERVAL_AUTO; /* FIXME */
643  break;
644  case 2: /* PN420 */
645  str_guard_interval = "PN420";
646  c->guard_interval = GUARD_INTERVAL_AUTO; /* FIXME */
647  break;
648  default:
649  str_guard_interval = "?";
650  }
651 
652  /* carrier, 0x81[2] */
653  switch ((buf[1] >> 2) & 0x01) {
654  case 0:
655  str_carrier = "C=1";
656  break;
657  case 1:
658  str_carrier = "C=3780";
659  break;
660  default:
661  str_carrier = "?";
662  }
663 
664  /* frame header & carrier set, 0x81[3] */
665  switch ((buf[1] >> 3) & 0x01) {
666  case 0:
667  str_guard_interval_carrier = "manual";
668  break;
669  case 1:
670  str_guard_interval_carrier = "auto";
671  break;
672  default:
673  str_guard_interval_carrier = "?";
674  }
675 
676  /* interleave, 0x82[0] */
677  switch ((buf[2] >> 0) & 0x01) {
678  case 0:
679  str_interleave = "M=720";
680  break;
681  case 1:
682  str_interleave = "M=240";
683  break;
684  default:
685  str_interleave = "?";
686  }
687 
688  /* interleave set, 0x82[1] */
689  switch ((buf[2] >> 1) & 0x01) {
690  case 0:
691  str_interleave_ = "manual";
692  break;
693  case 1:
694  str_interleave_ = "auto";
695  break;
696  default:
697  str_interleave_ = "?";
698  }
699 
700  /*
701  * We can read out current detected NCO and use that value next
702  * time instead of calculating new value from targed IF.
703  * I think it will not effect receiver sensitivity but gaining lock
704  * after tune could be easier...
705  */
706  ret = hd29l2_rd_regs(priv, 0xb1, &buf[0], 3);
707  if (ret)
708  goto err;
709 
710  if_ctl = (buf[0] << 16) | ((buf[1] - 7) << 8) | buf[2];
711 
712  dev_dbg(&priv->i2c->dev, "%s: %s %s %s | %s %s %s | %s %s | NCO=%06x\n",
713  __func__, str_constellation, str_code_rate,
714  str_constellation_code_rate, str_guard_interval,
715  str_carrier, str_guard_interval_carrier, str_interleave,
716  str_interleave_, if_ctl);
717  return 0;
718 err:
719  dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
720  return ret;
721 }
722 
723 static int hd29l2_init(struct dvb_frontend *fe)
724 {
725  int ret, i;
726  struct hd29l2_priv *priv = fe->demodulator_priv;
727  u8 tmp;
728  static const struct reg_val tab[] = {
729  { 0x3a, 0x06 },
730  { 0x3b, 0x03 },
731  { 0x3c, 0x04 },
732  { 0xaf, 0x06 },
733  { 0xb0, 0x1b },
734  { 0x80, 0x64 },
735  { 0x10, 0x38 },
736  };
737 
738  dev_dbg(&priv->i2c->dev, "%s:\n", __func__);
739 
740  /* reset demod */
741  /* it is recommended to HW reset chip using RST_N pin */
742  if (fe->callback) {
743  ret = fe->callback(fe, DVB_FRONTEND_COMPONENT_DEMOD, 0, 0);
744  if (ret)
745  goto err;
746 
747  /* reprogramming needed because HW reset clears registers */
748  priv->tuner_i2c_addr_programmed = false;
749  }
750 
751  /* init */
752  for (i = 0; i < ARRAY_SIZE(tab); i++) {
753  ret = hd29l2_wr_reg(priv, tab[i].reg, tab[i].val);
754  if (ret)
755  goto err;
756  }
757 
758  /* TS params */
759  ret = hd29l2_rd_reg(priv, 0x36, &tmp);
760  if (ret)
761  goto err;
762 
763  tmp &= 0x1b;
764  tmp |= priv->cfg.ts_mode;
765  ret = hd29l2_wr_reg(priv, 0x36, tmp);
766  if (ret)
767  goto err;
768 
769  ret = hd29l2_rd_reg(priv, 0x31, &tmp);
770  tmp &= 0xef;
771 
772  if (!(priv->cfg.ts_mode >> 7))
773  /* set b4 for serial TS */
774  tmp |= 0x10;
775 
776  ret = hd29l2_wr_reg(priv, 0x31, tmp);
777  if (ret)
778  goto err;
779 
780  return ret;
781 err:
782  dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
783  return ret;
784 }
785 
786 static void hd29l2_release(struct dvb_frontend *fe)
787 {
788  struct hd29l2_priv *priv = fe->demodulator_priv;
789  kfree(priv);
790 }
791 
792 static struct dvb_frontend_ops hd29l2_ops;
793 
795  struct i2c_adapter *i2c)
796 {
797  int ret;
798  struct hd29l2_priv *priv = NULL;
799  u8 tmp;
800 
801  /* allocate memory for the internal state */
802  priv = kzalloc(sizeof(struct hd29l2_priv), GFP_KERNEL);
803  if (priv == NULL)
804  goto err;
805 
806  /* setup the state */
807  priv->i2c = i2c;
808  memcpy(&priv->cfg, config, sizeof(struct hd29l2_config));
809 
810 
811  /* check if the demod is there */
812  ret = hd29l2_rd_reg(priv, 0x00, &tmp);
813  if (ret)
814  goto err;
815 
816  /* create dvb_frontend */
817  memcpy(&priv->fe.ops, &hd29l2_ops, sizeof(struct dvb_frontend_ops));
818  priv->fe.demodulator_priv = priv;
819 
820  return &priv->fe;
821 err:
822  kfree(priv);
823  return NULL;
824 }
826 
827 static struct dvb_frontend_ops hd29l2_ops = {
828  .delsys = { SYS_DVBT },
829  .info = {
830  .name = "HDIC HD29L2 DMB-TH",
831  .frequency_min = 474000000,
832  .frequency_max = 858000000,
833  .frequency_stepsize = 10000,
834  .caps = FE_CAN_FEC_AUTO |
835  FE_CAN_QPSK |
836  FE_CAN_QAM_16 |
837  FE_CAN_QAM_32 |
838  FE_CAN_QAM_64 |
845  },
846 
847  .release = hd29l2_release,
848 
849  .init = hd29l2_init,
850 
851  .get_frontend_algo = hd29l2_get_frontend_algo,
852  .search = hd29l2_search,
853  .get_frontend = hd29l2_get_frontend,
854 
855  .read_status = hd29l2_read_status,
856  .read_snr = hd29l2_read_snr,
857  .read_signal_strength = hd29l2_read_signal_strength,
858  .read_ber = hd29l2_read_ber,
859  .read_ucblocks = hd29l2_read_ucblocks,
860 
861  .i2c_gate_ctrl = hd29l2_i2c_gate_ctrl,
862 };
863 
864 MODULE_AUTHOR("Antti Palosaari <[email protected]>");
865 MODULE_DESCRIPTION("HDIC HD29L2 DMB-TH demodulator driver");
866 MODULE_LICENSE("GPL");