drivers/media/video/em28xx/em28xx-dvb.c

   1 /*
   2  DVB device driver for em28xx
   3
   4  (c) 2008-2011 Mauro Carvalho Chehab <mchehab@infradead.org>
   5
   6  (c) 2008 Devin Heitmueller <devin.heitmueller@gmail.com>
   7         - Fixes for the driver to properly work with HVR-950
   8         - Fixes for the driver to properly work with Pinnacle PCTV HD Pro Stick
   9         - Fixes for the driver to properly work with AMD ATI TV Wonder HD 600
  10
  11  (c) 2008 Aidan Thornton <makosoft@googlemail.com>
  12
  13  Based on cx88-dvb, saa7134-dvb and videobuf-dvb originally written by:
  14         (c) 2004, 2005 Chris Pascoe <c.pascoe@itee.uq.edu.au>
  15         (c) 2004 Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]
  16
  17  This program is free software; you can redistribute it and/or modify
  18  it under the terms of the GNU General Public License as published by
  19  the Free Software Foundation; either version 2 of the License.
  20  */
  21
  22 #include <linux/kernel.h>
  23 #include <linux/slab.h>
  24 #include <linux/usb.h>
  25
  26 #include "em28xx.h"
  27 #include <media/v4l2-common.h>
  28 #include <media/videobuf-vmalloc.h>
  29 #include <media/tuner.h>
  30 #include "tuner-simple.h"
  31
  32 #include "lgdt330x.h"
  33 #include "lgdt3305.h"
  34 #include "zl10353.h"
  35 #include "s5h1409.h"
  36 #include "mt352.h"
  37 #include "mt352_priv.h" /* FIXME */
  38 #include "tda1002x.h"
  39 #include "tda18271.h"
  40 #include "s921.h"
  41 #include "drxd.h"
  42 #include "cxd2820r.h"
  43 #include "tda18271c2dd.h"
  44 #include "drxk.h"
  45
  46 MODULE_DESCRIPTION("driver for em28xx based DVB cards");
  47 MODULE_AUTHOR("Mauro Carvalho Chehab <mchehab@infradead.org>");
  48 MODULE_LICENSE("GPL");
  49
  50 static unsigned int debug;
  51 module_param(debug, int, 0644);
  52 MODULE_PARM_DESC(debug, "enable debug messages [dvb]");
  53
  54 DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
  55
  56 #define dprintk(level, fmt, arg...) do {                        \
  57 if (debug >= level)                                             \
  58         printk(KERN_DEBUG "%s/2-dvb: " fmt, dev->name, ## arg); \
  59 } while (0)
  60
  61 #define EM28XX_DVB_NUM_BUFS 5
  62 #define EM28XX_DVB_MAX_PACKETS 64
  63
  64 struct em28xx_dvb {
  65         struct dvb_frontend        *fe[2];
  66
  67         /* feed count management */
  68         struct mutex               lock;
  69         int                        nfeeds;
  70
  71         /* general boilerplate stuff */
  72         struct dvb_adapter         adapter;
  73         struct dvb_demux           demux;
  74         struct dmxdev              dmxdev;
  75         struct dmx_frontend        fe_hw;
  76         struct dmx_frontend        fe_mem;
  77         struct dvb_net             net;
  78
  79         /* Due to DRX-K - probably need changes */
  80         int (*gate_ctrl)(struct dvb_frontend *, int);
  81         struct semaphore      pll_mutex;
  82         bool                    dont_attach_fe1;
  83 };
  84
  85
  86 static inline void print_err_status(struct em28xx *dev,
  87                                      int packet, int status)
  88 {
  89         char *errmsg = "Unknown";
  90
  91         switch (status) {
  92         case -ENOENT:
  93                 errmsg = "unlinked synchronuously";
  94                 break;
  95         case -ECONNRESET:
  96                 errmsg = "unlinked asynchronuously";
  97                 break;
  98         case -ENOSR:
  99                 errmsg = "Buffer error (overrun)";
 100                 break;
 101         case -EPIPE:
 102                 errmsg = "Stalled (device not responding)";
 103                 break;
 104         case -EOVERFLOW:
 105                 errmsg = "Babble (bad cable?)";
 106                 break;
 107         case -EPROTO:
 108                 errmsg = "Bit-stuff error (bad cable?)";
 109                 break;
 110         case -EILSEQ:
 111                 errmsg = "CRC/Timeout (could be anything)";
 112                 break;
 113         case -ETIME:
 114                 errmsg = "Device does not respond";
 115                 break;
 116         }
 117         if (packet < 0) {
 118                 dprintk(1, "URB status %d [%s].\n", status, errmsg);
 119         } else {
 120                 dprintk(1, "URB packet %d, status %d [%s].\n",
 121                         packet, status, errmsg);
 122         }
 123 }
 124
 125 static inline int dvb_isoc_copy(struct em28xx *dev, struct urb *urb)
 126 {
 127         int i;
 128
 129         if (!dev)
 130                 return 0;
 131
 132         if ((dev->state & DEV_DISCONNECTED) || (dev->state & DEV_MISCONFIGURED))
 133                 return 0;
 134
 135         if (urb->status < 0) {
 136                 print_err_status(dev, -1, urb->status);
 137                 if (urb->status == -ENOENT)
 138                         return 0;
 139         }
 140
 141         for (i = 0; i < urb->number_of_packets; i++) {
 142                 int status = urb->iso_frame_desc[i].status;
 143
 144                 if (status < 0) {
 145                         print_err_status(dev, i, status);
 146                         if (urb->iso_frame_desc[i].status != -EPROTO)
 147                                 continue;
 148                 }
 149
 150                 dvb_dmx_swfilter(&dev->dvb->demux, urb->transfer_buffer +
 151                                  urb->iso_frame_desc[i].offset,
 152                                  urb->iso_frame_desc[i].actual_length);
 153         }
 154
 155         return 0;
 156 }
 157
 158 static int start_streaming(struct em28xx_dvb *dvb)
 159 {
 160         int rc;
 161         struct em28xx *dev = dvb->adapter.priv;
 162         int max_dvb_packet_size;
 163
 164         usb_set_interface(dev->udev, 0, 1);
 165         rc = em28xx_set_mode(dev, EM28XX_DIGITAL_MODE);
 166         if (rc < 0)
 167                 return rc;
 168
 169         max_dvb_packet_size = em28xx_isoc_dvb_max_packetsize(dev);
 170         if (max_dvb_packet_size < 0)
 171                 return max_dvb_packet_size;
 172         dprintk(1, "Using %d buffers each with %d bytes\n",
 173                 EM28XX_DVB_NUM_BUFS,
 174                 max_dvb_packet_size);
 175
 176         return em28xx_init_isoc(dev, EM28XX_DVB_MAX_PACKETS,
 177                                 EM28XX_DVB_NUM_BUFS, max_dvb_packet_size,
 178                                 dvb_isoc_copy);
 179 }
 180
 181 static int stop_streaming(struct em28xx_dvb *dvb)
 182 {
 183         struct em28xx *dev = dvb->adapter.priv;
 184
 185         em28xx_uninit_isoc(dev);
 186
 187         em28xx_set_mode(dev, EM28XX_SUSPEND);
 188
 189         return 0;
 190 }
 191
 192 static int start_feed(struct dvb_demux_feed *feed)
 193 {
 194         struct dvb_demux *demux  = feed->demux;
 195         struct em28xx_dvb *dvb = demux->priv;
 196         int rc, ret;
 197
 198         if (!demux->dmx.frontend)
 199                 return -EINVAL;
 200
 201         mutex_lock(&dvb->lock);
 202         dvb->nfeeds++;
 203         rc = dvb->nfeeds;
 204
 205         if (dvb->nfeeds == 1) {
 206                 ret = start_streaming(dvb);
 207                 if (ret < 0)
 208                         rc = ret;
 209         }
 210
 211         mutex_unlock(&dvb->lock);
 212         return rc;
 213 }
 214
 215 static int stop_feed(struct dvb_demux_feed *feed)
 216 {
 217         struct dvb_demux *demux  = feed->demux;
 218         struct em28xx_dvb *dvb = demux->priv;
 219         int err = 0;
 220
 221         mutex_lock(&dvb->lock);
 222         dvb->nfeeds--;
 223
 224         if (0 == dvb->nfeeds)
 225                 err = stop_streaming(dvb);
 226
 227         mutex_unlock(&dvb->lock);
 228         return err;
 229 }
 230
 231
 232
 233 /* ------------------------------------------------------------------ */
 234 static int em28xx_dvb_bus_ctrl(struct dvb_frontend *fe, int acquire)
 235 {
 236         struct em28xx *dev = fe->dvb->priv;
 237
 238         if (acquire)
 239                 return em28xx_set_mode(dev, EM28XX_DIGITAL_MODE);
 240         else
 241                 return em28xx_set_mode(dev, EM28XX_SUSPEND);
 242 }
 243
 244 /* ------------------------------------------------------------------ */
 245
 246 static struct lgdt330x_config em2880_lgdt3303_dev = {
 247         .demod_address = 0x0e,
 248         .demod_chip = LGDT3303,
 249 };
 250
 251 static struct lgdt3305_config em2870_lgdt3304_dev = {
 252         .i2c_addr           = 0x0e,
 253         .demod_chip         = LGDT3304,
 254         .spectral_inversion = 1,
 255         .deny_i2c_rptr      = 1,
 256         .mpeg_mode          = LGDT3305_MPEG_PARALLEL,
 257         .tpclk_edge         = LGDT3305_TPCLK_FALLING_EDGE,
 258         .tpvalid_polarity   = LGDT3305_TP_VALID_HIGH,
 259         .vsb_if_khz         = 3250,
 260         .qam_if_khz         = 4000,
 261 };
 262
 263 static struct s921_config sharp_isdbt = {
 264         .demod_address = 0x30 >> 1
 265 };
 266
 267 static struct zl10353_config em28xx_zl10353_with_xc3028 = {
 268         .demod_address = (0x1e >> 1),
 269         .no_tuner = 1,
 270         .parallel_ts = 1,
 271         .if2 = 45600,
 272 };
 273
 274 static struct s5h1409_config em28xx_s5h1409_with_xc3028 = {
 275         .demod_address = 0x32 >> 1,
 276         .output_mode   = S5H1409_PARALLEL_OUTPUT,
 277         .gpio          = S5H1409_GPIO_OFF,
 278         .inversion     = S5H1409_INVERSION_OFF,
 279         .status_mode   = S5H1409_DEMODLOCKING,
 280         .mpeg_timing   = S5H1409_MPEGTIMING_CONTINOUS_NONINVERTING_CLOCK
 281 };
 282
 283 static struct tda18271_std_map kworld_a340_std_map = {
 284         .atsc_6   = { .if_freq = 3250, .agc_mode = 3, .std = 0,
 285                       .if_lvl = 1, .rfagc_top = 0x37, },
 286         .qam_6    = { .if_freq = 4000, .agc_mode = 3, .std = 1,
 287                       .if_lvl = 1, .rfagc_top = 0x37, },
 288 };
 289
 290 static struct tda18271_config kworld_a340_config = {
 291         .std_map           = &kworld_a340_std_map,
 292 };
 293
 294 static struct zl10353_config em28xx_zl10353_xc3028_no_i2c_gate = {
 295         .demod_address = (0x1e >> 1),
 296         .no_tuner = 1,
 297         .disable_i2c_gate_ctrl = 1,
 298         .parallel_ts = 1,
 299         .if2 = 45600,
 300 };
 301
 302 static struct drxd_config em28xx_drxd = {
 303         .index = 0, .demod_address = 0x70, .demod_revision = 0xa2,
 304         .demoda_address = 0x00, .pll_address = 0x00,
 305         .pll_type = DRXD_PLL_NONE, .clock = 12000, .insert_rs_byte = 1,
 306         .pll_set = NULL, .osc_deviation = NULL, .IF = 42800000,
 307         .disable_i2c_gate_ctrl = 1,
 308 };
 309
 310 struct drxk_config terratec_h5_drxk = {
 311         .adr = 0x29,
 312         .single_master = 1,
 313         .no_i2c_bridge = 1,
 314         .microcode_name = "dvb-usb-terratec-h5-drxk.fw",
 315 };
 316
 317 static int drxk_gate_ctrl(struct dvb_frontend *fe, int enable)
 318 {
 319         struct em28xx_dvb *dvb = fe->sec_priv;
 320         int status;
 321
 322         if (!dvb)
 323                 return -EINVAL;
 324
 325         if (enable) {
 326                 down(&dvb->pll_mutex);
 327                 status = dvb->gate_ctrl(fe, 1);
 328         } else {
 329                 status = dvb->gate_ctrl(fe, 0);
 330                 up(&dvb->pll_mutex);
 331         }
 332         return status;
 333 }
 334
 335 static void terratec_h5_init(struct em28xx *dev)
 336 {
 337         int i;
 338         struct em28xx_reg_seq terratec_h5_init[] = {
 339                 {EM28XX_R08_GPIO,       0xff,   0xff,   10},
 340                 {EM2874_R80_GPIO,       0xf6,   0xff,   100},
 341                 {EM2874_R80_GPIO,       0xf2,   0xff,   50},
 342                 {EM2874_R80_GPIO,       0xf6,   0xff,   100},
 343                 { -1,                   -1,     -1,     -1},
 344         };
 345         struct em28xx_reg_seq terratec_h5_end[] = {
 346                 {EM2874_R80_GPIO,       0xe6,   0xff,   100},
 347                 {EM2874_R80_GPIO,       0xa6,   0xff,   50},
 348                 {EM2874_R80_GPIO,       0xe6,   0xff,   100},
 349                 { -1,                   -1,     -1,     -1},
 350         };
 351         struct {
 352                 unsigned char r[4];
 353                 int len;
 354         } regs[] = {
 355                 {{ 0x06, 0x02, 0x00, 0x31 }, 4},
 356                 {{ 0x01, 0x02 }, 2},
 357                 {{ 0x01, 0x02, 0x00, 0xc6 }, 4},
 358                 {{ 0x01, 0x00 }, 2},
 359                 {{ 0x01, 0x00, 0xff, 0xaf }, 4},
 360                 {{ 0x01, 0x00, 0x03, 0xa0 }, 4},
 361                 {{ 0x01, 0x00 }, 2},
 362                 {{ 0x01, 0x00, 0x73, 0xaf }, 4},
 363                 {{ 0x04, 0x00 }, 2},
 364                 {{ 0x00, 0x04 }, 2},
 365                 {{ 0x00, 0x04, 0x00, 0x0a }, 4},
 366                 {{ 0x04, 0x14 }, 2},
 367                 {{ 0x04, 0x14, 0x00, 0x00 }, 4},
 368         };
 369
 370         em28xx_gpio_set(dev, terratec_h5_init);
 371         em28xx_write_reg(dev, EM28XX_R06_I2C_CLK, 0x40);
 372         msleep(10);
 373         em28xx_write_reg(dev, EM28XX_R06_I2C_CLK, 0x45);
 374         msleep(10);
 375
 376         dev->i2c_client.addr = 0x82 >> 1;
 377
 378         for (i = 0; i < ARRAY_SIZE(regs); i++)
 379                 i2c_master_send(&dev->i2c_client, regs[i].r, regs[i].len);
 380         em28xx_gpio_set(dev, terratec_h5_end);
 381 };
 382
 383 static int mt352_terratec_xs_init(struct dvb_frontend *fe)
 384 {
 385         /* Values extracted from a USB trace of the Terratec Windows driver */
 386         static u8 clock_config[]   = { CLOCK_CTL,  0x38, 0x2c };
 387         static u8 reset[]          = { RESET,      0x80 };
 388         static u8 adc_ctl_1_cfg[]  = { ADC_CTL_1,  0x40 };
 389         static u8 agc_cfg[]        = { AGC_TARGET, 0x28, 0xa0 };
 390         static u8 input_freq_cfg[] = { INPUT_FREQ_1, 0x31, 0xb8 };
 391         static u8 rs_err_cfg[]     = { RS_ERR_PER_1, 0x00, 0x4d };
 392         static u8 capt_range_cfg[] = { CAPT_RANGE, 0x32 };
 393         static u8 trl_nom_cfg[]    = { TRL_NOMINAL_RATE_1, 0x64, 0x00 };
 394         static u8 tps_given_cfg[]  = { TPS_GIVEN_1, 0x40, 0x80, 0x50 };
 395         static u8 tuner_go[]       = { TUNER_GO, 0x01};
 396
 397         mt352_write(fe, clock_config,   sizeof(clock_config));
 398         udelay(200);
 399         mt352_write(fe, reset,          sizeof(reset));
 400         mt352_write(fe, adc_ctl_1_cfg,  sizeof(adc_ctl_1_cfg));
 401         mt352_write(fe, agc_cfg,        sizeof(agc_cfg));
 402         mt352_write(fe, input_freq_cfg, sizeof(input_freq_cfg));
 403         mt352_write(fe, rs_err_cfg,     sizeof(rs_err_cfg));
 404         mt352_write(fe, capt_range_cfg, sizeof(capt_range_cfg));
 405         mt352_write(fe, trl_nom_cfg,    sizeof(trl_nom_cfg));
 406         mt352_write(fe, tps_given_cfg,  sizeof(tps_given_cfg));
 407         mt352_write(fe, tuner_go,       sizeof(tuner_go));
 408         return 0;
 409 }
 410
 411 static struct mt352_config terratec_xs_mt352_cfg = {
 412         .demod_address = (0x1e >> 1),
 413         .no_tuner = 1,
 414         .if2 = 45600,
 415         .demod_init = mt352_terratec_xs_init,
 416 };
 417
 418 static struct tda10023_config em28xx_tda10023_config = {
 419         .demod_address = 0x0c,
 420         .invert = 1,
 421 };
 422
 423 static struct cxd2820r_config em28xx_cxd2820r_config = {
 424         .i2c_address = (0xd8 >> 1),
 425         .ts_mode = CXD2820R_TS_SERIAL,
 426         .if_dvbt_6  = 3300,
 427         .if_dvbt_7  = 3500,
 428         .if_dvbt_8  = 4000,
 429         .if_dvbt2_6 = 3300,
 430         .if_dvbt2_7 = 3500,
 431         .if_dvbt2_8 = 4000,
 432         .if_dvbc    = 5000,
 433
 434         /* enable LNA for DVB-T2 and DVB-C */
 435         .gpio_dvbt2[0] = CXD2820R_GPIO_E | CXD2820R_GPIO_O | CXD2820R_GPIO_L,
 436         .gpio_dvbc[0] = CXD2820R_GPIO_E | CXD2820R_GPIO_O | CXD2820R_GPIO_L,
 437 };
 438
 439 static struct tda18271_config em28xx_cxd2820r_tda18271_config = {
 440         .output_opt = TDA18271_OUTPUT_LT_OFF,
 441 };
 442
 443 /* ------------------------------------------------------------------ */
 444
 445 static int attach_xc3028(u8 addr, struct em28xx *dev)
 446 {
 447         struct dvb_frontend *fe;
 448         struct xc2028_config cfg;
 449
 450         memset(&cfg, 0, sizeof(cfg));
 451         cfg.i2c_adap  = &dev->i2c_adap;
 452         cfg.i2c_addr  = addr;
 453
 454         if (!dev->dvb->fe[0]) {
 455                 em28xx_errdev("/2: dvb frontend not attached. "
 456                                 "Can't attach xc3028\n");
 457                 return -EINVAL;
 458         }
 459
 460         fe = dvb_attach(xc2028_attach, dev->dvb->fe[0], &cfg);
 461         if (!fe) {
 462                 em28xx_errdev("/2: xc3028 attach failed\n");
 463                 dvb_frontend_detach(dev->dvb->fe[0]);
 464                 dev->dvb->fe[0] = NULL;
 465                 return -EINVAL;
 466         }
 467
 468         em28xx_info("%s/2: xc3028 attached\n", dev->name);
 469
 470         return 0;
 471 }
 472
 473 /* ------------------------------------------------------------------ */
 474
 475 static int register_dvb(struct em28xx_dvb *dvb,
 476                  struct module *module,
 477                  struct em28xx *dev,
 478                  struct device *device)
 479 {
 480         int result;
 481
 482         mutex_init(&dvb->lock);
 483
 484         /* register adapter */
 485         result = dvb_register_adapter(&dvb->adapter, dev->name, module, device,
 486                                       adapter_nr);
 487         if (result < 0) {
 488                 printk(KERN_WARNING "%s: dvb_register_adapter failed (errno = %d)\n",
 489                        dev->name, result);
 490                 goto fail_adapter;
 491         }
 492
 493         /* Ensure all frontends negotiate bus access */
 494         dvb->fe[0]->ops.ts_bus_ctrl = em28xx_dvb_bus_ctrl;
 495         if (dvb->fe[1])
 496                 dvb->fe[1]->ops.ts_bus_ctrl = em28xx_dvb_bus_ctrl;
 497
 498         dvb->adapter.priv = dev;
 499
 500         /* register frontend */
 501         result = dvb_register_frontend(&dvb->adapter, dvb->fe[0]);
 502         if (result < 0) {
 503                 printk(KERN_WARNING "%s: dvb_register_frontend failed (errno = %d)\n",
 504                        dev->name, result);
 505                 goto fail_frontend0;
 506         }
 507
 508         /* register 2nd frontend */
 509         if (dvb->fe[1]) {
 510                 result = dvb_register_frontend(&dvb->adapter, dvb->fe[1]);
 511                 if (result < 0) {
 512                         printk(KERN_WARNING "%s: 2nd dvb_register_frontend failed (errno = %d)\n",
 513                                 dev->name, result);
 514                         goto fail_frontend1;
 515                 }
 516         }
 517
 518         /* register demux stuff */
 519         dvb->demux.dmx.capabilities =
 520                 DMX_TS_FILTERING | DMX_SECTION_FILTERING |
 521                 DMX_MEMORY_BASED_FILTERING;
 522         dvb->demux.priv       = dvb;
 523         dvb->demux.filternum  = 256;
 524         dvb->demux.feednum    = 256;
 525         dvb->demux.start_feed = start_feed;
 526         dvb->demux.stop_feed  = stop_feed;
 527
 528         result = dvb_dmx_init(&dvb->demux);
 529         if (result < 0) {
 530                 printk(KERN_WARNING "%s: dvb_dmx_init failed (errno = %d)\n",
 531                        dev->name, result);
 532                 goto fail_dmx;
 533         }
 534
 535         dvb->dmxdev.filternum    = 256;
 536         dvb->dmxdev.demux        = &dvb->demux.dmx;
 537         dvb->dmxdev.capabilities = 0;
 538         result = dvb_dmxdev_init(&dvb->dmxdev, &dvb->adapter);
 539         if (result < 0) {
 540                 printk(KERN_WARNING "%s: dvb_dmxdev_init failed (errno = %d)\n",
 541                        dev->name, result);
 542                 goto fail_dmxdev;
 543         }
 544
 545         dvb->fe_hw.source = DMX_FRONTEND_0;
 546         result = dvb->demux.dmx.add_frontend(&dvb->demux.dmx, &dvb->fe_hw);
 547         if (result < 0) {
 548                 printk(KERN_WARNING "%s: add_frontend failed (DMX_FRONTEND_0, errno = %d)\n",
 549                        dev->name, result);
 550                 goto fail_fe_hw;
 551         }
 552
 553         dvb->fe_mem.source = DMX_MEMORY_FE;
 554         result = dvb->demux.dmx.add_frontend(&dvb->demux.dmx, &dvb->fe_mem);
 555         if (result < 0) {
 556                 printk(KERN_WARNING "%s: add_frontend failed (DMX_MEMORY_FE, errno = %d)\n",
 557                        dev->name, result);
 558                 goto fail_fe_mem;
 559         }
 560
 561         result = dvb->demux.dmx.connect_frontend(&dvb->demux.dmx, &dvb->fe_hw);
 562         if (result < 0) {
 563                 printk(KERN_WARNING "%s: connect_frontend failed (errno = %d)\n",
 564                        dev->name, result);
 565                 goto fail_fe_conn;
 566         }
 567
 568         /* register network adapter */
 569         dvb_net_init(&dvb->adapter, &dvb->net, &dvb->demux.dmx);
 570         return 0;
 571
 572 fail_fe_conn:
 573         dvb->demux.dmx.remove_frontend(&dvb->demux.dmx, &dvb->fe_mem);
 574 fail_fe_mem:
 575         dvb->demux.dmx.remove_frontend(&dvb->demux.dmx, &dvb->fe_hw);
 576 fail_fe_hw:
 577         dvb_dmxdev_release(&dvb->dmxdev);
 578 fail_dmxdev:
 579         dvb_dmx_release(&dvb->demux);
 580 fail_dmx:
 581         if (dvb->fe[1])
 582                 dvb_unregister_frontend(dvb->fe[1]);
 583         dvb_unregister_frontend(dvb->fe[0]);
 584 fail_frontend1:
 585         if (dvb->fe[1])
 586                 dvb_frontend_detach(dvb->fe[1]);
 587 fail_frontend0:
 588         dvb_frontend_detach(dvb->fe[0]);
 589         dvb_unregister_adapter(&dvb->adapter);
 590 fail_adapter:
 591         return result;
 592 }
 593
 594 static void unregister_dvb(struct em28xx_dvb *dvb)
 595 {
 596         dvb_net_release(&dvb->net);
 597         dvb->demux.dmx.remove_frontend(&dvb->demux.dmx, &dvb->fe_mem);
 598         dvb->demux.dmx.remove_frontend(&dvb->demux.dmx, &dvb->fe_hw);
 599         dvb_dmxdev_release(&dvb->dmxdev);
 600         dvb_dmx_release(&dvb->demux);
 601         if (dvb->fe[1])
 602                 dvb_unregister_frontend(dvb->fe[1]);
 603         dvb_unregister_frontend(dvb->fe[0]);
 604         if (dvb->fe[1] && !dvb->dont_attach_fe1)
 605                 dvb_frontend_detach(dvb->fe[1]);
 606         dvb_frontend_detach(dvb->fe[0]);
 607         dvb_unregister_adapter(&dvb->adapter);
 608 }
 609
 610 static int dvb_init(struct em28xx *dev)
 611 {
 612         int result = 0;
 613         struct em28xx_dvb *dvb;
 614
 615         if (!dev->board.has_dvb) {
 616                 /* This device does not support the extension */
 617                 printk(KERN_INFO "em28xx_dvb: This device does not support the extension\n");
 618                 return 0;
 619         }
 620
 621         dvb = kzalloc(sizeof(struct em28xx_dvb), GFP_KERNEL);
 622
 623         if (dvb == NULL) {
 624                 em28xx_info("em28xx_dvb: memory allocation failed\n");
 625                 return -ENOMEM;
 626         }
 627         dev->dvb = dvb;
 628         dvb->fe[0] = dvb->fe[1] = NULL;
 629
 630         mutex_lock(&dev->lock);
 631         em28xx_set_mode(dev, EM28XX_DIGITAL_MODE);
 632         /* init frontend */
 633         switch (dev->model) {
 634         case EM2874_BOARD_LEADERSHIP_ISDBT:
 635                 dvb->fe[0] = dvb_attach(s921_attach,
 636                                 &sharp_isdbt, &dev->i2c_adap);
 637
 638                 if (!dvb->fe[0]) {
 639                         result = -EINVAL;
 640                         goto out_free;
 641                 }
 642
 643                 break;
 644         case EM2883_BOARD_HAUPPAUGE_WINTV_HVR_850:
 645         case EM2883_BOARD_HAUPPAUGE_WINTV_HVR_950:
 646         case EM2880_BOARD_PINNACLE_PCTV_HD_PRO:
 647         case EM2880_BOARD_AMD_ATI_TV_WONDER_HD_600:
 648                 dvb->fe[0] = dvb_attach(lgdt330x_attach,
 649                                            &em2880_lgdt3303_dev,
 650                                            &dev->i2c_adap);
 651                 if (attach_xc3028(0x61, dev) < 0) {
 652                         result = -EINVAL;
 653                         goto out_free;
 654                 }
 655                 break;
 656         case EM2880_BOARD_KWORLD_DVB_310U:
 657                 dvb->fe[0] = dvb_attach(zl10353_attach,
 658                                            &em28xx_zl10353_with_xc3028,
 659                                            &dev->i2c_adap);
 660                 if (attach_xc3028(0x61, dev) < 0) {
 661                         result = -EINVAL;
 662                         goto out_free;
 663                 }
 664                 break;
 665         case EM2880_BOARD_HAUPPAUGE_WINTV_HVR_900:
 666         case EM2882_BOARD_TERRATEC_HYBRID_XS:
 667         case EM2880_BOARD_EMPIRE_DUAL_TV:
 668                 dvb->fe[0] = dvb_attach(zl10353_attach,
 669                                            &em28xx_zl10353_xc3028_no_i2c_gate,
 670                                            &dev->i2c_adap);
 671                 if (attach_xc3028(0x61, dev) < 0) {
 672                         result = -EINVAL;
 673                         goto out_free;
 674                 }
 675                 break;
 676         case EM2880_BOARD_TERRATEC_HYBRID_XS:
 677         case EM2880_BOARD_TERRATEC_HYBRID_XS_FR:
 678         case EM2881_BOARD_PINNACLE_HYBRID_PRO:
 679         case EM2882_BOARD_DIKOM_DK300:
 680         case EM2882_BOARD_KWORLD_VS_DVBT:
 681                 dvb->fe[0] = dvb_attach(zl10353_attach,
 682                                            &em28xx_zl10353_xc3028_no_i2c_gate,
 683                                            &dev->i2c_adap);
 684                 if (dvb->fe[0] == NULL) {
 685                         /* This board could have either a zl10353 or a mt352.
 686                            If the chip id isn't for zl10353, try mt352 */
 687                         dvb->fe[0] = dvb_attach(mt352_attach,
 688                                                    &terratec_xs_mt352_cfg,
 689                                                    &dev->i2c_adap);
 690                 }
 691
 692                 if (attach_xc3028(0x61, dev) < 0) {
 693                         result = -EINVAL;
 694                         goto out_free;
 695                 }
 696                 break;
 697         case EM2883_BOARD_KWORLD_HYBRID_330U:
 698         case EM2882_BOARD_EVGA_INDTUBE:
 699                 dvb->fe[0] = dvb_attach(s5h1409_attach,
 700                                            &em28xx_s5h1409_with_xc3028,
 701                                            &dev->i2c_adap);
 702                 if (attach_xc3028(0x61, dev) < 0) {
 703                         result = -EINVAL;
 704                         goto out_free;
 705                 }
 706                 break;
 707         case EM2882_BOARD_KWORLD_ATSC_315U:
 708                 dvb->fe[0] = dvb_attach(lgdt330x_attach,
 709                                            &em2880_lgdt3303_dev,
 710                                            &dev->i2c_adap);
 711                 if (dvb->fe[0] != NULL) {
 712                         if (!dvb_attach(simple_tuner_attach, dvb->fe[0],
 713                                 &dev->i2c_adap, 0x61, TUNER_THOMSON_DTT761X)) {
 714                                 result = -EINVAL;
 715                                 goto out_free;
 716                         }
 717                 }
 718                 break;
 719         case EM2880_BOARD_HAUPPAUGE_WINTV_HVR_900_R2:
 720         case EM2882_BOARD_PINNACLE_HYBRID_PRO_330E:
 721                 dvb->fe[0] = dvb_attach(drxd_attach, &em28xx_drxd, NULL,
 722                                            &dev->i2c_adap, &dev->udev->dev);
 723                 if (attach_xc3028(0x61, dev) < 0) {
 724                         result = -EINVAL;
 725                         goto out_free;
 726                 }
 727                 break;
 728         case EM2870_BOARD_REDDO_DVB_C_USB_BOX:
 729                 /* Philips CU1216L NIM (Philips TDA10023 + Infineon TUA6034) */
 730                 dvb->fe[0] = dvb_attach(tda10023_attach,
 731                         &em28xx_tda10023_config,
 732                         &dev->i2c_adap, 0x48);
 733                 if (dvb->fe[0]) {
 734                         if (!dvb_attach(simple_tuner_attach, dvb->fe[0],
 735                                 &dev->i2c_adap, 0x60, TUNER_PHILIPS_CU1216L)) {
 736                                 result = -EINVAL;
 737                                 goto out_free;
 738                         }
 739                 }
 740                 break;
 741         case EM2870_BOARD_KWORLD_A340:
 742                 dvb->fe[0] = dvb_attach(lgdt3305_attach,
 743                                            &em2870_lgdt3304_dev,
 744                                            &dev->i2c_adap);
 745                 if (dvb->fe[0] != NULL)
 746                         dvb_attach(tda18271_attach, dvb->fe[0], 0x60,
 747                                    &dev->i2c_adap, &kworld_a340_config);
 748                 break;
 749         case EM28174_BOARD_PCTV_290E:
 750                 /* MFE
 751                  * FE 0 = DVB-T/T2 + FE 1 = DVB-C, both sharing same tuner. */
 752                 /* FE 0 */
 753                 dvb->fe[0] = dvb_attach(cxd2820r_attach,
 754                         &em28xx_cxd2820r_config, &dev->i2c_adap, NULL);
 755                 if (dvb->fe[0]) {
 756                         struct i2c_adapter *i2c_tuner;
 757                         i2c_tuner = cxd2820r_get_tuner_i2c_adapter(dvb->fe[0]);
 758                         /* FE 0 attach tuner */
 759                         if (!dvb_attach(tda18271_attach, dvb->fe[0], 0x60,
 760                                 i2c_tuner, &em28xx_cxd2820r_tda18271_config)) {
 761                                 dvb_frontend_detach(dvb->fe[0]);
 762                                 result = -EINVAL;
 763                                 goto out_free;
 764                         }
 765                         /* FE 1. This dvb_attach() cannot fail. */
 766                         dvb->fe[1] = dvb_attach(cxd2820r_attach, NULL, NULL,
 767                                 dvb->fe[0]);
 768                         dvb->fe[1]->id = 1;
 769                         /* FE 1 attach tuner */
 770                         if (!dvb_attach(tda18271_attach, dvb->fe[1], 0x60,
 771                                 i2c_tuner, &em28xx_cxd2820r_tda18271_config)) {
 772                                 dvb_frontend_detach(dvb->fe[1]);
 773                                 /* leave FE 0 still active */
 774                         }
 775                 }
 776                 break;
 777         case EM2884_BOARD_TERRATEC_H5:
 778                 terratec_h5_init(dev);
 779
 780                 dvb->dont_attach_fe1 = 1;
 781
 782                 dvb->fe[0] = dvb_attach(drxk_attach, &terratec_h5_drxk, &dev->i2c_adap, &dvb->fe[1]);
 783                 if (!dvb->fe[0]) {
 784                         result = -EINVAL;
 785                         goto out_free;
 786                 }
 787
 788                 /* FIXME: do we need a pll semaphore? */
 789                 dvb->fe[0]->sec_priv = dvb;
 790                 sema_init(&dvb->pll_mutex, 1);
 791                 dvb->gate_ctrl = dvb->fe[0]->ops.i2c_gate_ctrl;
 792                 dvb->fe[0]->ops.i2c_gate_ctrl = drxk_gate_ctrl;
 793                 dvb->fe[1]->id = 1;
 794
 795                 /* Attach tda18271 to DVB-C frontend */
 796                 if (dvb->fe[0]->ops.i2c_gate_ctrl)
 797                         dvb->fe[0]->ops.i2c_gate_ctrl(dvb->fe[0], 1);
 798                 if (!dvb_attach(tda18271c2dd_attach, dvb->fe[0], &dev->i2c_adap, 0x60)) {
 799                         result = -EINVAL;
 800                         goto out_free;
 801                 }
 802                 if (dvb->fe[0]->ops.i2c_gate_ctrl)
 803                         dvb->fe[0]->ops.i2c_gate_ctrl(dvb->fe[0], 0);
 804
 805                 /* Hack - needed by drxk/tda18271c2dd */
 806                 dvb->fe[1]->tuner_priv = dvb->fe[0]->tuner_priv;
 807                 memcpy(&dvb->fe[1]->ops.tuner_ops,
 808                        &dvb->fe[0]->ops.tuner_ops,
 809                        sizeof(dvb->fe[0]->ops.tuner_ops));
 810
 811                 break;
 812         default:
 813                 em28xx_errdev("/2: The frontend of your DVB/ATSC card"
 814                                 " isn't supported yet\n");
 815                 break;
 816         }
 817         if (NULL == dvb->fe[0]) {
 818                 em28xx_errdev("/2: frontend initialization failed\n");
 819                 result = -EINVAL;
 820                 goto out_free;
 821         }
 822         /* define general-purpose callback pointer */
 823         dvb->fe[0]->callback = em28xx_tuner_callback;
 824
 825         /* register everything */
 826         result = register_dvb(dvb, THIS_MODULE, dev, &dev->udev->dev);
 827
 828         if (result < 0)
 829                 goto out_free;
 830
 831         em28xx_info("Successfully loaded em28xx-dvb\n");
 832 ret:
 833         em28xx_set_mode(dev, EM28XX_SUSPEND);
 834         mutex_unlock(&dev->lock);
 835         return result;
 836
 837 out_free:
 838         kfree(dvb);
 839         dev->dvb = NULL;
 840         goto ret;
 841 }
 842
 843 static int dvb_fini(struct em28xx *dev)
 844 {
 845         if (!dev->board.has_dvb) {
 846                 /* This device does not support the extension */
 847                 return 0;
 848         }
 849
 850         if (dev->dvb) {
 851                 unregister_dvb(dev->dvb);
 852                 kfree(dev->dvb);
 853                 dev->dvb = NULL;
 854         }
 855
 856         return 0;
 857 }
 858
 859 static struct em28xx_ops dvb_ops = {
 860         .id   = EM28XX_DVB,
 861         .name = "Em28xx dvb Extension",
 862         .init = dvb_init,
 863         .fini = dvb_fini,
 864 };
 865
 866 static int __init em28xx_dvb_register(void)
 867 {
 868         return em28xx_register_extension(&dvb_ops);
 869 }
 870
 871 static void __exit em28xx_dvb_unregister(void)
 872 {
 873         em28xx_unregister_extension(&dvb_ops);
 874 }
 875
 876 module_init(em28xx_dvb_register);
 877 module_exit(em28xx_dvb_unregister);