linux-imx

// SPDX-License-Identifier: GPL-2.0

/*

 * core.c - contains all core device and protocol registration functions

 *

 * Copyright 2002 Adam Belay <ambx1@neo.rr.com>

 */

​

#include <linux/pnp.h>

#include <linux/types.h>

#include <linux/list.h>

#include <linux/device.h>

#include <linux/module.h>

#include <linux/mutex.h>

#include <linux/init.h>

#include <linux/string.h>

#include <linux/slab.h>

#include <linux/errno.h>

#include <linux/dma-mapping.h>

​

#include "base.h"

​

static LIST_HEAD(pnp_protocols);

LIST_HEAD(pnp_global);

DEFINE_MUTEX(pnp_lock);

​

/*

 * ACPI or PNPBIOS should tell us about all platform devices, so we can

 * skip some blind probes.  ISAPNP typically enumerates only plug-in ISA

 * devices, not built-in things like COM ports.

 */

int pnp_platform_devices;

EXPORT_SYMBOL(pnp_platform_devices);

​

void *pnp_alloc(long size)

{

    void *result;

​

    result = kzalloc(size, GFP_KERNEL);

    if (!result) {

        printk(KERN_ERR "pnp: Out of Memory\n");

        return NULL;

    }

    return result;

}

​

static void pnp_remove_protocol(struct pnp_protocol *protocol)

{

    mutex_lock(&pnp_lock);

    list_del(&protocol->protocol_list);

    mutex_unlock(&pnp_lock);

}

​

/**

 * pnp_protocol_register - adds a pnp protocol to the pnp layer

 * @protocol: pointer to the corresponding pnp_protocol structure

 *

 *  Ex protocols: ISAPNP, PNPBIOS, etc

 */

int pnp_register_protocol(struct pnp_protocol *protocol)

{

    struct list_head *pos;

    int nodenum, ret;

​

    INIT_LIST_HEAD(&protocol->devices);

    INIT_LIST_HEAD(&protocol->cards);

    nodenum = 0;

​

    mutex_lock(&pnp_lock);

​

    /* assign the lowest unused number */

    list_for_each(pos, &pnp_protocols) {

        struct pnp_protocol *cur = to_pnp_protocol(pos);

        if (cur->number == nodenum) {

            pos = &pnp_protocols;

            nodenum++;

        }

    }

​

    protocol->number = nodenum;

    dev_set_name(&protocol->dev, "pnp%d", nodenum);

​

    list_add_tail(&protocol->protocol_list, &pnp_protocols);

​

    mutex_unlock(&pnp_lock);

​

    ret = device_register(&protocol->dev);

    if (ret)

        pnp_remove_protocol(protocol);

​

    return ret;

}

​