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