drivers/media/pci/mantis/mantis_cards.c - third_party/kernel - Git at Google

 // SPDX-License-Identifier: GPL-2.0-or-later
 /*
 	Mantis PCI bridge driver

 	Copyright (C) Manu Abraham (abraham.manu@gmail.com)

 */

 #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 == NULL)) {
 		dprintk(MANTIS_ERROR, 1, "Mantis == NULL");
 		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");
	// SPDX-License-Identifier: GPL-2.0-or-later
	/*
	Mantis PCI bridge driver

	Copyright (C) Manu Abraham (abraham.manu@gmail.com)

	*/

	#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 == NULL)) {
	dprintk(MANTIS_ERROR, 1, "Mantis == NULL");
	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");