root/drivers/media/pci/mantis/mantis_pci.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");