1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * Realtek RTL2830 DVB-T demodulator driver
4 *
5 * Copyright (C) 2011 Antti Palosaari <crope@iki.fi>
6 */
7
8 #include "rtl2830_priv.h"
9
10 /* Our regmap is bypassing I2C adapter lock, thus we do it! */
rtl2830_bulk_write(struct i2c_client * client,unsigned int reg,const void * val,size_t val_count)11 static int rtl2830_bulk_write(struct i2c_client *client, unsigned int reg,
12 const void *val, size_t val_count)
13 {
14 struct rtl2830_dev *dev = i2c_get_clientdata(client);
15 int ret;
16
17 i2c_lock_bus(client->adapter, I2C_LOCK_SEGMENT);
18 ret = regmap_bulk_write(dev->regmap, reg, val, val_count);
19 i2c_unlock_bus(client->adapter, I2C_LOCK_SEGMENT);
20 return ret;
21 }
22
rtl2830_update_bits(struct i2c_client * client,unsigned int reg,unsigned int mask,unsigned int val)23 static int rtl2830_update_bits(struct i2c_client *client, unsigned int reg,
24 unsigned int mask, unsigned int val)
25 {
26 struct rtl2830_dev *dev = i2c_get_clientdata(client);
27 int ret;
28
29 i2c_lock_bus(client->adapter, I2C_LOCK_SEGMENT);
30 ret = regmap_update_bits(dev->regmap, reg, mask, val);
31 i2c_unlock_bus(client->adapter, I2C_LOCK_SEGMENT);
32 return ret;
33 }
34
rtl2830_bulk_read(struct i2c_client * client,unsigned int reg,void * val,size_t val_count)35 static int rtl2830_bulk_read(struct i2c_client *client, unsigned int reg,
36 void *val, size_t val_count)
37 {
38 struct rtl2830_dev *dev = i2c_get_clientdata(client);
39 int ret;
40
41 i2c_lock_bus(client->adapter, I2C_LOCK_SEGMENT);
42 ret = regmap_bulk_read(dev->regmap, reg, val, val_count);
43 i2c_unlock_bus(client->adapter, I2C_LOCK_SEGMENT);
44 return ret;
45 }
46
rtl2830_init(struct dvb_frontend * fe)47 static int rtl2830_init(struct dvb_frontend *fe)
48 {
49 struct i2c_client *client = fe->demodulator_priv;
50 struct rtl2830_dev *dev = i2c_get_clientdata(client);
51 struct dtv_frontend_properties *c = &dev->fe.dtv_property_cache;
52 int ret, i;
53 struct rtl2830_reg_val_mask tab[] = {
54 {0x00d, 0x01, 0x03},
55 {0x00d, 0x10, 0x10},
56 {0x104, 0x00, 0x1e},
57 {0x105, 0x80, 0x80},
58 {0x110, 0x02, 0x03},
59 {0x110, 0x08, 0x0c},
60 {0x17b, 0x00, 0x40},
61 {0x17d, 0x05, 0x0f},
62 {0x17d, 0x50, 0xf0},
63 {0x18c, 0x08, 0x0f},
64 {0x18d, 0x00, 0xc0},
65 {0x188, 0x05, 0x0f},
66 {0x189, 0x00, 0xfc},
67 {0x2d5, 0x02, 0x02},
68 {0x2f1, 0x02, 0x06},
69 {0x2f1, 0x20, 0xf8},
70 {0x16d, 0x00, 0x01},
71 {0x1a6, 0x00, 0x80},
72 {0x106, dev->pdata->vtop, 0x3f},
73 {0x107, dev->pdata->krf, 0x3f},
74 {0x112, 0x28, 0xff},
75 {0x103, dev->pdata->agc_targ_val, 0xff},
76 {0x00a, 0x02, 0x07},
77 {0x140, 0x0c, 0x3c},
78 {0x140, 0x40, 0xc0},
79 {0x15b, 0x05, 0x07},
80 {0x15b, 0x28, 0x38},
81 {0x15c, 0x05, 0x07},
82 {0x15c, 0x28, 0x38},
83 {0x115, dev->pdata->spec_inv, 0x01},
84 {0x16f, 0x01, 0x07},
85 {0x170, 0x18, 0x38},
86 {0x172, 0x0f, 0x0f},
87 {0x173, 0x08, 0x38},
88 {0x175, 0x01, 0x07},
89 {0x176, 0x00, 0xc0},
90 };
91
92 for (i = 0; i < ARRAY_SIZE(tab); i++) {
93 ret = rtl2830_update_bits(client, tab[i].reg, tab[i].mask,
94 tab[i].val);
95 if (ret)
96 goto err;
97 }
98
99 ret = rtl2830_bulk_write(client, 0x18f, "\x28\x00", 2);
100 if (ret)
101 goto err;
102
103 ret = rtl2830_bulk_write(client, 0x195,
104 "\x04\x06\x0a\x12\x0a\x12\x1e\x28", 8);
105 if (ret)
106 goto err;
107
108 /* TODO: spec init */
109
110 /* soft reset */
111 ret = rtl2830_update_bits(client, 0x101, 0x04, 0x04);
112 if (ret)
113 goto err;
114
115 ret = rtl2830_update_bits(client, 0x101, 0x04, 0x00);
116 if (ret)
117 goto err;
118
119 /* init stats here in order signal app which stats are supported */
120 c->strength.len = 1;
121 c->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
122 c->cnr.len = 1;
123 c->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
124 c->post_bit_error.len = 1;
125 c->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
126 c->post_bit_count.len = 1;
127 c->post_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
128
129 dev->sleeping = false;
130
131 return ret;
132 err:
133 dev_dbg(&client->dev, "failed=%d\n", ret);
134 return ret;
135 }
136
rtl2830_sleep(struct dvb_frontend * fe)137 static int rtl2830_sleep(struct dvb_frontend *fe)
138 {
139 struct i2c_client *client = fe->demodulator_priv;
140 struct rtl2830_dev *dev = i2c_get_clientdata(client);
141
142 dev->sleeping = true;
143 dev->fe_status = 0;
144
145 return 0;
146 }
147
rtl2830_get_tune_settings(struct dvb_frontend * fe,struct dvb_frontend_tune_settings * s)148 static int rtl2830_get_tune_settings(struct dvb_frontend *fe,
149 struct dvb_frontend_tune_settings *s)
150 {
151 s->min_delay_ms = 500;
152 s->step_size = fe->ops.info.frequency_stepsize_hz * 2;
153 s->max_drift = (fe->ops.info.frequency_stepsize_hz * 2) + 1;
154
155 return 0;
156 }
157
rtl2830_set_frontend(struct dvb_frontend * fe)158 static int rtl2830_set_frontend(struct dvb_frontend *fe)
159 {
160 struct i2c_client *client = fe->demodulator_priv;
161 struct rtl2830_dev *dev = i2c_get_clientdata(client);
162 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
163 int ret, i;
164 u64 num;
165 u8 buf[3], u8tmp;
166 u32 if_ctl, if_frequency;
167 static const u8 bw_params1[3][34] = {
168 {
169 0x1f, 0xf0, 0x1f, 0xf0, 0x1f, 0xfa, 0x00, 0x17, 0x00, 0x41,
170 0x00, 0x64, 0x00, 0x67, 0x00, 0x38, 0x1f, 0xde, 0x1f, 0x7a,
171 0x1f, 0x47, 0x1f, 0x7c, 0x00, 0x30, 0x01, 0x4b, 0x02, 0x82,
172 0x03, 0x73, 0x03, 0xcf, /* 6 MHz */
173 }, {
174 0x1f, 0xfa, 0x1f, 0xda, 0x1f, 0xc1, 0x1f, 0xb3, 0x1f, 0xca,
175 0x00, 0x07, 0x00, 0x4d, 0x00, 0x6d, 0x00, 0x40, 0x1f, 0xca,
176 0x1f, 0x4d, 0x1f, 0x2a, 0x1f, 0xb2, 0x00, 0xec, 0x02, 0x7e,
177 0x03, 0xd0, 0x04, 0x53, /* 7 MHz */
178 }, {
179 0x00, 0x10, 0x00, 0x0e, 0x1f, 0xf7, 0x1f, 0xc9, 0x1f, 0xa0,
180 0x1f, 0xa6, 0x1f, 0xec, 0x00, 0x4e, 0x00, 0x7d, 0x00, 0x3a,
181 0x1f, 0x98, 0x1f, 0x10, 0x1f, 0x40, 0x00, 0x75, 0x02, 0x5f,
182 0x04, 0x24, 0x04, 0xdb, /* 8 MHz */
183 },
184 };
185 static const u8 bw_params2[3][6] = {
186 {0xc3, 0x0c, 0x44, 0x33, 0x33, 0x30}, /* 6 MHz */
187 {0xb8, 0xe3, 0x93, 0x99, 0x99, 0x98}, /* 7 MHz */
188 {0xae, 0xba, 0xf3, 0x26, 0x66, 0x64}, /* 8 MHz */
189 };
190
191 dev_dbg(&client->dev, "frequency=%u bandwidth_hz=%u inversion=%u\n",
192 c->frequency, c->bandwidth_hz, c->inversion);
193
194 /* program tuner */
195 if (fe->ops.tuner_ops.set_params)
196 fe->ops.tuner_ops.set_params(fe);
197
198 switch (c->bandwidth_hz) {
199 case 6000000:
200 i = 0;
201 break;
202 case 7000000:
203 i = 1;
204 break;
205 case 8000000:
206 i = 2;
207 break;
208 default:
209 dev_err(&client->dev, "invalid bandwidth_hz %u\n",
210 c->bandwidth_hz);
211 return -EINVAL;
212 }
213
214 ret = rtl2830_update_bits(client, 0x008, 0x06, i << 1);
215 if (ret)
216 goto err;
217
218 /* program if frequency */
219 if (fe->ops.tuner_ops.get_if_frequency)
220 ret = fe->ops.tuner_ops.get_if_frequency(fe, &if_frequency);
221 else
222 ret = -EINVAL;
223 if (ret)
224 goto err;
225
226 num = if_frequency % dev->pdata->clk;
227 num *= 0x400000;
228 num = div_u64(num, dev->pdata->clk);
229 num = -num;
230 if_ctl = num & 0x3fffff;
231 dev_dbg(&client->dev, "if_frequency=%d if_ctl=%08x\n",
232 if_frequency, if_ctl);
233
234 buf[0] = (if_ctl >> 16) & 0x3f;
235 buf[1] = (if_ctl >> 8) & 0xff;
236 buf[2] = (if_ctl >> 0) & 0xff;
237
238 ret = rtl2830_bulk_read(client, 0x119, &u8tmp, 1);
239 if (ret)
240 goto err;
241
242 buf[0] |= u8tmp & 0xc0; /* [7:6] */
243
244 ret = rtl2830_bulk_write(client, 0x119, buf, 3);
245 if (ret)
246 goto err;
247
248 /* 1/2 split I2C write */
249 ret = rtl2830_bulk_write(client, 0x11c, &bw_params1[i][0], 17);
250 if (ret)
251 goto err;
252
253 /* 2/2 split I2C write */
254 ret = rtl2830_bulk_write(client, 0x12d, &bw_params1[i][17], 17);
255 if (ret)
256 goto err;
257
258 ret = rtl2830_bulk_write(client, 0x19d, bw_params2[i], 6);
259 if (ret)
260 goto err;
261
262 return ret;
263 err:
264 dev_dbg(&client->dev, "failed=%d\n", ret);
265 return ret;
266 }
267
rtl2830_get_frontend(struct dvb_frontend * fe,struct dtv_frontend_properties * c)268 static int rtl2830_get_frontend(struct dvb_frontend *fe,
269 struct dtv_frontend_properties *c)
270 {
271 struct i2c_client *client = fe->demodulator_priv;
272 struct rtl2830_dev *dev = i2c_get_clientdata(client);
273 int ret;
274 u8 buf[3];
275
276 if (dev->sleeping)
277 return 0;
278
279 ret = rtl2830_bulk_read(client, 0x33c, buf, 2);
280 if (ret)
281 goto err;
282
283 ret = rtl2830_bulk_read(client, 0x351, &buf[2], 1);
284 if (ret)
285 goto err;
286
287 dev_dbg(&client->dev, "TPS=%*ph\n", 3, buf);
288
289 switch ((buf[0] >> 2) & 3) {
290 case 0:
291 c->modulation = QPSK;
292 break;
293 case 1:
294 c->modulation = QAM_16;
295 break;
296 case 2:
297 c->modulation = QAM_64;
298 break;
299 }
300
301 switch ((buf[2] >> 2) & 1) {
302 case 0:
303 c->transmission_mode = TRANSMISSION_MODE_2K;
304 break;
305 case 1:
306 c->transmission_mode = TRANSMISSION_MODE_8K;
307 }
308
309 switch ((buf[2] >> 0) & 3) {
310 case 0:
311 c->guard_interval = GUARD_INTERVAL_1_32;
312 break;
313 case 1:
314 c->guard_interval = GUARD_INTERVAL_1_16;
315 break;
316 case 2:
317 c->guard_interval = GUARD_INTERVAL_1_8;
318 break;
319 case 3:
320 c->guard_interval = GUARD_INTERVAL_1_4;
321 break;
322 }
323
324 switch ((buf[0] >> 4) & 7) {
325 case 0:
326 c->hierarchy = HIERARCHY_NONE;
327 break;
328 case 1:
329 c->hierarchy = HIERARCHY_1;
330 break;
331 case 2:
332 c->hierarchy = HIERARCHY_2;
333 break;
334 case 3:
335 c->hierarchy = HIERARCHY_4;
336 break;
337 }
338
339 switch ((buf[1] >> 3) & 7) {
340 case 0:
341 c->code_rate_HP = FEC_1_2;
342 break;
343 case 1:
344 c->code_rate_HP = FEC_2_3;
345 break;
346 case 2:
347 c->code_rate_HP = FEC_3_4;
348 break;
349 case 3:
350 c->code_rate_HP = FEC_5_6;
351 break;
352 case 4:
353 c->code_rate_HP = FEC_7_8;
354 break;
355 }
356
357 switch ((buf[1] >> 0) & 7) {
358 case 0:
359 c->code_rate_LP = FEC_1_2;
360 break;
361 case 1:
362 c->code_rate_LP = FEC_2_3;
363 break;
364 case 2:
365 c->code_rate_LP = FEC_3_4;
366 break;
367 case 3:
368 c->code_rate_LP = FEC_5_6;
369 break;
370 case 4:
371 c->code_rate_LP = FEC_7_8;
372 break;
373 }
374
375 return 0;
376 err:
377 dev_dbg(&client->dev, "failed=%d\n", ret);
378 return ret;
379 }
380
rtl2830_read_status(struct dvb_frontend * fe,enum fe_status * status)381 static int rtl2830_read_status(struct dvb_frontend *fe, enum fe_status *status)
382 {
383 struct i2c_client *client = fe->demodulator_priv;
384 struct rtl2830_dev *dev = i2c_get_clientdata(client);
385 struct dtv_frontend_properties *c = &dev->fe.dtv_property_cache;
386 int ret, stmp;
387 unsigned int utmp;
388 u8 u8tmp, buf[2];
389
390 *status = 0;
391
392 if (dev->sleeping)
393 return 0;
394
395 ret = rtl2830_bulk_read(client, 0x351, &u8tmp, 1);
396 if (ret)
397 goto err;
398
399 u8tmp = (u8tmp >> 3) & 0x0f; /* [6:3] */
400 if (u8tmp == 11) {
401 *status |= FE_HAS_SIGNAL | FE_HAS_CARRIER |
402 FE_HAS_VITERBI | FE_HAS_SYNC | FE_HAS_LOCK;
403 } else if (u8tmp == 10) {
404 *status |= FE_HAS_SIGNAL | FE_HAS_CARRIER |
405 FE_HAS_VITERBI;
406 }
407
408 dev->fe_status = *status;
409
410 /* Signal strength */
411 if (dev->fe_status & FE_HAS_SIGNAL) {
412 /* Read IF AGC */
413 ret = rtl2830_bulk_read(client, 0x359, buf, 2);
414 if (ret)
415 goto err;
416
417 stmp = buf[0] << 8 | buf[1] << 0;
418 stmp = sign_extend32(stmp, 13);
419 utmp = clamp_val(-4 * stmp + 32767, 0x0000, 0xffff);
420
421 dev_dbg(&client->dev, "IF AGC=%d\n", stmp);
422
423 c->strength.stat[0].scale = FE_SCALE_RELATIVE;
424 c->strength.stat[0].uvalue = utmp;
425 } else {
426 c->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
427 }
428
429 /* CNR */
430 if (dev->fe_status & FE_HAS_VITERBI) {
431 unsigned int hierarchy, constellation;
432 #define CONSTELLATION_NUM 3
433 #define HIERARCHY_NUM 4
434 static const u32 constant[CONSTELLATION_NUM][HIERARCHY_NUM] = {
435 {70705899, 70705899, 70705899, 70705899},
436 {82433173, 82433173, 87483115, 94445660},
437 {92888734, 92888734, 95487525, 99770748},
438 };
439
440 ret = rtl2830_bulk_read(client, 0x33c, &u8tmp, 1);
441 if (ret)
442 goto err;
443
444 constellation = (u8tmp >> 2) & 0x03; /* [3:2] */
445 if (constellation > CONSTELLATION_NUM - 1)
446 goto err;
447
448 hierarchy = (u8tmp >> 4) & 0x07; /* [6:4] */
449 if (hierarchy > HIERARCHY_NUM - 1)
450 goto err;
451
452 ret = rtl2830_bulk_read(client, 0x40c, buf, 2);
453 if (ret)
454 goto err;
455
456 utmp = buf[0] << 8 | buf[1] << 0;
457 if (utmp)
458 stmp = (constant[constellation][hierarchy] -
459 intlog10(utmp)) / ((1 << 24) / 10000);
460 else
461 stmp = 0;
462
463 dev_dbg(&client->dev, "CNR raw=%u\n", utmp);
464
465 c->cnr.stat[0].scale = FE_SCALE_DECIBEL;
466 c->cnr.stat[0].svalue = stmp;
467 } else {
468 c->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
469 }
470
471 /* BER */
472 if (dev->fe_status & FE_HAS_LOCK) {
473 ret = rtl2830_bulk_read(client, 0x34e, buf, 2);
474 if (ret)
475 goto err;
476
477 utmp = buf[0] << 8 | buf[1] << 0;
478 dev->post_bit_error += utmp;
479 dev->post_bit_count += 1000000;
480
481 dev_dbg(&client->dev, "BER errors=%u total=1000000\n", utmp);
482
483 c->post_bit_error.stat[0].scale = FE_SCALE_COUNTER;
484 c->post_bit_error.stat[0].uvalue = dev->post_bit_error;
485 c->post_bit_count.stat[0].scale = FE_SCALE_COUNTER;
486 c->post_bit_count.stat[0].uvalue = dev->post_bit_count;
487 } else {
488 c->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
489 c->post_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
490 }
491
492
493 return ret;
494 err:
495 dev_dbg(&client->dev, "failed=%d\n", ret);
496 return ret;
497 }
498
rtl2830_read_snr(struct dvb_frontend * fe,u16 * snr)499 static int rtl2830_read_snr(struct dvb_frontend *fe, u16 *snr)
500 {
501 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
502
503 if (c->cnr.stat[0].scale == FE_SCALE_DECIBEL)
504 *snr = div_s64(c->cnr.stat[0].svalue, 100);
505 else
506 *snr = 0;
507
508 return 0;
509 }
510
rtl2830_read_ber(struct dvb_frontend * fe,u32 * ber)511 static int rtl2830_read_ber(struct dvb_frontend *fe, u32 *ber)
512 {
513 struct i2c_client *client = fe->demodulator_priv;
514 struct rtl2830_dev *dev = i2c_get_clientdata(client);
515
516 *ber = (dev->post_bit_error - dev->post_bit_error_prev);
517 dev->post_bit_error_prev = dev->post_bit_error;
518
519 return 0;
520 }
521
rtl2830_read_ucblocks(struct dvb_frontend * fe,u32 * ucblocks)522 static int rtl2830_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks)
523 {
524 *ucblocks = 0;
525
526 return 0;
527 }
528
rtl2830_read_signal_strength(struct dvb_frontend * fe,u16 * strength)529 static int rtl2830_read_signal_strength(struct dvb_frontend *fe, u16 *strength)
530 {
531 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
532
533 if (c->strength.stat[0].scale == FE_SCALE_RELATIVE)
534 *strength = c->strength.stat[0].uvalue;
535 else
536 *strength = 0;
537
538 return 0;
539 }
540
541 static const struct dvb_frontend_ops rtl2830_ops = {
542 .delsys = {SYS_DVBT},
543 .info = {
544 .name = "Realtek RTL2830 (DVB-T)",
545 .caps = FE_CAN_FEC_1_2 |
546 FE_CAN_FEC_2_3 |
547 FE_CAN_FEC_3_4 |
548 FE_CAN_FEC_5_6 |
549 FE_CAN_FEC_7_8 |
550 FE_CAN_FEC_AUTO |
551 FE_CAN_QPSK |
552 FE_CAN_QAM_16 |
553 FE_CAN_QAM_64 |
554 FE_CAN_QAM_AUTO |
555 FE_CAN_TRANSMISSION_MODE_AUTO |
556 FE_CAN_GUARD_INTERVAL_AUTO |
557 FE_CAN_HIERARCHY_AUTO |
558 FE_CAN_RECOVER |
559 FE_CAN_MUTE_TS
560 },
561
562 .init = rtl2830_init,
563 .sleep = rtl2830_sleep,
564
565 .get_tune_settings = rtl2830_get_tune_settings,
566
567 .set_frontend = rtl2830_set_frontend,
568 .get_frontend = rtl2830_get_frontend,
569
570 .read_status = rtl2830_read_status,
571 .read_snr = rtl2830_read_snr,
572 .read_ber = rtl2830_read_ber,
573 .read_ucblocks = rtl2830_read_ucblocks,
574 .read_signal_strength = rtl2830_read_signal_strength,
575 };
576
rtl2830_pid_filter_ctrl(struct dvb_frontend * fe,int onoff)577 static int rtl2830_pid_filter_ctrl(struct dvb_frontend *fe, int onoff)
578 {
579 struct i2c_client *client = fe->demodulator_priv;
580 int ret;
581 u8 u8tmp;
582
583 dev_dbg(&client->dev, "onoff=%d\n", onoff);
584
585 /* enable / disable PID filter */
586 if (onoff)
587 u8tmp = 0x80;
588 else
589 u8tmp = 0x00;
590
591 ret = rtl2830_update_bits(client, 0x061, 0x80, u8tmp);
592 if (ret)
593 goto err;
594
595 return 0;
596 err:
597 dev_dbg(&client->dev, "failed=%d\n", ret);
598 return ret;
599 }
600
rtl2830_pid_filter(struct dvb_frontend * fe,u8 index,u16 pid,int onoff)601 static int rtl2830_pid_filter(struct dvb_frontend *fe, u8 index, u16 pid, int onoff)
602 {
603 struct i2c_client *client = fe->demodulator_priv;
604 struct rtl2830_dev *dev = i2c_get_clientdata(client);
605 int ret;
606 u8 buf[4];
607
608 dev_dbg(&client->dev, "index=%d pid=%04x onoff=%d\n",
609 index, pid, onoff);
610
611 /* skip invalid PIDs (0x2000) */
612 if (pid > 0x1fff || index >= 32)
613 return 0;
614
615 if (onoff)
616 set_bit(index, &dev->filters);
617 else
618 clear_bit(index, &dev->filters);
619
620 /* enable / disable PIDs */
621 buf[0] = (dev->filters >> 0) & 0xff;
622 buf[1] = (dev->filters >> 8) & 0xff;
623 buf[2] = (dev->filters >> 16) & 0xff;
624 buf[3] = (dev->filters >> 24) & 0xff;
625 ret = rtl2830_bulk_write(client, 0x062, buf, 4);
626 if (ret)
627 goto err;
628
629 /* add PID */
630 buf[0] = (pid >> 8) & 0xff;
631 buf[1] = (pid >> 0) & 0xff;
632 ret = rtl2830_bulk_write(client, 0x066 + 2 * index, buf, 2);
633 if (ret)
634 goto err;
635
636 return 0;
637 err:
638 dev_dbg(&client->dev, "failed=%d\n", ret);
639 return ret;
640 }
641
642 /*
643 * I2C gate/mux/repeater logic
644 * We must use unlocked __i2c_transfer() here (through regmap) because of I2C
645 * adapter lock is already taken by tuner driver.
646 * Gate is closed automatically after single I2C transfer.
647 */
rtl2830_select(struct i2c_mux_core * muxc,u32 chan_id)648 static int rtl2830_select(struct i2c_mux_core *muxc, u32 chan_id)
649 {
650 struct i2c_client *client = i2c_mux_priv(muxc);
651 struct rtl2830_dev *dev = i2c_get_clientdata(client);
652 int ret;
653
654 dev_dbg(&client->dev, "\n");
655
656 /* open I2C repeater for 1 transfer, closes automatically */
657 /* XXX: regmap_update_bits() does not lock I2C adapter */
658 ret = regmap_update_bits(dev->regmap, 0x101, 0x08, 0x08);
659 if (ret)
660 goto err;
661
662 return 0;
663 err:
664 dev_dbg(&client->dev, "failed=%d\n", ret);
665 return ret;
666 }
667
rtl2830_get_dvb_frontend(struct i2c_client * client)668 static struct dvb_frontend *rtl2830_get_dvb_frontend(struct i2c_client *client)
669 {
670 struct rtl2830_dev *dev = i2c_get_clientdata(client);
671
672 dev_dbg(&client->dev, "\n");
673
674 return &dev->fe;
675 }
676
rtl2830_get_i2c_adapter(struct i2c_client * client)677 static struct i2c_adapter *rtl2830_get_i2c_adapter(struct i2c_client *client)
678 {
679 struct rtl2830_dev *dev = i2c_get_clientdata(client);
680
681 dev_dbg(&client->dev, "\n");
682
683 return dev->muxc->adapter[0];
684 }
685
686 /*
687 * We implement own I2C access routines for regmap in order to get manual access
688 * to I2C adapter lock, which is needed for I2C mux adapter.
689 */
rtl2830_regmap_read(void * context,const void * reg_buf,size_t reg_size,void * val_buf,size_t val_size)690 static int rtl2830_regmap_read(void *context, const void *reg_buf,
691 size_t reg_size, void *val_buf, size_t val_size)
692 {
693 struct i2c_client *client = context;
694 int ret;
695 struct i2c_msg msg[2] = {
696 {
697 .addr = client->addr,
698 .flags = 0,
699 .len = reg_size,
700 .buf = (u8 *)reg_buf,
701 }, {
702 .addr = client->addr,
703 .flags = I2C_M_RD,
704 .len = val_size,
705 .buf = val_buf,
706 }
707 };
708
709 ret = __i2c_transfer(client->adapter, msg, 2);
710 if (ret != 2) {
711 dev_warn(&client->dev, "i2c reg read failed %d\n", ret);
712 if (ret >= 0)
713 ret = -EREMOTEIO;
714 return ret;
715 }
716 return 0;
717 }
718
rtl2830_regmap_write(void * context,const void * data,size_t count)719 static int rtl2830_regmap_write(void *context, const void *data, size_t count)
720 {
721 struct i2c_client *client = context;
722 int ret;
723 struct i2c_msg msg[1] = {
724 {
725 .addr = client->addr,
726 .flags = 0,
727 .len = count,
728 .buf = (u8 *)data,
729 }
730 };
731
732 ret = __i2c_transfer(client->adapter, msg, 1);
733 if (ret != 1) {
734 dev_warn(&client->dev, "i2c reg write failed %d\n", ret);
735 if (ret >= 0)
736 ret = -EREMOTEIO;
737 return ret;
738 }
739 return 0;
740 }
741
rtl2830_regmap_gather_write(void * context,const void * reg,size_t reg_len,const void * val,size_t val_len)742 static int rtl2830_regmap_gather_write(void *context, const void *reg,
743 size_t reg_len, const void *val,
744 size_t val_len)
745 {
746 struct i2c_client *client = context;
747 int ret;
748 u8 buf[256];
749 struct i2c_msg msg[1] = {
750 {
751 .addr = client->addr,
752 .flags = 0,
753 .len = 1 + val_len,
754 .buf = buf,
755 }
756 };
757
758 buf[0] = *(u8 const *)reg;
759 memcpy(&buf[1], val, val_len);
760
761 ret = __i2c_transfer(client->adapter, msg, 1);
762 if (ret != 1) {
763 dev_warn(&client->dev, "i2c reg write failed %d\n", ret);
764 if (ret >= 0)
765 ret = -EREMOTEIO;
766 return ret;
767 }
768 return 0;
769 }
770
rtl2830_probe(struct i2c_client * client)771 static int rtl2830_probe(struct i2c_client *client)
772 {
773 struct rtl2830_platform_data *pdata = client->dev.platform_data;
774 struct rtl2830_dev *dev;
775 int ret;
776 u8 u8tmp;
777 static const struct regmap_bus regmap_bus = {
778 .read = rtl2830_regmap_read,
779 .write = rtl2830_regmap_write,
780 .gather_write = rtl2830_regmap_gather_write,
781 .val_format_endian_default = REGMAP_ENDIAN_NATIVE,
782 };
783 static const struct regmap_range_cfg regmap_range_cfg[] = {
784 {
785 .selector_reg = 0x00,
786 .selector_mask = 0xff,
787 .selector_shift = 0,
788 .window_start = 0,
789 .window_len = 0x100,
790 .range_min = 0 * 0x100,
791 .range_max = 5 * 0x100,
792 },
793 };
794 static const struct regmap_config regmap_config = {
795 .reg_bits = 8,
796 .val_bits = 8,
797 .max_register = 5 * 0x100,
798 .ranges = regmap_range_cfg,
799 .num_ranges = ARRAY_SIZE(regmap_range_cfg),
800 };
801
802 dev_dbg(&client->dev, "\n");
803
804 if (pdata == NULL) {
805 ret = -EINVAL;
806 goto err;
807 }
808
809 /* allocate memory for the internal state */
810 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
811 if (dev == NULL) {
812 ret = -ENOMEM;
813 goto err;
814 }
815
816 /* setup the state */
817 i2c_set_clientdata(client, dev);
818 dev->client = client;
819 dev->pdata = client->dev.platform_data;
820 dev->sleeping = true;
821 dev->regmap = regmap_init(&client->dev, ®map_bus, client,
822 ®map_config);
823 if (IS_ERR(dev->regmap)) {
824 ret = PTR_ERR(dev->regmap);
825 goto err_kfree;
826 }
827
828 /* check if the demod is there */
829 ret = rtl2830_bulk_read(client, 0x000, &u8tmp, 1);
830 if (ret)
831 goto err_regmap_exit;
832
833 /* create muxed i2c adapter for tuner */
834 dev->muxc = i2c_mux_alloc(client->adapter, &client->dev, 1, 0, 0,
835 rtl2830_select, NULL);
836 if (!dev->muxc) {
837 ret = -ENOMEM;
838 goto err_regmap_exit;
839 }
840 dev->muxc->priv = client;
841 ret = i2c_mux_add_adapter(dev->muxc, 0, 0, 0);
842 if (ret)
843 goto err_regmap_exit;
844
845 /* create dvb frontend */
846 memcpy(&dev->fe.ops, &rtl2830_ops, sizeof(dev->fe.ops));
847 dev->fe.demodulator_priv = client;
848
849 /* setup callbacks */
850 pdata->get_dvb_frontend = rtl2830_get_dvb_frontend;
851 pdata->get_i2c_adapter = rtl2830_get_i2c_adapter;
852 pdata->pid_filter = rtl2830_pid_filter;
853 pdata->pid_filter_ctrl = rtl2830_pid_filter_ctrl;
854
855 dev_info(&client->dev, "Realtek RTL2830 successfully attached\n");
856
857 return 0;
858 err_regmap_exit:
859 regmap_exit(dev->regmap);
860 err_kfree:
861 kfree(dev);
862 err:
863 dev_dbg(&client->dev, "failed=%d\n", ret);
864 return ret;
865 }
866
rtl2830_remove(struct i2c_client * client)867 static void rtl2830_remove(struct i2c_client *client)
868 {
869 struct rtl2830_dev *dev = i2c_get_clientdata(client);
870
871 dev_dbg(&client->dev, "\n");
872
873 i2c_mux_del_adapters(dev->muxc);
874 regmap_exit(dev->regmap);
875 kfree(dev);
876 }
877
878 static const struct i2c_device_id rtl2830_id_table[] = {
879 {"rtl2830", 0},
880 {}
881 };
882 MODULE_DEVICE_TABLE(i2c, rtl2830_id_table);
883
884 static struct i2c_driver rtl2830_driver = {
885 .driver = {
886 .name = "rtl2830",
887 .suppress_bind_attrs = true,
888 },
889 .probe = rtl2830_probe,
890 .remove = rtl2830_remove,
891 .id_table = rtl2830_id_table,
892 };
893
894 module_i2c_driver(rtl2830_driver);
895
896 MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>");
897 MODULE_DESCRIPTION("Realtek RTL2830 DVB-T demodulator driver");
898 MODULE_LICENSE("GPL");
899