157 lines
		
	
	
		
			3.5 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			157 lines
		
	
	
		
			3.5 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // 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/moduleparam.h>
 | |
| #include <linux/kernel.h>
 | |
| #include <asm/io.h>
 | |
| #include <asm/page.h>
 | |
| #include <linux/kmod.h>
 | |
| #include <linux/vmalloc.h>
 | |
| #include <linux/init.h>
 | |
| #include <linux/device.h>
 | |
| #include <linux/pci.h>
 | |
| 
 | |
| #include <asm/irq.h>
 | |
| #include <linux/signal.h>
 | |
| #include <linux/sched.h>
 | |
| #include <linux/interrupt.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_reg.h"
 | |
| #include "mantis_pci.h"
 | |
| 
 | |
| #define DRIVER_NAME		"Mantis Core"
 | |
| 
 | |
| int mantis_pci_init(struct mantis_pci *mantis)
 | |
| {
 | |
| 	u8 latency;
 | |
| 	struct mantis_hwconfig *config	= mantis->hwconfig;
 | |
| 	struct pci_dev *pdev		= mantis->pdev;
 | |
| 	int err, ret = 0;
 | |
| 
 | |
| 	dprintk(MANTIS_ERROR, 0, "found a %s PCI %s device on (%02x:%02x.%x),\n",
 | |
| 		config->model_name,
 | |
| 		config->dev_type,
 | |
| 		mantis->pdev->bus->number,
 | |
| 		PCI_SLOT(mantis->pdev->devfn),
 | |
| 		PCI_FUNC(mantis->pdev->devfn));
 | |
| 
 | |
| 	err = pci_enable_device(pdev);
 | |
| 	if (err != 0) {
 | |
| 		ret = -ENODEV;
 | |
| 		dprintk(MANTIS_ERROR, 1, "ERROR: PCI enable failed <%i>", err);
 | |
| 		goto fail0;
 | |
| 	}
 | |
| 
 | |
| 	err = dma_set_coherent_mask(&pdev->dev, DMA_BIT_MASK(32));
 | |
| 	if (err != 0) {
 | |
| 		dprintk(MANTIS_ERROR, 1, "ERROR: Unable to obtain 32 bit DMA <%i>", err);
 | |
| 		ret = -ENOMEM;
 | |
| 		goto fail1;
 | |
| 	}
 | |
| 
 | |
| 	pci_set_master(pdev);
 | |
| 
 | |
| 	if (!request_mem_region(pci_resource_start(pdev, 0),
 | |
| 				pci_resource_len(pdev, 0),
 | |
| 				DRIVER_NAME)) {
 | |
| 
 | |
| 		dprintk(MANTIS_ERROR, 1, "ERROR: BAR0 Request failed !");
 | |
| 		ret = -ENODEV;
 | |
| 		goto fail1;
 | |
| 	}
 | |
| 
 | |
| 	mantis->mmio = ioremap(pci_resource_start(pdev, 0),
 | |
| 			       pci_resource_len(pdev, 0));
 | |
| 
 | |
| 	if (!mantis->mmio) {
 | |
| 		dprintk(MANTIS_ERROR, 1, "ERROR: BAR0 remap failed !");
 | |
| 		ret = -ENODEV;
 | |
| 		goto fail2;
 | |
| 	}
 | |
| 
 | |
| 	pci_read_config_byte(pdev, PCI_LATENCY_TIMER, &latency);
 | |
| 	mantis->latency = latency;
 | |
| 	mantis->revision = pdev->revision;
 | |
| 
 | |
| 	dprintk(MANTIS_ERROR, 0, "    Mantis Rev %d [%04x:%04x], ",
 | |
| 		mantis->revision,
 | |
| 		mantis->pdev->subsystem_vendor,
 | |
| 		mantis->pdev->subsystem_device);
 | |
| 
 | |
| 	dprintk(MANTIS_ERROR, 0,
 | |
| 		"irq: %d, latency: %d\n    memory: 0x%lx, mmio: 0x%p\n",
 | |
| 		mantis->pdev->irq,
 | |
| 		mantis->latency,
 | |
| 		mantis->mantis_addr,
 | |
| 		mantis->mmio);
 | |
| 
 | |
| 	err = request_irq(pdev->irq,
 | |
| 			  config->irq_handler,
 | |
| 			  IRQF_SHARED,
 | |
| 			  DRIVER_NAME,
 | |
| 			  mantis);
 | |
| 
 | |
| 	if (err != 0) {
 | |
| 
 | |
| 		dprintk(MANTIS_ERROR, 1, "ERROR: IRQ registration failed ! <%d>", err);
 | |
| 		ret = -ENODEV;
 | |
| 		goto fail3;
 | |
| 	}
 | |
| 
 | |
| 	pci_set_drvdata(pdev, mantis);
 | |
| 	return ret;
 | |
| 
 | |
| 	/* Error conditions */
 | |
| fail3:
 | |
| 	dprintk(MANTIS_ERROR, 1, "ERROR: <%d> I/O unmap", ret);
 | |
| 	if (mantis->mmio)
 | |
| 		iounmap(mantis->mmio);
 | |
| 
 | |
| fail2:
 | |
| 	dprintk(MANTIS_ERROR, 1, "ERROR: <%d> releasing regions", ret);
 | |
| 	release_mem_region(pci_resource_start(pdev, 0),
 | |
| 			   pci_resource_len(pdev, 0));
 | |
| 
 | |
| fail1:
 | |
| 	dprintk(MANTIS_ERROR, 1, "ERROR: <%d> disabling device", ret);
 | |
| 	pci_disable_device(pdev);
 | |
| 
 | |
| fail0:
 | |
| 	dprintk(MANTIS_ERROR, 1, "ERROR: <%d> exiting", ret);
 | |
| 	return ret;
 | |
| }
 | |
| EXPORT_SYMBOL_GPL(mantis_pci_init);
 | |
| 
 | |
| void mantis_pci_exit(struct mantis_pci *mantis)
 | |
| {
 | |
| 	struct pci_dev *pdev = mantis->pdev;
 | |
| 
 | |
| 	dprintk(MANTIS_NOTICE, 1, " mem: 0x%p", mantis->mmio);
 | |
| 	free_irq(pdev->irq, mantis);
 | |
| 	if (mantis->mmio) {
 | |
| 		iounmap(mantis->mmio);
 | |
| 		release_mem_region(pci_resource_start(pdev, 0),
 | |
| 				   pci_resource_len(pdev, 0));
 | |
| 	}
 | |
| 
 | |
| 	pci_disable_device(pdev);
 | |
| }
 | |
| EXPORT_SYMBOL_GPL(mantis_pci_exit);
 | |
| 
 | |
| MODULE_DESCRIPTION("Mantis PCI DTV bridge driver");
 | |
| MODULE_AUTHOR("Manu Abraham");
 | |
| MODULE_LICENSE("GPL");
 |