Pileus Git - ~andy/linux/blob - drivers/media/dvb/dm1105/dm1105.c

   1 /*
   2  * dm1105.c - driver for DVB cards based on SDMC DM1105 PCI chip
   3  *
   4  * Copyright (C) 2008 Igor M. Liplianin <liplianin@me.by>
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation; either version 2 of the License, or
   9  * (at your option) any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  * GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program; if not, write to the Free Software
  18  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  19  *
  20  */
  21
  22 #include <linux/i2c.h>
  23 #include <linux/init.h>
  24 #include <linux/kernel.h>
  25 #include <linux/module.h>
  26 #include <linux/proc_fs.h>
  27 #include <linux/pci.h>
  28 #include <linux/dma-mapping.h>
  29 #include <linux/input.h>
  30 #include <linux/slab.h>
  31 #include <media/ir-common.h>
  32
  33 #include "demux.h"
  34 #include "dmxdev.h"
  35 #include "dvb_demux.h"
  36 #include "dvb_frontend.h"
  37 #include "dvb_net.h"
  38 #include "dvbdev.h"
  39 #include "dvb-pll.h"
  40
  41 #include "stv0299.h"
  42 #include "stv0288.h"
  43 #include "stb6000.h"
  44 #include "si21xx.h"
  45 #include "cx24116.h"
  46 #include "z0194a.h"
  47 #include "ds3000.h"
  48
  49 #define MODULE_NAME "dm1105"
  50
  51 #define UNSET (-1U)
  52
  53 #define DM1105_BOARD_NOAUTO             UNSET
  54 #define DM1105_BOARD_UNKNOWN            0
  55 #define DM1105_BOARD_DVBWORLD_2002      1
  56 #define DM1105_BOARD_DVBWORLD_2004      2
  57 #define DM1105_BOARD_AXESS_DM05         3
  58
  59 /* ----------------------------------------------- */
  60 /*
  61  * PCI ID's
  62  */
  63 #ifndef PCI_VENDOR_ID_TRIGEM
  64 #define PCI_VENDOR_ID_TRIGEM    0x109f
  65 #endif
  66 #ifndef PCI_VENDOR_ID_AXESS
  67 #define PCI_VENDOR_ID_AXESS     0x195d
  68 #endif
  69 #ifndef PCI_DEVICE_ID_DM1105
  70 #define PCI_DEVICE_ID_DM1105    0x036f
  71 #endif
  72 #ifndef PCI_DEVICE_ID_DW2002
  73 #define PCI_DEVICE_ID_DW2002    0x2002
  74 #endif
  75 #ifndef PCI_DEVICE_ID_DW2004
  76 #define PCI_DEVICE_ID_DW2004    0x2004
  77 #endif
  78 #ifndef PCI_DEVICE_ID_DM05
  79 #define PCI_DEVICE_ID_DM05      0x1105
  80 #endif
  81 /* ----------------------------------------------- */
  82 /* sdmc dm1105 registers */
  83
  84 /* TS Control */
  85 #define DM1105_TSCTR                            0x00
  86 #define DM1105_DTALENTH                         0x04
  87
  88 /* GPIO Interface */
  89 #define DM1105_GPIOVAL                          0x08
  90 #define DM1105_GPIOCTR                          0x0c
  91
  92 /* PID serial number */
  93 #define DM1105_PIDN                             0x10
  94
  95 /* Odd-even secret key select */
  96 #define DM1105_CWSEL                            0x14
  97
  98 /* Host Command Interface */
  99 #define DM1105_HOST_CTR                         0x18
 100 #define DM1105_HOST_AD                          0x1c
 101
 102 /* PCI Interface */
 103 #define DM1105_CR                               0x30
 104 #define DM1105_RST                              0x34
 105 #define DM1105_STADR                            0x38
 106 #define DM1105_RLEN                             0x3c
 107 #define DM1105_WRP                              0x40
 108 #define DM1105_INTCNT                           0x44
 109 #define DM1105_INTMAK                           0x48
 110 #define DM1105_INTSTS                           0x4c
 111
 112 /* CW Value */
 113 #define DM1105_ODD                              0x50
 114 #define DM1105_EVEN                             0x58
 115
 116 /* PID Value */
 117 #define DM1105_PID                              0x60
 118
 119 /* IR Control */
 120 #define DM1105_IRCTR                            0x64
 121 #define DM1105_IRMODE                           0x68
 122 #define DM1105_SYSTEMCODE                       0x6c
 123 #define DM1105_IRCODE                           0x70
 124
 125 /* Unknown Values */
 126 #define DM1105_ENCRYPT                          0x74
 127 #define DM1105_VER                              0x7c
 128
 129 /* I2C Interface */
 130 #define DM1105_I2CCTR                           0x80
 131 #define DM1105_I2CSTS                           0x81
 132 #define DM1105_I2CDAT                           0x82
 133 #define DM1105_I2C_RA                           0x83
 134 /* ----------------------------------------------- */
 135 /* Interrupt Mask Bits */
 136
 137 #define INTMAK_TSIRQM                           0x01
 138 #define INTMAK_HIRQM                            0x04
 139 #define INTMAK_IRM                              0x08
 140 #define INTMAK_ALLMASK                          (INTMAK_TSIRQM | \
 141                                                 INTMAK_HIRQM | \
 142                                                 INTMAK_IRM)
 143 #define INTMAK_NONEMASK                         0x00
 144
 145 /* Interrupt Status Bits */
 146 #define INTSTS_TSIRQ                            0x01
 147 #define INTSTS_HIRQ                             0x04
 148 #define INTSTS_IR                               0x08
 149
 150 /* IR Control Bits */
 151 #define DM1105_IR_EN                            0x01
 152 #define DM1105_SYS_CHK                          0x02
 153 #define DM1105_REP_FLG                          0x08
 154
 155 /* EEPROM addr */
 156 #define IIC_24C01_addr                          0xa0
 157 /* Max board count */
 158 #define DM1105_MAX                              0x04
 159
 160 #define DRIVER_NAME                             "dm1105"
 161
 162 #define DM1105_DMA_PACKETS                      47
 163 #define DM1105_DMA_PACKET_LENGTH                (128*4)
 164 #define DM1105_DMA_BYTES                        (128 * 4 * DM1105_DMA_PACKETS)
 165
 166 /* GPIO's for LNB power control */
 167 #define DM1105_LNB_MASK                         0x00000000
 168 #define DM1105_LNB_OFF                          0x00020000
 169 #define DM1105_LNB_13V                          0x00010100
 170 #define DM1105_LNB_18V                          0x00000100
 171
 172 /* GPIO's for LNB power control for Axess DM05 */
 173 #define DM05_LNB_MASK                           0x00000000
 174 #define DM05_LNB_OFF                            0x00020000/* actually 13v */
 175 #define DM05_LNB_13V                            0x00020000
 176 #define DM05_LNB_18V                            0x00030000
 177
 178 static unsigned int card[]  = {[0 ... 3] = UNSET };
 179 module_param_array(card,  int, NULL, 0444);
 180 MODULE_PARM_DESC(card, "card type");
 181
 182 static int ir_debug;
 183 module_param(ir_debug, int, 0644);
 184 MODULE_PARM_DESC(ir_debug, "enable debugging information for IR decoding");
 185
 186 static unsigned int dm1105_devcount;
 187
 188 DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
 189
 190 struct dm1105_board {
 191         char                    *name;
 192 };
 193
 194 struct dm1105_subid {
 195         u16     subvendor;
 196         u16     subdevice;
 197         u32     card;
 198 };
 199
 200 static const struct dm1105_board dm1105_boards[] = {
 201         [DM1105_BOARD_UNKNOWN] = {
 202                 .name           = "UNKNOWN/GENERIC",
 203         },
 204         [DM1105_BOARD_DVBWORLD_2002] = {
 205                 .name           = "DVBWorld PCI 2002",
 206         },
 207         [DM1105_BOARD_DVBWORLD_2004] = {
 208                 .name           = "DVBWorld PCI 2004",
 209         },
 210         [DM1105_BOARD_AXESS_DM05] = {
 211                 .name           = "Axess/EasyTv DM05",
 212         },
 213 };
 214
 215 static const struct dm1105_subid dm1105_subids[] = {
 216         {
 217                 .subvendor = 0x0000,
 218                 .subdevice = 0x2002,
 219                 .card      = DM1105_BOARD_DVBWORLD_2002,
 220         }, {
 221                 .subvendor = 0x0001,
 222                 .subdevice = 0x2002,
 223                 .card      = DM1105_BOARD_DVBWORLD_2002,
 224         }, {
 225                 .subvendor = 0x0000,
 226                 .subdevice = 0x2004,
 227                 .card      = DM1105_BOARD_DVBWORLD_2004,
 228         }, {
 229                 .subvendor = 0x0001,
 230                 .subdevice = 0x2004,
 231                 .card      = DM1105_BOARD_DVBWORLD_2004,
 232         }, {
 233                 .subvendor = 0x195d,
 234                 .subdevice = 0x1105,
 235                 .card      = DM1105_BOARD_AXESS_DM05,
 236         },
 237 };
 238
 239 static void dm1105_card_list(struct pci_dev *pci)
 240 {
 241         int i;
 242
 243         if (0 == pci->subsystem_vendor &&
 244                         0 == pci->subsystem_device) {
 245                 printk(KERN_ERR
 246                         "dm1105: Your board has no valid PCI Subsystem ID\n"
 247                         "dm1105: and thus can't be autodetected\n"
 248                         "dm1105: Please pass card=<n> insmod option to\n"
 249                         "dm1105: workaround that.  Redirect complaints to\n"
 250                         "dm1105: the vendor of the TV card.  Best regards,\n"
 251                         "dm1105: -- tux\n");
 252         } else {
 253                 printk(KERN_ERR
 254                         "dm1105: Your board isn't known (yet) to the driver.\n"
 255                         "dm1105: You can try to pick one of the existing\n"
 256                         "dm1105: card configs via card=<n> insmod option.\n"
 257                         "dm1105: Updating to the latest version might help\n"
 258                         "dm1105: as well.\n");
 259         }
 260         printk(KERN_ERR "Here is a list of valid choices for the card=<n> "
 261                    "insmod option:\n");
 262         for (i = 0; i < ARRAY_SIZE(dm1105_boards); i++)
 263                 printk(KERN_ERR "dm1105:    card=%d -> %s\n",
 264                                 i, dm1105_boards[i].name);
 265 }
 266
 267 /* infrared remote control */
 268 struct infrared {
 269         struct input_dev        *input_dev;
 270         struct ir_input_state   ir;
 271         char                    input_phys[32];
 272         struct work_struct      work;
 273         u32                     ir_command;
 274 };
 275
 276 struct dm1105_dev {
 277         /* pci */
 278         struct pci_dev *pdev;
 279         u8 __iomem *io_mem;
 280
 281         /* ir */
 282         struct infrared ir;
 283
 284         /* dvb */
 285         struct dmx_frontend hw_frontend;
 286         struct dmx_frontend mem_frontend;
 287         struct dmxdev dmxdev;
 288         struct dvb_adapter dvb_adapter;
 289         struct dvb_demux demux;
 290         struct dvb_frontend *fe;
 291         struct dvb_net dvbnet;
 292         unsigned int full_ts_users;
 293         unsigned int boardnr;
 294         int nr;
 295
 296         /* i2c */
 297         struct i2c_adapter i2c_adap;
 298
 299         /* irq */
 300         struct work_struct work;
 301         struct workqueue_struct *wq;
 302         char wqn[16];
 303
 304         /* dma */
 305         dma_addr_t dma_addr;
 306         unsigned char *ts_buf;
 307         u32 wrp;
 308         u32 nextwrp;
 309         u32 buffer_size;
 310         unsigned int    PacketErrorCount;
 311         unsigned int dmarst;
 312         spinlock_t lock;
 313 };
 314
 315 #define dm_io_mem(reg)  ((unsigned long)(&dev->io_mem[reg]))
 316
 317 #define dm_readb(reg)           inb(dm_io_mem(reg))
 318 #define dm_writeb(reg, value)   outb((value), (dm_io_mem(reg)))
 319
 320 #define dm_readw(reg)           inw(dm_io_mem(reg))
 321 #define dm_writew(reg, value)   outw((value), (dm_io_mem(reg)))
 322
 323 #define dm_readl(reg)           inl(dm_io_mem(reg))
 324 #define dm_writel(reg, value)   outl((value), (dm_io_mem(reg)))
 325
 326 #define dm_andorl(reg, mask, value) \
 327         outl((inl(dm_io_mem(reg)) & ~(mask)) |\
 328                 ((value) & (mask)), (dm_io_mem(reg)))
 329
 330 #define dm_setl(reg, bit)       dm_andorl((reg), (bit), (bit))
 331 #define dm_clearl(reg, bit)     dm_andorl((reg), (bit), 0)
 332
 333 static int dm1105_i2c_xfer(struct i2c_adapter *i2c_adap,
 334                             struct i2c_msg *msgs, int num)
 335 {
 336         struct dm1105_dev *dev ;
 337
 338         int addr, rc, i, j, k, len, byte, data;
 339         u8 status;
 340
 341         dev = i2c_adap->algo_data;
 342         for (i = 0; i < num; i++) {
 343                 dm_writeb(DM1105_I2CCTR, 0x00);
 344                 if (msgs[i].flags & I2C_M_RD) {
 345                         /* read bytes */
 346                         addr  = msgs[i].addr << 1;
 347                         addr |= 1;
 348                         dm_writeb(DM1105_I2CDAT, addr);
 349                         for (byte = 0; byte < msgs[i].len; byte++)
 350                                 dm_writeb(DM1105_I2CDAT + byte + 1, 0);
 351
 352                         dm_writeb(DM1105_I2CCTR, 0x81 + msgs[i].len);
 353                         for (j = 0; j < 55; j++) {
 354                                 mdelay(10);
 355                                 status = dm_readb(DM1105_I2CSTS);
 356                                 if ((status & 0xc0) == 0x40)
 357                                         break;
 358                         }
 359                         if (j >= 55)
 360                                 return -1;
 361
 362                         for (byte = 0; byte < msgs[i].len; byte++) {
 363                                 rc = dm_readb(DM1105_I2CDAT + byte + 1);
 364                                 if (rc < 0)
 365                                         goto err;
 366                                 msgs[i].buf[byte] = rc;
 367                         }
 368                 } else if ((msgs[i].buf[0] == 0xf7) && (msgs[i].addr == 0x55)) {
 369                         /* prepaired for cx24116 firmware */
 370                         /* Write in small blocks */
 371                         len = msgs[i].len - 1;
 372                         k = 1;
 373                         do {
 374                                 dm_writeb(DM1105_I2CDAT, msgs[i].addr << 1);
 375                                 dm_writeb(DM1105_I2CDAT + 1, 0xf7);
 376                                 for (byte = 0; byte < (len > 48 ? 48 : len); byte++) {
 377                                         data = msgs[i].buf[k + byte];
 378                                         dm_writeb(DM1105_I2CDAT + byte + 2, data);
 379                                 }
 380                                 dm_writeb(DM1105_I2CCTR, 0x82 + (len > 48 ? 48 : len));
 381                                 for (j = 0; j < 25; j++) {
 382                                         mdelay(10);
 383                                         status = dm_readb(DM1105_I2CSTS);
 384                                         if ((status & 0xc0) == 0x40)
 385                                                 break;
 386                                 }
 387
 388                                 if (j >= 25)
 389                                         return -1;
 390
 391                                 k += 48;
 392                                 len -= 48;
 393                         } while (len > 0);
 394                 } else {
 395                         /* write bytes */
 396                         dm_writeb(DM1105_I2CDAT, msgs[i].addr << 1);
 397                         for (byte = 0; byte < msgs[i].len; byte++) {
 398                                 data = msgs[i].buf[byte];
 399                                 dm_writeb(DM1105_I2CDAT + byte + 1, data);
 400                         }
 401                         dm_writeb(DM1105_I2CCTR, 0x81 + msgs[i].len);
 402                         for (j = 0; j < 25; j++) {
 403                                 mdelay(10);
 404                                 status = dm_readb(DM1105_I2CSTS);
 405                                 if ((status & 0xc0) == 0x40)
 406                                         break;
 407                         }
 408
 409                         if (j >= 25)
 410                                 return -1;
 411                 }
 412         }
 413         return num;
 414  err:
 415         return rc;
 416 }
 417
 418 static u32 functionality(struct i2c_adapter *adap)
 419 {
 420         return I2C_FUNC_I2C;
 421 }
 422
 423 static struct i2c_algorithm dm1105_algo = {
 424         .master_xfer   = dm1105_i2c_xfer,
 425         .functionality = functionality,
 426 };
 427
 428 static inline struct dm1105_dev *feed_to_dm1105_dev(struct dvb_demux_feed *feed)
 429 {
 430         return container_of(feed->demux, struct dm1105_dev, demux);
 431 }
 432
 433 static inline struct dm1105_dev *frontend_to_dm1105_dev(struct dvb_frontend *fe)
 434 {
 435         return container_of(fe->dvb, struct dm1105_dev, dvb_adapter);
 436 }
 437
 438 static int dm1105_set_voltage(struct dvb_frontend *fe, fe_sec_voltage_t voltage)
 439 {
 440         struct dm1105_dev *dev = frontend_to_dm1105_dev(fe);
 441         u32 lnb_mask, lnb_13v, lnb_18v, lnb_off;
 442
 443         switch (dev->boardnr) {
 444         case DM1105_BOARD_AXESS_DM05:
 445                 lnb_mask = DM05_LNB_MASK;
 446                 lnb_off = DM05_LNB_OFF;
 447                 lnb_13v = DM05_LNB_13V;
 448                 lnb_18v = DM05_LNB_18V;
 449                 break;
 450         case DM1105_BOARD_DVBWORLD_2002:
 451         case DM1105_BOARD_DVBWORLD_2004:
 452         default:
 453                 lnb_mask = DM1105_LNB_MASK;
 454                 lnb_off = DM1105_LNB_OFF;
 455                 lnb_13v = DM1105_LNB_13V;
 456                 lnb_18v = DM1105_LNB_18V;
 457         }
 458
 459         dm_writel(DM1105_GPIOCTR, lnb_mask);
 460         if (voltage == SEC_VOLTAGE_18)
 461                 dm_writel(DM1105_GPIOVAL, lnb_18v);
 462         else if (voltage == SEC_VOLTAGE_13)
 463                 dm_writel(DM1105_GPIOVAL, lnb_13v);
 464         else
 465                 dm_writel(DM1105_GPIOVAL, lnb_off);
 466
 467         return 0;
 468 }
 469
 470 static void dm1105_set_dma_addr(struct dm1105_dev *dev)
 471 {
 472         dm_writel(DM1105_STADR, cpu_to_le32(dev->dma_addr));
 473 }
 474
 475 static int __devinit dm1105_dma_map(struct dm1105_dev *dev)
 476 {
 477         dev->ts_buf = pci_alloc_consistent(dev->pdev,
 478                                         6 * DM1105_DMA_BYTES,
 479                                         &dev->dma_addr);
 480
 481         return !dev->ts_buf;
 482 }
 483
 484 static void dm1105_dma_unmap(struct dm1105_dev *dev)
 485 {
 486         pci_free_consistent(dev->pdev,
 487                         6 * DM1105_DMA_BYTES,
 488                         dev->ts_buf,
 489                         dev->dma_addr);
 490 }
 491
 492 static void dm1105_enable_irqs(struct dm1105_dev *dev)
 493 {
 494         dm_writeb(DM1105_INTMAK, INTMAK_ALLMASK);
 495         dm_writeb(DM1105_CR, 1);
 496 }
 497
 498 static void dm1105_disable_irqs(struct dm1105_dev *dev)
 499 {
 500         dm_writeb(DM1105_INTMAK, INTMAK_IRM);
 501         dm_writeb(DM1105_CR, 0);
 502 }
 503
 504 static int dm1105_start_feed(struct dvb_demux_feed *f)
 505 {
 506         struct dm1105_dev *dev = feed_to_dm1105_dev(f);
 507
 508         if (dev->full_ts_users++ == 0)
 509                 dm1105_enable_irqs(dev);
 510
 511         return 0;
 512 }
 513
 514 static int dm1105_stop_feed(struct dvb_demux_feed *f)
 515 {
 516         struct dm1105_dev *dev = feed_to_dm1105_dev(f);
 517
 518         if (--dev->full_ts_users == 0)
 519                 dm1105_disable_irqs(dev);
 520
 521         return 0;
 522 }
 523
 524 /* ir work handler */
 525 static void dm1105_emit_key(struct work_struct *work)
 526 {
 527         struct infrared *ir = container_of(work, struct infrared, work);
 528         u32 ircom = ir->ir_command;
 529         u8 data;
 530
 531         if (ir_debug)
 532                 printk(KERN_INFO "%s: received byte 0x%04x\n", __func__, ircom);
 533
 534         data = (ircom >> 8) & 0x7f;
 535
 536         ir_input_keydown(ir->input_dev, &ir->ir, data);
 537         ir_input_nokey(ir->input_dev, &ir->ir);
 538 }
 539
 540 /* work handler */
 541 static void dm1105_dmx_buffer(struct work_struct *work)
 542 {
 543         struct dm1105_dev *dev = container_of(work, struct dm1105_dev, work);
 544         unsigned int nbpackets;
 545         u32 oldwrp = dev->wrp;
 546         u32 nextwrp = dev->nextwrp;
 547
 548         if (!((dev->ts_buf[oldwrp] == 0x47) &&
 549                         (dev->ts_buf[oldwrp + 188] == 0x47) &&
 550                         (dev->ts_buf[oldwrp + 188 * 2] == 0x47))) {
 551                 dev->PacketErrorCount++;
 552                 /* bad packet found */
 553                 if ((dev->PacketErrorCount >= 2) &&
 554                                 (dev->dmarst == 0)) {
 555                         dm_writeb(DM1105_RST, 1);
 556                         dev->wrp = 0;
 557                         dev->PacketErrorCount = 0;
 558                         dev->dmarst = 0;
 559                         return;
 560                 }
 561         }
 562
 563         if (nextwrp < oldwrp) {
 564                 memcpy(dev->ts_buf + dev->buffer_size, dev->ts_buf, nextwrp);
 565                 nbpackets = ((dev->buffer_size - oldwrp) + nextwrp) / 188;
 566         } else
 567                 nbpackets = (nextwrp - oldwrp) / 188;
 568
 569         dev->wrp = nextwrp;
 570         dvb_dmx_swfilter_packets(&dev->demux, &dev->ts_buf[oldwrp], nbpackets);
 571 }
 572
 573 static irqreturn_t dm1105_irq(int irq, void *dev_id)
 574 {
 575         struct dm1105_dev *dev = dev_id;
 576
 577         /* Read-Write INSTS Ack's Interrupt for DM1105 chip 16.03.2008 */
 578         unsigned int intsts = dm_readb(DM1105_INTSTS);
 579         dm_writeb(DM1105_INTSTS, intsts);
 580
 581         switch (intsts) {
 582         case INTSTS_TSIRQ:
 583         case (INTSTS_TSIRQ | INTSTS_IR):
 584                 dev->nextwrp = dm_readl(DM1105_WRP) - dm_readl(DM1105_STADR);
 585                 queue_work(dev->wq, &dev->work);
 586                 break;
 587         case INTSTS_IR:
 588                 dev->ir.ir_command = dm_readl(DM1105_IRCODE);
 589                 schedule_work(&dev->ir.work);
 590                 break;
 591         }
 592
 593         return IRQ_HANDLED;
 594 }
 595
 596 int __devinit dm1105_ir_init(struct dm1105_dev *dm1105)
 597 {
 598         struct input_dev *input_dev;
 599         char *ir_codes = NULL;
 600         u64 ir_type = IR_TYPE_OTHER;
 601         int err = -ENOMEM;
 602
 603         input_dev = input_allocate_device();
 604         if (!input_dev)
 605                 return -ENOMEM;
 606
 607         dm1105->ir.input_dev = input_dev;
 608         snprintf(dm1105->ir.input_phys, sizeof(dm1105->ir.input_phys),
 609                 "pci-%s/ir0", pci_name(dm1105->pdev));
 610
 611         err = ir_input_init(input_dev, &dm1105->ir.ir, ir_type);
 612         if (err < 0) {
 613                 input_free_device(input_dev);
 614                 return err;
 615         }
 616
 617         input_dev->name = "DVB on-card IR receiver";
 618         input_dev->phys = dm1105->ir.input_phys;
 619         input_dev->id.bustype = BUS_PCI;
 620         input_dev->id.version = 1;
 621         if (dm1105->pdev->subsystem_vendor) {
 622                 input_dev->id.vendor = dm1105->pdev->subsystem_vendor;
 623                 input_dev->id.product = dm1105->pdev->subsystem_device;
 624         } else {
 625                 input_dev->id.vendor = dm1105->pdev->vendor;
 626                 input_dev->id.product = dm1105->pdev->device;
 627         }
 628
 629         input_dev->dev.parent = &dm1105->pdev->dev;
 630
 631         INIT_WORK(&dm1105->ir.work, dm1105_emit_key);
 632
 633         err = ir_input_register(input_dev, ir_codes, NULL, MODULE_NAME);
 634
 635         return err;
 636 }
 637
 638 void __devexit dm1105_ir_exit(struct dm1105_dev *dm1105)
 639 {
 640         ir_input_unregister(dm1105->ir.input_dev);
 641 }
 642
 643 static int __devinit dm1105_hw_init(struct dm1105_dev *dev)
 644 {
 645         dm1105_disable_irqs(dev);
 646
 647         dm_writeb(DM1105_HOST_CTR, 0);
 648
 649         /*DATALEN 188,*/
 650         dm_writeb(DM1105_DTALENTH, 188);
 651         /*TS_STRT TS_VALP MSBFIRST TS_MODE ALPAS TSPES*/
 652         dm_writew(DM1105_TSCTR, 0xc10a);
 653
 654         /* map DMA and set address */
 655         dm1105_dma_map(dev);
 656         dm1105_set_dma_addr(dev);
 657         /* big buffer */
 658         dm_writel(DM1105_RLEN, 5 * DM1105_DMA_BYTES);
 659         dm_writeb(DM1105_INTCNT, 47);
 660
 661         /* IR NEC mode enable */
 662         dm_writeb(DM1105_IRCTR, (DM1105_IR_EN | DM1105_SYS_CHK));
 663         dm_writeb(DM1105_IRMODE, 0);
 664         dm_writew(DM1105_SYSTEMCODE, 0);
 665
 666         return 0;
 667 }
 668
 669 static void dm1105_hw_exit(struct dm1105_dev *dev)
 670 {
 671         dm1105_disable_irqs(dev);
 672
 673         /* IR disable */
 674         dm_writeb(DM1105_IRCTR, 0);
 675         dm_writeb(DM1105_INTMAK, INTMAK_NONEMASK);
 676
 677         dm1105_dma_unmap(dev);
 678 }
 679
 680 static struct stv0299_config sharp_z0194a_config = {
 681         .demod_address = 0x68,
 682         .inittab = sharp_z0194a_inittab,
 683         .mclk = 88000000UL,
 684         .invert = 1,
 685         .skip_reinit = 0,
 686         .lock_output = STV0299_LOCKOUTPUT_1,
 687         .volt13_op0_op1 = STV0299_VOLT13_OP1,
 688         .min_delay_ms = 100,
 689         .set_symbol_rate = sharp_z0194a_set_symbol_rate,
 690 };
 691
 692 static struct stv0288_config earda_config = {
 693         .demod_address = 0x68,
 694         .min_delay_ms = 100,
 695 };
 696
 697 static struct si21xx_config serit_config = {
 698         .demod_address = 0x68,
 699         .min_delay_ms = 100,
 700
 701 };
 702
 703 static struct cx24116_config serit_sp2633_config = {
 704         .demod_address = 0x55,
 705 };
 706
 707 static struct ds3000_config dvbworld_ds3000_config = {
 708         .demod_address = 0x68,
 709 };
 710
 711 static int __devinit frontend_init(struct dm1105_dev *dev)
 712 {
 713         int ret;
 714
 715         switch (dev->boardnr) {
 716         case DM1105_BOARD_DVBWORLD_2004:
 717                 dev->fe = dvb_attach(
 718                         cx24116_attach, &serit_sp2633_config,
 719                         &dev->i2c_adap);
 720                 if (dev->fe) {
 721                         dev->fe->ops.set_voltage = dm1105_set_voltage;
 722                         break;
 723                 }
 724
 725                 dev->fe = dvb_attach(
 726                         ds3000_attach, &dvbworld_ds3000_config,
 727                         &dev->i2c_adap);
 728                 if (dev->fe)
 729                         dev->fe->ops.set_voltage = dm1105_set_voltage;
 730
 731                 break;
 732         case DM1105_BOARD_DVBWORLD_2002:
 733         case DM1105_BOARD_AXESS_DM05:
 734         default:
 735                 dev->fe = dvb_attach(
 736                         stv0299_attach, &sharp_z0194a_config,
 737                         &dev->i2c_adap);
 738                 if (dev->fe) {
 739                         dev->fe->ops.set_voltage = dm1105_set_voltage;
 740                         dvb_attach(dvb_pll_attach, dev->fe, 0x60,
 741                                         &dev->i2c_adap, DVB_PLL_OPERA1);
 742                         break;
 743                 }
 744
 745                 dev->fe = dvb_attach(
 746                         stv0288_attach, &earda_config,
 747                         &dev->i2c_adap);
 748                 if (dev->fe) {
 749                         dev->fe->ops.set_voltage = dm1105_set_voltage;
 750                         dvb_attach(stb6000_attach, dev->fe, 0x61,
 751                                         &dev->i2c_adap);
 752                         break;
 753                 }
 754
 755                 dev->fe = dvb_attach(
 756                         si21xx_attach, &serit_config,
 757                         &dev->i2c_adap);
 758                 if (dev->fe)
 759                         dev->fe->ops.set_voltage = dm1105_set_voltage;
 760
 761         }
 762
 763         if (!dev->fe) {
 764                 dev_err(&dev->pdev->dev, "could not attach frontend\n");
 765                 return -ENODEV;
 766         }
 767
 768         ret = dvb_register_frontend(&dev->dvb_adapter, dev->fe);
 769         if (ret < 0) {
 770                 if (dev->fe->ops.release)
 771                         dev->fe->ops.release(dev->fe);
 772                 dev->fe = NULL;
 773                 return ret;
 774         }
 775
 776         return 0;
 777 }
 778
 779 static void __devinit dm1105_read_mac(struct dm1105_dev *dev, u8 *mac)
 780 {
 781         static u8 command[1] = { 0x28 };
 782
 783         struct i2c_msg msg[] = {
 784                 {
 785                         .addr = IIC_24C01_addr >> 1,
 786                         .flags = 0,
 787                         .buf = command,
 788                         .len = 1
 789                 }, {
 790                         .addr = IIC_24C01_addr >> 1,
 791                         .flags = I2C_M_RD,
 792                         .buf = mac,
 793                         .len = 6
 794                 },
 795         };
 796
 797         dm1105_i2c_xfer(&dev->i2c_adap, msg , 2);
 798         dev_info(&dev->pdev->dev, "MAC %pM\n", mac);
 799 }
 800
 801 static int __devinit dm1105_probe(struct pci_dev *pdev,
 802                                   const struct pci_device_id *ent)
 803 {
 804         struct dm1105_dev *dev;
 805         struct dvb_adapter *dvb_adapter;
 806         struct dvb_demux *dvbdemux;
 807         struct dmx_demux *dmx;
 808         int ret = -ENOMEM;
 809         int i;
 810
 811         dev = kzalloc(sizeof(struct dm1105_dev), GFP_KERNEL);
 812         if (!dev)
 813                 return -ENOMEM;
 814
 815         /* board config */
 816         dev->nr = dm1105_devcount;
 817         dev->boardnr = UNSET;
 818         if (card[dev->nr] < ARRAY_SIZE(dm1105_boards))
 819                 dev->boardnr = card[dev->nr];
 820         for (i = 0; UNSET == dev->boardnr &&
 821                                 i < ARRAY_SIZE(dm1105_subids); i++)
 822                 if (pdev->subsystem_vendor ==
 823                         dm1105_subids[i].subvendor &&
 824                                 pdev->subsystem_device ==
 825                                         dm1105_subids[i].subdevice)
 826                         dev->boardnr = dm1105_subids[i].card;
 827
 828         if (UNSET == dev->boardnr) {
 829                 dev->boardnr = DM1105_BOARD_UNKNOWN;
 830                 dm1105_card_list(pdev);
 831         }
 832
 833         dm1105_devcount++;
 834         dev->pdev = pdev;
 835         dev->buffer_size = 5 * DM1105_DMA_BYTES;
 836         dev->PacketErrorCount = 0;
 837         dev->dmarst = 0;
 838
 839         ret = pci_enable_device(pdev);
 840         if (ret < 0)
 841                 goto err_kfree;
 842
 843         ret = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
 844         if (ret < 0)
 845                 goto err_pci_disable_device;
 846
 847         pci_set_master(pdev);
 848
 849         ret = pci_request_regions(pdev, DRIVER_NAME);
 850         if (ret < 0)
 851                 goto err_pci_disable_device;
 852
 853         dev->io_mem = pci_iomap(pdev, 0, pci_resource_len(pdev, 0));
 854         if (!dev->io_mem) {
 855                 ret = -EIO;
 856                 goto err_pci_release_regions;
 857         }
 858
 859         spin_lock_init(&dev->lock);
 860         pci_set_drvdata(pdev, dev);
 861
 862         ret = dm1105_hw_init(dev);
 863         if (ret < 0)
 864                 goto err_pci_iounmap;
 865
 866         /* i2c */
 867         i2c_set_adapdata(&dev->i2c_adap, dev);
 868         strcpy(dev->i2c_adap.name, DRIVER_NAME);
 869         dev->i2c_adap.owner = THIS_MODULE;
 870         dev->i2c_adap.class = I2C_CLASS_TV_DIGITAL;
 871         dev->i2c_adap.dev.parent = &pdev->dev;
 872         dev->i2c_adap.algo = &dm1105_algo;
 873         dev->i2c_adap.algo_data = dev;
 874         ret = i2c_add_adapter(&dev->i2c_adap);
 875
 876         if (ret < 0)
 877                 goto err_dm1105_hw_exit;
 878
 879         /* dvb */
 880         ret = dvb_register_adapter(&dev->dvb_adapter, DRIVER_NAME,
 881                                         THIS_MODULE, &pdev->dev, adapter_nr);
 882         if (ret < 0)
 883                 goto err_i2c_del_adapter;
 884
 885         dvb_adapter = &dev->dvb_adapter;
 886
 887         dm1105_read_mac(dev, dvb_adapter->proposed_mac);
 888
 889         dvbdemux = &dev->demux;
 890         dvbdemux->filternum = 256;
 891         dvbdemux->feednum = 256;
 892         dvbdemux->start_feed = dm1105_start_feed;
 893         dvbdemux->stop_feed = dm1105_stop_feed;
 894         dvbdemux->dmx.capabilities = (DMX_TS_FILTERING |
 895                         DMX_SECTION_FILTERING | DMX_MEMORY_BASED_FILTERING);
 896         ret = dvb_dmx_init(dvbdemux);
 897         if (ret < 0)
 898                 goto err_dvb_unregister_adapter;
 899
 900         dmx = &dvbdemux->dmx;
 901         dev->dmxdev.filternum = 256;
 902         dev->dmxdev.demux = dmx;
 903         dev->dmxdev.capabilities = 0;
 904
 905         ret = dvb_dmxdev_init(&dev->dmxdev, dvb_adapter);
 906         if (ret < 0)
 907                 goto err_dvb_dmx_release;
 908
 909         dev->hw_frontend.source = DMX_FRONTEND_0;
 910
 911         ret = dmx->add_frontend(dmx, &dev->hw_frontend);
 912         if (ret < 0)
 913                 goto err_dvb_dmxdev_release;
 914
 915         dev->mem_frontend.source = DMX_MEMORY_FE;
 916
 917         ret = dmx->add_frontend(dmx, &dev->mem_frontend);
 918         if (ret < 0)
 919                 goto err_remove_hw_frontend;
 920
 921         ret = dmx->connect_frontend(dmx, &dev->hw_frontend);
 922         if (ret < 0)
 923                 goto err_remove_mem_frontend;
 924
 925         ret = frontend_init(dev);
 926         if (ret < 0)
 927                 goto err_disconnect_frontend;
 928
 929         dvb_net_init(dvb_adapter, &dev->dvbnet, dmx);
 930         dm1105_ir_init(dev);
 931
 932         INIT_WORK(&dev->work, dm1105_dmx_buffer);
 933         sprintf(dev->wqn, "%s/%d", dvb_adapter->name, dvb_adapter->num);
 934         dev->wq = create_singlethread_workqueue(dev->wqn);
 935         if (!dev->wq)
 936                 goto err_dvb_net;
 937
 938         ret = request_irq(pdev->irq, dm1105_irq, IRQF_SHARED,
 939                                                 DRIVER_NAME, dev);
 940         if (ret < 0)
 941                 goto err_workqueue;
 942
 943         return 0;
 944
 945 err_workqueue:
 946         destroy_workqueue(dev->wq);
 947 err_dvb_net:
 948         dvb_net_release(&dev->dvbnet);
 949 err_disconnect_frontend:
 950         dmx->disconnect_frontend(dmx);
 951 err_remove_mem_frontend:
 952         dmx->remove_frontend(dmx, &dev->mem_frontend);
 953 err_remove_hw_frontend:
 954         dmx->remove_frontend(dmx, &dev->hw_frontend);
 955 err_dvb_dmxdev_release:
 956         dvb_dmxdev_release(&dev->dmxdev);
 957 err_dvb_dmx_release:
 958         dvb_dmx_release(dvbdemux);
 959 err_dvb_unregister_adapter:
 960         dvb_unregister_adapter(dvb_adapter);
 961 err_i2c_del_adapter:
 962         i2c_del_adapter(&dev->i2c_adap);
 963 err_dm1105_hw_exit:
 964         dm1105_hw_exit(dev);
 965 err_pci_iounmap:
 966         pci_iounmap(pdev, dev->io_mem);
 967 err_pci_release_regions:
 968         pci_release_regions(pdev);
 969 err_pci_disable_device:
 970         pci_disable_device(pdev);
 971 err_kfree:
 972         pci_set_drvdata(pdev, NULL);
 973         kfree(dev);
 974         return ret;
 975 }
 976
 977 static void __devexit dm1105_remove(struct pci_dev *pdev)
 978 {
 979         struct dm1105_dev *dev = pci_get_drvdata(pdev);
 980         struct dvb_adapter *dvb_adapter = &dev->dvb_adapter;
 981         struct dvb_demux *dvbdemux = &dev->demux;
 982         struct dmx_demux *dmx = &dvbdemux->dmx;
 983
 984         dm1105_ir_exit(dev);
 985         dmx->close(dmx);
 986         dvb_net_release(&dev->dvbnet);
 987         if (dev->fe)
 988                 dvb_unregister_frontend(dev->fe);
 989
 990         dmx->disconnect_frontend(dmx);
 991         dmx->remove_frontend(dmx, &dev->mem_frontend);
 992         dmx->remove_frontend(dmx, &dev->hw_frontend);
 993         dvb_dmxdev_release(&dev->dmxdev);
 994         dvb_dmx_release(dvbdemux);
 995         dvb_unregister_adapter(dvb_adapter);
 996         if (&dev->i2c_adap)
 997                 i2c_del_adapter(&dev->i2c_adap);
 998
 999         dm1105_hw_exit(dev);
1000         synchronize_irq(pdev->irq);
1001         free_irq(pdev->irq, dev);
1002         pci_iounmap(pdev, dev->io_mem);
1003         pci_release_regions(pdev);
1004         pci_disable_device(pdev);
1005         pci_set_drvdata(pdev, NULL);
1006         dm1105_devcount--;
1007         kfree(dev);
1008 }
1009
1010 static struct pci_device_id dm1105_id_table[] __devinitdata = {
1011         {
1012                 .vendor = PCI_VENDOR_ID_TRIGEM,
1013                 .device = PCI_DEVICE_ID_DM1105,
1014                 .subvendor = PCI_ANY_ID,
1015                 .subdevice = PCI_ANY_ID,
1016         }, {
1017                 .vendor = PCI_VENDOR_ID_AXESS,
1018                 .device = PCI_DEVICE_ID_DM05,
1019                 .subvendor = PCI_ANY_ID,
1020                 .subdevice = PCI_ANY_ID,
1021         }, {
1022                 /* empty */
1023         },
1024 };
1025
1026 MODULE_DEVICE_TABLE(pci, dm1105_id_table);
1027
1028 static struct pci_driver dm1105_driver = {
1029         .name = DRIVER_NAME,
1030         .id_table = dm1105_id_table,
1031         .probe = dm1105_probe,
1032         .remove = __devexit_p(dm1105_remove),
1033 };
1034
1035 static int __init dm1105_init(void)
1036 {
1037         return pci_register_driver(&dm1105_driver);
1038 }
1039
1040 static void __exit dm1105_exit(void)
1041 {
1042         pci_unregister_driver(&dm1105_driver);
1043 }
1044
1045 module_init(dm1105_init);
1046 module_exit(dm1105_exit);
1047
1048 MODULE_AUTHOR("Igor M. Liplianin <liplianin@me.by>");
1049 MODULE_DESCRIPTION("SDMC DM1105 DVB driver");
1050 MODULE_LICENSE("GPL");