linux-imx

// SPDX-License-Identifier: GPL-2.0

/*

 * driver.c - device id matching, driver model, etc.

 *

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

 */

​

#include <linux/string.h>

#include <linux/list.h>

#include <linux/module.h>

#include <linux/ctype.h>

#include <linux/slab.h>

#include <linux/pnp.h>

#include "base.h"

​

static int compare_func(const char *ida, const char *idb)

{

    int i;

​

    /* we only need to compare the last 4 chars */

    for (i = 3; i < 7; i++) {

        if (ida[i] != 'X' &&

            idb[i] != 'X' && toupper(ida[i]) != toupper(idb[i]))

            return 0;

    }

    return 1;

}

​

int compare_pnp_id(struct pnp_id *pos, const char *id)

{

    if (!pos || !id || (strlen(id) != 7))

        return 0;

    if (memcmp(id, "ANYDEVS", 7) == 0)

        return 1;

    while (pos) {

        if (memcmp(pos->id, id, 3) == 0)

            if (compare_func(pos->id, id) == 1)

                return 1;

        pos = pos->next;

    }

    return 0;

}

​

static const struct pnp_device_id *match_device(struct pnp_driver *drv,

                        struct pnp_dev *dev)

{

    const struct pnp_device_id *drv_id = drv->id_table;

​

    if (!drv_id)

        return NULL;

​

    while (*drv_id->id) {

        if (compare_pnp_id(dev->id, drv_id->id))

            return drv_id;

        drv_id++;

    }

    return NULL;

}

​

int pnp_device_attach(struct pnp_dev *pnp_dev)

{

    mutex_lock(&pnp_lock);

    if (pnp_dev->status != PNP_READY) {

        mutex_unlock(&pnp_lock);

        return -EBUSY;

    }

    pnp_dev->status = PNP_ATTACHED;

    mutex_unlock(&pnp_lock);

    return 0;

}

​

void pnp_device_detach(struct pnp_dev *pnp_dev)

{

    mutex_lock(&pnp_lock);

    if (pnp_dev->status == PNP_ATTACHED)

        pnp_dev->status = PNP_READY;

    mutex_unlock(&pnp_lock);

}

​

static int pnp_device_probe(struct device *dev)

{

    int error;

    struct pnp_driver *pnp_drv;

    struct pnp_dev *pnp_dev;

    const struct pnp_device_id *dev_id = NULL;

    pnp_dev = to_pnp_dev(dev);

    pnp_drv = to_pnp_driver(dev->driver);

​

    error = pnp_device_attach(pnp_dev);

    if (error < 0)

        return error;

​