linux-imx

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

/*

 * cpcihp_generic.c

 *

 * Generic port I/O CompactPCI driver

 *

 * Copyright 2002 SOMA Networks, Inc.

 * Copyright 2001 Intel San Luis Obispo

 * Copyright 2000,2001 MontaVista Software Inc.

 *

 * This generic CompactPCI hotplug driver should allow using the PCI hotplug

 * mechanism on any CompactPCI board that exposes the #ENUM signal as a bit

 * in a system register that can be read through standard port I/O.

 *

 * Send feedback to <scottm@somanetworks.com>

 */

​

#include <linux/module.h>

#include <linux/init.h>

#include <linux/errno.h>

#include <linux/pci.h>

#include <linux/string.h>

#include "cpci_hotplug.h"

​

#define DRIVER_VERSION  "0.1"

#define DRIVER_AUTHOR   "Scott Murray <scottm@somanetworks.com>"

#define DRIVER_DESC "Generic port I/O CompactPCI Hot Plug Driver"

​

#if !defined(MODULE)

#define MY_NAME "cpcihp_generic"

#else

#define MY_NAME THIS_MODULE->name

#endif

​

#define dbg(format, arg...)                 \

    do {                            \

        if (debug)                  \

            printk(KERN_DEBUG "%s: " format "\n",   \

                MY_NAME, ## arg);       \

    } while (0)

#define err(format, arg...) printk(KERN_ERR "%s: " format "\n", MY_NAME, ## arg)

#define info(format, arg...) printk(KERN_INFO "%s: " format "\n", MY_NAME, ## arg)

#define warn(format, arg...) printk(KERN_WARNING "%s: " format "\n", MY_NAME, ## arg)

​

/* local variables */

static bool debug;

static char *bridge;

static u8 bridge_busnr;

static u8 bridge_slot;

static struct pci_bus *bus;

static u8 first_slot;

static u8 last_slot;

static u16 port;

static unsigned int enum_bit;

static u8 enum_mask;

​

static struct cpci_hp_controller_ops generic_hpc_ops;

static struct cpci_hp_controller generic_hpc;

​

static int __init validate_parameters(void)

{

    char *str;

    char *p;

    unsigned long tmp;

​

    if (!bridge) {

        info("not configured, disabling.");

        return -EINVAL;

    }

    str = bridge;

    if (!*str)

        return -EINVAL;

​

    tmp = simple_strtoul(str, &p, 16);

    if (p == str || tmp > 0xff) {

        err("Invalid hotplug bus bridge device bus number");

        return -EINVAL;

    }

    bridge_busnr = (u8) tmp;

    dbg("bridge_busnr = 0x%02x", bridge_busnr);

    if (*p != ':') {

        err("Invalid hotplug bus bridge device");

        return -EINVAL;

    }

    str = p + 1;

    tmp = simple_strtoul(str, &p, 16);

    if (p == str || tmp > 0x1f) {

        err("Invalid hotplug bus bridge device slot number");

        return -EINVAL;

    }

    bridge_slot = (u8) tmp;

    dbg("bridge_slot = 0x%02x", bridge_slot);