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