linux-imx

// SPDX-License-Identifier: GPL-2.0

/*

 * manager.c - Resource Management, Conflict Resolution, Activation and Disabling of Devices

 *

 * based on isapnp.c resource management (c) Jaroslav Kysela <perex@perex.cz>

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

 * Copyright (C) 2008 Hewlett-Packard Development Company, L.P.

 *  Bjorn Helgaas <bjorn.helgaas@hp.com>

 */

​

#include <linux/errno.h>

#include <linux/module.h>

#include <linux/init.h>

#include <linux/kernel.h>

#include <linux/pnp.h>

#include <linux/bitmap.h>

#include <linux/mutex.h>

#include "base.h"

​

DEFINE_MUTEX(pnp_res_mutex);

​

static struct resource *pnp_find_resource(struct pnp_dev *dev,

                      unsigned char rule,

                      unsigned long type,

                      unsigned int bar)

{

    struct resource *res = pnp_get_resource(dev, type, bar);

​

    /* when the resource already exists, set its resource bits from rule */

    if (res) {

        res->flags &= ~IORESOURCE_BITS;

        res->flags |= rule & IORESOURCE_BITS;

    }

​

    return res;

}

​

static int pnp_assign_port(struct pnp_dev *dev, struct pnp_port *rule, int idx)

{

    struct resource *res, local_res;

​

    res = pnp_find_resource(dev, rule->flags, IORESOURCE_IO, idx);

    if (res) {

        pnp_dbg(&dev->dev, "  io %d already set to %#llx-%#llx "

            "flags %#lx\n", idx, (unsigned long long) res->start,

            (unsigned long long) res->end, res->flags);

        return 0;

    }

​

    res = &local_res;

    res->flags = rule->flags | IORESOURCE_AUTO;

    res->start = 0;

    res->end = 0;

​

    if (!rule->size) {

        res->flags |= IORESOURCE_DISABLED;

        pnp_dbg(&dev->dev, "  io %d disabled\n", idx);

        goto __add;

    }

​

    res->start = rule->min;

    res->end = res->start + rule->size - 1;

​

    while (!pnp_check_port(dev, res)) {

        res->start += rule->align;

        res->end = res->start + rule->size - 1;

        if (res->start > rule->max || !rule->align) {

            pnp_dbg(&dev->dev, "  couldn't assign io %d "

                "(min %#llx max %#llx)\n", idx,

                (unsigned long long) rule->min,

                (unsigned long long) rule->max);

            return -EBUSY;

        }

    }

​

__add:

    pnp_add_io_resource(dev, res->start, res->end, res->flags);

    return 0;

}

​

static int pnp_assign_mem(struct pnp_dev *dev, struct pnp_mem *rule, int idx)

{

    struct resource *res, local_res;

​

    res = pnp_find_resource(dev, rule->flags, IORESOURCE_MEM, idx);

    if (res) {

        pnp_dbg(&dev->dev, "  mem %d already set to %#llx-%#llx "

            "flags %#lx\n", idx, (unsigned long long) res->start,

            (unsigned long long) res->end, res->flags);

        return 0;

    }

​