linux-imx

/*

 * pnpacpi -- PnP ACPI driver

 *

 * Copyright (c) 2004 Matthieu Castet <castet.matthieu@free.fr>

 * Copyright (c) 2004 Li Shaohua <shaohua.li@intel.com>

 *

 * This program is free software; you can redistribute it and/or modify it

 * under the terms of the GNU General Public License as published by the

 * Free Software Foundation; either version 2, or (at your option) any

 * later version.

 *

 * This program is distributed in the hope that it will be useful, but

 * WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU

 * General Public License for more details.

 *

 * You should have received a copy of the GNU General Public License

 * along with this program; if not, write to the Free Software

 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA

 */

​

#include <linux/export.h>

#include <linux/acpi.h>

#include <linux/pnp.h>

#include <linux/slab.h>

#include <linux/mod_devicetable.h>

​

#include "../base.h"

#include "pnpacpi.h"

​

static int num;

​

/*

 * Compatible Device IDs

 */

#define TEST_HEX(c) \

    if (!(('0' <= (c) && (c) <= '9') || ('A' <= (c) && (c) <= 'F'))) \

        return 0

#define TEST_ALPHA(c) \

    if (!('A' <= (c) && (c) <= 'Z')) \

        return 0

static int __init ispnpidacpi(const char *id)

{

    TEST_ALPHA(id[0]);

    TEST_ALPHA(id[1]);

    TEST_ALPHA(id[2]);

    TEST_HEX(id[3]);

    TEST_HEX(id[4]);

    TEST_HEX(id[5]);

    TEST_HEX(id[6]);

    if (id[7] != '\0')

        return 0;

    return 1;

}

​

static int pnpacpi_get_resources(struct pnp_dev *dev)

{

    pnp_dbg(&dev->dev, "get resources\n");

    return pnpacpi_parse_allocated_resource(dev);

}

​

static int pnpacpi_set_resources(struct pnp_dev *dev)

{

    struct acpi_device *acpi_dev;

    acpi_handle handle;

    int ret = 0;

​

    pnp_dbg(&dev->dev, "set resources\n");

​

    acpi_dev = ACPI_COMPANION(&dev->dev);

    if (!acpi_dev) {

        dev_dbg(&dev->dev, "ACPI device not found in %s!\n", __func__);

        return -ENODEV;

    }

​

    if (WARN_ON_ONCE(acpi_dev != dev->data))

        dev->data = acpi_dev;

​

    handle = acpi_dev->handle;

    if (acpi_has_method(handle, METHOD_NAME__SRS)) {

        struct acpi_buffer buffer;

​

        ret = pnpacpi_build_resource_template(dev, &buffer);

        if (ret)

            return ret;

​

        ret = pnpacpi_encode_resources(dev, &buffer);

        if (!ret) {

            acpi_status status;

​

            status = acpi_set_current_resources(handle, &buffer);

            if (ACPI_FAILURE(status))