drivers/media/pci/smipcie/smipcie.c

   1 /*
   2  * SMI PCIe driver for DVBSky cards.
   3  *
   4  * Copyright (C) 2014 Max nibble <nibble.max@gmail.com>
   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
  17 #include "smipcie.h"
  18 #include "m88ds3103.h"
  19 #include "m88ts2022.h"
  20 #include "m88rs6000t.h"
  21 #include "si2168.h"
  22 #include "si2157.h"
  23
  24 DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
  25
  26 static int smi_hw_init(struct smi_dev *dev)
  27 {
  28         u32 port_mux, port_ctrl, int_stat;
  29
  30         /* set port mux.*/
  31         port_mux = smi_read(MUX_MODE_CTRL);
  32         port_mux &= ~(rbPaMSMask);
  33         port_mux |= rbPaMSDtvNoGpio;
  34         port_mux &= ~(rbPbMSMask);
  35         port_mux |= rbPbMSDtvNoGpio;
  36         port_mux &= ~(0x0f0000);
  37         port_mux |= 0x50000;
  38         smi_write(MUX_MODE_CTRL, port_mux);
  39
  40         /* set DTV register.*/
  41         /* Port A */
  42         port_ctrl = smi_read(VIDEO_CTRL_STATUS_A);
  43         port_ctrl &= ~0x01;
  44         smi_write(VIDEO_CTRL_STATUS_A, port_ctrl);
  45         port_ctrl = smi_read(MPEG2_CTRL_A);
  46         port_ctrl &= ~0x40;
  47         port_ctrl |= 0x80;
  48         smi_write(MPEG2_CTRL_A, port_ctrl);
  49         /* Port B */
  50         port_ctrl = smi_read(VIDEO_CTRL_STATUS_B);
  51         port_ctrl &= ~0x01;
  52         smi_write(VIDEO_CTRL_STATUS_B, port_ctrl);
  53         port_ctrl = smi_read(MPEG2_CTRL_B);
  54         port_ctrl &= ~0x40;
  55         port_ctrl |= 0x80;
  56         smi_write(MPEG2_CTRL_B, port_ctrl);
  57
  58         /* disable and clear interrupt.*/
  59         smi_write(MSI_INT_ENA_CLR, ALL_INT);
  60         int_stat = smi_read(MSI_INT_STATUS);
  61         smi_write(MSI_INT_STATUS_CLR, int_stat);
  62
  63         /* reset demod.*/
  64         smi_clear(PERIPHERAL_CTRL, 0x0303);
  65         msleep(50);
  66         smi_set(PERIPHERAL_CTRL, 0x0101);
  67         return 0;
  68 }
  69
  70 /* i2c bit bus.*/
  71 static void smi_i2c_cfg(struct smi_dev *dev, u32 sw_ctl)
  72 {
  73         u32 dwCtrl;
  74
  75         dwCtrl = smi_read(sw_ctl);
  76         dwCtrl &= ~0x18; /* disable output.*/
  77         dwCtrl |= 0x21; /* reset and software mode.*/
  78         dwCtrl &= ~0xff00;
  79         dwCtrl |= 0x6400;
  80         smi_write(sw_ctl, dwCtrl);
  81         msleep(20);
  82         dwCtrl = smi_read(sw_ctl);
  83         dwCtrl &= ~0x20;
  84         smi_write(sw_ctl, dwCtrl);
  85 }
  86
  87 static void smi_i2c_setsda(struct smi_dev *dev, int state, u32 sw_ctl)
  88 {
  89         if (state) {
  90                 /* set as input.*/
  91                 smi_clear(sw_ctl, SW_I2C_MSK_DAT_EN);
  92         } else {
  93                 smi_clear(sw_ctl, SW_I2C_MSK_DAT_OUT);
  94                 /* set as output.*/
  95                 smi_set(sw_ctl, SW_I2C_MSK_DAT_EN);
  96         }
  97 }
  98
  99 static void smi_i2c_setscl(void *data, int state, u32 sw_ctl)
 100 {
 101         struct smi_dev *dev = data;
 102
 103         if (state) {
 104                 /* set as input.*/
 105                 smi_clear(sw_ctl, SW_I2C_MSK_CLK_EN);
 106         } else {
 107                 smi_clear(sw_ctl, SW_I2C_MSK_CLK_OUT);
 108                 /* set as output.*/
 109                 smi_set(sw_ctl, SW_I2C_MSK_CLK_EN);
 110         }
 111 }
 112
 113 static int smi_i2c_getsda(void *data, u32 sw_ctl)
 114 {
 115         struct smi_dev *dev = data;
 116         /* set as input.*/
 117         smi_clear(sw_ctl, SW_I2C_MSK_DAT_EN);
 118         udelay(1);
 119         return (smi_read(sw_ctl) & SW_I2C_MSK_DAT_IN) ? 1 : 0;
 120 }
 121
 122 static int smi_i2c_getscl(void *data, u32 sw_ctl)
 123 {
 124         struct smi_dev *dev = data;
 125         /* set as input.*/
 126         smi_clear(sw_ctl, SW_I2C_MSK_CLK_EN);
 127         udelay(1);
 128         return (smi_read(sw_ctl) & SW_I2C_MSK_CLK_IN) ? 1 : 0;
 129 }
 130 /* i2c 0.*/
 131 static void smi_i2c0_setsda(void *data, int state)
 132 {
 133         struct smi_dev *dev = data;
 134
 135         smi_i2c_setsda(dev, state, I2C_A_SW_CTL);
 136 }
 137
 138 static void smi_i2c0_setscl(void *data, int state)
 139 {
 140         struct smi_dev *dev = data;
 141
 142         smi_i2c_setscl(dev, state, I2C_A_SW_CTL);
 143 }
 144
 145 static int smi_i2c0_getsda(void *data)
 146 {
 147         struct smi_dev *dev = data;
 148
 149         return  smi_i2c_getsda(dev, I2C_A_SW_CTL);
 150 }
 151
 152 static int smi_i2c0_getscl(void *data)
 153 {
 154         struct smi_dev *dev = data;
 155
 156         return  smi_i2c_getscl(dev, I2C_A_SW_CTL);
 157 }
 158 /* i2c 1.*/
 159 static void smi_i2c1_setsda(void *data, int state)
 160 {
 161         struct smi_dev *dev = data;
 162
 163         smi_i2c_setsda(dev, state, I2C_B_SW_CTL);
 164 }
 165
 166 static void smi_i2c1_setscl(void *data, int state)
 167 {
 168         struct smi_dev *dev = data;
 169
 170         smi_i2c_setscl(dev, state, I2C_B_SW_CTL);
 171 }
 172
 173 static int smi_i2c1_getsda(void *data)
 174 {
 175         struct smi_dev *dev = data;
 176
 177         return  smi_i2c_getsda(dev, I2C_B_SW_CTL);
 178 }
 179
 180 static int smi_i2c1_getscl(void *data)
 181 {
 182         struct smi_dev *dev = data;
 183
 184         return  smi_i2c_getscl(dev, I2C_B_SW_CTL);
 185 }
 186
 187 static int smi_i2c_init(struct smi_dev *dev)
 188 {
 189         int ret;
 190
 191         /* i2c bus 0 */
 192         smi_i2c_cfg(dev, I2C_A_SW_CTL);
 193         i2c_set_adapdata(&dev->i2c_bus[0], dev);
 194         strcpy(dev->i2c_bus[0].name, "SMI-I2C0");
 195         dev->i2c_bus[0].owner = THIS_MODULE;
 196         dev->i2c_bus[0].dev.parent = &dev->pci_dev->dev;
 197         dev->i2c_bus[0].algo_data = &dev->i2c_bit[0];
 198         dev->i2c_bit[0].data = dev;
 199         dev->i2c_bit[0].setsda = smi_i2c0_setsda;
 200         dev->i2c_bit[0].setscl = smi_i2c0_setscl;
 201         dev->i2c_bit[0].getsda = smi_i2c0_getsda;
 202         dev->i2c_bit[0].getscl = smi_i2c0_getscl;
 203         dev->i2c_bit[0].udelay = 12;
 204         dev->i2c_bit[0].timeout = 10;
 205         /* Raise SCL and SDA */
 206         smi_i2c0_setsda(dev, 1);
 207         smi_i2c0_setscl(dev, 1);
 208
 209         ret = i2c_bit_add_bus(&dev->i2c_bus[0]);
 210         if (ret < 0)
 211                 return ret;
 212
 213         /* i2c bus 1 */
 214         smi_i2c_cfg(dev, I2C_B_SW_CTL);
 215         i2c_set_adapdata(&dev->i2c_bus[1], dev);
 216         strcpy(dev->i2c_bus[1].name, "SMI-I2C1");
 217         dev->i2c_bus[1].owner = THIS_MODULE;
 218         dev->i2c_bus[1].dev.parent = &dev->pci_dev->dev;
 219         dev->i2c_bus[1].algo_data = &dev->i2c_bit[1];
 220         dev->i2c_bit[1].data = dev;
 221         dev->i2c_bit[1].setsda = smi_i2c1_setsda;
 222         dev->i2c_bit[1].setscl = smi_i2c1_setscl;
 223         dev->i2c_bit[1].getsda = smi_i2c1_getsda;
 224         dev->i2c_bit[1].getscl = smi_i2c1_getscl;
 225         dev->i2c_bit[1].udelay = 12;
 226         dev->i2c_bit[1].timeout = 10;
 227         /* Raise SCL and SDA */
 228         smi_i2c1_setsda(dev, 1);
 229         smi_i2c1_setscl(dev, 1);
 230
 231         ret = i2c_bit_add_bus(&dev->i2c_bus[1]);
 232         if (ret < 0)
 233                 i2c_del_adapter(&dev->i2c_bus[0]);
 234
 235         return ret;
 236 }
 237
 238 static void smi_i2c_exit(struct smi_dev *dev)
 239 {
 240         i2c_del_adapter(&dev->i2c_bus[0]);
 241         i2c_del_adapter(&dev->i2c_bus[1]);
 242 }
 243
 244 static int smi_read_eeprom(struct i2c_adapter *i2c, u16 reg, u8 *data, u16 size)
 245 {
 246         int ret;
 247         u8 b0[2] = { (reg >> 8) & 0xff, reg & 0xff };
 248
 249         struct i2c_msg msg[] = {
 250                 { .addr = 0x50, .flags = 0,
 251                         .buf = b0, .len = 2 },
 252                 { .addr = 0x50, .flags = I2C_M_RD,
 253                         .buf = data, .len = size }
 254         };
 255
 256         ret = i2c_transfer(i2c, msg, 2);
 257
 258         if (ret != 2) {
 259                 dev_err(&i2c->dev, "%s: reg=0x%x (error=%d)\n",
 260                         __func__, reg, ret);
 261                 return ret;
 262         }
 263         return ret;
 264 }
 265
 266 /* ts port interrupt operations */
 267 static void smi_port_disableInterrupt(struct smi_port *port)
 268 {
 269         struct smi_dev *dev = port->dev;
 270
 271         smi_write(MSI_INT_ENA_CLR,
 272                 (port->_dmaInterruptCH0 | port->_dmaInterruptCH1));
 273 }
 274
 275 static void smi_port_enableInterrupt(struct smi_port *port)
 276 {
 277         struct smi_dev *dev = port->dev;
 278
 279         smi_write(MSI_INT_ENA_SET,
 280                 (port->_dmaInterruptCH0 | port->_dmaInterruptCH1));
 281 }
 282
 283 static void smi_port_clearInterrupt(struct smi_port *port)
 284 {
 285         struct smi_dev *dev = port->dev;
 286
 287         smi_write(MSI_INT_STATUS_CLR,
 288                 (port->_dmaInterruptCH0 | port->_dmaInterruptCH1));
 289 }
 290
 291 /* tasklet handler: DMA data to dmx.*/
 292 static void smi_dma_xfer(unsigned long data)
 293 {
 294         struct smi_port *port = (struct smi_port *) data;
 295         struct smi_dev *dev = port->dev;
 296         u32 intr_status, finishedData, dmaManagement;
 297         u8 dmaChan0State, dmaChan1State;
 298
 299         intr_status = port->_int_status;
 300         dmaManagement = smi_read(port->DMA_MANAGEMENT);
 301         dmaChan0State = (u8)((dmaManagement & 0x00000030) >> 4);
 302         dmaChan1State = (u8)((dmaManagement & 0x00300000) >> 20);
 303
 304         /* CH-0 DMA interrupt.*/
 305         if ((intr_status & port->_dmaInterruptCH0) && (dmaChan0State == 0x01)) {
 306                 dev_dbg(&dev->pci_dev->dev,
 307                         "Port[%d]-DMA CH0 engine complete successful !\n",
 308                         port->idx);
 309                 finishedData = smi_read(port->DMA_CHAN0_TRANS_STATE);
 310                 finishedData &= 0x003FFFFF;
 311                 /* value of DMA_PORT0_CHAN0_TRANS_STATE register [21:0]
 312                  * indicate dma total transfer length and
 313                  * zero of [21:0] indicate dma total transfer length
 314                  * equal to 0x400000 (4MB)*/
 315                 if (finishedData == 0)
 316                         finishedData = 0x00400000;
 317                 if (finishedData != SMI_TS_DMA_BUF_SIZE) {
 318                         dev_dbg(&dev->pci_dev->dev,
 319                                 "DMA CH0 engine complete length mismatched, finish data=%d !\n",
 320                                 finishedData);
 321                 }
 322                 dvb_dmx_swfilter_packets(&port->demux,
 323                         port->cpu_addr[0], (finishedData / 188));
 324                 /*dvb_dmx_swfilter(&port->demux,
 325                         port->cpu_addr[0], finishedData);*/
 326         }
 327         /* CH-1 DMA interrupt.*/
 328         if ((intr_status & port->_dmaInterruptCH1) && (dmaChan1State == 0x01)) {
 329                 dev_dbg(&dev->pci_dev->dev,
 330                         "Port[%d]-DMA CH1 engine complete successful !\n",
 331                         port->idx);
 332                 finishedData = smi_read(port->DMA_CHAN1_TRANS_STATE);
 333                 finishedData &= 0x003FFFFF;
 334                 /* value of DMA_PORT0_CHAN0_TRANS_STATE register [21:0]
 335                  * indicate dma total transfer length and
 336                  * zero of [21:0] indicate dma total transfer length
 337                  * equal to 0x400000 (4MB)*/
 338                 if (finishedData == 0)
 339                         finishedData = 0x00400000;
 340                 if (finishedData != SMI_TS_DMA_BUF_SIZE) {
 341                         dev_dbg(&dev->pci_dev->dev,
 342                                 "DMA CH1 engine complete length mismatched, finish data=%d !\n",
 343                                 finishedData);
 344                 }
 345                 dvb_dmx_swfilter_packets(&port->demux,
 346                         port->cpu_addr[1], (finishedData / 188));
 347                 /*dvb_dmx_swfilter(&port->demux,
 348                         port->cpu_addr[1], finishedData);*/
 349         }
 350         /* restart DMA.*/
 351         if (intr_status & port->_dmaInterruptCH0)
 352                 dmaManagement |= 0x00000002;
 353         if (intr_status & port->_dmaInterruptCH1)
 354                 dmaManagement |= 0x00020000;
 355         smi_write(port->DMA_MANAGEMENT, dmaManagement);
 356         /* Re-enable interrupts */
 357         smi_port_enableInterrupt(port);
 358 }
 359
 360 static void smi_port_dma_free(struct smi_port *port)
 361 {
 362         if (port->cpu_addr[0]) {
 363                 pci_free_consistent(port->dev->pci_dev, SMI_TS_DMA_BUF_SIZE,
 364                                     port->cpu_addr[0], port->dma_addr[0]);
 365                 port->cpu_addr[0] = NULL;
 366         }
 367         if (port->cpu_addr[1]) {
 368                 pci_free_consistent(port->dev->pci_dev, SMI_TS_DMA_BUF_SIZE,
 369                                     port->cpu_addr[1], port->dma_addr[1]);
 370                 port->cpu_addr[1] = NULL;
 371         }
 372 }
 373
 374 static int smi_port_init(struct smi_port *port, int dmaChanUsed)
 375 {
 376         dev_dbg(&port->dev->pci_dev->dev,
 377                 "%s, port %d, dmaused %d\n", __func__, port->idx, dmaChanUsed);
 378         port->enable = 0;
 379         if (port->idx == 0) {
 380                 /* Port A */
 381                 port->_dmaInterruptCH0 = dmaChanUsed & 0x01;
 382                 port->_dmaInterruptCH1 = dmaChanUsed & 0x02;
 383
 384                 port->DMA_CHAN0_ADDR_LOW        = DMA_PORTA_CHAN0_ADDR_LOW;
 385                 port->DMA_CHAN0_ADDR_HI         = DMA_PORTA_CHAN0_ADDR_HI;
 386                 port->DMA_CHAN0_TRANS_STATE     = DMA_PORTA_CHAN0_TRANS_STATE;
 387                 port->DMA_CHAN0_CONTROL         = DMA_PORTA_CHAN0_CONTROL;
 388                 port->DMA_CHAN1_ADDR_LOW        = DMA_PORTA_CHAN1_ADDR_LOW;
 389                 port->DMA_CHAN1_ADDR_HI         = DMA_PORTA_CHAN1_ADDR_HI;
 390                 port->DMA_CHAN1_TRANS_STATE     = DMA_PORTA_CHAN1_TRANS_STATE;
 391                 port->DMA_CHAN1_CONTROL         = DMA_PORTA_CHAN1_CONTROL;
 392                 port->DMA_MANAGEMENT            = DMA_PORTA_MANAGEMENT;
 393         } else {
 394                 /* Port B */
 395                 port->_dmaInterruptCH0 = (dmaChanUsed << 2) & 0x04;
 396                 port->_dmaInterruptCH1 = (dmaChanUsed << 2) & 0x08;
 397
 398                 port->DMA_CHAN0_ADDR_LOW        = DMA_PORTB_CHAN0_ADDR_LOW;
 399                 port->DMA_CHAN0_ADDR_HI         = DMA_PORTB_CHAN0_ADDR_HI;
 400                 port->DMA_CHAN0_TRANS_STATE     = DMA_PORTB_CHAN0_TRANS_STATE;
 401                 port->DMA_CHAN0_CONTROL         = DMA_PORTB_CHAN0_CONTROL;
 402                 port->DMA_CHAN1_ADDR_LOW        = DMA_PORTB_CHAN1_ADDR_LOW;
 403                 port->DMA_CHAN1_ADDR_HI         = DMA_PORTB_CHAN1_ADDR_HI;
 404                 port->DMA_CHAN1_TRANS_STATE     = DMA_PORTB_CHAN1_TRANS_STATE;
 405                 port->DMA_CHAN1_CONTROL         = DMA_PORTB_CHAN1_CONTROL;
 406                 port->DMA_MANAGEMENT            = DMA_PORTB_MANAGEMENT;
 407         }
 408
 409         if (port->_dmaInterruptCH0) {
 410                 port->cpu_addr[0] = pci_alloc_consistent(port->dev->pci_dev,
 411                                         SMI_TS_DMA_BUF_SIZE,
 412                                         &port->dma_addr[0]);
 413                 if (!port->cpu_addr[0]) {
 414                         dev_err(&port->dev->pci_dev->dev,
 415                                 "Port[%d] DMA CH0 memory allocation failed!\n",
 416                                 port->idx);
 417                         goto err;
 418                 }
 419         }
 420
 421         if (port->_dmaInterruptCH1) {
 422                 port->cpu_addr[1] = pci_alloc_consistent(port->dev->pci_dev,
 423                                         SMI_TS_DMA_BUF_SIZE,
 424                                         &port->dma_addr[1]);
 425                 if (!port->cpu_addr[1]) {
 426                         dev_err(&port->dev->pci_dev->dev,
 427                                 "Port[%d] DMA CH1 memory allocation failed!\n",
 428                                 port->idx);
 429                         goto err;
 430                 }
 431         }
 432
 433         smi_port_disableInterrupt(port);
 434         tasklet_init(&port->tasklet, smi_dma_xfer, (unsigned long)port);
 435         tasklet_disable(&port->tasklet);
 436         port->enable = 1;
 437         return 0;
 438 err:
 439         smi_port_dma_free(port);
 440         return -ENOMEM;
 441 }
 442
 443 static void smi_port_exit(struct smi_port *port)
 444 {
 445         smi_port_disableInterrupt(port);
 446         tasklet_kill(&port->tasklet);
 447         smi_port_dma_free(port);
 448         port->enable = 0;
 449 }
 450
 451 static int smi_port_irq(struct smi_port *port, u32 int_status)
 452 {
 453         u32 port_req_irq = port->_dmaInterruptCH0 | port->_dmaInterruptCH1;
 454         int handled = 0;
 455
 456         if (int_status & port_req_irq) {
 457                 smi_port_disableInterrupt(port);
 458                 port->_int_status = int_status;
 459                 smi_port_clearInterrupt(port);
 460                 tasklet_schedule(&port->tasklet);
 461                 handled = 1;
 462         }
 463         return handled;
 464 }
 465
 466 static irqreturn_t smi_irq_handler(int irq, void *dev_id)
 467 {
 468         struct smi_dev *dev = dev_id;
 469         struct smi_port *port0 = &dev->ts_port[0];
 470         struct smi_port *port1 = &dev->ts_port[1];
 471         int handled = 0;
 472
 473         u32 intr_status = smi_read(MSI_INT_STATUS);
 474
 475         /* ts0 interrupt.*/
 476         if (dev->info->ts_0)
 477                 handled += smi_port_irq(port0, intr_status);
 478
 479         /* ts1 interrupt.*/
 480         if (dev->info->ts_1)
 481                 handled += smi_port_irq(port1, intr_status);
 482
 483         return IRQ_RETVAL(handled);
 484 }
 485
 486 static struct i2c_client *smi_add_i2c_client(struct i2c_adapter *adapter,
 487                         struct i2c_board_info *info)
 488 {
 489         struct i2c_client *client;
 490
 491         request_module(info->type);
 492         client = i2c_new_device(adapter, info);
 493         if (client == NULL || client->dev.driver == NULL)
 494                 goto err_add_i2c_client;
 495
 496         if (!try_module_get(client->dev.driver->owner)) {
 497                 i2c_unregister_device(client);
 498                 goto err_add_i2c_client;
 499         }
 500         return client;
 501
 502 err_add_i2c_client:
 503         client = NULL;
 504         return client;
 505 }
 506
 507 static void smi_del_i2c_client(struct i2c_client *client)
 508 {
 509         module_put(client->dev.driver->owner);
 510         i2c_unregister_device(client);
 511 }
 512
 513 static const struct m88ds3103_config smi_dvbsky_m88ds3103_cfg = {
 514         .i2c_addr = 0x68,
 515         .clock = 27000000,
 516         .i2c_wr_max = 33,
 517         .clock_out = 0,
 518         .ts_mode = M88DS3103_TS_PARALLEL,
 519         .ts_clk = 16000,
 520         .ts_clk_pol = 1,
 521         .agc = 0x99,
 522         .lnb_hv_pol = 0,
 523         .lnb_en_pol = 1,
 524 };
 525
 526 static int smi_dvbsky_m88ds3103_fe_attach(struct smi_port *port)
 527 {
 528         int ret = 0;
 529         struct smi_dev *dev = port->dev;
 530         struct i2c_adapter *i2c;
 531         /* tuner I2C module */
 532         struct i2c_adapter *tuner_i2c_adapter;
 533         struct i2c_client *tuner_client;
 534         struct i2c_board_info tuner_info;
 535         struct m88ts2022_config m88ts2022_config = {
 536                 .clock = 27000000,
 537         };
 538         memset(&tuner_info, 0, sizeof(struct i2c_board_info));
 539         i2c = (port->idx == 0) ? &dev->i2c_bus[0] : &dev->i2c_bus[1];
 540
 541         /* attach demod */
 542         port->fe = dvb_attach(m88ds3103_attach,
 543                         &smi_dvbsky_m88ds3103_cfg, i2c, &tuner_i2c_adapter);
 544         if (!port->fe) {
 545                 ret = -ENODEV;
 546                 return ret;
 547         }
 548         /* attach tuner */
 549         m88ts2022_config.fe = port->fe;
 550         strlcpy(tuner_info.type, "m88ts2022", I2C_NAME_SIZE);
 551         tuner_info.addr = 0x60;
 552         tuner_info.platform_data = &m88ts2022_config;
 553         tuner_client = smi_add_i2c_client(tuner_i2c_adapter, &tuner_info);
 554         if (!tuner_client) {
 555                 ret = -ENODEV;
 556                 goto err_tuner_i2c_device;
 557         }
 558
 559         /* delegate signal strength measurement to tuner */
 560         port->fe->ops.read_signal_strength =
 561                         port->fe->ops.tuner_ops.get_rf_strength;
 562
 563         port->i2c_client_tuner = tuner_client;
 564         return ret;
 565
 566 err_tuner_i2c_device:
 567         dvb_frontend_detach(port->fe);
 568         return ret;
 569 }
 570
 571 static const struct m88ds3103_config smi_dvbsky_m88rs6000_cfg = {
 572         .i2c_addr = 0x69,
 573         .clock = 27000000,
 574         .i2c_wr_max = 33,
 575         .ts_mode = M88DS3103_TS_PARALLEL,
 576         .ts_clk = 16000,
 577         .ts_clk_pol = 1,
 578         .agc = 0x99,
 579         .lnb_hv_pol = 0,
 580         .lnb_en_pol = 1,
 581 };
 582
 583 static int smi_dvbsky_m88rs6000_fe_attach(struct smi_port *port)
 584 {
 585         int ret = 0;
 586         struct smi_dev *dev = port->dev;
 587         struct i2c_adapter *i2c;
 588         /* tuner I2C module */
 589         struct i2c_adapter *tuner_i2c_adapter;
 590         struct i2c_client *tuner_client;
 591         struct i2c_board_info tuner_info;
 592         struct m88rs6000t_config m88rs6000t_config;
 593
 594         memset(&tuner_info, 0, sizeof(struct i2c_board_info));
 595         i2c = (port->idx == 0) ? &dev->i2c_bus[0] : &dev->i2c_bus[1];
 596
 597         /* attach demod */
 598         port->fe = dvb_attach(m88ds3103_attach,
 599                         &smi_dvbsky_m88rs6000_cfg, i2c, &tuner_i2c_adapter);
 600         if (!port->fe) {
 601                 ret = -ENODEV;
 602                 return ret;
 603         }
 604         /* attach tuner */
 605         m88rs6000t_config.fe = port->fe;
 606         strlcpy(tuner_info.type, "m88rs6000t", I2C_NAME_SIZE);
 607         tuner_info.addr = 0x21;
 608         tuner_info.platform_data = &m88rs6000t_config;
 609         tuner_client = smi_add_i2c_client(tuner_i2c_adapter, &tuner_info);
 610         if (!tuner_client) {
 611                 ret = -ENODEV;
 612                 goto err_tuner_i2c_device;
 613         }
 614
 615         /* delegate signal strength measurement to tuner */
 616         port->fe->ops.read_signal_strength =
 617                         port->fe->ops.tuner_ops.get_rf_strength;
 618
 619         port->i2c_client_tuner = tuner_client;
 620         return ret;
 621
 622 err_tuner_i2c_device:
 623         dvb_frontend_detach(port->fe);
 624         return ret;
 625 }
 626
 627 static int smi_dvbsky_sit2_fe_attach(struct smi_port *port)
 628 {
 629         int ret = 0;
 630         struct smi_dev *dev = port->dev;
 631         struct i2c_adapter *i2c;
 632         struct i2c_adapter *tuner_i2c_adapter;
 633         struct i2c_client *client_tuner, *client_demod;
 634         struct i2c_board_info client_info;
 635         struct si2168_config si2168_config;
 636         struct si2157_config si2157_config;
 637
 638         /* select i2c bus */
 639         i2c = (port->idx == 0) ? &dev->i2c_bus[0] : &dev->i2c_bus[1];
 640
 641         /* attach demod */
 642         memset(&si2168_config, 0, sizeof(si2168_config));
 643         si2168_config.i2c_adapter = &tuner_i2c_adapter;
 644         si2168_config.fe = &port->fe;
 645         si2168_config.ts_mode = SI2168_TS_PARALLEL;
 646
 647         memset(&client_info, 0, sizeof(struct i2c_board_info));
 648         strlcpy(client_info.type, "si2168", I2C_NAME_SIZE);
 649         client_info.addr = 0x64;
 650         client_info.platform_data = &si2168_config;
 651
 652         client_demod = smi_add_i2c_client(i2c, &client_info);
 653         if (!client_demod) {
 654                 ret = -ENODEV;
 655                 return ret;
 656         }
 657         port->i2c_client_demod = client_demod;
 658
 659         /* attach tuner */
 660         memset(&si2157_config, 0, sizeof(si2157_config));
 661         si2157_config.fe = port->fe;
 662
 663         memset(&client_info, 0, sizeof(struct i2c_board_info));
 664         strlcpy(client_info.type, "si2157", I2C_NAME_SIZE);
 665         client_info.addr = 0x60;
 666         client_info.platform_data = &si2157_config;
 667
 668         client_tuner = smi_add_i2c_client(tuner_i2c_adapter, &client_info);
 669         if (!client_tuner) {
 670                 smi_del_i2c_client(port->i2c_client_demod);
 671                 port->i2c_client_demod = NULL;
 672                 ret = -ENODEV;
 673                 return ret;
 674         }
 675         port->i2c_client_tuner = client_tuner;
 676         return ret;
 677 }
 678
 679 static int smi_fe_init(struct smi_port *port)
 680 {
 681         int ret = 0;
 682         struct smi_dev *dev = port->dev;
 683         struct dvb_adapter *adap = &port->dvb_adapter;
 684         u8 mac_ee[16];
 685
 686         dev_dbg(&port->dev->pci_dev->dev,
 687                 "%s: port %d, fe_type = %d\n",
 688                 __func__, port->idx, port->fe_type);
 689         switch (port->fe_type) {
 690         case DVBSKY_FE_M88DS3103:
 691                 ret = smi_dvbsky_m88ds3103_fe_attach(port);
 692                 break;
 693         case DVBSKY_FE_M88RS6000:
 694                 ret = smi_dvbsky_m88rs6000_fe_attach(port);
 695                 break;
 696         case DVBSKY_FE_SIT2:
 697                 ret = smi_dvbsky_sit2_fe_attach(port);
 698                 break;
 699         }
 700         if (ret < 0)
 701                 return ret;
 702
 703         /* register dvb frontend */
 704         ret = dvb_register_frontend(adap, port->fe);
 705         if (ret < 0) {
 706                 if (port->i2c_client_tuner)
 707                         smi_del_i2c_client(port->i2c_client_tuner);
 708                 if (port->i2c_client_demod)
 709                         smi_del_i2c_client(port->i2c_client_demod);
 710                 dvb_frontend_detach(port->fe);
 711                 return ret;
 712         }
 713         /* init MAC.*/
 714         ret = smi_read_eeprom(&dev->i2c_bus[0], 0xc0, mac_ee, 16);
 715         dev_info(&port->dev->pci_dev->dev,
 716                 "DVBSky SMI PCIe MAC= %pM\n", mac_ee + (port->idx)*8);
 717         memcpy(adap->proposed_mac, mac_ee + (port->idx)*8, 6);
 718         return ret;
 719 }
 720
 721 static void smi_fe_exit(struct smi_port *port)
 722 {
 723         dvb_unregister_frontend(port->fe);
 724         /* remove I2C demod and tuner */
 725         if (port->i2c_client_tuner)
 726                 smi_del_i2c_client(port->i2c_client_tuner);
 727         if (port->i2c_client_demod)
 728                 smi_del_i2c_client(port->i2c_client_demod);
 729         dvb_frontend_detach(port->fe);
 730 }
 731
 732 static int my_dvb_dmx_ts_card_init(struct dvb_demux *dvbdemux, char *id,
 733                             int (*start_feed)(struct dvb_demux_feed *),
 734                             int (*stop_feed)(struct dvb_demux_feed *),
 735                             void *priv)
 736 {
 737         dvbdemux->priv = priv;
 738
 739         dvbdemux->filternum = 256;
 740         dvbdemux->feednum = 256;
 741         dvbdemux->start_feed = start_feed;
 742         dvbdemux->stop_feed = stop_feed;
 743         dvbdemux->write_to_decoder = NULL;
 744         dvbdemux->dmx.capabilities = (DMX_TS_FILTERING |
 745                                       DMX_SECTION_FILTERING |
 746                                       DMX_MEMORY_BASED_FILTERING);
 747         return dvb_dmx_init(dvbdemux);
 748 }
 749
 750 static int my_dvb_dmxdev_ts_card_init(struct dmxdev *dmxdev,
 751                                struct dvb_demux *dvbdemux,
 752                                struct dmx_frontend *hw_frontend,
 753                                struct dmx_frontend *mem_frontend,
 754                                struct dvb_adapter *dvb_adapter)
 755 {
 756         int ret;
 757
 758         dmxdev->filternum = 256;
 759         dmxdev->demux = &dvbdemux->dmx;
 760         dmxdev->capabilities = 0;
 761         ret = dvb_dmxdev_init(dmxdev, dvb_adapter);
 762         if (ret < 0)
 763                 return ret;
 764
 765         hw_frontend->source = DMX_FRONTEND_0;
 766         dvbdemux->dmx.add_frontend(&dvbdemux->dmx, hw_frontend);
 767         mem_frontend->source = DMX_MEMORY_FE;
 768         dvbdemux->dmx.add_frontend(&dvbdemux->dmx, mem_frontend);
 769         return dvbdemux->dmx.connect_frontend(&dvbdemux->dmx, hw_frontend);
 770 }
 771
 772 static u32 smi_config_DMA(struct smi_port *port)
 773 {
 774         struct smi_dev *dev = port->dev;
 775         u32 totalLength = 0, dmaMemPtrLow, dmaMemPtrHi, dmaCtlReg;
 776         u8 chanLatencyTimer = 0, dmaChanEnable = 1, dmaTransStart = 1;
 777         u32 dmaManagement = 0, tlpTransUnit = DMA_TRANS_UNIT_188;
 778         u8 tlpTc = 0, tlpTd = 1, tlpEp = 0, tlpAttr = 0;
 779         u64 mem;
 780
 781         dmaManagement = smi_read(port->DMA_MANAGEMENT);
 782         /* Setup Channel-0 */
 783         if (port->_dmaInterruptCH0) {
 784                 totalLength = SMI_TS_DMA_BUF_SIZE;
 785                 mem = port->dma_addr[0];
 786                 dmaMemPtrLow = mem & 0xffffffff;
 787                 dmaMemPtrHi = mem >> 32;
 788                 dmaCtlReg = (totalLength) | (tlpTransUnit << 22) | (tlpTc << 25)
 789                         | (tlpTd << 28) | (tlpEp << 29) | (tlpAttr << 30);
 790                 dmaManagement |= dmaChanEnable | (dmaTransStart << 1)
 791                         | (chanLatencyTimer << 8);
 792                 /* write DMA register, start DMA engine */
 793                 smi_write(port->DMA_CHAN0_ADDR_LOW, dmaMemPtrLow);
 794                 smi_write(port->DMA_CHAN0_ADDR_HI, dmaMemPtrHi);
 795                 smi_write(port->DMA_CHAN0_CONTROL, dmaCtlReg);
 796         }
 797         /* Setup Channel-1 */
 798         if (port->_dmaInterruptCH1) {
 799                 totalLength = SMI_TS_DMA_BUF_SIZE;
 800                 mem = port->dma_addr[1];
 801                 dmaMemPtrLow = mem & 0xffffffff;
 802                 dmaMemPtrHi = mem >> 32;
 803                 dmaCtlReg = (totalLength) | (tlpTransUnit << 22) | (tlpTc << 25)
 804                         | (tlpTd << 28) | (tlpEp << 29) | (tlpAttr << 30);
 805                 dmaManagement |= (dmaChanEnable << 16) | (dmaTransStart << 17)
 806                         | (chanLatencyTimer << 24);
 807                 /* write DMA register, start DMA engine */
 808                 smi_write(port->DMA_CHAN1_ADDR_LOW, dmaMemPtrLow);
 809                 smi_write(port->DMA_CHAN1_ADDR_HI, dmaMemPtrHi);
 810                 smi_write(port->DMA_CHAN1_CONTROL, dmaCtlReg);
 811         }
 812         return dmaManagement;
 813 }
 814
 815 static int smi_start_feed(struct dvb_demux_feed *dvbdmxfeed)
 816 {
 817         struct dvb_demux *dvbdmx = dvbdmxfeed->demux;
 818         struct smi_port *port = dvbdmx->priv;
 819         struct smi_dev *dev = port->dev;
 820         u32 dmaManagement;
 821
 822         if (port->users++ == 0) {
 823                 dmaManagement = smi_config_DMA(port);
 824                 smi_port_clearInterrupt(port);
 825                 smi_port_enableInterrupt(port);
 826                 smi_write(port->DMA_MANAGEMENT, dmaManagement);
 827                 tasklet_enable(&port->tasklet);
 828         }
 829         return port->users;
 830 }
 831
 832 static int smi_stop_feed(struct dvb_demux_feed *dvbdmxfeed)
 833 {
 834         struct dvb_demux *dvbdmx = dvbdmxfeed->demux;
 835         struct smi_port *port = dvbdmx->priv;
 836         struct smi_dev *dev = port->dev;
 837
 838         if (--port->users)
 839                 return port->users;
 840
 841         tasklet_disable(&port->tasklet);
 842         smi_port_disableInterrupt(port);
 843         smi_clear(port->DMA_MANAGEMENT, 0x30003);
 844         return 0;
 845 }
 846
 847 static int smi_dvb_init(struct smi_port *port)
 848 {
 849         int ret;
 850         struct dvb_adapter *adap = &port->dvb_adapter;
 851         struct dvb_demux *dvbdemux = &port->demux;
 852
 853         dev_dbg(&port->dev->pci_dev->dev,
 854                 "%s, port %d\n", __func__, port->idx);
 855
 856         ret = dvb_register_adapter(adap, "SMI_DVB", THIS_MODULE,
 857                                    &port->dev->pci_dev->dev,
 858                                    adapter_nr);
 859         if (ret < 0) {
 860                 dev_err(&port->dev->pci_dev->dev, "Fail to register DVB adapter.\n");
 861                 return ret;
 862         }
 863         ret = my_dvb_dmx_ts_card_init(dvbdemux, "SW demux",
 864                                       smi_start_feed,
 865                                       smi_stop_feed, port);
 866         if (ret < 0)
 867                 goto err_del_dvb_register_adapter;
 868
 869         ret = my_dvb_dmxdev_ts_card_init(&port->dmxdev, &port->demux,
 870                                          &port->hw_frontend,
 871                                          &port->mem_frontend, adap);
 872         if (ret < 0)
 873                 goto err_del_dvb_dmx;
 874
 875         ret = dvb_net_init(adap, &port->dvbnet, port->dmxdev.demux);
 876         if (ret < 0)
 877                 goto err_del_dvb_dmxdev;
 878         return 0;
 879 err_del_dvb_dmxdev:
 880         dvbdemux->dmx.close(&dvbdemux->dmx);
 881         dvbdemux->dmx.remove_frontend(&dvbdemux->dmx, &port->hw_frontend);
 882         dvbdemux->dmx.remove_frontend(&dvbdemux->dmx, &port->mem_frontend);
 883         dvb_dmxdev_release(&port->dmxdev);
 884 err_del_dvb_dmx:
 885         dvb_dmx_release(&port->demux);
 886 err_del_dvb_register_adapter:
 887         dvb_unregister_adapter(&port->dvb_adapter);
 888         return ret;
 889 }
 890
 891 static void smi_dvb_exit(struct smi_port *port)
 892 {
 893         struct dvb_demux *dvbdemux = &port->demux;
 894
 895         dvb_net_release(&port->dvbnet);
 896
 897         dvbdemux->dmx.close(&dvbdemux->dmx);
 898         dvbdemux->dmx.remove_frontend(&dvbdemux->dmx, &port->hw_frontend);
 899         dvbdemux->dmx.remove_frontend(&dvbdemux->dmx, &port->mem_frontend);
 900         dvb_dmxdev_release(&port->dmxdev);
 901         dvb_dmx_release(&port->demux);
 902
 903         dvb_unregister_adapter(&port->dvb_adapter);
 904 }
 905
 906 static int smi_port_attach(struct smi_dev *dev,
 907                 struct smi_port *port, int index)
 908 {
 909         int ret, dmachs;
 910
 911         port->dev = dev;
 912         port->idx = index;
 913         port->fe_type = (index == 0) ? dev->info->fe_0 : dev->info->fe_1;
 914         dmachs = (index == 0) ? dev->info->ts_0 : dev->info->ts_1;
 915         /* port init.*/
 916         ret = smi_port_init(port, dmachs);
 917         if (ret < 0)
 918                 return ret;
 919         /* dvb init.*/
 920         ret = smi_dvb_init(port);
 921         if (ret < 0)
 922                 goto err_del_port_init;
 923         /* fe init.*/
 924         ret = smi_fe_init(port);
 925         if (ret < 0)
 926                 goto err_del_dvb_init;
 927         return 0;
 928 err_del_dvb_init:
 929         smi_dvb_exit(port);
 930 err_del_port_init:
 931         smi_port_exit(port);
 932         return ret;
 933 }
 934
 935 static void smi_port_detach(struct smi_port *port)
 936 {
 937         smi_fe_exit(port);
 938         smi_dvb_exit(port);
 939         smi_port_exit(port);
 940 }
 941
 942 static int smi_probe(struct pci_dev *pdev, const struct pci_device_id *id)
 943 {
 944         struct smi_dev *dev;
 945         int ret = -ENOMEM;
 946
 947         if (pci_enable_device(pdev) < 0)
 948                 return -ENODEV;
 949
 950         dev = kzalloc(sizeof(struct smi_dev), GFP_KERNEL);
 951         if (!dev) {
 952                 ret = -ENOMEM;
 953                 goto err_pci_disable_device;
 954         }
 955
 956         dev->pci_dev = pdev;
 957         pci_set_drvdata(pdev, dev);
 958         dev->info = (struct smi_cfg_info *) id->driver_data;
 959         dev_info(&dev->pci_dev->dev,
 960                 "card detected: %s\n", dev->info->name);
 961
 962         dev->nr = dev->info->type;
 963         dev->lmmio = ioremap(pci_resource_start(dev->pci_dev, 0),
 964                             pci_resource_len(dev->pci_dev, 0));
 965         if (!dev->lmmio) {
 966                 ret = -ENOMEM;
 967                 goto err_kfree;
 968         }
 969
 970         /* should we set to 32bit DMA? */
 971         ret = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
 972         if (ret < 0)
 973                 goto err_pci_iounmap;
 974
 975         pci_set_master(pdev);
 976
 977         ret = smi_hw_init(dev);
 978         if (ret < 0)
 979                 goto err_pci_iounmap;
 980
 981         ret = smi_i2c_init(dev);
 982         if (ret < 0)
 983                 goto err_pci_iounmap;
 984
 985         if (dev->info->ts_0) {
 986                 ret = smi_port_attach(dev, &dev->ts_port[0], 0);
 987                 if (ret < 0)
 988                         goto err_del_i2c_adaptor;
 989         }
 990
 991         if (dev->info->ts_1) {
 992                 ret = smi_port_attach(dev, &dev->ts_port[1], 1);
 993                 if (ret < 0)
 994                         goto err_del_port0_attach;
 995         }
 996
 997 #ifdef CONFIG_PCI_MSI /* to do msi interrupt.???*/
 998         if (pci_msi_enabled())
 999                 ret = pci_enable_msi(dev->pci_dev);
1000         if (ret)
1001                 dev_info(&dev->pci_dev->dev, "MSI not available.\n");
1002 #endif
1003
1004         ret = request_irq(dev->pci_dev->irq, smi_irq_handler,
1005                            IRQF_SHARED, "SMI_PCIE", dev);
1006         if (ret < 0)
1007                 goto err_del_port1_attach;
1008
1009         return 0;
1010
1011 err_del_port1_attach:
1012         if (dev->info->ts_1)
1013                 smi_port_detach(&dev->ts_port[1]);
1014 err_del_port0_attach:
1015         if (dev->info->ts_0)
1016                 smi_port_detach(&dev->ts_port[0]);
1017 err_del_i2c_adaptor:
1018         smi_i2c_exit(dev);
1019 err_pci_iounmap:
1020         iounmap(dev->lmmio);
1021 err_kfree:
1022         pci_set_drvdata(pdev, NULL);
1023         kfree(dev);
1024 err_pci_disable_device:
1025         pci_disable_device(pdev);
1026         return ret;
1027 }
1028
1029 static void smi_remove(struct pci_dev *pdev)
1030 {
1031         struct smi_dev *dev = pci_get_drvdata(pdev);
1032
1033         smi_write(MSI_INT_ENA_CLR, ALL_INT);
1034         free_irq(dev->pci_dev->irq, dev);
1035 #ifdef CONFIG_PCI_MSI
1036         pci_disable_msi(dev->pci_dev);
1037 #endif
1038         if (dev->info->ts_1)
1039                 smi_port_detach(&dev->ts_port[1]);
1040         if (dev->info->ts_0)
1041                 smi_port_detach(&dev->ts_port[0]);
1042
1043         smi_i2c_exit(dev);
1044         iounmap(dev->lmmio);
1045         pci_set_drvdata(pdev, NULL);
1046         pci_disable_device(pdev);
1047         kfree(dev);
1048 }
1049
1050 /* DVBSky cards */
1051 static struct smi_cfg_info dvbsky_s950_cfg = {
1052         .type = SMI_DVBSKY_S950,
1053         .name = "DVBSky S950 V3",
1054         .ts_0 = SMI_TS_NULL,
1055         .ts_1 = SMI_TS_DMA_BOTH,
1056         .fe_0 = DVBSKY_FE_NULL,
1057         .fe_1 = DVBSKY_FE_M88DS3103,
1058 };
1059
1060 static struct smi_cfg_info dvbsky_s952_cfg = {
1061         .type = SMI_DVBSKY_S952,
1062         .name = "DVBSky S952 V3",
1063         .ts_0 = SMI_TS_DMA_BOTH,
1064         .ts_1 = SMI_TS_DMA_BOTH,
1065         .fe_0 = DVBSKY_FE_M88RS6000,
1066         .fe_1 = DVBSKY_FE_M88RS6000,
1067 };
1068
1069 static struct smi_cfg_info dvbsky_t9580_cfg = {
1070         .type = SMI_DVBSKY_T9580,
1071         .name = "DVBSky T9580 V3",
1072         .ts_0 = SMI_TS_DMA_BOTH,
1073         .ts_1 = SMI_TS_DMA_BOTH,
1074         .fe_0 = DVBSKY_FE_SIT2,
1075         .fe_1 = DVBSKY_FE_M88DS3103,
1076 };
1077
1078 /* PCI IDs */
1079 #define SMI_ID(_subvend, _subdev, _driverdata) {        \
1080         .vendor      = SMI_VID,    .device    = SMI_PID, \
1081         .subvendor   = _subvend, .subdevice = _subdev, \
1082         .driver_data = (unsigned long)&_driverdata }
1083
1084 static const struct pci_device_id smi_id_table[] = {
1085         SMI_ID(0x4254, 0x0550, dvbsky_s950_cfg),
1086         SMI_ID(0x4254, 0x0552, dvbsky_s952_cfg),
1087         SMI_ID(0x4254, 0x5580, dvbsky_t9580_cfg),
1088         {0}
1089 };
1090 MODULE_DEVICE_TABLE(pci, smi_id_table);
1091
1092 static struct pci_driver smipcie_driver = {
1093         .name = "SMI PCIe driver",
1094         .id_table = smi_id_table,
1095         .probe = smi_probe,
1096         .remove = smi_remove,
1097 };
1098
1099 module_pci_driver(smipcie_driver);
1100
1101 MODULE_AUTHOR("Max nibble <nibble.max@gmail.com>");
1102 MODULE_DESCRIPTION("SMI PCIe driver");
1103 MODULE_LICENSE("GPL");