objtool: Re-arrange validate_functions()
[linux-block.git] / drivers / media / usb / dvb-usb-v2 / rtl28xxu.c
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * Realtek RTL28xxU DVB USB driver
4  *
5  * Copyright (C) 2009 Antti Palosaari <crope@iki.fi>
6  * Copyright (C) 2011 Antti Palosaari <crope@iki.fi>
7  * Copyright (C) 2012 Thomas Mair <thomas.mair86@googlemail.com>
8  */
9
10 #include "rtl28xxu.h"
11
12 static int rtl28xxu_disable_rc;
13 module_param_named(disable_rc, rtl28xxu_disable_rc, int, 0644);
14 MODULE_PARM_DESC(disable_rc, "disable RTL2832U remote controller");
15 DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
16
17 static int rtl28xxu_ctrl_msg(struct dvb_usb_device *d, struct rtl28xxu_req *req)
18 {
19         struct rtl28xxu_dev *dev = d->priv;
20         int ret;
21         unsigned int pipe;
22         u8 requesttype;
23
24         mutex_lock(&d->usb_mutex);
25
26         if (req->size > sizeof(dev->buf)) {
27                 dev_err(&d->intf->dev, "too large message %u\n", req->size);
28                 ret = -EINVAL;
29                 goto err_mutex_unlock;
30         }
31
32         if (req->index & CMD_WR_FLAG) {
33                 /* write */
34                 memcpy(dev->buf, req->data, req->size);
35                 requesttype = (USB_TYPE_VENDOR | USB_DIR_OUT);
36                 pipe = usb_sndctrlpipe(d->udev, 0);
37         } else {
38                 /* read */
39                 requesttype = (USB_TYPE_VENDOR | USB_DIR_IN);
40                 pipe = usb_rcvctrlpipe(d->udev, 0);
41         }
42
43         ret = usb_control_msg(d->udev, pipe, 0, requesttype, req->value,
44                         req->index, dev->buf, req->size, 1000);
45         dvb_usb_dbg_usb_control_msg(d->udev, 0, requesttype, req->value,
46                         req->index, dev->buf, req->size);
47         if (ret < 0)
48                 goto err_mutex_unlock;
49
50         /* read request, copy returned data to return buf */
51         if (requesttype == (USB_TYPE_VENDOR | USB_DIR_IN))
52                 memcpy(req->data, dev->buf, req->size);
53
54         mutex_unlock(&d->usb_mutex);
55
56         return 0;
57 err_mutex_unlock:
58         mutex_unlock(&d->usb_mutex);
59         dev_dbg(&d->intf->dev, "failed=%d\n", ret);
60         return ret;
61 }
62
63 static int rtl28xxu_wr_regs(struct dvb_usb_device *d, u16 reg, u8 *val, int len)
64 {
65         struct rtl28xxu_req req;
66
67         if (reg < 0x3000)
68                 req.index = CMD_USB_WR;
69         else if (reg < 0x4000)
70                 req.index = CMD_SYS_WR;
71         else
72                 req.index = CMD_IR_WR;
73
74         req.value = reg;
75         req.size = len;
76         req.data = val;
77
78         return rtl28xxu_ctrl_msg(d, &req);
79 }
80
81 static int rtl28xxu_rd_regs(struct dvb_usb_device *d, u16 reg, u8 *val, int len)
82 {
83         struct rtl28xxu_req req;
84
85         if (reg < 0x3000)
86                 req.index = CMD_USB_RD;
87         else if (reg < 0x4000)
88                 req.index = CMD_SYS_RD;
89         else
90                 req.index = CMD_IR_RD;
91
92         req.value = reg;
93         req.size = len;
94         req.data = val;
95
96         return rtl28xxu_ctrl_msg(d, &req);
97 }
98
99 static int rtl28xxu_wr_reg(struct dvb_usb_device *d, u16 reg, u8 val)
100 {
101         return rtl28xxu_wr_regs(d, reg, &val, 1);
102 }
103
104 static int rtl28xxu_rd_reg(struct dvb_usb_device *d, u16 reg, u8 *val)
105 {
106         return rtl28xxu_rd_regs(d, reg, val, 1);
107 }
108
109 static int rtl28xxu_wr_reg_mask(struct dvb_usb_device *d, u16 reg, u8 val,
110                 u8 mask)
111 {
112         int ret;
113         u8 tmp;
114
115         /* no need for read if whole reg is written */
116         if (mask != 0xff) {
117                 ret = rtl28xxu_rd_reg(d, reg, &tmp);
118                 if (ret)
119                         return ret;
120
121                 val &= mask;
122                 tmp &= ~mask;
123                 val |= tmp;
124         }
125
126         return rtl28xxu_wr_reg(d, reg, val);
127 }
128
129 /* I2C */
130 static int rtl28xxu_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg msg[],
131         int num)
132 {
133         int ret;
134         struct dvb_usb_device *d = i2c_get_adapdata(adap);
135         struct rtl28xxu_dev *dev = d->priv;
136         struct rtl28xxu_req req;
137
138         /*
139          * It is not known which are real I2C bus xfer limits, but testing
140          * with RTL2831U + MT2060 gives max RD 24 and max WR 22 bytes.
141          * TODO: find out RTL2832U lens
142          */
143
144         /*
145          * I2C adapter logic looks rather complicated due to fact it handles
146          * three different access methods. Those methods are;
147          * 1) integrated demod access
148          * 2) old I2C access
149          * 3) new I2C access
150          *
151          * Used method is selected in order 1, 2, 3. Method 3 can handle all
152          * requests but there is two reasons why not use it always;
153          * 1) It is most expensive, usually two USB messages are needed
154          * 2) At least RTL2831U does not support it
155          *
156          * Method 3 is needed in case of I2C write+read (typical register read)
157          * where write is more than one byte.
158          */
159
160         if (mutex_lock_interruptible(&d->i2c_mutex) < 0)
161                 return -EAGAIN;
162
163         if (num == 2 && !(msg[0].flags & I2C_M_RD) &&
164                 (msg[1].flags & I2C_M_RD)) {
165                 if (msg[0].len > 24 || msg[1].len > 24) {
166                         /* TODO: check msg[0].len max */
167                         ret = -EOPNOTSUPP;
168                         goto err_mutex_unlock;
169                 } else if (msg[0].addr == 0x10) {
170                         /* method 1 - integrated demod */
171                         if (msg[0].buf[0] == 0x00) {
172                                 /* return demod page from driver cache */
173                                 msg[1].buf[0] = dev->page;
174                                 ret = 0;
175                         } else {
176                                 req.value = (msg[0].buf[0] << 8) | (msg[0].addr << 1);
177                                 req.index = CMD_DEMOD_RD | dev->page;
178                                 req.size = msg[1].len;
179                                 req.data = &msg[1].buf[0];
180                                 ret = rtl28xxu_ctrl_msg(d, &req);
181                         }
182                 } else if (msg[0].len < 2) {
183                         /* method 2 - old I2C */
184                         req.value = (msg[0].buf[0] << 8) | (msg[0].addr << 1);
185                         req.index = CMD_I2C_RD;
186                         req.size = msg[1].len;
187                         req.data = &msg[1].buf[0];
188                         ret = rtl28xxu_ctrl_msg(d, &req);
189                 } else {
190                         /* method 3 - new I2C */
191                         req.value = (msg[0].addr << 1);
192                         req.index = CMD_I2C_DA_WR;
193                         req.size = msg[0].len;
194                         req.data = msg[0].buf;
195                         ret = rtl28xxu_ctrl_msg(d, &req);
196                         if (ret)
197                                 goto err_mutex_unlock;
198
199                         req.value = (msg[0].addr << 1);
200                         req.index = CMD_I2C_DA_RD;
201                         req.size = msg[1].len;
202                         req.data = msg[1].buf;
203                         ret = rtl28xxu_ctrl_msg(d, &req);
204                 }
205         } else if (num == 1 && !(msg[0].flags & I2C_M_RD)) {
206                 if (msg[0].len > 22) {
207                         /* TODO: check msg[0].len max */
208                         ret = -EOPNOTSUPP;
209                         goto err_mutex_unlock;
210                 } else if (msg[0].addr == 0x10) {
211                         /* method 1 - integrated demod */
212                         if (msg[0].buf[0] == 0x00) {
213                                 /* save demod page for later demod access */
214                                 dev->page = msg[0].buf[1];
215                                 ret = 0;
216                         } else {
217                                 req.value = (msg[0].buf[0] << 8) |
218                                         (msg[0].addr << 1);
219                                 req.index = CMD_DEMOD_WR | dev->page;
220                                 req.size = msg[0].len-1;
221                                 req.data = &msg[0].buf[1];
222                                 ret = rtl28xxu_ctrl_msg(d, &req);
223                         }
224                 } else if ((msg[0].len < 23) && (!dev->new_i2c_write)) {
225                         /* method 2 - old I2C */
226                         req.value = (msg[0].buf[0] << 8) | (msg[0].addr << 1);
227                         req.index = CMD_I2C_WR;
228                         req.size = msg[0].len-1;
229                         req.data = &msg[0].buf[1];
230                         ret = rtl28xxu_ctrl_msg(d, &req);
231                 } else {
232                         /* method 3 - new I2C */
233                         req.value = (msg[0].addr << 1);
234                         req.index = CMD_I2C_DA_WR;
235                         req.size = msg[0].len;
236                         req.data = msg[0].buf;
237                         ret = rtl28xxu_ctrl_msg(d, &req);
238                 }
239         } else if (num == 1 && (msg[0].flags & I2C_M_RD)) {
240                 req.value = (msg[0].addr << 1);
241                 req.index = CMD_I2C_DA_RD;
242                 req.size = msg[0].len;
243                 req.data = msg[0].buf;
244                 ret = rtl28xxu_ctrl_msg(d, &req);
245         } else {
246                 ret = -EOPNOTSUPP;
247         }
248
249         /* Retry failed I2C messages */
250         if (ret == -EPIPE)
251                 ret = -EAGAIN;
252
253 err_mutex_unlock:
254         mutex_unlock(&d->i2c_mutex);
255
256         return ret ? ret : num;
257 }
258
259 static u32 rtl28xxu_i2c_func(struct i2c_adapter *adapter)
260 {
261         return I2C_FUNC_I2C;
262 }
263
264 static struct i2c_algorithm rtl28xxu_i2c_algo = {
265         .master_xfer   = rtl28xxu_i2c_xfer,
266         .functionality = rtl28xxu_i2c_func,
267 };
268
269 static int rtl2831u_read_config(struct dvb_usb_device *d)
270 {
271         struct rtl28xxu_dev *dev = d_to_priv(d);
272         int ret;
273         u8 buf[1];
274         /* open RTL2831U/RTL2830 I2C gate */
275         struct rtl28xxu_req req_gate_open = {0x0120, 0x0011, 0x0001, "\x08"};
276         /* tuner probes */
277         struct rtl28xxu_req req_mt2060 = {0x00c0, CMD_I2C_RD, 1, buf};
278         struct rtl28xxu_req req_qt1010 = {0x0fc4, CMD_I2C_RD, 1, buf};
279
280         dev_dbg(&d->intf->dev, "\n");
281
282         /*
283          * RTL2831U GPIOs
284          * =========================================================
285          * GPIO0 | tuner#0 | 0 off | 1 on  | MXL5005S (?)
286          * GPIO2 | LED     | 0 off | 1 on  |
287          * GPIO4 | tuner#1 | 0 on  | 1 off | MT2060
288          */
289
290         /* GPIO direction */
291         ret = rtl28xxu_wr_reg(d, SYS_GPIO_DIR, 0x0a);
292         if (ret)
293                 goto err;
294
295         /* enable as output GPIO0, GPIO2, GPIO4 */
296         ret = rtl28xxu_wr_reg(d, SYS_GPIO_OUT_EN, 0x15);
297         if (ret)
298                 goto err;
299
300         /*
301          * Probe used tuner. We need to know used tuner before demod attach
302          * since there is some demod params needed to set according to tuner.
303          */
304
305         /* demod needs some time to wake up */
306         msleep(20);
307
308         dev->tuner_name = "NONE";
309
310         /* open demod I2C gate */
311         ret = rtl28xxu_ctrl_msg(d, &req_gate_open);
312         if (ret)
313                 goto err;
314
315         /* check QT1010 ID(?) register; reg=0f val=2c */
316         ret = rtl28xxu_ctrl_msg(d, &req_qt1010);
317         if (ret == 0 && buf[0] == 0x2c) {
318                 dev->tuner = TUNER_RTL2830_QT1010;
319                 dev->tuner_name = "QT1010";
320                 goto found;
321         }
322
323         /* open demod I2C gate */
324         ret = rtl28xxu_ctrl_msg(d, &req_gate_open);
325         if (ret)
326                 goto err;
327
328         /* check MT2060 ID register; reg=00 val=63 */
329         ret = rtl28xxu_ctrl_msg(d, &req_mt2060);
330         if (ret == 0 && buf[0] == 0x63) {
331                 dev->tuner = TUNER_RTL2830_MT2060;
332                 dev->tuner_name = "MT2060";
333                 goto found;
334         }
335
336         /* assume MXL5005S */
337         dev->tuner = TUNER_RTL2830_MXL5005S;
338         dev->tuner_name = "MXL5005S";
339         goto found;
340
341 found:
342         dev_dbg(&d->intf->dev, "tuner=%s\n", dev->tuner_name);
343
344         return 0;
345 err:
346         dev_dbg(&d->intf->dev, "failed=%d\n", ret);
347         return ret;
348 }
349
350 static int rtl2832u_read_config(struct dvb_usb_device *d)
351 {
352         struct rtl28xxu_dev *dev = d_to_priv(d);
353         int ret;
354         u8 buf[2];
355         /* open RTL2832U/RTL2832 I2C gate */
356         struct rtl28xxu_req req_gate_open = {0x0120, 0x0011, 0x0001, "\x18"};
357         /* close RTL2832U/RTL2832 I2C gate */
358         struct rtl28xxu_req req_gate_close = {0x0120, 0x0011, 0x0001, "\x10"};
359         /* tuner probes */
360         struct rtl28xxu_req req_fc0012 = {0x00c6, CMD_I2C_RD, 1, buf};
361         struct rtl28xxu_req req_fc0013 = {0x00c6, CMD_I2C_RD, 1, buf};
362         struct rtl28xxu_req req_mt2266 = {0x00c0, CMD_I2C_RD, 1, buf};
363         struct rtl28xxu_req req_fc2580 = {0x01ac, CMD_I2C_RD, 1, buf};
364         struct rtl28xxu_req req_mt2063 = {0x00c0, CMD_I2C_RD, 1, buf};
365         struct rtl28xxu_req req_max3543 = {0x00c0, CMD_I2C_RD, 1, buf};
366         struct rtl28xxu_req req_tua9001 = {0x7ec0, CMD_I2C_RD, 2, buf};
367         struct rtl28xxu_req req_mxl5007t = {0xd9c0, CMD_I2C_RD, 1, buf};
368         struct rtl28xxu_req req_e4000 = {0x02c8, CMD_I2C_RD, 1, buf};
369         struct rtl28xxu_req req_tda18272 = {0x00c0, CMD_I2C_RD, 2, buf};
370         struct rtl28xxu_req req_r820t = {0x0034, CMD_I2C_RD, 1, buf};
371         struct rtl28xxu_req req_r828d = {0x0074, CMD_I2C_RD, 1, buf};
372         struct rtl28xxu_req req_mn88472 = {0xff38, CMD_I2C_RD, 1, buf};
373         struct rtl28xxu_req req_mn88473 = {0xff38, CMD_I2C_RD, 1, buf};
374         struct rtl28xxu_req req_cxd2837er = {0xfdd8, CMD_I2C_RD, 1, buf};
375         struct rtl28xxu_req req_si2157 = {0x00c0, CMD_I2C_RD, 1, buf};
376         struct rtl28xxu_req req_si2168 = {0x00c8, CMD_I2C_RD, 1, buf};
377
378         dev_dbg(&d->intf->dev, "\n");
379
380         /* enable GPIO3 and GPIO6 as output */
381         ret = rtl28xxu_wr_reg_mask(d, SYS_GPIO_DIR, 0x00, 0x40);
382         if (ret)
383                 goto err;
384
385         ret = rtl28xxu_wr_reg_mask(d, SYS_GPIO_OUT_EN, 0x48, 0x48);
386         if (ret)
387                 goto err;
388
389         /*
390          * Probe used tuner. We need to know used tuner before demod attach
391          * since there is some demod params needed to set according to tuner.
392          */
393
394         /* open demod I2C gate */
395         ret = rtl28xxu_ctrl_msg(d, &req_gate_open);
396         if (ret)
397                 goto err;
398
399         dev->tuner_name = "NONE";
400
401         /* check FC0012 ID register; reg=00 val=a1 */
402         ret = rtl28xxu_ctrl_msg(d, &req_fc0012);
403         if (ret == 0 && buf[0] == 0xa1) {
404                 dev->tuner = TUNER_RTL2832_FC0012;
405                 dev->tuner_name = "FC0012";
406                 goto tuner_found;
407         }
408
409         /* check FC0013 ID register; reg=00 val=a3 */
410         ret = rtl28xxu_ctrl_msg(d, &req_fc0013);
411         if (ret == 0 && buf[0] == 0xa3) {
412                 dev->tuner = TUNER_RTL2832_FC0013;
413                 dev->tuner_name = "FC0013";
414                 goto tuner_found;
415         }
416
417         /* check MT2266 ID register; reg=00 val=85 */
418         ret = rtl28xxu_ctrl_msg(d, &req_mt2266);
419         if (ret == 0 && buf[0] == 0x85) {
420                 dev->tuner = TUNER_RTL2832_MT2266;
421                 dev->tuner_name = "MT2266";
422                 goto tuner_found;
423         }
424
425         /* check FC2580 ID register; reg=01 val=56 */
426         ret = rtl28xxu_ctrl_msg(d, &req_fc2580);
427         if (ret == 0 && buf[0] == 0x56) {
428                 dev->tuner = TUNER_RTL2832_FC2580;
429                 dev->tuner_name = "FC2580";
430                 goto tuner_found;
431         }
432
433         /* check MT2063 ID register; reg=00 val=9e || 9c */
434         ret = rtl28xxu_ctrl_msg(d, &req_mt2063);
435         if (ret == 0 && (buf[0] == 0x9e || buf[0] == 0x9c)) {
436                 dev->tuner = TUNER_RTL2832_MT2063;
437                 dev->tuner_name = "MT2063";
438                 goto tuner_found;
439         }
440
441         /* check MAX3543 ID register; reg=00 val=38 */
442         ret = rtl28xxu_ctrl_msg(d, &req_max3543);
443         if (ret == 0 && buf[0] == 0x38) {
444                 dev->tuner = TUNER_RTL2832_MAX3543;
445                 dev->tuner_name = "MAX3543";
446                 goto tuner_found;
447         }
448
449         /* check TUA9001 ID register; reg=7e val=2328 */
450         ret = rtl28xxu_ctrl_msg(d, &req_tua9001);
451         if (ret == 0 && buf[0] == 0x23 && buf[1] == 0x28) {
452                 dev->tuner = TUNER_RTL2832_TUA9001;
453                 dev->tuner_name = "TUA9001";
454                 goto tuner_found;
455         }
456
457         /* check MXL5007R ID register; reg=d9 val=14 */
458         ret = rtl28xxu_ctrl_msg(d, &req_mxl5007t);
459         if (ret == 0 && buf[0] == 0x14) {
460                 dev->tuner = TUNER_RTL2832_MXL5007T;
461                 dev->tuner_name = "MXL5007T";
462                 goto tuner_found;
463         }
464
465         /* check E4000 ID register; reg=02 val=40 */
466         ret = rtl28xxu_ctrl_msg(d, &req_e4000);
467         if (ret == 0 && buf[0] == 0x40) {
468                 dev->tuner = TUNER_RTL2832_E4000;
469                 dev->tuner_name = "E4000";
470                 goto tuner_found;
471         }
472
473         /* check TDA18272 ID register; reg=00 val=c760  */
474         ret = rtl28xxu_ctrl_msg(d, &req_tda18272);
475         if (ret == 0 && (buf[0] == 0xc7 || buf[1] == 0x60)) {
476                 dev->tuner = TUNER_RTL2832_TDA18272;
477                 dev->tuner_name = "TDA18272";
478                 goto tuner_found;
479         }
480
481         /* check R820T ID register; reg=00 val=69 */
482         ret = rtl28xxu_ctrl_msg(d, &req_r820t);
483         if (ret == 0 && buf[0] == 0x69) {
484                 dev->tuner = TUNER_RTL2832_R820T;
485                 dev->tuner_name = "R820T";
486                 goto tuner_found;
487         }
488
489         /* check R828D ID register; reg=00 val=69 */
490         ret = rtl28xxu_ctrl_msg(d, &req_r828d);
491         if (ret == 0 && buf[0] == 0x69) {
492                 dev->tuner = TUNER_RTL2832_R828D;
493                 dev->tuner_name = "R828D";
494                 goto tuner_found;
495         }
496
497         /* GPIO0 and GPIO5 to reset Si2157/Si2168 tuner and demod */
498         ret = rtl28xxu_wr_reg_mask(d, SYS_GPIO_OUT_VAL, 0x00, 0x21);
499         if (ret)
500                 goto err;
501
502         ret = rtl28xxu_wr_reg_mask(d, SYS_GPIO_OUT_EN, 0x00, 0x21);
503         if (ret)
504                 goto err;
505
506         msleep(50);
507
508         ret = rtl28xxu_wr_reg_mask(d, SYS_GPIO_OUT_VAL, 0x21, 0x21);
509         if (ret)
510                 goto err;
511
512         ret = rtl28xxu_wr_reg_mask(d, SYS_GPIO_OUT_EN, 0x21, 0x21);
513         if (ret)
514                 goto err;
515
516         msleep(50);
517
518         /* check Si2157 ID register; reg=c0 val=80 */
519         ret = rtl28xxu_ctrl_msg(d, &req_si2157);
520         if (ret == 0 && ((buf[0] & 0x80) == 0x80)) {
521                 dev->tuner = TUNER_RTL2832_SI2157;
522                 dev->tuner_name = "SI2157";
523                 goto tuner_found;
524         }
525
526 tuner_found:
527         dev_dbg(&d->intf->dev, "tuner=%s\n", dev->tuner_name);
528
529         /* probe slave demod */
530         if (dev->tuner == TUNER_RTL2832_R828D) {
531                 /* power off slave demod on GPIO0 to reset CXD2837ER */
532                 ret = rtl28xxu_wr_reg_mask(d, SYS_GPIO_OUT_VAL, 0x00, 0x01);
533                 if (ret)
534                         goto err;
535
536                 ret = rtl28xxu_wr_reg_mask(d, SYS_GPIO_OUT_EN, 0x00, 0x01);
537                 if (ret)
538                         goto err;
539
540                 msleep(50);
541
542                 /* power on slave demod on GPIO0 */
543                 ret = rtl28xxu_wr_reg_mask(d, SYS_GPIO_OUT_VAL, 0x01, 0x01);
544                 if (ret)
545                         goto err;
546
547                 ret = rtl28xxu_wr_reg_mask(d, SYS_GPIO_DIR, 0x00, 0x01);
548                 if (ret)
549                         goto err;
550
551                 ret = rtl28xxu_wr_reg_mask(d, SYS_GPIO_OUT_EN, 0x01, 0x01);
552                 if (ret)
553                         goto err;
554
555                 /* check slave answers */
556                 ret = rtl28xxu_ctrl_msg(d, &req_mn88472);
557                 if (ret == 0 && buf[0] == 0x02) {
558                         dev_dbg(&d->intf->dev, "MN88472 found\n");
559                         dev->slave_demod = SLAVE_DEMOD_MN88472;
560                         goto demod_found;
561                 }
562
563                 ret = rtl28xxu_ctrl_msg(d, &req_mn88473);
564                 if (ret == 0 && buf[0] == 0x03) {
565                         dev_dbg(&d->intf->dev, "MN88473 found\n");
566                         dev->slave_demod = SLAVE_DEMOD_MN88473;
567                         goto demod_found;
568                 }
569
570                 ret = rtl28xxu_ctrl_msg(d, &req_cxd2837er);
571                 if (ret == 0 && buf[0] == 0xb1) {
572                         dev_dbg(&d->intf->dev, "CXD2837ER found\n");
573                         dev->slave_demod = SLAVE_DEMOD_CXD2837ER;
574                         goto demod_found;
575                 }
576         }
577         if (dev->tuner == TUNER_RTL2832_SI2157) {
578                 /* check Si2168 ID register; reg=c8 val=80 */
579                 ret = rtl28xxu_ctrl_msg(d, &req_si2168);
580                 if (ret == 0 && ((buf[0] & 0x80) == 0x80)) {
581                         dev_dbg(&d->intf->dev, "Si2168 found\n");
582                         dev->slave_demod = SLAVE_DEMOD_SI2168;
583                         goto demod_found;
584                 }
585         }
586
587 demod_found:
588         /* close demod I2C gate */
589         ret = rtl28xxu_ctrl_msg(d, &req_gate_close);
590         if (ret < 0)
591                 goto err;
592
593         return 0;
594 err:
595         dev_dbg(&d->intf->dev, "failed=%d\n", ret);
596         return ret;
597 }
598
599 static int rtl28xxu_read_config(struct dvb_usb_device *d)
600 {
601         struct rtl28xxu_dev *dev = d_to_priv(d);
602
603         if (dev->chip_id == CHIP_ID_RTL2831U)
604                 return rtl2831u_read_config(d);
605         else
606                 return rtl2832u_read_config(d);
607 }
608
609 static int rtl28xxu_identify_state(struct dvb_usb_device *d, const char **name)
610 {
611         struct rtl28xxu_dev *dev = d_to_priv(d);
612         int ret;
613         struct rtl28xxu_req req_demod_i2c = {0x0020, CMD_I2C_DA_RD, 0, NULL};
614
615         dev_dbg(&d->intf->dev, "\n");
616
617         /*
618          * Detect chip type using I2C command that is not supported
619          * by old RTL2831U.
620          */
621         ret = rtl28xxu_ctrl_msg(d, &req_demod_i2c);
622         if (ret == -EPIPE) {
623                 dev->chip_id = CHIP_ID_RTL2831U;
624         } else if (ret == 0) {
625                 dev->chip_id = CHIP_ID_RTL2832U;
626         } else {
627                 dev_err(&d->intf->dev, "chip type detection failed %d\n", ret);
628                 goto err;
629         }
630         dev_dbg(&d->intf->dev, "chip_id=%u\n", dev->chip_id);
631
632         /* Retry failed I2C messages */
633         d->i2c_adap.retries = 3;
634         d->i2c_adap.timeout = msecs_to_jiffies(10);
635
636         return WARM;
637 err:
638         dev_dbg(&d->intf->dev, "failed=%d\n", ret);
639         return ret;
640 }
641
642 static const struct rtl2830_platform_data rtl2830_mt2060_platform_data = {
643         .clk = 28800000,
644         .spec_inv = 1,
645         .vtop = 0x20,
646         .krf = 0x04,
647         .agc_targ_val = 0x2d,
648
649 };
650
651 static const struct rtl2830_platform_data rtl2830_qt1010_platform_data = {
652         .clk = 28800000,
653         .spec_inv = 1,
654         .vtop = 0x20,
655         .krf = 0x04,
656         .agc_targ_val = 0x2d,
657 };
658
659 static const struct rtl2830_platform_data rtl2830_mxl5005s_platform_data = {
660         .clk = 28800000,
661         .spec_inv = 0,
662         .vtop = 0x3f,
663         .krf = 0x04,
664         .agc_targ_val = 0x3e,
665 };
666
667 static int rtl2831u_frontend_attach(struct dvb_usb_adapter *adap)
668 {
669         struct dvb_usb_device *d = adap_to_d(adap);
670         struct rtl28xxu_dev *dev = d_to_priv(d);
671         struct rtl2830_platform_data *pdata = &dev->rtl2830_platform_data;
672         struct i2c_board_info board_info;
673         struct i2c_client *client;
674         int ret;
675
676         dev_dbg(&d->intf->dev, "\n");
677
678         switch (dev->tuner) {
679         case TUNER_RTL2830_QT1010:
680                 *pdata = rtl2830_qt1010_platform_data;
681                 break;
682         case TUNER_RTL2830_MT2060:
683                 *pdata = rtl2830_mt2060_platform_data;
684                 break;
685         case TUNER_RTL2830_MXL5005S:
686                 *pdata = rtl2830_mxl5005s_platform_data;
687                 break;
688         default:
689                 dev_err(&d->intf->dev, "unknown tuner %s\n", dev->tuner_name);
690                 ret = -ENODEV;
691                 goto err;
692         }
693
694         /* attach demodulator */
695         memset(&board_info, 0, sizeof(board_info));
696         strscpy(board_info.type, "rtl2830", I2C_NAME_SIZE);
697         board_info.addr = 0x10;
698         board_info.platform_data = pdata;
699         request_module("%s", board_info.type);
700         client = i2c_new_client_device(&d->i2c_adap, &board_info);
701         if (!i2c_client_has_driver(client)) {
702                 ret = -ENODEV;
703                 goto err;
704         }
705
706         if (!try_module_get(client->dev.driver->owner)) {
707                 i2c_unregister_device(client);
708                 ret = -ENODEV;
709                 goto err;
710         }
711
712         adap->fe[0] = pdata->get_dvb_frontend(client);
713         dev->demod_i2c_adapter = pdata->get_i2c_adapter(client);
714
715         dev->i2c_client_demod = client;
716
717         return 0;
718 err:
719         dev_dbg(&d->intf->dev, "failed=%d\n", ret);
720         return ret;
721 }
722
723 static const struct rtl2832_platform_data rtl2832_fc2580_platform_data = {
724         .clk = 28800000,
725         .tuner = TUNER_RTL2832_FC2580,
726 };
727
728 static const struct rtl2832_platform_data rtl2832_fc0012_platform_data = {
729         .clk = 28800000,
730         .tuner = TUNER_RTL2832_FC0012
731 };
732
733 static const struct rtl2832_platform_data rtl2832_fc0013_platform_data = {
734         .clk = 28800000,
735         .tuner = TUNER_RTL2832_FC0013
736 };
737
738 static const struct rtl2832_platform_data rtl2832_tua9001_platform_data = {
739         .clk = 28800000,
740         .tuner = TUNER_RTL2832_TUA9001,
741 };
742
743 static const struct rtl2832_platform_data rtl2832_e4000_platform_data = {
744         .clk = 28800000,
745         .tuner = TUNER_RTL2832_E4000,
746 };
747
748 static const struct rtl2832_platform_data rtl2832_r820t_platform_data = {
749         .clk = 28800000,
750         .tuner = TUNER_RTL2832_R820T,
751 };
752
753 static const struct rtl2832_platform_data rtl2832_si2157_platform_data = {
754         .clk = 28800000,
755         .tuner = TUNER_RTL2832_SI2157,
756 };
757
758 static int rtl2832u_fc0012_tuner_callback(struct dvb_usb_device *d,
759                 int cmd, int arg)
760 {
761         int ret;
762         u8 val;
763
764         dev_dbg(&d->intf->dev, "cmd=%d arg=%d\n", cmd, arg);
765
766         switch (cmd) {
767         case FC_FE_CALLBACK_VHF_ENABLE:
768                 /* set output values */
769                 ret = rtl28xxu_rd_reg(d, SYS_GPIO_OUT_VAL, &val);
770                 if (ret)
771                         goto err;
772
773                 if (arg)
774                         val &= 0xbf; /* set GPIO6 low */
775                 else
776                         val |= 0x40; /* set GPIO6 high */
777
778
779                 ret = rtl28xxu_wr_reg(d, SYS_GPIO_OUT_VAL, val);
780                 if (ret)
781                         goto err;
782                 break;
783         default:
784                 ret = -EINVAL;
785                 goto err;
786         }
787         return 0;
788 err:
789         dev_dbg(&d->intf->dev, "failed=%d\n", ret);
790         return ret;
791 }
792
793 static int rtl2832u_tua9001_tuner_callback(struct dvb_usb_device *d,
794                 int cmd, int arg)
795 {
796         int ret;
797         u8 val;
798
799         dev_dbg(&d->intf->dev, "cmd=%d arg=%d\n", cmd, arg);
800
801         /*
802          * CEN     always enabled by hardware wiring
803          * RESETN  GPIO4
804          * RXEN    GPIO1
805          */
806
807         switch (cmd) {
808         case TUA9001_CMD_RESETN:
809                 if (arg)
810                         val = (1 << 4);
811                 else
812                         val = (0 << 4);
813
814                 ret = rtl28xxu_wr_reg_mask(d, SYS_GPIO_OUT_VAL, val, 0x10);
815                 if (ret)
816                         goto err;
817                 break;
818         case TUA9001_CMD_RXEN:
819                 if (arg)
820                         val = (1 << 1);
821                 else
822                         val = (0 << 1);
823
824                 ret = rtl28xxu_wr_reg_mask(d, SYS_GPIO_OUT_VAL, val, 0x02);
825                 if (ret)
826                         goto err;
827                 break;
828         }
829
830         return 0;
831 err:
832         dev_dbg(&d->intf->dev, "failed=%d\n", ret);
833         return ret;
834 }
835
836 static int rtl2832u_frontend_callback(void *adapter_priv, int component,
837                 int cmd, int arg)
838 {
839         struct i2c_adapter *adapter = adapter_priv;
840         struct device *parent = adapter->dev.parent;
841         struct i2c_adapter *parent_adapter;
842         struct dvb_usb_device *d;
843         struct rtl28xxu_dev *dev;
844
845         /*
846          * All tuners are connected to demod muxed I2C adapter. We have to
847          * resolve its parent adapter in order to get handle for this driver
848          * private data. That is a bit hackish solution, GPIO or direct driver
849          * callback would be better...
850          */
851         if (parent != NULL && parent->type == &i2c_adapter_type)
852                 parent_adapter = to_i2c_adapter(parent);
853         else
854                 return -EINVAL;
855
856         d = i2c_get_adapdata(parent_adapter);
857         dev = d->priv;
858
859         dev_dbg(&d->intf->dev, "component=%d cmd=%d arg=%d\n",
860                 component, cmd, arg);
861
862         switch (component) {
863         case DVB_FRONTEND_COMPONENT_TUNER:
864                 switch (dev->tuner) {
865                 case TUNER_RTL2832_FC0012:
866                         return rtl2832u_fc0012_tuner_callback(d, cmd, arg);
867                 case TUNER_RTL2832_TUA9001:
868                         return rtl2832u_tua9001_tuner_callback(d, cmd, arg);
869                 }
870         }
871
872         return 0;
873 }
874
875 static int rtl2832u_frontend_attach(struct dvb_usb_adapter *adap)
876 {
877         struct dvb_usb_device *d = adap_to_d(adap);
878         struct rtl28xxu_dev *dev = d_to_priv(d);
879         struct rtl2832_platform_data *pdata = &dev->rtl2832_platform_data;
880         struct i2c_board_info board_info;
881         struct i2c_client *client;
882         int ret;
883
884         dev_dbg(&d->intf->dev, "\n");
885
886         switch (dev->tuner) {
887         case TUNER_RTL2832_FC0012:
888                 *pdata = rtl2832_fc0012_platform_data;
889                 break;
890         case TUNER_RTL2832_FC0013:
891                 *pdata = rtl2832_fc0013_platform_data;
892                 break;
893         case TUNER_RTL2832_FC2580:
894                 *pdata = rtl2832_fc2580_platform_data;
895                 break;
896         case TUNER_RTL2832_TUA9001:
897                 *pdata = rtl2832_tua9001_platform_data;
898                 break;
899         case TUNER_RTL2832_E4000:
900                 *pdata = rtl2832_e4000_platform_data;
901                 break;
902         case TUNER_RTL2832_R820T:
903         case TUNER_RTL2832_R828D:
904                 *pdata = rtl2832_r820t_platform_data;
905                 break;
906         case TUNER_RTL2832_SI2157:
907                 *pdata = rtl2832_si2157_platform_data;
908                 break;
909         default:
910                 dev_err(&d->intf->dev, "unknown tuner %s\n", dev->tuner_name);
911                 ret = -ENODEV;
912                 goto err;
913         }
914
915         /* attach demodulator */
916         memset(&board_info, 0, sizeof(board_info));
917         strscpy(board_info.type, "rtl2832", I2C_NAME_SIZE);
918         board_info.addr = 0x10;
919         board_info.platform_data = pdata;
920         request_module("%s", board_info.type);
921         client = i2c_new_client_device(&d->i2c_adap, &board_info);
922         if (!i2c_client_has_driver(client)) {
923                 ret = -ENODEV;
924                 goto err;
925         }
926
927         if (!try_module_get(client->dev.driver->owner)) {
928                 i2c_unregister_device(client);
929                 ret = -ENODEV;
930                 goto err;
931         }
932
933         adap->fe[0] = pdata->get_dvb_frontend(client);
934         dev->demod_i2c_adapter = pdata->get_i2c_adapter(client);
935
936         dev->i2c_client_demod = client;
937
938         /* set fe callback */
939         adap->fe[0]->callback = rtl2832u_frontend_callback;
940
941         if (dev->slave_demod) {
942                 struct i2c_board_info info = {};
943
944                 /*
945                  * We continue on reduced mode, without DVB-T2/C, using master
946                  * demod, when slave demod fails.
947                  */
948                 ret = 0;
949
950                 /* attach slave demodulator */
951                 if (dev->slave_demod == SLAVE_DEMOD_MN88472) {
952                         struct mn88472_config mn88472_config = {};
953
954                         mn88472_config.fe = &adap->fe[1];
955                         mn88472_config.i2c_wr_max = 22,
956                         strscpy(info.type, "mn88472", I2C_NAME_SIZE);
957                         mn88472_config.xtal = 20500000;
958                         mn88472_config.ts_mode = SERIAL_TS_MODE;
959                         mn88472_config.ts_clock = VARIABLE_TS_CLOCK;
960                         info.addr = 0x18;
961                         info.platform_data = &mn88472_config;
962                         request_module(info.type);
963                         client = i2c_new_client_device(&d->i2c_adap, &info);
964                         if (!i2c_client_has_driver(client)) {
965                                 dev->slave_demod = SLAVE_DEMOD_NONE;
966                                 goto err_slave_demod_failed;
967                         }
968
969                         if (!try_module_get(client->dev.driver->owner)) {
970                                 i2c_unregister_device(client);
971                                 dev->slave_demod = SLAVE_DEMOD_NONE;
972                                 goto err_slave_demod_failed;
973                         }
974
975                         dev->i2c_client_slave_demod = client;
976                 } else if (dev->slave_demod == SLAVE_DEMOD_MN88473) {
977                         struct mn88473_config mn88473_config = {};
978
979                         mn88473_config.fe = &adap->fe[1];
980                         mn88473_config.i2c_wr_max = 22,
981                         strscpy(info.type, "mn88473", I2C_NAME_SIZE);
982                         info.addr = 0x18;
983                         info.platform_data = &mn88473_config;
984                         request_module(info.type);
985                         client = i2c_new_client_device(&d->i2c_adap, &info);
986                         if (!i2c_client_has_driver(client)) {
987                                 dev->slave_demod = SLAVE_DEMOD_NONE;
988                                 goto err_slave_demod_failed;
989                         }
990
991                         if (!try_module_get(client->dev.driver->owner)) {
992                                 i2c_unregister_device(client);
993                                 dev->slave_demod = SLAVE_DEMOD_NONE;
994                                 goto err_slave_demod_failed;
995                         }
996
997                         dev->i2c_client_slave_demod = client;
998                 } else if (dev->slave_demod == SLAVE_DEMOD_CXD2837ER) {
999                         struct cxd2841er_config cxd2837er_config = {};
1000
1001                         cxd2837er_config.i2c_addr = 0xd8;
1002                         cxd2837er_config.xtal = SONY_XTAL_20500;
1003                         cxd2837er_config.flags = (CXD2841ER_AUTO_IFHZ |
1004                                 CXD2841ER_NO_AGCNEG | CXD2841ER_TSBITS |
1005                                 CXD2841ER_EARLY_TUNE | CXD2841ER_TS_SERIAL);
1006                         adap->fe[1] = dvb_attach(cxd2841er_attach_t_c,
1007                                                  &cxd2837er_config,
1008                                                  &d->i2c_adap);
1009                         if (!adap->fe[1]) {
1010                                 dev->slave_demod = SLAVE_DEMOD_NONE;
1011                                 goto err_slave_demod_failed;
1012                         }
1013                         adap->fe[1]->id = 1;
1014                         dev->i2c_client_slave_demod = NULL;
1015                 } else {
1016                         struct si2168_config si2168_config = {};
1017                         struct i2c_adapter *adapter;
1018
1019                         si2168_config.i2c_adapter = &adapter;
1020                         si2168_config.fe = &adap->fe[1];
1021                         si2168_config.ts_mode = SI2168_TS_SERIAL;
1022                         si2168_config.ts_clock_inv = false;
1023                         si2168_config.ts_clock_gapped = true;
1024                         strscpy(info.type, "si2168", I2C_NAME_SIZE);
1025                         info.addr = 0x64;
1026                         info.platform_data = &si2168_config;
1027                         request_module(info.type);
1028                         client = i2c_new_client_device(&d->i2c_adap, &info);
1029                         if (!i2c_client_has_driver(client)) {
1030                                 dev->slave_demod = SLAVE_DEMOD_NONE;
1031                                 goto err_slave_demod_failed;
1032                         }
1033
1034                         if (!try_module_get(client->dev.driver->owner)) {
1035                                 i2c_unregister_device(client);
1036                                 dev->slave_demod = SLAVE_DEMOD_NONE;
1037                                 goto err_slave_demod_failed;
1038                         }
1039
1040                         dev->i2c_client_slave_demod = client;
1041
1042                         /* for Si2168 devices use only new I2C write method */
1043                         dev->new_i2c_write = true;
1044                 }
1045         }
1046         return 0;
1047 err_slave_demod_failed:
1048 err:
1049         dev_dbg(&d->intf->dev, "failed=%d\n", ret);
1050         return ret;
1051 }
1052
1053 static int rtl28xxu_frontend_attach(struct dvb_usb_adapter *adap)
1054 {
1055         struct rtl28xxu_dev *dev = adap_to_priv(adap);
1056
1057         if (dev->chip_id == CHIP_ID_RTL2831U)
1058                 return rtl2831u_frontend_attach(adap);
1059         else
1060                 return rtl2832u_frontend_attach(adap);
1061 }
1062
1063 static int rtl28xxu_frontend_detach(struct dvb_usb_adapter *adap)
1064 {
1065         struct dvb_usb_device *d = adap_to_d(adap);
1066         struct rtl28xxu_dev *dev = d_to_priv(d);
1067         struct i2c_client *client;
1068
1069         dev_dbg(&d->intf->dev, "\n");
1070
1071         /* remove I2C slave demod */
1072         client = dev->i2c_client_slave_demod;
1073         if (client) {
1074                 module_put(client->dev.driver->owner);
1075                 i2c_unregister_device(client);
1076         }
1077
1078         /* remove I2C demod */
1079         client = dev->i2c_client_demod;
1080         if (client) {
1081                 module_put(client->dev.driver->owner);
1082                 i2c_unregister_device(client);
1083         }
1084
1085         return 0;
1086 }
1087
1088 static struct qt1010_config rtl28xxu_qt1010_config = {
1089         .i2c_address = 0x62, /* 0xc4 */
1090 };
1091
1092 static struct mt2060_config rtl28xxu_mt2060_config = {
1093         .i2c_address = 0x60, /* 0xc0 */
1094         .clock_out = 0,
1095 };
1096
1097 static struct mxl5005s_config rtl28xxu_mxl5005s_config = {
1098         .i2c_address     = 0x63, /* 0xc6 */
1099         .if_freq         = IF_FREQ_4570000HZ,
1100         .xtal_freq       = CRYSTAL_FREQ_16000000HZ,
1101         .agc_mode        = MXL_SINGLE_AGC,
1102         .tracking_filter = MXL_TF_C_H,
1103         .rssi_enable     = MXL_RSSI_ENABLE,
1104         .cap_select      = MXL_CAP_SEL_ENABLE,
1105         .div_out         = MXL_DIV_OUT_4,
1106         .clock_out       = MXL_CLOCK_OUT_DISABLE,
1107         .output_load     = MXL5005S_IF_OUTPUT_LOAD_200_OHM,
1108         .top             = MXL5005S_TOP_25P2,
1109         .mod_mode        = MXL_DIGITAL_MODE,
1110         .if_mode         = MXL_ZERO_IF,
1111         .AgcMasterByte   = 0x00,
1112 };
1113
1114 static int rtl2831u_tuner_attach(struct dvb_usb_adapter *adap)
1115 {
1116         int ret;
1117         struct dvb_usb_device *d = adap_to_d(adap);
1118         struct rtl28xxu_dev *dev = d_to_priv(d);
1119         struct dvb_frontend *fe;
1120
1121         dev_dbg(&d->intf->dev, "\n");
1122
1123         switch (dev->tuner) {
1124         case TUNER_RTL2830_QT1010:
1125                 fe = dvb_attach(qt1010_attach, adap->fe[0],
1126                                 dev->demod_i2c_adapter,
1127                                 &rtl28xxu_qt1010_config);
1128                 break;
1129         case TUNER_RTL2830_MT2060:
1130                 fe = dvb_attach(mt2060_attach, adap->fe[0],
1131                                 dev->demod_i2c_adapter,
1132                                 &rtl28xxu_mt2060_config, 1220);
1133                 break;
1134         case TUNER_RTL2830_MXL5005S:
1135                 fe = dvb_attach(mxl5005s_attach, adap->fe[0],
1136                                 dev->demod_i2c_adapter,
1137                                 &rtl28xxu_mxl5005s_config);
1138                 break;
1139         default:
1140                 fe = NULL;
1141                 dev_err(&d->intf->dev, "unknown tuner %d\n", dev->tuner);
1142         }
1143
1144         if (fe == NULL) {
1145                 ret = -ENODEV;
1146                 goto err;
1147         }
1148
1149         return 0;
1150 err:
1151         dev_dbg(&d->intf->dev, "failed=%d\n", ret);
1152         return ret;
1153 }
1154
1155 static const struct fc0012_config rtl2832u_fc0012_config = {
1156         .i2c_address = 0x63, /* 0xc6 >> 1 */
1157         .xtal_freq = FC_XTAL_28_8_MHZ,
1158 };
1159
1160 static const struct r820t_config rtl2832u_r820t_config = {
1161         .i2c_addr = 0x1a,
1162         .xtal = 28800000,
1163         .max_i2c_msg_len = 2,
1164         .rafael_chip = CHIP_R820T,
1165 };
1166
1167 static const struct r820t_config rtl2832u_r828d_config = {
1168         .i2c_addr = 0x3a,
1169         .xtal = 16000000,
1170         .max_i2c_msg_len = 2,
1171         .rafael_chip = CHIP_R828D,
1172 };
1173
1174 static int rtl2832u_tuner_attach(struct dvb_usb_adapter *adap)
1175 {
1176         int ret;
1177         struct dvb_usb_device *d = adap_to_d(adap);
1178         struct rtl28xxu_dev *dev = d_to_priv(d);
1179         struct dvb_frontend *fe = NULL;
1180         struct i2c_board_info info;
1181         struct i2c_client *client;
1182         struct v4l2_subdev *subdev = NULL;
1183         struct platform_device *pdev;
1184         struct rtl2832_sdr_platform_data pdata;
1185
1186         dev_dbg(&d->intf->dev, "\n");
1187
1188         memset(&info, 0, sizeof(struct i2c_board_info));
1189         memset(&pdata, 0, sizeof(pdata));
1190
1191         switch (dev->tuner) {
1192         case TUNER_RTL2832_FC0012:
1193                 fe = dvb_attach(fc0012_attach, adap->fe[0],
1194                         dev->demod_i2c_adapter, &rtl2832u_fc0012_config);
1195
1196                 /* since fc0012 includs reading the signal strength delegate
1197                  * that to the tuner driver */
1198                 adap->fe[0]->ops.read_signal_strength =
1199                                 adap->fe[0]->ops.tuner_ops.get_rf_strength;
1200                 break;
1201         case TUNER_RTL2832_FC0013:
1202                 fe = dvb_attach(fc0013_attach, adap->fe[0],
1203                         dev->demod_i2c_adapter, 0xc6>>1, 0, FC_XTAL_28_8_MHZ);
1204
1205                 /* fc0013 also supports signal strength reading */
1206                 adap->fe[0]->ops.read_signal_strength =
1207                                 adap->fe[0]->ops.tuner_ops.get_rf_strength;
1208                 break;
1209         case TUNER_RTL2832_E4000: {
1210                         struct e4000_config e4000_config = {
1211                                 .fe = adap->fe[0],
1212                                 .clock = 28800000,
1213                         };
1214
1215                         strscpy(info.type, "e4000", I2C_NAME_SIZE);
1216                         info.addr = 0x64;
1217                         info.platform_data = &e4000_config;
1218
1219                         request_module(info.type);
1220                         client = i2c_new_client_device(dev->demod_i2c_adapter,
1221                                                        &info);
1222                         if (!i2c_client_has_driver(client))
1223                                 break;
1224
1225                         if (!try_module_get(client->dev.driver->owner)) {
1226                                 i2c_unregister_device(client);
1227                                 break;
1228                         }
1229
1230                         dev->i2c_client_tuner = client;
1231                         subdev = i2c_get_clientdata(client);
1232                 }
1233                 break;
1234         case TUNER_RTL2832_FC2580: {
1235                         struct fc2580_platform_data fc2580_pdata = {
1236                                 .dvb_frontend = adap->fe[0],
1237                         };
1238                         struct i2c_board_info board_info = {};
1239
1240                         strscpy(board_info.type, "fc2580", I2C_NAME_SIZE);
1241                         board_info.addr = 0x56;
1242                         board_info.platform_data = &fc2580_pdata;
1243                         request_module("fc2580");
1244                         client = i2c_new_client_device(dev->demod_i2c_adapter,
1245                                                        &board_info);
1246                         if (!i2c_client_has_driver(client))
1247                                 break;
1248                         if (!try_module_get(client->dev.driver->owner)) {
1249                                 i2c_unregister_device(client);
1250                                 break;
1251                         }
1252                         dev->i2c_client_tuner = client;
1253                         subdev = fc2580_pdata.get_v4l2_subdev(client);
1254                 }
1255                 break;
1256         case TUNER_RTL2832_TUA9001: {
1257                 struct tua9001_platform_data tua9001_pdata = {
1258                         .dvb_frontend = adap->fe[0],
1259                 };
1260                 struct i2c_board_info board_info = {};
1261
1262                 /* enable GPIO1 and GPIO4 as output */
1263                 ret = rtl28xxu_wr_reg_mask(d, SYS_GPIO_DIR, 0x00, 0x12);
1264                 if (ret)
1265                         goto err;
1266
1267                 ret = rtl28xxu_wr_reg_mask(d, SYS_GPIO_OUT_EN, 0x12, 0x12);
1268                 if (ret)
1269                         goto err;
1270
1271                 strscpy(board_info.type, "tua9001", I2C_NAME_SIZE);
1272                 board_info.addr = 0x60;
1273                 board_info.platform_data = &tua9001_pdata;
1274                 request_module("tua9001");
1275                 client = i2c_new_client_device(dev->demod_i2c_adapter,
1276                                                &board_info);
1277                 if (!i2c_client_has_driver(client))
1278                         break;
1279                 if (!try_module_get(client->dev.driver->owner)) {
1280                         i2c_unregister_device(client);
1281                         break;
1282                 }
1283                 dev->i2c_client_tuner = client;
1284                 break;
1285         }
1286         case TUNER_RTL2832_R820T:
1287                 fe = dvb_attach(r820t_attach, adap->fe[0],
1288                                 dev->demod_i2c_adapter,
1289                                 &rtl2832u_r820t_config);
1290
1291                 /* Use tuner to get the signal strength */
1292                 adap->fe[0]->ops.read_signal_strength =
1293                                 adap->fe[0]->ops.tuner_ops.get_rf_strength;
1294                 break;
1295         case TUNER_RTL2832_R828D:
1296                 fe = dvb_attach(r820t_attach, adap->fe[0],
1297                                 dev->demod_i2c_adapter,
1298                                 &rtl2832u_r828d_config);
1299                 adap->fe[0]->ops.read_signal_strength =
1300                                 adap->fe[0]->ops.tuner_ops.get_rf_strength;
1301
1302                 if (adap->fe[1]) {
1303                         fe = dvb_attach(r820t_attach, adap->fe[1],
1304                                         dev->demod_i2c_adapter,
1305                                         &rtl2832u_r828d_config);
1306                         adap->fe[1]->ops.read_signal_strength =
1307                                         adap->fe[1]->ops.tuner_ops.get_rf_strength;
1308                 }
1309                 break;
1310         case TUNER_RTL2832_SI2157: {
1311                         struct si2157_config si2157_config = {
1312                                 .fe = adap->fe[0],
1313                                 .if_port = 0,
1314                                 .inversion = false,
1315                         };
1316
1317                         strscpy(info.type, "si2157", I2C_NAME_SIZE);
1318                         info.addr = 0x60;
1319                         info.platform_data = &si2157_config;
1320                         request_module(info.type);
1321                         client = i2c_new_client_device(&d->i2c_adap, &info);
1322                         if (!i2c_client_has_driver(client))
1323                                 break;
1324
1325                         if (!try_module_get(client->dev.driver->owner)) {
1326                                 i2c_unregister_device(client);
1327                                 break;
1328                         }
1329
1330                         dev->i2c_client_tuner = client;
1331                         subdev = i2c_get_clientdata(client);
1332
1333                         /* copy tuner ops for 2nd FE as tuner is shared */
1334                         if (adap->fe[1]) {
1335                                 adap->fe[1]->tuner_priv =
1336                                                 adap->fe[0]->tuner_priv;
1337                                 memcpy(&adap->fe[1]->ops.tuner_ops,
1338                                                 &adap->fe[0]->ops.tuner_ops,
1339                                                 sizeof(struct dvb_tuner_ops));
1340                         }
1341                 }
1342                 break;
1343         default:
1344                 dev_err(&d->intf->dev, "unknown tuner %d\n", dev->tuner);
1345         }
1346         if (fe == NULL && dev->i2c_client_tuner == NULL) {
1347                 ret = -ENODEV;
1348                 goto err;
1349         }
1350
1351         /* register SDR */
1352         switch (dev->tuner) {
1353         case TUNER_RTL2832_FC2580:
1354         case TUNER_RTL2832_FC0012:
1355         case TUNER_RTL2832_FC0013:
1356         case TUNER_RTL2832_E4000:
1357         case TUNER_RTL2832_R820T:
1358         case TUNER_RTL2832_R828D:
1359                 pdata.clk = dev->rtl2832_platform_data.clk;
1360                 pdata.tuner = dev->tuner;
1361                 pdata.regmap = dev->rtl2832_platform_data.regmap;
1362                 pdata.dvb_frontend = adap->fe[0];
1363                 pdata.dvb_usb_device = d;
1364                 pdata.v4l2_subdev = subdev;
1365
1366                 request_module("%s", "rtl2832_sdr");
1367                 pdev = platform_device_register_data(&d->intf->dev,
1368                                                      "rtl2832_sdr",
1369                                                      PLATFORM_DEVID_AUTO,
1370                                                      &pdata, sizeof(pdata));
1371                 if (IS_ERR(pdev) || pdev->dev.driver == NULL)
1372                         break;
1373                 dev->platform_device_sdr = pdev;
1374                 break;
1375         default:
1376                 dev_dbg(&d->intf->dev, "no SDR for tuner=%d\n", dev->tuner);
1377         }
1378
1379         return 0;
1380 err:
1381         dev_dbg(&d->intf->dev, "failed=%d\n", ret);
1382         return ret;
1383 }
1384
1385 static int rtl28xxu_tuner_attach(struct dvb_usb_adapter *adap)
1386 {
1387         struct rtl28xxu_dev *dev = adap_to_priv(adap);
1388
1389         if (dev->chip_id == CHIP_ID_RTL2831U)
1390                 return rtl2831u_tuner_attach(adap);
1391         else
1392                 return rtl2832u_tuner_attach(adap);
1393 }
1394
1395 static int rtl28xxu_tuner_detach(struct dvb_usb_adapter *adap)
1396 {
1397         struct dvb_usb_device *d = adap_to_d(adap);
1398         struct rtl28xxu_dev *dev = d_to_priv(d);
1399         struct i2c_client *client;
1400         struct platform_device *pdev;
1401
1402         dev_dbg(&d->intf->dev, "\n");
1403
1404         /* remove platform SDR */
1405         pdev = dev->platform_device_sdr;
1406         if (pdev)
1407                 platform_device_unregister(pdev);
1408
1409         /* remove I2C tuner */
1410         client = dev->i2c_client_tuner;
1411         if (client) {
1412                 module_put(client->dev.driver->owner);
1413                 i2c_unregister_device(client);
1414         }
1415
1416         return 0;
1417 }
1418
1419 static int rtl28xxu_init(struct dvb_usb_device *d)
1420 {
1421         int ret;
1422         u8 val;
1423
1424         dev_dbg(&d->intf->dev, "\n");
1425
1426         /* init USB endpoints */
1427         ret = rtl28xxu_rd_reg(d, USB_SYSCTL_0, &val);
1428         if (ret)
1429                 goto err;
1430
1431         /* enable DMA and Full Packet Mode*/
1432         val |= 0x09;
1433         ret = rtl28xxu_wr_reg(d, USB_SYSCTL_0, val);
1434         if (ret)
1435                 goto err;
1436
1437         /* set EPA maximum packet size to 0x0200 */
1438         ret = rtl28xxu_wr_regs(d, USB_EPA_MAXPKT, "\x00\x02\x00\x00", 4);
1439         if (ret)
1440                 goto err;
1441
1442         /* change EPA FIFO length */
1443         ret = rtl28xxu_wr_regs(d, USB_EPA_FIFO_CFG, "\x14\x00\x00\x00", 4);
1444         if (ret)
1445                 goto err;
1446
1447         return ret;
1448 err:
1449         dev_dbg(&d->intf->dev, "failed=%d\n", ret);
1450         return ret;
1451 }
1452
1453 static int rtl2831u_power_ctrl(struct dvb_usb_device *d, int onoff)
1454 {
1455         int ret;
1456         u8 gpio, sys0, epa_ctl[2];
1457
1458         dev_dbg(&d->intf->dev, "onoff=%d\n", onoff);
1459
1460         /* demod adc */
1461         ret = rtl28xxu_rd_reg(d, SYS_SYS0, &sys0);
1462         if (ret)
1463                 goto err;
1464
1465         /* tuner power, read GPIOs */
1466         ret = rtl28xxu_rd_reg(d, SYS_GPIO_OUT_VAL, &gpio);
1467         if (ret)
1468                 goto err;
1469
1470         dev_dbg(&d->intf->dev, "RD SYS0=%02x GPIO_OUT_VAL=%02x\n", sys0, gpio);
1471
1472         if (onoff) {
1473                 gpio |= 0x01; /* GPIO0 = 1 */
1474                 gpio &= (~0x10); /* GPIO4 = 0 */
1475                 gpio |= 0x04; /* GPIO2 = 1, LED on */
1476                 sys0 = sys0 & 0x0f;
1477                 sys0 |= 0xe0;
1478                 epa_ctl[0] = 0x00; /* clear stall */
1479                 epa_ctl[1] = 0x00; /* clear reset */
1480         } else {
1481                 gpio &= (~0x01); /* GPIO0 = 0 */
1482                 gpio |= 0x10; /* GPIO4 = 1 */
1483                 gpio &= (~0x04); /* GPIO2 = 1, LED off */
1484                 sys0 = sys0 & (~0xc0);
1485                 epa_ctl[0] = 0x10; /* set stall */
1486                 epa_ctl[1] = 0x02; /* set reset */
1487         }
1488
1489         dev_dbg(&d->intf->dev, "WR SYS0=%02x GPIO_OUT_VAL=%02x\n", sys0, gpio);
1490
1491         /* demod adc */
1492         ret = rtl28xxu_wr_reg(d, SYS_SYS0, sys0);
1493         if (ret)
1494                 goto err;
1495
1496         /* tuner power, write GPIOs */
1497         ret = rtl28xxu_wr_reg(d, SYS_GPIO_OUT_VAL, gpio);
1498         if (ret)
1499                 goto err;
1500
1501         /* streaming EP: stall & reset */
1502         ret = rtl28xxu_wr_regs(d, USB_EPA_CTL, epa_ctl, 2);
1503         if (ret)
1504                 goto err;
1505
1506         if (onoff)
1507                 usb_clear_halt(d->udev, usb_rcvbulkpipe(d->udev, 0x81));
1508
1509         return ret;
1510 err:
1511         dev_dbg(&d->intf->dev, "failed=%d\n", ret);
1512         return ret;
1513 }
1514
1515 static int rtl2832u_power_ctrl(struct dvb_usb_device *d, int onoff)
1516 {
1517         int ret;
1518
1519         dev_dbg(&d->intf->dev, "onoff=%d\n", onoff);
1520
1521         if (onoff) {
1522                 /* GPIO3=1, GPIO4=0 */
1523                 ret = rtl28xxu_wr_reg_mask(d, SYS_GPIO_OUT_VAL, 0x08, 0x18);
1524                 if (ret)
1525                         goto err;
1526
1527                 /* suspend? */
1528                 ret = rtl28xxu_wr_reg_mask(d, SYS_DEMOD_CTL1, 0x00, 0x10);
1529                 if (ret)
1530                         goto err;
1531
1532                 /* enable PLL */
1533                 ret = rtl28xxu_wr_reg_mask(d, SYS_DEMOD_CTL, 0x80, 0x80);
1534                 if (ret)
1535                         goto err;
1536
1537                 /* disable reset */
1538                 ret = rtl28xxu_wr_reg_mask(d, SYS_DEMOD_CTL, 0x20, 0x20);
1539                 if (ret)
1540                         goto err;
1541
1542                 /* streaming EP: clear stall & reset */
1543                 ret = rtl28xxu_wr_regs(d, USB_EPA_CTL, "\x00\x00", 2);
1544                 if (ret)
1545                         goto err;
1546
1547                 ret = usb_clear_halt(d->udev, usb_rcvbulkpipe(d->udev, 0x81));
1548                 if (ret)
1549                         goto err;
1550         } else {
1551                 /* GPIO4=1 */
1552                 ret = rtl28xxu_wr_reg_mask(d, SYS_GPIO_OUT_VAL, 0x10, 0x10);
1553                 if (ret)
1554                         goto err;
1555
1556                 /* disable PLL */
1557                 ret = rtl28xxu_wr_reg_mask(d, SYS_DEMOD_CTL, 0x00, 0x80);
1558                 if (ret)
1559                         goto err;
1560
1561                 /* streaming EP: set stall & reset */
1562                 ret = rtl28xxu_wr_regs(d, USB_EPA_CTL, "\x10\x02", 2);
1563                 if (ret)
1564                         goto err;
1565         }
1566
1567         return ret;
1568 err:
1569         dev_dbg(&d->intf->dev, "failed=%d\n", ret);
1570         return ret;
1571 }
1572
1573 static int rtl28xxu_power_ctrl(struct dvb_usb_device *d, int onoff)
1574 {
1575         struct rtl28xxu_dev *dev = d_to_priv(d);
1576
1577         if (dev->chip_id == CHIP_ID_RTL2831U)
1578                 return rtl2831u_power_ctrl(d, onoff);
1579         else
1580                 return rtl2832u_power_ctrl(d, onoff);
1581 }
1582
1583 static int rtl28xxu_frontend_ctrl(struct dvb_frontend *fe, int onoff)
1584 {
1585         struct dvb_usb_device *d = fe_to_d(fe);
1586         struct rtl28xxu_dev *dev = fe_to_priv(fe);
1587         struct rtl2832_platform_data *pdata = &dev->rtl2832_platform_data;
1588         int ret;
1589         u8 val;
1590
1591         dev_dbg(&d->intf->dev, "fe=%d onoff=%d\n", fe->id, onoff);
1592
1593         if (dev->chip_id == CHIP_ID_RTL2831U)
1594                 return 0;
1595
1596         if (fe->id == 0) {
1597                 /* control internal demod ADC */
1598                 if (onoff)
1599                         val = 0x48; /* enable ADC */
1600                 else
1601                         val = 0x00; /* disable ADC */
1602
1603                 ret = rtl28xxu_wr_reg_mask(d, SYS_DEMOD_CTL, val, 0x48);
1604                 if (ret)
1605                         goto err;
1606         } else if (fe->id == 1) {
1607                 /* bypass slave demod TS through master demod */
1608                 ret = pdata->slave_ts_ctrl(dev->i2c_client_demod, onoff);
1609                 if (ret)
1610                         goto err;
1611         }
1612
1613         return 0;
1614 err:
1615         dev_dbg(&d->intf->dev, "failed=%d\n", ret);
1616         return ret;
1617 }
1618
1619 #if IS_ENABLED(CONFIG_RC_CORE)
1620 static int rtl2831u_rc_query(struct dvb_usb_device *d)
1621 {
1622         int ret, i;
1623         struct rtl28xxu_dev *dev = d->priv;
1624         u8 buf[5];
1625         u32 rc_code;
1626         static const struct rtl28xxu_reg_val rc_nec_tab[] = {
1627                 { 0x3033, 0x80 },
1628                 { 0x3020, 0x43 },
1629                 { 0x3021, 0x16 },
1630                 { 0x3022, 0x16 },
1631                 { 0x3023, 0x5a },
1632                 { 0x3024, 0x2d },
1633                 { 0x3025, 0x16 },
1634                 { 0x3026, 0x01 },
1635                 { 0x3028, 0xb0 },
1636                 { 0x3029, 0x04 },
1637                 { 0x302c, 0x88 },
1638                 { 0x302e, 0x13 },
1639                 { 0x3030, 0xdf },
1640                 { 0x3031, 0x05 },
1641         };
1642
1643         /* init remote controller */
1644         if (!dev->rc_active) {
1645                 for (i = 0; i < ARRAY_SIZE(rc_nec_tab); i++) {
1646                         ret = rtl28xxu_wr_reg(d, rc_nec_tab[i].reg,
1647                                         rc_nec_tab[i].val);
1648                         if (ret)
1649                                 goto err;
1650                 }
1651                 dev->rc_active = true;
1652         }
1653
1654         ret = rtl28xxu_rd_regs(d, SYS_IRRC_RP, buf, 5);
1655         if (ret)
1656                 goto err;
1657
1658         if (buf[4] & 0x01) {
1659                 enum rc_proto proto;
1660
1661                 if (buf[2] == (u8) ~buf[3]) {
1662                         if (buf[0] == (u8) ~buf[1]) {
1663                                 /* NEC standard (16 bit) */
1664                                 rc_code = RC_SCANCODE_NEC(buf[0], buf[2]);
1665                                 proto = RC_PROTO_NEC;
1666                         } else {
1667                                 /* NEC extended (24 bit) */
1668                                 rc_code = RC_SCANCODE_NECX(buf[0] << 8 | buf[1],
1669                                                            buf[2]);
1670                                 proto = RC_PROTO_NECX;
1671                         }
1672                 } else {
1673                         /* NEC full (32 bit) */
1674                         rc_code = RC_SCANCODE_NEC32(buf[0] << 24 | buf[1] << 16 |
1675                                                     buf[2] << 8  | buf[3]);
1676                         proto = RC_PROTO_NEC32;
1677                 }
1678
1679                 rc_keydown(d->rc_dev, proto, rc_code, 0);
1680
1681                 ret = rtl28xxu_wr_reg(d, SYS_IRRC_SR, 1);
1682                 if (ret)
1683                         goto err;
1684
1685                 /* repeated intentionally to avoid extra keypress */
1686                 ret = rtl28xxu_wr_reg(d, SYS_IRRC_SR, 1);
1687                 if (ret)
1688                         goto err;
1689         }
1690
1691         return ret;
1692 err:
1693         dev_dbg(&d->intf->dev, "failed=%d\n", ret);
1694         return ret;
1695 }
1696
1697 static int rtl2831u_get_rc_config(struct dvb_usb_device *d,
1698                 struct dvb_usb_rc *rc)
1699 {
1700         rc->map_name = RC_MAP_EMPTY;
1701         rc->allowed_protos = RC_PROTO_BIT_NEC | RC_PROTO_BIT_NECX |
1702                                                         RC_PROTO_BIT_NEC32;
1703         rc->query = rtl2831u_rc_query;
1704         rc->interval = 400;
1705
1706         return 0;
1707 }
1708
1709 static int rtl2832u_rc_query(struct dvb_usb_device *d)
1710 {
1711         int ret, i, len;
1712         struct rtl28xxu_dev *dev = d->priv;
1713         struct ir_raw_event ev = {};
1714         u8 buf[128];
1715         static const struct rtl28xxu_reg_val_mask refresh_tab[] = {
1716                 {IR_RX_IF,               0x03, 0xff},
1717                 {IR_RX_BUF_CTRL,         0x80, 0xff},
1718                 {IR_RX_CTRL,             0x80, 0xff},
1719         };
1720
1721         /* init remote controller */
1722         if (!dev->rc_active) {
1723                 static const struct rtl28xxu_reg_val_mask init_tab[] = {
1724                         {SYS_DEMOD_CTL1,         0x00, 0x04},
1725                         {SYS_DEMOD_CTL1,         0x00, 0x08},
1726                         {USB_CTRL,               0x20, 0x20},
1727                         {SYS_GPIO_DIR,           0x00, 0x08},
1728                         {SYS_GPIO_OUT_EN,        0x08, 0x08},
1729                         {SYS_GPIO_OUT_VAL,       0x08, 0x08},
1730                         {IR_MAX_DURATION0,       0xd0, 0xff},
1731                         {IR_MAX_DURATION1,       0x07, 0xff},
1732                         {IR_IDLE_LEN0,           0xc0, 0xff},
1733                         {IR_IDLE_LEN1,           0x00, 0xff},
1734                         {IR_GLITCH_LEN,          0x03, 0xff},
1735                         {IR_RX_CLK,              0x09, 0xff},
1736                         {IR_RX_CFG,              0x1c, 0xff},
1737                         {IR_MAX_H_TOL_LEN,       0x1e, 0xff},
1738                         {IR_MAX_L_TOL_LEN,       0x1e, 0xff},
1739                         {IR_RX_CTRL,             0x80, 0xff},
1740                 };
1741
1742                 for (i = 0; i < ARRAY_SIZE(init_tab); i++) {
1743                         ret = rtl28xxu_wr_reg_mask(d, init_tab[i].reg,
1744                                         init_tab[i].val, init_tab[i].mask);
1745                         if (ret)
1746                                 goto err;
1747                 }
1748
1749                 dev->rc_active = true;
1750         }
1751
1752         ret = rtl28xxu_rd_reg(d, IR_RX_IF, &buf[0]);
1753         if (ret)
1754                 goto err;
1755
1756         if (buf[0] != 0x83)
1757                 goto exit;
1758
1759         ret = rtl28xxu_rd_reg(d, IR_RX_BC, &buf[0]);
1760         if (ret || buf[0] > sizeof(buf))
1761                 goto err;
1762
1763         len = buf[0];
1764
1765         /* read raw code from hw */
1766         ret = rtl28xxu_rd_regs(d, IR_RX_BUF, buf, len);
1767         if (ret)
1768                 goto err;
1769
1770         /* let hw receive new code */
1771         for (i = 0; i < ARRAY_SIZE(refresh_tab); i++) {
1772                 ret = rtl28xxu_wr_reg_mask(d, refresh_tab[i].reg,
1773                                 refresh_tab[i].val, refresh_tab[i].mask);
1774                 if (ret)
1775                         goto err;
1776         }
1777
1778         /* pass data to Kernel IR decoder */
1779         for (i = 0; i < len; i++) {
1780                 ev.pulse = buf[i] >> 7;
1781                 ev.duration = 50800 * (buf[i] & 0x7f);
1782                 ir_raw_event_store_with_filter(d->rc_dev, &ev);
1783         }
1784
1785         /* 'flush' ir_raw_event_store_with_filter() */
1786         ir_raw_event_handle(d->rc_dev);
1787 exit:
1788         return ret;
1789 err:
1790         dev_dbg(&d->intf->dev, "failed=%d\n", ret);
1791         return ret;
1792 }
1793
1794 static int rtl2832u_get_rc_config(struct dvb_usb_device *d,
1795                 struct dvb_usb_rc *rc)
1796 {
1797         /* disable IR interrupts in order to avoid SDR sample loss */
1798         if (rtl28xxu_disable_rc)
1799                 return rtl28xxu_wr_reg(d, IR_RX_IE, 0x00);
1800
1801         /* load empty to enable rc */
1802         if (!rc->map_name)
1803                 rc->map_name = RC_MAP_EMPTY;
1804         rc->allowed_protos = RC_PROTO_BIT_ALL_IR_DECODER;
1805         rc->driver_type = RC_DRIVER_IR_RAW;
1806         rc->query = rtl2832u_rc_query;
1807         rc->interval = 200;
1808         /* we program idle len to 0xc0, set timeout to one less */
1809         rc->timeout = 0xbf * 50800;
1810
1811         return 0;
1812 }
1813
1814 static int rtl28xxu_get_rc_config(struct dvb_usb_device *d,
1815                 struct dvb_usb_rc *rc)
1816 {
1817         struct rtl28xxu_dev *dev = d_to_priv(d);
1818
1819         if (dev->chip_id == CHIP_ID_RTL2831U)
1820                 return rtl2831u_get_rc_config(d, rc);
1821         else
1822                 return rtl2832u_get_rc_config(d, rc);
1823 }
1824 #else
1825 #define rtl28xxu_get_rc_config NULL
1826 #endif
1827
1828 static int rtl28xxu_pid_filter_ctrl(struct dvb_usb_adapter *adap, int onoff)
1829 {
1830         struct rtl28xxu_dev *dev = adap_to_priv(adap);
1831
1832         if (dev->chip_id == CHIP_ID_RTL2831U) {
1833                 struct rtl2830_platform_data *pdata = &dev->rtl2830_platform_data;
1834
1835                 return pdata->pid_filter_ctrl(adap->fe[0], onoff);
1836         } else {
1837                 struct rtl2832_platform_data *pdata = &dev->rtl2832_platform_data;
1838
1839                 return pdata->pid_filter_ctrl(adap->fe[0], onoff);
1840         }
1841 }
1842
1843 static int rtl28xxu_pid_filter(struct dvb_usb_adapter *adap, int index,
1844                                u16 pid, int onoff)
1845 {
1846         struct rtl28xxu_dev *dev = adap_to_priv(adap);
1847
1848         if (dev->chip_id == CHIP_ID_RTL2831U) {
1849                 struct rtl2830_platform_data *pdata = &dev->rtl2830_platform_data;
1850
1851                 return pdata->pid_filter(adap->fe[0], index, pid, onoff);
1852         } else {
1853                 struct rtl2832_platform_data *pdata = &dev->rtl2832_platform_data;
1854
1855                 return pdata->pid_filter(adap->fe[0], index, pid, onoff);
1856         }
1857 }
1858
1859 static const struct dvb_usb_device_properties rtl28xxu_props = {
1860         .driver_name = KBUILD_MODNAME,
1861         .owner = THIS_MODULE,
1862         .adapter_nr = adapter_nr,
1863         .size_of_priv = sizeof(struct rtl28xxu_dev),
1864
1865         .identify_state = rtl28xxu_identify_state,
1866         .power_ctrl = rtl28xxu_power_ctrl,
1867         .frontend_ctrl = rtl28xxu_frontend_ctrl,
1868         .i2c_algo = &rtl28xxu_i2c_algo,
1869         .read_config = rtl28xxu_read_config,
1870         .frontend_attach = rtl28xxu_frontend_attach,
1871         .frontend_detach = rtl28xxu_frontend_detach,
1872         .tuner_attach = rtl28xxu_tuner_attach,
1873         .tuner_detach = rtl28xxu_tuner_detach,
1874         .init = rtl28xxu_init,
1875         .get_rc_config = rtl28xxu_get_rc_config,
1876
1877         .num_adapters = 1,
1878         .adapter = {
1879                 {
1880                         .caps = DVB_USB_ADAP_HAS_PID_FILTER |
1881                                 DVB_USB_ADAP_PID_FILTER_CAN_BE_TURNED_OFF,
1882
1883                         .pid_filter_count = 32,
1884                         .pid_filter_ctrl = rtl28xxu_pid_filter_ctrl,
1885                         .pid_filter = rtl28xxu_pid_filter,
1886
1887                         .stream = DVB_USB_STREAM_BULK(0x81, 6, 8 * 512),
1888                 },
1889         },
1890 };
1891
1892 static const struct usb_device_id rtl28xxu_id_table[] = {
1893         /* RTL2831U devices: */
1894         { DVB_USB_DEVICE(USB_VID_REALTEK, USB_PID_REALTEK_RTL2831U,
1895                 &rtl28xxu_props, "Realtek RTL2831U reference design", NULL) },
1896         { DVB_USB_DEVICE(USB_VID_WIDEVIEW, USB_PID_FREECOM_DVBT,
1897                 &rtl28xxu_props, "Freecom USB2.0 DVB-T", NULL) },
1898         { DVB_USB_DEVICE(USB_VID_WIDEVIEW, USB_PID_FREECOM_DVBT_2,
1899                 &rtl28xxu_props, "Freecom USB2.0 DVB-T", NULL) },
1900
1901         /* RTL2832U devices: */
1902         { DVB_USB_DEVICE(USB_VID_REALTEK, 0x2832,
1903                 &rtl28xxu_props, "Realtek RTL2832U reference design", NULL) },
1904         { DVB_USB_DEVICE(USB_VID_REALTEK, 0x2838,
1905                 &rtl28xxu_props, "Realtek RTL2832U reference design", NULL) },
1906         { DVB_USB_DEVICE(USB_VID_TERRATEC, USB_PID_TERRATEC_CINERGY_T_STICK_BLACK_REV1,
1907                 &rtl28xxu_props, "TerraTec Cinergy T Stick Black", RC_MAP_TERRATEC_SLIM) },
1908         { DVB_USB_DEVICE(USB_VID_GTEK, USB_PID_DELOCK_USB2_DVBT,
1909                 &rtl28xxu_props, "G-Tek Electronics Group Lifeview LV5TDLX DVB-T", NULL) },
1910         { DVB_USB_DEVICE(USB_VID_TERRATEC, USB_PID_NOXON_DAB_STICK,
1911                 &rtl28xxu_props, "TerraTec NOXON DAB Stick", NULL) },
1912         { DVB_USB_DEVICE(USB_VID_TERRATEC, USB_PID_NOXON_DAB_STICK_REV2,
1913                 &rtl28xxu_props, "TerraTec NOXON DAB Stick (rev 2)", NULL) },
1914         { DVB_USB_DEVICE(USB_VID_TERRATEC, USB_PID_NOXON_DAB_STICK_REV3,
1915                 &rtl28xxu_props, "TerraTec NOXON DAB Stick (rev 3)", NULL) },
1916         { DVB_USB_DEVICE(USB_VID_GTEK, USB_PID_TREKSTOR_TERRES_2_0,
1917                 &rtl28xxu_props, "Trekstor DVB-T Stick Terres 2.0", NULL) },
1918         { DVB_USB_DEVICE(USB_VID_DEXATEK, 0x1101,
1919                 &rtl28xxu_props, "Dexatek DK DVB-T Dongle", NULL) },
1920         { DVB_USB_DEVICE(USB_VID_LEADTEK, 0x6680,
1921                 &rtl28xxu_props, "DigitalNow Quad DVB-T Receiver", NULL) },
1922         { DVB_USB_DEVICE(USB_VID_LEADTEK, USB_PID_WINFAST_DTV_DONGLE_MINID,
1923                 &rtl28xxu_props, "Leadtek Winfast DTV Dongle Mini D", NULL) },
1924         { DVB_USB_DEVICE(USB_VID_LEADTEK, USB_PID_WINFAST_DTV2000DS_PLUS,
1925                 &rtl28xxu_props, "Leadtek WinFast DTV2000DS Plus", RC_MAP_LEADTEK_Y04G0051) },
1926         { DVB_USB_DEVICE(USB_VID_TERRATEC, 0x00d3,
1927                 &rtl28xxu_props, "TerraTec Cinergy T Stick RC (Rev. 3)", NULL) },
1928         { DVB_USB_DEVICE(USB_VID_DEXATEK, 0x1102,
1929                 &rtl28xxu_props, "Dexatek DK mini DVB-T Dongle", NULL) },
1930         { DVB_USB_DEVICE(USB_VID_TERRATEC, 0x00d7,
1931                 &rtl28xxu_props, "TerraTec Cinergy T Stick+", NULL) },
1932         { DVB_USB_DEVICE(USB_VID_KWORLD_2, 0xd3a8,
1933                 &rtl28xxu_props, "ASUS My Cinema-U3100Mini Plus V2", NULL) },
1934         { DVB_USB_DEVICE(USB_VID_KWORLD_2, 0xd393,
1935                 &rtl28xxu_props, "GIGABYTE U7300", NULL) },
1936         { DVB_USB_DEVICE(USB_VID_DEXATEK, 0x1104,
1937                 &rtl28xxu_props, "MSI DIGIVOX Micro HD", NULL) },
1938         { DVB_USB_DEVICE(USB_VID_COMPRO, 0x0620,
1939                 &rtl28xxu_props, "Compro VideoMate U620F", NULL) },
1940         { DVB_USB_DEVICE(USB_VID_COMPRO, 0x0650,
1941                 &rtl28xxu_props, "Compro VideoMate U650F", NULL) },
1942         { DVB_USB_DEVICE(USB_VID_KWORLD_2, 0xd394,
1943                 &rtl28xxu_props, "MaxMedia HU394-T", NULL) },
1944         { DVB_USB_DEVICE(USB_VID_LEADTEK, 0x6a03,
1945                 &rtl28xxu_props, "Leadtek WinFast DTV Dongle mini", NULL) },
1946         { DVB_USB_DEVICE(USB_VID_GTEK, USB_PID_CPYTO_REDI_PC50A,
1947                 &rtl28xxu_props, "Crypto ReDi PC 50 A", NULL) },
1948         { DVB_USB_DEVICE(USB_VID_KYE, 0x707f,
1949                 &rtl28xxu_props, "Genius TVGo DVB-T03", NULL) },
1950         { DVB_USB_DEVICE(USB_VID_KWORLD_2, 0xd395,
1951                 &rtl28xxu_props, "Peak DVB-T USB", NULL) },
1952         { DVB_USB_DEVICE(USB_VID_KWORLD_2, USB_PID_SVEON_STV20_RTL2832U,
1953                 &rtl28xxu_props, "Sveon STV20", NULL) },
1954         { DVB_USB_DEVICE(USB_VID_KWORLD_2, USB_PID_SVEON_STV21,
1955                 &rtl28xxu_props, "Sveon STV21", NULL) },
1956         { DVB_USB_DEVICE(USB_VID_KWORLD_2, USB_PID_SVEON_STV27,
1957                 &rtl28xxu_props, "Sveon STV27", NULL) },
1958         { DVB_USB_DEVICE(USB_VID_KWORLD_2, USB_PID_TURBOX_DTT_2000,
1959                 &rtl28xxu_props, "TURBO-X Pure TV Tuner DTT-2000", NULL) },
1960         { DVB_USB_DEVICE(USB_VID_GTEK, USB_PID_PROLECTRIX_DV107669,
1961                 &rtl28xxu_props, "PROlectrix DV107669", NULL) },
1962
1963         /* RTL2832P devices: */
1964         { DVB_USB_DEVICE(USB_VID_HANFTEK, 0x0131,
1965                 &rtl28xxu_props, "Astrometa DVB-T2",
1966                 RC_MAP_ASTROMETA_T2HYBRID) },
1967         { DVB_USB_DEVICE(0x5654, 0xca42,
1968                 &rtl28xxu_props, "GoTView MasterHD 3", NULL) },
1969         { }
1970 };
1971 MODULE_DEVICE_TABLE(usb, rtl28xxu_id_table);
1972
1973 static struct usb_driver rtl28xxu_usb_driver = {
1974         .name = KBUILD_MODNAME,
1975         .id_table = rtl28xxu_id_table,
1976         .probe = dvb_usbv2_probe,
1977         .disconnect = dvb_usbv2_disconnect,
1978         .suspend = dvb_usbv2_suspend,
1979         .resume = dvb_usbv2_resume,
1980         .reset_resume = dvb_usbv2_reset_resume,
1981         .no_dynamic_id = 1,
1982         .soft_unbind = 1,
1983 };
1984
1985 module_usb_driver(rtl28xxu_usb_driver);
1986
1987 MODULE_DESCRIPTION("Realtek RTL28xxU DVB USB driver");
1988 MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>");
1989 MODULE_AUTHOR("Thomas Mair <thomas.mair86@googlemail.com>");
1990 MODULE_LICENSE("GPL");