mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
306 lines
7.4 KiB
306 lines
7.4 KiB
// SPDX-License-Identifier: GPL-2.0-or-later |
|
/* |
|
Mantis PCI bridge driver |
|
|
|
Copyright (C) Manu Abraham ([email protected]) |
|
|
|
*/ |
|
|
|
#include <linux/module.h> |
|
#include <linux/kernel.h> |
|
#include <linux/pci.h> |
|
#include <linux/slab.h> |
|
#include <asm/irq.h> |
|
#include <linux/interrupt.h> |
|
#include <media/rc-map.h> |
|
|
|
#include <media/dmxdev.h> |
|
#include <media/dvbdev.h> |
|
#include <media/dvb_demux.h> |
|
#include <media/dvb_frontend.h> |
|
#include <media/dvb_net.h> |
|
|
|
#include "mantis_common.h" |
|
|
|
#include "mantis_vp1033.h" |
|
#include "mantis_vp1034.h" |
|
#include "mantis_vp1041.h" |
|
#include "mantis_vp2033.h" |
|
#include "mantis_vp2040.h" |
|
#include "mantis_vp3030.h" |
|
|
|
#include "mantis_dma.h" |
|
#include "mantis_ca.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" |
|
#include "mantis_input.h" |
|
|
|
static unsigned int verbose; |
|
module_param(verbose, int, 0644); |
|
MODULE_PARM_DESC(verbose, "verbose startup messages, default is 0 (no)"); |
|
|
|
static int devs; |
|
|
|
#define DRIVER_NAME "Mantis" |
|
|
|
static char *label[10] = { |
|
"DMA", |
|
"IRQ-0", |
|
"IRQ-1", |
|
"OCERR", |
|
"PABRT", |
|
"RIPRR", |
|
"PPERR", |
|
"FTRGT", |
|
"RISCI", |
|
"RACK" |
|
}; |
|
|
|
static irqreturn_t mantis_irq_handler(int irq, void *dev_id) |
|
{ |
|
u32 stat = 0, mask = 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)) |
|
return IRQ_NONE; |
|
ca = mantis->mantis_ca; |
|
|
|
stat = mmread(MANTIS_INT_STAT); |
|
mask = mmread(MANTIS_INT_MASK); |
|
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]); |
|
spin_lock(&mantis->intmask_lock); |
|
mmwrite(mmread(MANTIS_INT_MASK) & ~MANTIS_INT_IRQ1, |
|
MANTIS_INT_MASK); |
|
spin_unlock(&mantis->intmask_lock); |
|
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->busy_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, "<Unknown> Stat=<%02x> Mask=<%02x>", stat, mask); |
|
|
|
dprintk(MANTIS_DEBUG, 0, "\n"); |
|
return IRQ_HANDLED; |
|
} |
|
|
|
static int mantis_pci_probe(struct pci_dev *pdev, |
|
const struct pci_device_id *pci_id) |
|
{ |
|
struct mantis_pci_drvdata *drvdata; |
|
struct mantis_pci *mantis; |
|
struct mantis_hwconfig *config; |
|
int err; |
|
|
|
mantis = kzalloc(sizeof(*mantis), GFP_KERNEL); |
|
if (!mantis) |
|
return -ENOMEM; |
|
|
|
drvdata = (void *)pci_id->driver_data; |
|
mantis->num = devs; |
|
mantis->verbose = verbose; |
|
mantis->pdev = pdev; |
|
config = drvdata->hwconfig; |
|
config->irq_handler = &mantis_irq_handler; |
|
mantis->hwconfig = config; |
|
mantis->rc_map_name = drvdata->rc_map_name; |
|
|
|
spin_lock_init(&mantis->intmask_lock); |
|
|
|
err = mantis_pci_init(mantis); |
|
if (err) { |
|
dprintk(MANTIS_ERROR, 1, "ERROR: Mantis PCI initialization failed <%d>", err); |
|
goto err_free_mantis; |
|
} |
|
|
|
err = mantis_stream_control(mantis, STREAM_TO_HIF); |
|
if (err < 0) { |
|
dprintk(MANTIS_ERROR, 1, "ERROR: Mantis stream control failed <%d>", err); |
|
goto err_pci_exit; |
|
} |
|
|
|
err = mantis_i2c_init(mantis); |
|
if (err < 0) { |
|
dprintk(MANTIS_ERROR, 1, "ERROR: Mantis I2C initialization failed <%d>", err); |
|
goto err_pci_exit; |
|
} |
|
|
|
err = mantis_get_mac(mantis); |
|
if (err < 0) { |
|
dprintk(MANTIS_ERROR, 1, "ERROR: Mantis MAC address read failed <%d>", err); |
|
goto err_i2c_exit; |
|
} |
|
|
|
err = mantis_dma_init(mantis); |
|
if (err < 0) { |
|
dprintk(MANTIS_ERROR, 1, "ERROR: Mantis DMA initialization failed <%d>", err); |
|
goto err_i2c_exit; |
|
} |
|
|
|
err = mantis_dvb_init(mantis); |
|
if (err < 0) { |
|
dprintk(MANTIS_ERROR, 1, "ERROR: Mantis DVB initialization failed <%d>", err); |
|
goto err_dma_exit; |
|
} |
|
|
|
err = mantis_input_init(mantis); |
|
if (err < 0) { |
|
dprintk(MANTIS_ERROR, 1, |
|
"ERROR: Mantis DVB initialization failed <%d>", err); |
|
goto err_dvb_exit; |
|
} |
|
|
|
err = mantis_uart_init(mantis); |
|
if (err < 0) { |
|
dprintk(MANTIS_ERROR, 1, "ERROR: Mantis UART initialization failed <%d>", err); |
|
goto err_input_exit; |
|
} |
|
|
|
devs++; |
|
|
|
return 0; |
|
|
|
err_input_exit: |
|
mantis_input_exit(mantis); |
|
|
|
err_dvb_exit: |
|
mantis_dvb_exit(mantis); |
|
|
|
err_dma_exit: |
|
mantis_dma_exit(mantis); |
|
|
|
err_i2c_exit: |
|
mantis_i2c_exit(mantis); |
|
|
|
err_pci_exit: |
|
mantis_pci_exit(mantis); |
|
|
|
err_free_mantis: |
|
kfree(mantis); |
|
|
|
return err; |
|
} |
|
|
|
static void mantis_pci_remove(struct pci_dev *pdev) |
|
{ |
|
struct mantis_pci *mantis = pci_get_drvdata(pdev); |
|
|
|
if (mantis) { |
|
|
|
mantis_uart_exit(mantis); |
|
mantis_input_exit(mantis); |
|
mantis_dvb_exit(mantis); |
|
mantis_dma_exit(mantis); |
|
mantis_i2c_exit(mantis); |
|
mantis_pci_exit(mantis); |
|
kfree(mantis); |
|
} |
|
return; |
|
} |
|
|
|
static const struct pci_device_id mantis_pci_table[] = { |
|
MAKE_ENTRY(TECHNISAT, CABLESTAR_HD2, &vp2040_config, |
|
RC_MAP_TECHNISAT_TS35), |
|
MAKE_ENTRY(TECHNISAT, SKYSTAR_HD2_10, &vp1041_config, |
|
NULL), |
|
MAKE_ENTRY(TECHNISAT, SKYSTAR_HD2_20, &vp1041_config, |
|
NULL), |
|
MAKE_ENTRY(TERRATEC, CINERGY_C, &vp2040_config, |
|
RC_MAP_TERRATEC_CINERGY_C_PCI), |
|
MAKE_ENTRY(TERRATEC, CINERGY_S2_PCI_HD, &vp1041_config, |
|
RC_MAP_TERRATEC_CINERGY_S2_HD), |
|
MAKE_ENTRY(TWINHAN_TECHNOLOGIES, MANTIS_VP_1033_DVB_S, &vp1033_config, |
|
NULL), |
|
MAKE_ENTRY(TWINHAN_TECHNOLOGIES, MANTIS_VP_1034_DVB_S, &vp1034_config, |
|
NULL), |
|
MAKE_ENTRY(TWINHAN_TECHNOLOGIES, MANTIS_VP_1041_DVB_S2, &vp1041_config, |
|
RC_MAP_TWINHAN_DTV_CAB_CI), |
|
MAKE_ENTRY(TWINHAN_TECHNOLOGIES, MANTIS_VP_2033_DVB_C, &vp2033_config, |
|
RC_MAP_TWINHAN_DTV_CAB_CI), |
|
MAKE_ENTRY(TWINHAN_TECHNOLOGIES, MANTIS_VP_2040_DVB_C, &vp2040_config, |
|
NULL), |
|
MAKE_ENTRY(TWINHAN_TECHNOLOGIES, MANTIS_VP_3030_DVB_T, &vp3030_config, |
|
NULL), |
|
{ } |
|
}; |
|
|
|
MODULE_DEVICE_TABLE(pci, mantis_pci_table); |
|
|
|
static struct pci_driver mantis_pci_driver = { |
|
.name = DRIVER_NAME, |
|
.id_table = mantis_pci_table, |
|
.probe = mantis_pci_probe, |
|
.remove = mantis_pci_remove, |
|
}; |
|
|
|
module_pci_driver(mantis_pci_driver); |
|
|
|
MODULE_DESCRIPTION("MANTIS driver"); |
|
MODULE_AUTHOR("Manu Abraham"); |
|
MODULE_LICENSE("GPL");
|
|
|