| /* |
| * pluto2.c - Satelco Easywatch Mobile Terrestrial Receiver [DVB-T] |
| * |
| * Copyright (C) 2005 Andreas Oberritter <obi@linuxtv.org> |
| * |
| * based on pluto2.c 1.10 - http://instinct-wp8.no-ip.org/pluto/ |
| * by Dany Salman <salmandany@yahoo.fr> |
| * Copyright (c) 2004 TDF |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 of the License, or |
| * (at your option) any later version. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License |
| * along with this program; if not, write to the Free Software |
| * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. |
| * |
| */ |
| |
| #include <linux/i2c.h> |
| #include <linux/i2c-algo-bit.h> |
| #include <linux/init.h> |
| #include <linux/kernel.h> |
| #include <linux/module.h> |
| #include <linux/pci.h> |
| #include <linux/dma-mapping.h> |
| |
| #include "demux.h" |
| #include "dmxdev.h" |
| #include "dvb_demux.h" |
| #include "dvb_frontend.h" |
| #include "dvb_net.h" |
| #include "dvbdev.h" |
| #include "tda1004x.h" |
| |
| #define DRIVER_NAME "pluto2" |
| |
| #define REG_PIDn(n) ((n) << 2) /* PID n pattern registers */ |
| #define REG_PCAR 0x0020 /* PC address register */ |
| #define REG_TSCR 0x0024 /* TS ctrl & status */ |
| #define REG_MISC 0x0028 /* miscellaneous */ |
| #define REG_MMAC 0x002c /* MSB MAC address */ |
| #define REG_IMAC 0x0030 /* ISB MAC address */ |
| #define REG_LMAC 0x0034 /* LSB MAC address */ |
| #define REG_SPID 0x0038 /* SPI data */ |
| #define REG_SLCS 0x003c /* serial links ctrl/status */ |
| |
| #define PID0_NOFIL (0x0001 << 16) |
| #define PIDn_ENP (0x0001 << 15) |
| #define PID0_END (0x0001 << 14) |
| #define PID0_AFIL (0x0001 << 13) |
| #define PIDn_PID (0x1fff << 0) |
| |
| #define TSCR_NBPACKETS (0x00ff << 24) |
| #define TSCR_DEM (0x0001 << 17) |
| #define TSCR_DE (0x0001 << 16) |
| #define TSCR_RSTN (0x0001 << 15) |
| #define TSCR_MSKO (0x0001 << 14) |
| #define TSCR_MSKA (0x0001 << 13) |
| #define TSCR_MSKL (0x0001 << 12) |
| #define TSCR_OVR (0x0001 << 11) |
| #define TSCR_AFUL (0x0001 << 10) |
| #define TSCR_LOCK (0x0001 << 9) |
| #define TSCR_IACK (0x0001 << 8) |
| #define TSCR_ADEF (0x007f << 0) |
| |
| #define MISC_DVR (0x0fff << 4) |
| #define MISC_ALED (0x0001 << 3) |
| #define MISC_FRST (0x0001 << 2) |
| #define MISC_LED1 (0x0001 << 1) |
| #define MISC_LED0 (0x0001 << 0) |
| |
| #define SPID_SPIDR (0x00ff << 0) |
| |
| #define SLCS_SCL (0x0001 << 7) |
| #define SLCS_SDA (0x0001 << 6) |
| #define SLCS_CSN (0x0001 << 2) |
| #define SLCS_OVR (0x0001 << 1) |
| #define SLCS_SWC (0x0001 << 0) |
| |
| #define TS_DMA_PACKETS (8) |
| #define TS_DMA_BYTES (188 * TS_DMA_PACKETS) |
| |
| #define I2C_ADDR_TDA10046 0x10 |
| #define I2C_ADDR_TUA6034 0xc2 |
| #define NHWFILTERS 8 |
| |
| struct pluto { |
| /* pci */ |
| struct pci_dev *pdev; |
| u8 __iomem *io_mem; |
| |
| /* dvb */ |
| struct dmx_frontend hw_frontend; |
| struct dmx_frontend mem_frontend; |
| struct dmxdev dmxdev; |
| struct dvb_adapter dvb_adapter; |
| struct dvb_demux demux; |
| struct dvb_frontend *fe; |
| struct dvb_net dvbnet; |
| unsigned int full_ts_users; |
| unsigned int users; |
| |
| /* i2c */ |
| struct i2c_algo_bit_data i2c_bit; |
| struct i2c_adapter i2c_adap; |
| unsigned int i2cbug; |
| |
| /* irq */ |
| unsigned int overflow; |
| |
| /* dma */ |
| dma_addr_t dma_addr; |
| u8 dma_buf[TS_DMA_BYTES]; |
| u8 dummy[4096]; |
| }; |
| |
| static inline struct pluto *feed_to_pluto(struct dvb_demux_feed *feed) |
| { |
| return container_of(feed->demux, struct pluto, demux); |
| } |
| |
| static inline struct pluto *frontend_to_pluto(struct dvb_frontend *fe) |
| { |
| return container_of(fe->dvb, struct pluto, dvb_adapter); |
| } |
| |
| static inline u32 pluto_readreg(struct pluto *pluto, u32 reg) |
| { |
| return readl(&pluto->io_mem[reg]); |
| } |
| |
| static inline void pluto_writereg(struct pluto *pluto, u32 reg, u32 val) |
| { |
| writel(val, &pluto->io_mem[reg]); |
| } |
| |
| static inline void pluto_rw(struct pluto *pluto, u32 reg, u32 mask, u32 bits) |
| { |
| u32 val = readl(&pluto->io_mem[reg]); |
| val &= ~mask; |
| val |= bits; |
| writel(val, &pluto->io_mem[reg]); |
| } |
| |
| static void pluto_setsda(void *data, int state) |
| { |
| struct pluto *pluto = data; |
| |
| if (state) |
| pluto_rw(pluto, REG_SLCS, SLCS_SDA, SLCS_SDA); |
| else |
| pluto_rw(pluto, REG_SLCS, SLCS_SDA, 0); |
| } |
| |
| static void pluto_setscl(void *data, int state) |
| { |
| struct pluto *pluto = data; |
| |
| if (state) |
| pluto_rw(pluto, REG_SLCS, SLCS_SCL, SLCS_SCL); |
| else |
| pluto_rw(pluto, REG_SLCS, SLCS_SCL, 0); |
| |
| /* try to detect i2c_inb() to workaround hardware bug: |
| * reset SDA to high after SCL has been set to low */ |
| if ((state) && (pluto->i2cbug == 0)) { |
| pluto->i2cbug = 1; |
| } else { |
| if ((!state) && (pluto->i2cbug == 1)) |
| pluto_setsda(pluto, 1); |
| pluto->i2cbug = 0; |
| } |
| } |
| |
| static int pluto_getsda(void *data) |
| { |
| struct pluto *pluto = data; |
| |
| return pluto_readreg(pluto, REG_SLCS) & SLCS_SDA; |
| } |
| |
| static int pluto_getscl(void *data) |
| { |
| struct pluto *pluto = data; |
| |
| return pluto_readreg(pluto, REG_SLCS) & SLCS_SCL; |
| } |
| |
| static void pluto_reset_frontend(struct pluto *pluto, int reenable) |
| { |
| u32 val = pluto_readreg(pluto, REG_MISC); |
| |
| if (val & MISC_FRST) { |
| val &= ~MISC_FRST; |
| pluto_writereg(pluto, REG_MISC, val); |
| } |
| if (reenable) { |
| val |= MISC_FRST; |
| pluto_writereg(pluto, REG_MISC, val); |
| } |
| } |
| |
| static void pluto_reset_ts(struct pluto *pluto, int reenable) |
| { |
| u32 val = pluto_readreg(pluto, REG_TSCR); |
| |
| if (val & TSCR_RSTN) { |
| val &= ~TSCR_RSTN; |
| pluto_writereg(pluto, REG_TSCR, val); |
| } |
| if (reenable) { |
| val |= TSCR_RSTN; |
| pluto_writereg(pluto, REG_TSCR, val); |
| } |
| } |
| |
| static void pluto_set_dma_addr(struct pluto *pluto) |
| { |
| pluto_writereg(pluto, REG_PCAR, cpu_to_le32(pluto->dma_addr)); |
| } |
| |
| static int __devinit pluto_dma_map(struct pluto *pluto) |
| { |
| pluto->dma_addr = pci_map_single(pluto->pdev, pluto->dma_buf, |
| TS_DMA_BYTES, PCI_DMA_FROMDEVICE); |
| |
| return pci_dma_mapping_error(pluto->dma_addr); |
| } |
| |
| static void pluto_dma_unmap(struct pluto *pluto) |
| { |
| pci_unmap_single(pluto->pdev, pluto->dma_addr, |
| TS_DMA_BYTES, PCI_DMA_FROMDEVICE); |
| } |
| |
| static int pluto_start_feed(struct dvb_demux_feed *f) |
| { |
| struct pluto *pluto = feed_to_pluto(f); |
| |
| /* enable PID filtering */ |
| if (pluto->users++ == 0) |
| pluto_rw(pluto, REG_PIDn(0), PID0_AFIL | PID0_NOFIL, 0); |
| |
| if ((f->pid < 0x2000) && (f->index < NHWFILTERS)) |
| pluto_rw(pluto, REG_PIDn(f->index), PIDn_ENP | PIDn_PID, PIDn_ENP | f->pid); |
| else if (pluto->full_ts_users++ == 0) |
| pluto_rw(pluto, REG_PIDn(0), PID0_NOFIL, PID0_NOFIL); |
| |
| return 0; |
| } |
| |
| static int pluto_stop_feed(struct dvb_demux_feed *f) |
| { |
| struct pluto *pluto = feed_to_pluto(f); |
| |
| /* disable PID filtering */ |
| if (--pluto->users == 0) |
| pluto_rw(pluto, REG_PIDn(0), PID0_AFIL, PID0_AFIL); |
| |
| if ((f->pid < 0x2000) && (f->index < NHWFILTERS)) |
| pluto_rw(pluto, REG_PIDn(f->index), PIDn_ENP | PIDn_PID, 0x1fff); |
| else if (--pluto->full_ts_users == 0) |
| pluto_rw(pluto, REG_PIDn(0), PID0_NOFIL, 0); |
| |
| return 0; |
| } |
| |
| static void pluto_dma_end(struct pluto *pluto, unsigned int nbpackets) |
| { |
| /* synchronize the DMA transfer with the CPU |
| * first so that we see updated contents. */ |
| pci_dma_sync_single_for_cpu(pluto->pdev, pluto->dma_addr, |
| TS_DMA_BYTES, PCI_DMA_FROMDEVICE); |
| |
| /* Workaround for broken hardware: |
| * [1] On startup NBPACKETS seems to contain an uninitialized value, |
| * but no packets have been transfered. |
| * [2] Sometimes (actually very often) NBPACKETS stays at zero |
| * although one packet has been transfered. |
| */ |
| if ((nbpackets == 0) || (nbpackets > TS_DMA_PACKETS)) { |
| unsigned int i = 0, valid; |
| while (pluto->dma_buf[i] == 0x47) |
| i += 188; |
| valid = i / 188; |
| if (nbpackets != valid) { |
| dev_err(&pluto->pdev->dev, "nbpackets=%u valid=%u\n", |
| nbpackets, valid); |
| nbpackets = valid; |
| } |
| } |
| |
| dvb_dmx_swfilter_packets(&pluto->demux, pluto->dma_buf, nbpackets); |
| |
| /* clear the dma buffer. this is needed to be able to identify |
| * new valid ts packets above */ |
| memset(pluto->dma_buf, 0, nbpackets * 188); |
| |
| /* reset the dma address */ |
| pluto_set_dma_addr(pluto); |
| |
| /* sync the buffer and give it back to the card */ |
| pci_dma_sync_single_for_device(pluto->pdev, pluto->dma_addr, |
| TS_DMA_BYTES, PCI_DMA_FROMDEVICE); |
| } |
| |
| static irqreturn_t pluto_irq(int irq, void *dev_id, struct pt_regs *regs) |
| { |
| struct pluto *pluto = dev_id; |
| u32 tscr; |
| |
| /* check whether an interrupt occured on this device */ |
| tscr = pluto_readreg(pluto, REG_TSCR); |
| if (!(tscr & (TSCR_DE | TSCR_OVR))) |
| return IRQ_NONE; |
| |
| if (tscr == 0xffffffff) { |
| // FIXME: maybe recover somehow |
| dev_err(&pluto->pdev->dev, "card hung up :(\n"); |
| return IRQ_HANDLED; |
| } |
| |
| /* dma end interrupt */ |
| if (tscr & TSCR_DE) { |
| pluto_dma_end(pluto, (tscr & TSCR_NBPACKETS) >> 24); |
| /* overflow interrupt */ |
| if (tscr & TSCR_OVR) |
| pluto->overflow++; |
| if (pluto->overflow) { |
| dev_err(&pluto->pdev->dev, "overflow irq (%d)\n", |
| pluto->overflow); |
| pluto_reset_ts(pluto, 1); |
| pluto->overflow = 0; |
| } |
| } else if (tscr & TSCR_OVR) { |
| pluto->overflow++; |
| } |
| |
| /* ACK the interrupt */ |
| pluto_writereg(pluto, REG_TSCR, tscr | TSCR_IACK); |
| |
| return IRQ_HANDLED; |
| } |
| |
| static void __devinit pluto_enable_irqs(struct pluto *pluto) |
| { |
| u32 val = pluto_readreg(pluto, REG_TSCR); |
| |
| /* set the number of packets */ |
| val &= ~TSCR_ADEF; |
| val |= TS_DMA_PACKETS / 2; |
| /* disable AFUL and LOCK interrupts */ |
| val |= (TSCR_MSKA | TSCR_MSKL); |
| /* enable DMA and OVERFLOW interrupts */ |
| val &= ~(TSCR_DEM | TSCR_MSKO); |
| /* clear pending interrupts */ |
| val |= TSCR_IACK; |
| |
| pluto_writereg(pluto, REG_TSCR, val); |
| } |
| |
| static void pluto_disable_irqs(struct pluto *pluto) |
| { |
| u32 val = pluto_readreg(pluto, REG_TSCR); |
| |
| /* disable all interrupts */ |
| val |= (TSCR_DEM | TSCR_MSKO | TSCR_MSKA | TSCR_MSKL); |
| /* clear pending interrupts */ |
| val |= TSCR_IACK; |
| |
| pluto_writereg(pluto, REG_TSCR, val); |
| } |
| |
| static int __devinit pluto_hw_init(struct pluto *pluto) |
| { |
| pluto_reset_frontend(pluto, 1); |
| |
| /* set automatic LED control by FPGA */ |
| pluto_rw(pluto, REG_MISC, MISC_ALED, MISC_ALED); |
| |
| /* set data endianess */ |
| #ifdef __LITTLE_ENDIAN |
| pluto_rw(pluto, REG_PIDn(0), PID0_END, PID0_END); |
| #else |
| pluto_rw(pluto, REG_PIDn(0), PID0_END, 0); |
| #endif |
| /* map DMA and set address */ |
| pluto_dma_map(pluto); |
| pluto_set_dma_addr(pluto); |
| |
| /* enable interrupts */ |
| pluto_enable_irqs(pluto); |
| |
| /* reset TS logic */ |
| pluto_reset_ts(pluto, 1); |
| |
| return 0; |
| } |
| |
| static void pluto_hw_exit(struct pluto *pluto) |
| { |
| /* disable interrupts */ |
| pluto_disable_irqs(pluto); |
| |
| pluto_reset_ts(pluto, 0); |
| |
| /* LED: disable automatic control, enable yellow, disable green */ |
| pluto_rw(pluto, REG_MISC, MISC_ALED | MISC_LED1 | MISC_LED0, MISC_LED1); |
| |
| /* unmap DMA */ |
| pluto_dma_unmap(pluto); |
| |
| pluto_reset_frontend(pluto, 0); |
| } |
| |
| static inline u32 divide(u32 numerator, u32 denominator) |
| { |
| if (denominator == 0) |
| return ~0; |
| |
| return (numerator + denominator / 2) / denominator; |
| } |
| |
| /* LG Innotek TDTE-E001P (Infineon TUA6034) */ |
| static int lg_tdtpe001p_pll_set(struct dvb_frontend *fe, |
| struct dvb_frontend_parameters *p) |
| { |
| struct pluto *pluto = frontend_to_pluto(fe); |
| struct i2c_msg msg; |
| int ret; |
| u8 buf[4]; |
| u32 div; |
| |
| // Fref = 166.667 Hz |
| // Fref * 3 = 500.000 Hz |
| // IF = 36166667 |
| // IF / Fref = 217 |
| //div = divide(p->frequency + 36166667, 166667); |
| div = divide(p->frequency * 3, 500000) + 217; |
| buf[0] = (div >> 8) & 0x7f; |
| buf[1] = (div >> 0) & 0xff; |
| |
| if (p->frequency < 611000000) |
| buf[2] = 0xb4; |
| else if (p->frequency < 811000000) |
| buf[2] = 0xbc; |
| else |
| buf[2] = 0xf4; |
| |
| // VHF: 174-230 MHz |
| // center: 350 MHz |
| // UHF: 470-862 MHz |
| if (p->frequency < 350000000) |
| buf[3] = 0x02; |
| else |
| buf[3] = 0x04; |
| |
| if (p->u.ofdm.bandwidth == BANDWIDTH_8_MHZ) |
| buf[3] |= 0x08; |
| |
| if (sizeof(buf) == 6) { |
| buf[4] = buf[2]; |
| buf[4] &= ~0x1c; |
| buf[4] |= 0x18; |
| |
| buf[5] = (0 << 7) | (2 << 4); |
| } |
| |
| msg.addr = I2C_ADDR_TUA6034 >> 1; |
| msg.flags = 0; |
| msg.buf = buf; |
| msg.len = sizeof(buf); |
| |
| ret = i2c_transfer(&pluto->i2c_adap, &msg, 1); |
| if (ret < 0) |
| return ret; |
| else if (ret == 0) |
| return -EREMOTEIO; |
| |
| return 0; |
| } |
| |
| static int pluto2_request_firmware(struct dvb_frontend *fe, |
| const struct firmware **fw, char *name) |
| { |
| struct pluto *pluto = frontend_to_pluto(fe); |
| |
| return request_firmware(fw, name, &pluto->pdev->dev); |
| } |
| |
| static struct tda1004x_config pluto2_fe_config __devinitdata = { |
| .demod_address = I2C_ADDR_TDA10046 >> 1, |
| .invert = 1, |
| .invert_oclk = 0, |
| .xtal_freq = TDA10046_XTAL_16M, |
| .agc_config = TDA10046_AGC_DEFAULT, |
| .if_freq = TDA10046_FREQ_3617, |
| .pll_set = lg_tdtpe001p_pll_set, |
| .pll_sleep = NULL, |
| .request_firmware = pluto2_request_firmware, |
| }; |
| |
| static int __devinit frontend_init(struct pluto *pluto) |
| { |
| int ret; |
| |
| pluto->fe = tda10046_attach(&pluto2_fe_config, &pluto->i2c_adap); |
| if (!pluto->fe) { |
| dev_err(&pluto->pdev->dev, "could not attach frontend\n"); |
| return -ENODEV; |
| } |
| |
| ret = dvb_register_frontend(&pluto->dvb_adapter, pluto->fe); |
| if (ret < 0) { |
| if (pluto->fe->ops->release) |
| pluto->fe->ops->release(pluto->fe); |
| return ret; |
| } |
| |
| return 0; |
| } |
| |
| static void __devinit pluto_read_rev(struct pluto *pluto) |
| { |
| u32 val = pluto_readreg(pluto, REG_MISC) & MISC_DVR; |
| dev_info(&pluto->pdev->dev, "board revision %d.%d\n", |
| (val >> 12) & 0x0f, (val >> 4) & 0xff); |
| } |
| |
| static void __devinit pluto_read_mac(struct pluto *pluto, u8 *mac) |
| { |
| u32 val = pluto_readreg(pluto, REG_MMAC); |
| mac[0] = (val >> 8) & 0xff; |
| mac[1] = (val >> 0) & 0xff; |
| |
| val = pluto_readreg(pluto, REG_IMAC); |
| mac[2] = (val >> 8) & 0xff; |
| mac[3] = (val >> 0) & 0xff; |
| |
| val = pluto_readreg(pluto, REG_LMAC); |
| mac[4] = (val >> 8) & 0xff; |
| mac[5] = (val >> 0) & 0xff; |
| |
| dev_info(&pluto->pdev->dev, "MAC %02x:%02x:%02x:%02x:%02x:%02x\n", |
| mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]); |
| } |
| |
| static int __devinit pluto_read_serial(struct pluto *pluto) |
| { |
| struct pci_dev *pdev = pluto->pdev; |
| unsigned int i, j; |
| u8 __iomem *cis; |
| |
| cis = pci_iomap(pdev, 1, 0); |
| if (!cis) |
| return -EIO; |
| |
| dev_info(&pdev->dev, "S/N "); |
| |
| for (i = 0xe0; i < 0x100; i += 4) { |
| u32 val = readl(&cis[i]); |
| for (j = 0; j < 32; j += 8) { |
| if ((val & 0xff) == 0xff) |
| goto out; |
| printk("%c", val & 0xff); |
| val >>= 8; |
| } |
| } |
| out: |
| printk("\n"); |
| pci_iounmap(pdev, cis); |
| |
| return 0; |
| } |
| |
| static int __devinit pluto2_probe(struct pci_dev *pdev, |
| const struct pci_device_id *ent) |
| { |
| struct pluto *pluto; |
| struct dvb_adapter *dvb_adapter; |
| struct dvb_demux *dvbdemux; |
| struct dmx_demux *dmx; |
| int ret = -ENOMEM; |
| |
| pluto = kmalloc(sizeof(struct pluto), GFP_KERNEL); |
| if (!pluto) |
| goto out; |
| |
| memset(pluto, 0, sizeof(struct pluto)); |
| pluto->pdev = pdev; |
| |
| ret = pci_enable_device(pdev); |
| if (ret < 0) |
| goto err_kfree; |
| |
| /* enable interrupts */ |
| pci_write_config_dword(pdev, 0x6c, 0x8000); |
| |
| ret = pci_set_dma_mask(pdev, DMA_32BIT_MASK); |
| if (ret < 0) |
| goto err_pci_disable_device; |
| |
| pci_set_master(pdev); |
| |
| ret = pci_request_regions(pdev, DRIVER_NAME); |
| if (ret < 0) |
| goto err_pci_disable_device; |
| |
| pluto->io_mem = pci_iomap(pdev, 0, 0x40); |
| if (!pluto->io_mem) { |
| ret = -EIO; |
| goto err_pci_release_regions; |
| } |
| |
| pci_set_drvdata(pdev, pluto); |
| |
| ret = request_irq(pdev->irq, pluto_irq, SA_SHIRQ, DRIVER_NAME, pluto); |
| if (ret < 0) |
| goto err_pci_iounmap; |
| |
| ret = pluto_hw_init(pluto); |
| if (ret < 0) |
| goto err_free_irq; |
| |
| /* i2c */ |
| i2c_set_adapdata(&pluto->i2c_adap, pluto); |
| strcpy(pluto->i2c_adap.name, DRIVER_NAME); |
| pluto->i2c_adap.owner = THIS_MODULE; |
| pluto->i2c_adap.id = I2C_ALGO_BIT; |
| pluto->i2c_adap.class = I2C_CLASS_TV_DIGITAL; |
| pluto->i2c_adap.dev.parent = &pdev->dev; |
| pluto->i2c_adap.algo_data = &pluto->i2c_bit; |
| pluto->i2c_bit.data = pluto; |
| pluto->i2c_bit.setsda = pluto_setsda; |
| pluto->i2c_bit.setscl = pluto_setscl; |
| pluto->i2c_bit.getsda = pluto_getsda; |
| pluto->i2c_bit.getscl = pluto_getscl; |
| pluto->i2c_bit.udelay = 10; |
| pluto->i2c_bit.timeout = 10; |
| |
| /* Raise SCL and SDA */ |
| pluto_setsda(pluto, 1); |
| pluto_setscl(pluto, 1); |
| |
| ret = i2c_bit_add_bus(&pluto->i2c_adap); |
| if (ret < 0) |
| goto err_pluto_hw_exit; |
| |
| /* dvb */ |
| ret = dvb_register_adapter(&pluto->dvb_adapter, DRIVER_NAME, THIS_MODULE); |
| if (ret < 0) |
| goto err_i2c_bit_del_bus; |
| |
| dvb_adapter = &pluto->dvb_adapter; |
| |
| pluto_read_rev(pluto); |
| pluto_read_serial(pluto); |
| pluto_read_mac(pluto, dvb_adapter->proposed_mac); |
| |
| dvbdemux = &pluto->demux; |
| dvbdemux->filternum = 256; |
| dvbdemux->feednum = 256; |
| dvbdemux->start_feed = pluto_start_feed; |
| dvbdemux->stop_feed = pluto_stop_feed; |
| dvbdemux->dmx.capabilities = (DMX_TS_FILTERING | |
| DMX_SECTION_FILTERING | DMX_MEMORY_BASED_FILTERING); |
| ret = dvb_dmx_init(dvbdemux); |
| if (ret < 0) |
| goto err_dvb_unregister_adapter; |
| |
| dmx = &dvbdemux->dmx; |
| |
| pluto->hw_frontend.source = DMX_FRONTEND_0; |
| pluto->mem_frontend.source = DMX_MEMORY_FE; |
| pluto->dmxdev.filternum = NHWFILTERS; |
| pluto->dmxdev.demux = dmx; |
| |
| ret = dvb_dmxdev_init(&pluto->dmxdev, dvb_adapter); |
| if (ret < 0) |
| goto err_dvb_dmx_release; |
| |
| ret = dmx->add_frontend(dmx, &pluto->hw_frontend); |
| if (ret < 0) |
| goto err_dvb_dmxdev_release; |
| |
| ret = dmx->add_frontend(dmx, &pluto->mem_frontend); |
| if (ret < 0) |
| goto err_remove_hw_frontend; |
| |
| ret = dmx->connect_frontend(dmx, &pluto->hw_frontend); |
| if (ret < 0) |
| goto err_remove_mem_frontend; |
| |
| ret = frontend_init(pluto); |
| if (ret < 0) |
| goto err_disconnect_frontend; |
| |
| dvb_net_init(dvb_adapter, &pluto->dvbnet, dmx); |
| out: |
| return ret; |
| |
| err_disconnect_frontend: |
| dmx->disconnect_frontend(dmx); |
| err_remove_mem_frontend: |
| dmx->remove_frontend(dmx, &pluto->mem_frontend); |
| err_remove_hw_frontend: |
| dmx->remove_frontend(dmx, &pluto->hw_frontend); |
| err_dvb_dmxdev_release: |
| dvb_dmxdev_release(&pluto->dmxdev); |
| err_dvb_dmx_release: |
| dvb_dmx_release(dvbdemux); |
| err_dvb_unregister_adapter: |
| dvb_unregister_adapter(dvb_adapter); |
| err_i2c_bit_del_bus: |
| i2c_bit_del_bus(&pluto->i2c_adap); |
| err_pluto_hw_exit: |
| pluto_hw_exit(pluto); |
| err_free_irq: |
| free_irq(pdev->irq, pluto); |
| err_pci_iounmap: |
| pci_iounmap(pdev, pluto->io_mem); |
| err_pci_release_regions: |
| pci_release_regions(pdev); |
| err_pci_disable_device: |
| pci_disable_device(pdev); |
| err_kfree: |
| pci_set_drvdata(pdev, NULL); |
| kfree(pluto); |
| goto out; |
| } |
| |
| static void __devexit pluto2_remove(struct pci_dev *pdev) |
| { |
| struct pluto *pluto = pci_get_drvdata(pdev); |
| struct dvb_adapter *dvb_adapter = &pluto->dvb_adapter; |
| struct dvb_demux *dvbdemux = &pluto->demux; |
| struct dmx_demux *dmx = &dvbdemux->dmx; |
| |
| dmx->close(dmx); |
| dvb_net_release(&pluto->dvbnet); |
| if (pluto->fe) |
| dvb_unregister_frontend(pluto->fe); |
| |
| dmx->disconnect_frontend(dmx); |
| dmx->remove_frontend(dmx, &pluto->mem_frontend); |
| dmx->remove_frontend(dmx, &pluto->hw_frontend); |
| dvb_dmxdev_release(&pluto->dmxdev); |
| dvb_dmx_release(dvbdemux); |
| dvb_unregister_adapter(dvb_adapter); |
| i2c_bit_del_bus(&pluto->i2c_adap); |
| pluto_hw_exit(pluto); |
| free_irq(pdev->irq, pluto); |
| pci_iounmap(pdev, pluto->io_mem); |
| pci_release_regions(pdev); |
| pci_disable_device(pdev); |
| pci_set_drvdata(pdev, NULL); |
| kfree(pluto); |
| } |
| |
| #ifndef PCI_VENDOR_ID_SCM |
| #define PCI_VENDOR_ID_SCM 0x0432 |
| #endif |
| #ifndef PCI_DEVICE_ID_PLUTO2 |
| #define PCI_DEVICE_ID_PLUTO2 0x0001 |
| #endif |
| |
| static struct pci_device_id pluto2_id_table[] __devinitdata = { |
| { |
| .vendor = PCI_VENDOR_ID_SCM, |
| .device = PCI_DEVICE_ID_PLUTO2, |
| .subvendor = PCI_ANY_ID, |
| .subdevice = PCI_ANY_ID, |
| }, { |
| /* empty */ |
| }, |
| }; |
| |
| MODULE_DEVICE_TABLE(pci, pluto2_id_table); |
| |
| static struct pci_driver pluto2_driver = { |
| .name = DRIVER_NAME, |
| .id_table = pluto2_id_table, |
| .probe = pluto2_probe, |
| .remove = __devexit_p(pluto2_remove), |
| }; |
| |
| static int __init pluto2_init(void) |
| { |
| return pci_register_driver(&pluto2_driver); |
| } |
| |
| static void __exit pluto2_exit(void) |
| { |
| pci_unregister_driver(&pluto2_driver); |
| } |
| |
| module_init(pluto2_init); |
| module_exit(pluto2_exit); |
| |
| MODULE_AUTHOR("Andreas Oberritter <obi@linuxtv.org>"); |
| MODULE_DESCRIPTION("Pluto2 driver"); |
| MODULE_LICENSE("GPL"); |