Blame view
drivers/parport/probe.c
7.4 KB
b24413180 License cleanup: ... |
1 |
// SPDX-License-Identifier: GPL-2.0 |
612de10db parport: remove C... |
2 |
/* |
1da177e4c Linux-2.6.12-rc2 |
3 4 5 6 7 8 9 10 11 12 |
* 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> |
5a0e3ad6a include cleanup: ... |
13 |
#include <linux/slab.h> |
7c0f6ba68 Replace <asm/uacc... |
14 |
#include <linux/uaccess.h> |
1da177e4c Linux-2.6.12-rc2 |
15 |
|
a6767b7cc [PATCH] parport: ... |
16 17 18 |
static const struct { const char *token; const char *descr; |
1da177e4c Linux-2.6.12-rc2 |
19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 |
} 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]; |
decf26f6e parport: Convert ... |
40 |
pr_info("%s", port->name); |
1da177e4c Linux-2.6.12-rc2 |
41 42 |
if (device >= 0) |
aa3d6e7c4 parport: Use more... |
43 |
pr_cont(" (addr %d)", device); |
1da177e4c Linux-2.6.12-rc2 |
44 |
|
aa3d6e7c4 parport: Use more... |
45 |
pr_cont(": %s", classes[info->class].descr); |
1da177e4c Linux-2.6.12-rc2 |
46 |
if (info->class) |
aa3d6e7c4 parport: Use more... |
47 |
pr_cont(", %s %s", info->mfr, info->model); |
1da177e4c Linux-2.6.12-rc2 |
48 |
|
aa3d6e7c4 parport: Use more... |
49 50 |
pr_cont(" "); |
1da177e4c Linux-2.6.12-rc2 |
51 |
} |
1da177e4c Linux-2.6.12-rc2 |
52 53 54 55 56 57 58 59 |
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) { |
decf26f6e parport: Convert ... |
60 61 |
pr_warn("%s probe: memory squeeze ", port->name); |
1da177e4c Linux-2.6.12-rc2 |
62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 |
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")) { |
6044ec888 [PATCH] kfree cle... |
83 |
kfree(info->mfr); |
543537bd9 [PATCH] create a ... |
84 |
info->mfr = kstrdup(sep, GFP_KERNEL); |
1da177e4c Linux-2.6.12-rc2 |
85 |
} else if (!strcmp(p, "MDL") || !strcmp(p, "MODEL")) { |
6044ec888 [PATCH] kfree cle... |
86 |
kfree(info->model); |
543537bd9 [PATCH] create a ... |
87 |
info->model = kstrdup(sep, GFP_KERNEL); |
1da177e4c Linux-2.6.12-rc2 |
88 89 |
} else if (!strcmp(p, "CLS") || !strcmp(p, "CLASS")) { int i; |
6044ec888 [PATCH] kfree cle... |
90 91 |
kfree(info->class_name); |
543537bd9 [PATCH] create a ... |
92 |
info->class_name = kstrdup(sep, GFP_KERNEL); |
1da177e4c Linux-2.6.12-rc2 |
93 94 95 96 97 98 99 100 |
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; } } |
decf26f6e parport: Convert ... |
101 102 103 |
pr_warn("%s probe: warning, class '%s' not understood ", port->name, sep); |
1da177e4c Linux-2.6.12-rc2 |
104 105 106 |
info->class = PARPORT_CLASS_OTHER; } else if (!strcmp(p, "CMD") || !strcmp(p, "COMMAND SET")) { |
6044ec888 [PATCH] kfree cle... |
107 |
kfree(info->cmdset); |
543537bd9 [PATCH] create a ... |
108 |
info->cmdset = kstrdup(sep, GFP_KERNEL); |
1da177e4c Linux-2.6.12-rc2 |
109 110 111 112 113 |
/* 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")) { |
6044ec888 [PATCH] kfree cle... |
114 |
kfree(info->description); |
543537bd9 [PATCH] create a ... |
115 |
info->description = kstrdup(sep, GFP_KERNEL); |
1da177e4c Linux-2.6.12-rc2 |
116 117 118 |
} } rock_on: |
6044ec888 [PATCH] kfree cle... |
119 120 121 122 |
if (q) p = q + 1; else p = NULL; |
1da177e4c Linux-2.6.12-rc2 |
123 124 125 126 127 128 129 130 131 132 133 |
} /* 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); } |
c66062905 [PATCH] parport: ... |
134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 |
/* 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; |
efad798b9 Spelling fixes: l... |
169 |
/* Don't try lengths of 0x100 and 0x200 as 1 and 2 */ |
c66062905 [PATCH] parport: ... |
170 171 172 173 174 175 176 177 178 179 180 |
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) { |
aa3d6e7c4 parport: Use more... |
181 182 183 |
printk(KERN_DEBUG "%s: reported broken Device ID length of %#zX bytes ", port->name, idlens[0]); |
c66062905 [PATCH] parport: ... |
184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 |
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) { |
aa3d6e7c4 parport: Use more... |
205 206 207 |
printk(KERN_DEBUG "%s: Device ID was %zd bytes while device told it would be %d bytes ", port->name, len, belen); |
c66062905 [PATCH] parport: ... |
208 209 210 211 212 213 214 215 216 |
} 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] == ';') { |
aa3d6e7c4 parport: Use more... |
217 218 219 220 |
printk(KERN_DEBUG "%s: Device ID reading stopped before device told data not available. Current idlen %u of %u, len bytes %02X %02X ", port->name, current_idlen, numidlens, length[0], length[1]); |
c66062905 [PATCH] parport: ... |
221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 |
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; } |
1da177e4c Linux-2.6.12-rc2 |
254 |
/* Get Std 1284 Device ID. */ |
c66062905 [PATCH] parport: ... |
255 |
ssize_t parport_device_id (int devnum, char *buffer, size_t count) |
1da177e4c Linux-2.6.12-rc2 |
256 257 |
{ ssize_t retval = -ENXIO; |
c059d5799 parport: daisy: a... |
258 |
struct pardevice *dev = parport_open(devnum, daisy_dev_name); |
1da177e4c Linux-2.6.12-rc2 |
259 260 261 262 |
if (!dev) return -ENXIO; parport_claim_or_block (dev); |
c66062905 [PATCH] parport: ... |
263 264 265 |
/* 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.) */ |
1da177e4c Linux-2.6.12-rc2 |
266 267 268 269 270 |
parport_negotiate (dev->port, IEEE1284_MODE_COMPAT); retval = parport_negotiate (dev->port, IEEE1284_MODE_NIBBLE | IEEE1284_DEVICEID); if (!retval) { |
c66062905 [PATCH] parport: ... |
271 |
retval = parport_read_device_id (dev->port, buffer, count); |
1da177e4c Linux-2.6.12-rc2 |
272 |
parport_negotiate (dev->port, IEEE1284_MODE_COMPAT); |
c66062905 [PATCH] parport: ... |
273 274 |
if (retval > 2) parse_data (dev->port, dev->daisy, buffer+2); |
1da177e4c Linux-2.6.12-rc2 |
275 |
} |
1da177e4c Linux-2.6.12-rc2 |
276 277 278 279 |
parport_release (dev); parport_close (dev); return retval; } |