cregit-Linux how code gets into the kernel

Release 4.14 drivers/parport/probe.c

Directory: drivers/parport
// 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"); }

Contributors

PersonTokensPropCommitsCommitProp
Linus Torvalds (pre-git)90100.00%1100.00%
Total90100.00%1100.00%


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); for (u = sep; *u; u++) *u = toupper(*u); for (i = 0; classes[i].token; i++) { if (!strcmp(classes[i].token, sep)) { info->class = i; goto rock_on; } } printk(KERN_WARNING "%s probe: warning, class '%s' not understood.\n", port->name, sep); info->class = PARPORT_CLASS_OTHER; } else if (!strcmp(p, "CMD") || !strcmp(p, "COMMAND SET")) { kfree(info->cmdset); info->cmdset = kstrdup(sep, GFP_KERNEL); /* if it speaks printer language, it's probably a printer */ if (strstr(sep, "PJL") || strstr(sep, "PCL")) guessed_class = PARPORT_CLASS_PRINTER; } else if (!strcmp(p, "DES") || !strcmp(p, "DESCRIPTION")) { kfree(info->description); info->description = kstrdup(sep, GFP_KERNEL); } } rock_on: if (q) p = q + 1; else p = NULL; } /* If the device didn't tell us its class, maybe we have managed to guess one from the things it did say. */ if (info->class == PARPORT_CLASS_UNSPEC) info->class = guessed_class; pretty_print (port, device); kfree(txt); }

Contributors

PersonTokensPropCommitsCommitProp
Linus Torvalds (pre-git)51094.44%457.14%
Linus Torvalds152.78%228.57%
Paulo Marques152.78%114.29%
Total540100.00%7100.00%

/* Read up to count-1 bytes of device id. Terminate buffer with * '\0'. Buffer begins with two Device ID length bytes as given by * device. */
static ssize_t parport_read_device_id (struct parport *port, char *buffer, size_t count) { unsigned char length[2]; unsigned lelen, belen; size_t idlens[4]; unsigned numidlens; unsigned current_idlen; ssize_t retval; size_t len; /* First two bytes are MSB,LSB of inclusive length. */ retval = parport_read (port, length, 2); if (retval < 0) return retval; if (retval != 2) return -EIO; if (count < 2) return 0; memcpy(buffer, length, 2); len = 2; /* Some devices wrongly send LE length, and some send it two * bytes short. Construct a sorted array of lengths to try. */ belen = (length[0] << 8) + length[1]; lelen = (length[1] << 8) + length[0]; idlens[0] = min(belen, lelen); idlens[1] = idlens[0]+2; if (belen != lelen) { int off = 2; /* Don't try lengths of 0x100 and 0x200 as 1 and 2 */ if (idlens[0] <= 2) off = 0; idlens[off] = max(belen, lelen); idlens[off+1] = idlens[off]+2; numidlens = off+2; } else { /* Some devices don't truly implement Device ID, but * just return constant nibble forever. This catches * also those cases. */ if (idlens[0] == 0 || idlens[0] > 0xFFF) { printk (KERN_DEBUG "%s: reported broken Device ID" " length of %#zX bytes\n", port->name, idlens[0]); return -EIO; } numidlens = 2; } /* Try to respect the given ID length despite all the bugs in * the ID length. Read according to shortest possible ID * first. */ for (current_idlen = 0; current_idlen < numidlens; ++current_idlen) { size_t idlen = idlens[current_idlen]; if (idlen+1 >= count) break; retval = parport_read (port, buffer+len, idlen-len); if (retval < 0) return retval; len += retval; if (port->physport->ieee1284.phase != IEEE1284_PH_HBUSY_DAVAIL) { if (belen != len) { printk (KERN_DEBUG "%s: Device ID was %zd bytes" " while device told it would be %d" " bytes\n", port->name, len, belen); } goto done; } /* This might end reading the Device ID too * soon. Hopefully the needed fields were already in * the first 256 bytes or so that we must have read so * far. */ if (buffer[len-1] == ';') { printk (KERN_DEBUG "%s: Device ID reading stopped" " before device told data not available. " "Current idlen %u of %u, len bytes %02X %02X\n", port->name, current_idlen, numidlens, length[0], length[1]); goto done; } } if (current_idlen < numidlens) { /* Buffer not large enough, read to end of buffer. */ size_t idlen, len2; if (len+1 < count) { retval = parport_read (port, buffer+len, count-len-1); if (retval < 0) return retval; len += retval; } /* Read the whole ID since some devices would not * otherwise give back the Device ID from beginning * next time when asked. */ idlen = idlens[current_idlen]; len2 = len; while(len2 < idlen && retval > 0) { char tmp[4]; retval = parport_read (port, tmp, min(sizeof tmp, idlen-len2)); if (retval < 0) return retval; len2 += retval; } } /* In addition, there are broken devices out there that don't even finish off with a semi-colon. We do not need to care about those at this time. */ done: buffer[len] = '\0'; return len; }

Contributors

PersonTokensPropCommitsCommitProp
Marko Kohtala53499.44%133.33%
Randy Dunlap20.37%133.33%
Paulius Zaleckas10.19%133.33%
Total537100.00%3100.00%

/* Get Std 1284 Device ID. */
ssize_t parport_device_id (int devnum, char *buffer, size_t count) { ssize_t retval = -ENXIO; struct pardevice *dev = parport_open (devnum, "Device ID probe"); if (!dev) return -ENXIO; parport_claim_or_block (dev); /* Negotiate to compatibility mode, and then to device ID * mode. (This so that we start form beginning of device ID if * already in device ID mode.) */ parport_negotiate (dev->port, IEEE1284_MODE_COMPAT); retval = parport_negotiate (dev->port, IEEE1284_MODE_NIBBLE | IEEE1284_DEVICEID); if (!retval) { retval = parport_read_device_id (dev->port, buffer, count); parport_negotiate (dev->port, IEEE1284_MODE_COMPAT); if (retval > 2) parse_data (dev->port, dev->daisy, buffer+2); } parport_release (dev); parport_close (dev); return retval; }

Contributors

PersonTokensPropCommitsCommitProp
Linus Torvalds (pre-git)12190.98%675.00%
Marko Kohtala75.26%112.50%
Alexander Nyberg53.76%112.50%
Total133100.00%8100.00%


Overall Contributors

PersonTokensPropCommitsCommitProp
Linus Torvalds (pre-git)83758.45%733.33%
Marko Kohtala54538.06%29.52%
Linus Torvalds161.12%314.29%
Paulo Marques151.05%14.76%
Alexander Nyberg50.35%14.76%
Arnaldo Carvalho de Melo30.21%14.76%
Tejun Heo30.21%14.76%
Al Viro30.21%14.76%
Randy Dunlap20.14%14.76%
Paulius Zaleckas10.07%14.76%
Adrian Bunk10.07%14.76%
Greg Kroah-Hartman10.07%14.76%
Total1432100.00%21100.00%
Directory: drivers/parport
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.