linux-imx

// SPDX-License-Identifier: GPL-2.0

/*

 * Parallel port device probing code

 *

 * Authors:    Carsten Gross, carsten@sol.wohnheim.uni-ulm.de

 *             Philip Blundell <philb@gnu.org>

 */

​

#include <linux/module.h>

#include <linux/parport.h>

#include <linux/ctype.h>

#include <linux/string.h>

#include <linux/slab.h>

#include <linux/uaccess.h>

​

static const struct {

    const char *token;

    const char *descr;

} classes[] = {

    { "",            "Legacy device" },

    { "PRINTER",     "Printer" },

    { "MODEM",       "Modem" },

    { "NET",         "Network device" },

    { "HDC",         "Hard disk" },

    { "PCMCIA",      "PCMCIA" },

    { "MEDIA",       "Multimedia device" },

    { "FDC",         "Floppy disk" },

    { "PORTS",       "Ports" },

    { "SCANNER",     "Scanner" },

    { "DIGICAM",     "Digital camera" },

    { "",            "Unknown device" },

    { "",            "Unspecified" },

    { "SCSIADAPTER", "SCSI adapter" },

    { NULL,          NULL }

};

​

static void pretty_print(struct parport *port, int device)

{

    struct parport_device_info *info = &port->probe_info[device + 1];

​

    printk(KERN_INFO "%s", port->name);

​

    if (device >= 0)

        printk (" (addr %d)", device);

​

    printk (": %s", classes[info->class].descr);

    if (info->class)

        printk(", %s %s", info->mfr, info->model);

​

    printk("\n");

}

​

static void parse_data(struct parport *port, int device, char *str)

{

    char *txt = kmalloc(strlen(str)+1, GFP_KERNEL);

    char *p = txt, *q;

    int guessed_class = PARPORT_CLASS_UNSPEC;

    struct parport_device_info *info = &port->probe_info[device + 1];

​

    if (!txt) {

        printk(KERN_WARNING "%s probe: memory squeeze\n", port->name);

        return;

    }

    strcpy(txt, str);

    while (p) {

        char *sep;

        q = strchr(p, ';');

        if (q) *q = 0;

        sep = strchr(p, ':');

        if (sep) {

            char *u;

            *(sep++) = 0;

            /* Get rid of trailing blanks */

            u = sep + strlen (sep) - 1;

            while (u >= p && *u == ' ')

                *u-- = '\0';

            u = p;

            while (*u) {

                *u = toupper(*u);

                u++;

            }

            if (!strcmp(p, "MFG") || !strcmp(p, "MANUFACTURER")) {

                kfree(info->mfr);

                info->mfr = kstrdup(sep, GFP_KERNEL);

            } else if (!strcmp(p, "MDL") || !strcmp(p, "MODEL")) {

                kfree(info->model);

                info->model = kstrdup(sep, GFP_KERNEL);

            } else if (!strcmp(p, "CLS") || !strcmp(p, "CLASS")) {

                int i;

​

                kfree(info->class_name);

                info->class_name = kstrdup(sep, GFP_KERNEL);