Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
cxd2820r_t2.c
Go to the documentation of this file.
1 /*
2  * Sony CXD2820R demodulator driver
3  *
4  * Copyright (C) 2010 Antti Palosaari <[email protected]>
5  *
6  * This program is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License as published by
8  * the Free Software Foundation; either version 2 of the License, or
9  * (at your option) any later version.
10  *
11  * This program is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License along
17  * with this program; if not, write to the Free Software Foundation, Inc.,
18  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
19  */
20 
21 
22 #include "cxd2820r_priv.h"
23 
25 {
26  struct cxd2820r_priv *priv = fe->demodulator_priv;
28  int ret, i, bw_i;
29  u32 if_freq, if_ctl;
30  u64 num;
31  u8 buf[3], bw_param;
32  u8 bw_params1[][5] = {
33  { 0x1c, 0xb3, 0x33, 0x33, 0x33 }, /* 5 MHz */
34  { 0x17, 0xea, 0xaa, 0xaa, 0xaa }, /* 6 MHz */
35  { 0x14, 0x80, 0x00, 0x00, 0x00 }, /* 7 MHz */
36  { 0x11, 0xf0, 0x00, 0x00, 0x00 }, /* 8 MHz */
37  };
38  struct reg_val_mask tab[] = {
39  { 0x00080, 0x02, 0xff },
40  { 0x00081, 0x20, 0xff },
41  { 0x00085, 0x07, 0xff },
42  { 0x00088, 0x01, 0xff },
43  { 0x02069, 0x01, 0xff },
44 
45  { 0x0207f, 0x2a, 0xff },
46  { 0x02082, 0x0a, 0xff },
47  { 0x02083, 0x0a, 0xff },
48  { 0x020cb, priv->cfg.if_agc_polarity << 6, 0x40 },
49  { 0x02070, priv->cfg.ts_mode, 0xff },
50  { 0x020b5, priv->cfg.spec_inv << 4, 0x10 },
51  { 0x02567, 0x07, 0x0f },
52  { 0x02569, 0x03, 0x03 },
53  { 0x02595, 0x1a, 0xff },
54  { 0x02596, 0x50, 0xff },
55  { 0x02a8c, 0x00, 0xff },
56  { 0x02a8d, 0x34, 0xff },
57  { 0x02a45, 0x06, 0x07 },
58  { 0x03f10, 0x0d, 0xff },
59  { 0x03f11, 0x02, 0xff },
60  { 0x03f12, 0x01, 0xff },
61  { 0x03f23, 0x2c, 0xff },
62  { 0x03f51, 0x13, 0xff },
63  { 0x03f52, 0x01, 0xff },
64  { 0x03f53, 0x00, 0xff },
65  { 0x027e6, 0x14, 0xff },
66  { 0x02786, 0x02, 0x07 },
67  { 0x02787, 0x40, 0xe0 },
68  { 0x027ef, 0x10, 0x18 },
69  };
70 
71  dev_dbg(&priv->i2c->dev, "%s: frequency=%d bandwidth_hz=%d\n", __func__,
72  c->frequency, c->bandwidth_hz);
73 
74  switch (c->bandwidth_hz) {
75  case 5000000:
76  bw_i = 0;
77  bw_param = 3;
78  break;
79  case 6000000:
80  bw_i = 1;
81  bw_param = 2;
82  break;
83  case 7000000:
84  bw_i = 2;
85  bw_param = 1;
86  break;
87  case 8000000:
88  bw_i = 3;
89  bw_param = 0;
90  break;
91  default:
92  return -EINVAL;
93  }
94 
95  /* program tuner */
96  if (fe->ops.tuner_ops.set_params)
97  fe->ops.tuner_ops.set_params(fe);
98 
99  if (priv->delivery_system != SYS_DVBT2) {
100  for (i = 0; i < ARRAY_SIZE(tab); i++) {
101  ret = cxd2820r_wr_reg_mask(priv, tab[i].reg,
102  tab[i].val, tab[i].mask);
103  if (ret)
104  goto error;
105  }
106  }
107 
108  priv->delivery_system = SYS_DVBT2;
109 
110  /* program IF frequency */
111  if (fe->ops.tuner_ops.get_if_frequency) {
112  ret = fe->ops.tuner_ops.get_if_frequency(fe, &if_freq);
113  if (ret)
114  goto error;
115  } else
116  if_freq = 0;
117 
118  dev_dbg(&priv->i2c->dev, "%s: if_freq=%d\n", __func__, if_freq);
119 
120  num = if_freq / 1000; /* Hz => kHz */
121  num *= 0x1000000;
122  if_ctl = cxd2820r_div_u64_round_closest(num, 41000);
123  buf[0] = ((if_ctl >> 16) & 0xff);
124  buf[1] = ((if_ctl >> 8) & 0xff);
125  buf[2] = ((if_ctl >> 0) & 0xff);
126 
127  ret = cxd2820r_wr_regs(priv, 0x020b6, buf, 3);
128  if (ret)
129  goto error;
130 
131  ret = cxd2820r_wr_regs(priv, 0x0209f, bw_params1[bw_i], 5);
132  if (ret)
133  goto error;
134 
135  ret = cxd2820r_wr_reg_mask(priv, 0x020d7, bw_param << 6, 0xc0);
136  if (ret)
137  goto error;
138 
139  ret = cxd2820r_wr_reg(priv, 0x000ff, 0x08);
140  if (ret)
141  goto error;
142 
143  ret = cxd2820r_wr_reg(priv, 0x000fe, 0x01);
144  if (ret)
145  goto error;
146 
147  return ret;
148 error:
149  dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
150  return ret;
151 
152 }
153 
155 {
156  struct cxd2820r_priv *priv = fe->demodulator_priv;
158  int ret;
159  u8 buf[2];
160 
161  ret = cxd2820r_rd_regs(priv, 0x0205c, buf, 2);
162  if (ret)
163  goto error;
164 
165  switch ((buf[0] >> 0) & 0x07) {
166  case 0:
168  break;
169  case 1:
171  break;
172  case 2:
174  break;
175  case 3:
177  break;
178  case 4:
180  break;
181  case 5:
183  break;
184  }
185 
186  switch ((buf[1] >> 4) & 0x07) {
187  case 0:
189  break;
190  case 1:
192  break;
193  case 2:
195  break;
196  case 3:
198  break;
199  case 4:
201  break;
202  case 5:
204  break;
205  case 6:
207  break;
208  }
209 
210  ret = cxd2820r_rd_regs(priv, 0x0225b, buf, 2);
211  if (ret)
212  goto error;
213 
214  switch ((buf[0] >> 0) & 0x07) {
215  case 0:
216  c->fec_inner = FEC_1_2;
217  break;
218  case 1:
219  c->fec_inner = FEC_3_5;
220  break;
221  case 2:
222  c->fec_inner = FEC_2_3;
223  break;
224  case 3:
225  c->fec_inner = FEC_3_4;
226  break;
227  case 4:
228  c->fec_inner = FEC_4_5;
229  break;
230  case 5:
231  c->fec_inner = FEC_5_6;
232  break;
233  }
234 
235  switch ((buf[1] >> 0) & 0x07) {
236  case 0:
237  c->modulation = QPSK;
238  break;
239  case 1:
240  c->modulation = QAM_16;
241  break;
242  case 2:
243  c->modulation = QAM_64;
244  break;
245  case 3:
246  c->modulation = QAM_256;
247  break;
248  }
249 
250  ret = cxd2820r_rd_reg(priv, 0x020b5, &buf[0]);
251  if (ret)
252  goto error;
253 
254  switch ((buf[0] >> 4) & 0x01) {
255  case 0:
257  break;
258  case 1:
259  c->inversion = INVERSION_ON;
260  break;
261  }
262 
263  return ret;
264 error:
265  dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
266  return ret;
267 }
268 
270 {
271  struct cxd2820r_priv *priv = fe->demodulator_priv;
272  int ret;
273  u8 buf[1];
274  *status = 0;
275 
276  ret = cxd2820r_rd_reg(priv, 0x02010 , &buf[0]);
277  if (ret)
278  goto error;
279 
280  if ((buf[0] & 0x07) == 6) {
281  if (((buf[0] >> 5) & 0x01) == 1) {
282  *status |= FE_HAS_SIGNAL | FE_HAS_CARRIER |
284  } else {
285  *status |= FE_HAS_SIGNAL | FE_HAS_CARRIER |
287  }
288  }
289 
290  dev_dbg(&priv->i2c->dev, "%s: lock=%02x\n", __func__, buf[0]);
291 
292  return ret;
293 error:
294  dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
295  return ret;
296 }
297 
299 {
300  struct cxd2820r_priv *priv = fe->demodulator_priv;
301  int ret;
302  u8 buf[4];
303  unsigned int errbits;
304  *ber = 0;
305  /* FIXME: correct calculation */
306 
307  ret = cxd2820r_rd_regs(priv, 0x02039, buf, sizeof(buf));
308  if (ret)
309  goto error;
310 
311  if ((buf[0] >> 4) & 0x01) {
312  errbits = (buf[0] & 0x0f) << 24 | buf[1] << 16 |
313  buf[2] << 8 | buf[3];
314 
315  if (errbits)
316  *ber = errbits * 64 / 16588800;
317  }
318 
319  return ret;
320 error:
321  dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
322  return ret;
323 }
324 
326  u16 *strength)
327 {
328  struct cxd2820r_priv *priv = fe->demodulator_priv;
329  int ret;
330  u8 buf[2];
331  u16 tmp;
332 
333  ret = cxd2820r_rd_regs(priv, 0x02026, buf, sizeof(buf));
334  if (ret)
335  goto error;
336 
337  tmp = (buf[0] & 0x0f) << 8 | buf[1];
338  tmp = ~tmp & 0x0fff;
339 
340  /* scale value to 0x0000-0xffff from 0x0000-0x0fff */
341  *strength = tmp * 0xffff / 0x0fff;
342 
343  return ret;
344 error:
345  dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
346  return ret;
347 }
348 
350 {
351  struct cxd2820r_priv *priv = fe->demodulator_priv;
352  int ret;
353  u8 buf[2];
354  u16 tmp;
355  /* report SNR in dB * 10 */
356 
357  ret = cxd2820r_rd_regs(priv, 0x02028, buf, sizeof(buf));
358  if (ret)
359  goto error;
360 
361  tmp = (buf[0] & 0x0f) << 8 | buf[1];
362  #define CXD2820R_LOG10_8_24 15151336 /* log10(8) << 24 */
363  if (tmp)
364  *snr = (intlog10(tmp) - CXD2820R_LOG10_8_24) / ((1 << 24)
365  / 100);
366  else
367  *snr = 0;
368 
369  dev_dbg(&priv->i2c->dev, "%s: dBx10=%d val=%04x\n", __func__, *snr,
370  tmp);
371 
372  return ret;
373 error:
374  dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
375  return ret;
376 }
377 
379 {
380  *ucblocks = 0;
381  /* no way to read ? */
382  return 0;
383 }
384 
386 {
387  struct cxd2820r_priv *priv = fe->demodulator_priv;
388  int ret, i;
389  struct reg_val_mask tab[] = {
390  { 0x000ff, 0x1f, 0xff },
391  { 0x00085, 0x00, 0xff },
392  { 0x00088, 0x01, 0xff },
393  { 0x02069, 0x00, 0xff },
394  { 0x00081, 0x00, 0xff },
395  { 0x00080, 0x00, 0xff },
396  };
397 
398  dev_dbg(&priv->i2c->dev, "%s\n", __func__);
399 
400  for (i = 0; i < ARRAY_SIZE(tab); i++) {
401  ret = cxd2820r_wr_reg_mask(priv, tab[i].reg, tab[i].val,
402  tab[i].mask);
403  if (ret)
404  goto error;
405  }
406 
408 
409  return ret;
410 error:
411  dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
412  return ret;
413 }
414 
417 {
418  s->min_delay_ms = 1500;
419  s->step_size = fe->ops.info.frequency_stepsize * 2;
420  s->max_drift = (fe->ops.info.frequency_stepsize * 2) + 1;
421 
422  return 0;
423 }