#include #include #include #include #include #include #include "dmxdev.h" #include "dvbdev.h" #include "dvb_demux.h" #include "dvb_frontend.h" #include "dvb_net.h" #include "mantis_common.h" #include "hopper_vp3028.h" #include "mantis_dma.h" #include "mantis_dvb.h" #include "mantis_uart.h" #include "mantis_ioc.h" #include "mantis_pci.h" #include "mantis_i2c.h" #include "mantis_reg.h" static unsigned int verbose; module_param(verbose, int, 0644); MODULE_PARM_DESC(verbose, "verbose startup messages, default is 1 (yes)"); #define DRIVER_NAME "Hopper" static char *label[10] = { "DMA", "IRQ-0", "IRQ-1", "OCERR", "PABRT", "RIPRR", "PPERR", "FTRGT", "RISCI", "RACK" }; static int devs; static irqreturn_t hopper_irq_handler(int irq, void *dev_id) { u32 stat = 0, mask = 0, lstat = 0, mstat = 0; u32 rst_stat = 0, rst_mask = 0; struct mantis_pci *mantis; struct mantis_ca *ca; mantis = (struct mantis_pci *) dev_id; if (unlikely(mantis == NULL)) { dprintk(MANTIS_ERROR, 1, "Mantis == NULL"); return IRQ_NONE; } ca = mantis->mantis_ca; stat = mmread(MANTIS_INT_STAT); mask = mmread(MANTIS_INT_MASK); mstat = lstat = stat & ~MANTIS_INT_RISCSTAT; if (!(stat & mask)) return IRQ_NONE; rst_mask = MANTIS_GPIF_WRACK | MANTIS_GPIF_OTHERR | MANTIS_SBUF_WSTO | MANTIS_GPIF_EXTIRQ; rst_stat = mmread(MANTIS_GPIF_STATUS); rst_stat &= rst_mask; mmwrite(rst_stat, MANTIS_GPIF_STATUS); mantis->mantis_int_stat = stat; mantis->mantis_int_mask = mask; dprintk(MANTIS_DEBUG, 0, "\n-- Stat=<%02x> Mask=<%02x> --", stat, mask); if (stat & MANTIS_INT_RISCEN) { dprintk(MANTIS_DEBUG, 0, "<%s>", label[0]); } if (stat & MANTIS_INT_IRQ0) { dprintk(MANTIS_DEBUG, 0, "<%s>", label[1]); mantis->gpif_status = rst_stat; wake_up(&ca->hif_write_wq); schedule_work(&ca->hif_evm_work); } if (stat & MANTIS_INT_IRQ1) { dprintk(MANTIS_DEBUG, 0, "<%s>", label[2]); schedule_work(&mantis->uart_work); } if (stat & MANTIS_INT_OCERR) { dprintk(MANTIS_DEBUG, 0, "<%s>", label[3]); } if (stat & MANTIS_INT_PABORT) { dprintk(MANTIS_DEBUG, 0, "<%s>", label[4]); } if (stat & MANTIS_INT_RIPERR) { dprintk(MANTIS_DEBUG, 0, "<%s>", label[5]); } if (stat & MANTIS_INT_PPERR) { dprintk(MANTIS_DEBUG, 0, "<%s>", label[6]); } if (stat & MANTIS_INT_FTRGT) { dprintk(MANTIS_DEBUG, 0, "<%s>", label[7]); } if (stat & MANTIS_INT_RISCI) { dprintk(MANTIS_DEBUG, 0, "<%s>", label[8]); mantis->finished_block = (stat & MANTIS_INT_RISCSTAT) >> 28; tasklet_schedule(&mantis->tasklet); } if (stat & MANTIS_INT_I2CDONE) { dprintk(MANTIS_DEBUG, 0, "<%s>", label[9]); wake_up(&mantis->i2c_wq); } mmwrite(stat, MANTIS_INT_STAT); stat &= ~(MANTIS_INT_RISCEN | MANTIS_INT_I2CDONE | MANTIS_INT_I2CRACK | MANTIS_INT_PCMCIA7 | MANTIS_INT_PCMCIA6 | MANTIS_INT_PCMCIA5 | MANTIS_INT_PCMCIA4 | MANTIS_INT_PCMCIA3 | MANTIS_INT_PCMCIA2 | MANTIS_INT_PCMCIA1 | MANTIS_INT_PCMCIA0 | MANTIS_INT_IRQ1 | MANTIS_INT_IRQ0 | MANTIS_INT_OCERR | MANTIS_INT_PABORT | MANTIS_INT_RIPERR | MANTIS_INT_PPERR | MANTIS_INT_FTRGT | MANTIS_INT_RISCI); if (stat) dprintk(MANTIS_DEBUG, 0, " Stat=<%02x> Mask=<%02x>", stat, mask); dprintk(MANTIS_DEBUG, 0, "\n"); return IRQ_HANDLED; } static int __devinit hopper_pci_probe(struct pci_dev *pdev, const struct pci_device_id *pci_id) { struct mantis_pci *mantis; struct mantis_hwconfig *config; int err = 0; mantis = kzalloc(sizeof (struct mantis_pci), GFP_KERNEL); if (mantis == NULL) { printk(KERN_ERR "%s ERROR: Out of memory\n", __func__); err = -ENOMEM; goto fail0; } mantis->num = devs; mantis->verbose = verbose; mantis->pdev = pdev; config = (struct mantis_hwconfig *) pci_id->driver_data; config->irq_handler = &hopper_irq_handler; mantis->hwconfig = config; err = mantis_pci_init(mantis); if (err) { dprintk(MANTIS_ERROR, 1, "ERROR: Mantis PCI initialization failed <%d>", err); goto fail1; } err = mantis_stream_control(mantis, STREAM_TO_HIF); if (err < 0) { dprintk(MANTIS_ERROR, 1, "ERROR: Mantis stream control failed <%d>", err); goto fail1; } err = mantis_i2c_init(mantis); if (err < 0) { dprintk(MANTIS_ERROR, 1, "ERROR: Mantis I2C initialization failed <%d>", err); goto fail2; } err = mantis_get_mac(mantis); if (err < 0) { dprintk(MANTIS_ERROR, 1, "ERROR: Mantis MAC address read failed <%d>", err); goto fail2; } err = mantis_dma_init(mantis); if (err < 0) { dprintk(MANTIS_ERROR, 1, "ERROR: Mantis DMA initialization failed <%d>", err); goto fail3; } err = mantis_dvb_init(mantis); if (err < 0) { dprintk(MANTIS_ERROR, 1, "ERROR: Mantis DVB initialization failed <%d>", err); goto fail4; } devs++; return err; fail5: dprintk(MANTIS_ERROR, 1, "ERROR: Mantis DVB exit! <%d>", err); mantis_dvb_exit(mantis); fail4: dprintk(MANTIS_ERROR, 1, "ERROR: Mantis DMA exit! <%d>", err); mantis_dma_exit(mantis); fail3: dprintk(MANTIS_ERROR, 1, "ERROR: Mantis I2C exit! <%d>", err); mantis_i2c_exit(mantis); fail2: dprintk(MANTIS_ERROR, 1, "ERROR: Mantis PCI exit! <%d>", err); mantis_pci_exit(mantis); fail1: dprintk(MANTIS_ERROR, 1, "ERROR: Mantis free! <%d>", err); kfree(mantis); fail0: return err; } static void __devexit hopper_pci_remove(struct pci_dev *pdev) { struct mantis_pci *mantis = pci_get_drvdata(pdev); if (mantis) { // mantis_uart_exit(mantis); mantis_dvb_exit(mantis); mantis_dma_exit(mantis); mantis_i2c_exit(mantis); mantis_pci_exit(mantis); kfree(mantis); } return; } static struct pci_device_id hopper_pci_table[] = { MAKE_ENTRY(TWINHAN_TECHNOLOGIES, MANTIS_VP_3028_DVB_T, &vp3028_config), { } }; static struct pci_driver hopper_pci_driver = { .name = DRIVER_NAME, .id_table = hopper_pci_table, .probe = hopper_pci_probe, .remove = hopper_pci_remove, }; static int __devinit hopper_init(void) { return pci_register_driver(&hopper_pci_driver); } static void __devexit hopper_exit(void) { return pci_unregister_driver(&hopper_pci_driver); } module_init(hopper_init); module_exit(hopper_exit); MODULE_DESCRIPTION("HOPPER driver"); MODULE_AUTHOR("Manu Abraham"); MODULE_LICENSE("GPL");