linux-imx

// SPDX-License-Identifier: GPL-2.0+

/*

 * Compaq Hot Plug Controller Driver

 *

 * Copyright (C) 1995,2001 Compaq Computer Corporation

 * Copyright (C) 2001 Greg Kroah-Hartman (greg@kroah.com)

 * Copyright (C) 2001 IBM Corp.

 *

 * All rights reserved.

 *

 * Send feedback to <greg@kroah.com>

 *

 */

​

#include <linux/module.h>

#include <linux/kernel.h>

#include <linux/types.h>

#include <linux/slab.h>

#include <linux/workqueue.h>

#include <linux/proc_fs.h>

#include <linux/pci.h>

#include <linux/pci_hotplug.h>

#include "../pci.h"

#include "cpqphp.h"

#include "cpqphp_nvram.h"

​

​

u8 cpqhp_nic_irq;

u8 cpqhp_disk_irq;

​

static u16 unused_IRQ;

​

/*

 * detect_HRT_floating_pointer

 *

 * find the Hot Plug Resource Table in the specified region of memory.

 *

 */

static void __iomem *detect_HRT_floating_pointer(void __iomem *begin, void __iomem *end)

{

    void __iomem *fp;

    void __iomem *endp;

    u8 temp1, temp2, temp3, temp4;

    int status = 0;

​

    endp = (end - sizeof(struct hrt) + 1);

​

    for (fp = begin; fp <= endp; fp += 16) {

        temp1 = readb(fp + SIG0);

        temp2 = readb(fp + SIG1);

        temp3 = readb(fp + SIG2);

        temp4 = readb(fp + SIG3);

        if (temp1 == '$' &&

            temp2 == 'H' &&

            temp3 == 'R' &&

            temp4 == 'T') {

            status = 1;

            break;

        }

    }

​

    if (!status)

        fp = NULL;

​

    dbg("Discovered Hotplug Resource Table at %p\n", fp);

    return fp;

}

​

​

int cpqhp_configure_device(struct controller *ctrl, struct pci_func *func)

{

    struct pci_bus *child;

    int num;

​

    pci_lock_rescan_remove();

​

    if (func->pci_dev == NULL)

        func->pci_dev = pci_get_domain_bus_and_slot(0, func->bus,

                            PCI_DEVFN(func->device,

                            func->function));

​

    /* No pci device, we need to create it then */

    if (func->pci_dev == NULL) {

        dbg("INFO: pci_dev still null\n");

​

        num = pci_scan_slot(ctrl->pci_dev->bus, PCI_DEVFN(func->device, func->function));

        if (num)

            pci_bus_add_devices(ctrl->pci_dev->bus);

​

        func->pci_dev = pci_get_domain_bus_and_slot(0, func->bus,

                            PCI_DEVFN(func->device,

                            func->function));