1 /* Simple code to turn various tables in an ELF file into alias definitions.
2 * This deals with kernel datastructures where they should be
3 * dealt with: in the kernel source.
4 *
5 * Copyright 2002-2003 Rusty Russell, IBM Corporation
6 * 2003 Kai Germaschewski
7 *
8 *
9 * This software may be used and distributed according to the terms
10 * of the GNU General Public License, incorporated herein by reference.
11 */
12
13 #include "modpost.h"
14
15 /* We use the ELF typedefs for kernel_ulong_t but bite the bullet and
16 * use either stdint.h or inttypes.h for the rest. */
17 #if KERNEL_ELFCLASS == ELFCLASS32
18 typedef Elf32_Addr kernel_ulong_t;
19 #define BITS_PER_LONG 32
20 #else
21 typedef Elf64_Addr kernel_ulong_t;
22 #define BITS_PER_LONG 64
23 #endif
24 #ifdef __sun__
25 #include <inttypes.h>
26 #else
27 #include <stdint.h>
28 #endif
29
30 #include <ctype.h>
31
32 typedef uint32_t __u32;
33 typedef uint16_t __u16;
34 typedef unsigned char __u8;
35
36 /* Big exception to the "don't include kernel headers into userspace, which
37 * even potentially has different endianness and word sizes, since
38 * we handle those differences explicitly below */
39 #include "../../include/linux/mod_devicetable.h"
40
41 #define ADD(str, sep, cond, field) \
42 do { \
43 strcat(str, sep); \
44 if (cond) \
45 sprintf(str + strlen(str), \
46 sizeof(field) == 1 ? "%02X" : \
47 sizeof(field) == 2 ? "%04X" : \
48 sizeof(field) == 4 ? "%08X" : "", \
49 field); \
50 else \
51 sprintf(str + strlen(str), "*"); \
52 } while(0)
53
54 /* Always end in a wildcard, for future extension */
add_wildcard(char * str)55 static inline void add_wildcard(char *str)
56 {
57 int len = strlen(str);
58
59 if (str[len - 1] != '*')
60 strcat(str + len, "*");
61 }
62
63 unsigned int cross_build = 0;
64 /**
65 * Check that sizeof(device_id type) are consistent with size of section
66 * in .o file. If in-consistent then userspace and kernel does not agree
67 * on actual size which is a bug.
68 * Also verify that the final entry in the table is all zeros.
69 * Ignore both checks if build host differ from target host and size differs.
70 **/
device_id_check(const char * modname,const char * device_id,unsigned long size,unsigned long id_size,void * symval)71 static void device_id_check(const char *modname, const char *device_id,
72 unsigned long size, unsigned long id_size,
73 void *symval)
74 {
75 int i;
76
77 if (size % id_size || size < id_size) {
78 if (cross_build != 0)
79 return;
80 fatal("%s: sizeof(struct %s_device_id)=%lu is not a modulo "
81 "of the size of section __mod_%s_device_table=%lu.\n"
82 "Fix definition of struct %s_device_id "
83 "in mod_devicetable.h\n",
84 modname, device_id, id_size, device_id, size, device_id);
85 }
86 /* Verify last one is a terminator */
87 for (i = 0; i < id_size; i++ ) {
88 if (*(uint8_t*)(symval+size-id_size+i)) {
89 fprintf(stderr,"%s: struct %s_device_id is %lu bytes. "
90 "The last of %lu is:\n",
91 modname, device_id, id_size, size / id_size);
92 for (i = 0; i < id_size; i++ )
93 fprintf(stderr,"0x%02x ",
94 *(uint8_t*)(symval+size-id_size+i) );
95 fprintf(stderr,"\n");
96 fatal("%s: struct %s_device_id is not terminated "
97 "with a NULL entry!\n", modname, device_id);
98 }
99 }
100 }
101
102 /* USB is special because the bcdDevice can be matched against a numeric range */
103 /* Looks like "usb:vNpNdNdcNdscNdpNicNiscNipN" */
do_usb_entry(struct usb_device_id * id,unsigned int bcdDevice_initial,int bcdDevice_initial_digits,unsigned char range_lo,unsigned char range_hi,unsigned char max,struct module * mod)104 static void do_usb_entry(struct usb_device_id *id,
105 unsigned int bcdDevice_initial, int bcdDevice_initial_digits,
106 unsigned char range_lo, unsigned char range_hi,
107 unsigned char max, struct module *mod)
108 {
109 char alias[500];
110 strcpy(alias, "usb:");
111 ADD(alias, "v", id->match_flags&USB_DEVICE_ID_MATCH_VENDOR,
112 id->idVendor);
113 ADD(alias, "p", id->match_flags&USB_DEVICE_ID_MATCH_PRODUCT,
114 id->idProduct);
115
116 strcat(alias, "d");
117 if (bcdDevice_initial_digits)
118 sprintf(alias + strlen(alias), "%0*X",
119 bcdDevice_initial_digits, bcdDevice_initial);
120 if (range_lo == range_hi)
121 sprintf(alias + strlen(alias), "%X", range_lo);
122 else if (range_lo > 0 || range_hi < max) {
123 if (range_lo > 0x9 || range_hi < 0xA)
124 sprintf(alias + strlen(alias),
125 "[%X-%X]",
126 range_lo,
127 range_hi);
128 else {
129 sprintf(alias + strlen(alias),
130 range_lo < 0x9 ? "[%X-9" : "[%X",
131 range_lo);
132 sprintf(alias + strlen(alias),
133 range_hi > 0xA ? "a-%X]" : "%X]",
134 range_lo);
135 }
136 }
137 if (bcdDevice_initial_digits < (sizeof(id->bcdDevice_lo) * 2 - 1))
138 strcat(alias, "*");
139
140 ADD(alias, "dc", id->match_flags&USB_DEVICE_ID_MATCH_DEV_CLASS,
141 id->bDeviceClass);
142 ADD(alias, "dsc",
143 id->match_flags&USB_DEVICE_ID_MATCH_DEV_SUBCLASS,
144 id->bDeviceSubClass);
145 ADD(alias, "dp",
146 id->match_flags&USB_DEVICE_ID_MATCH_DEV_PROTOCOL,
147 id->bDeviceProtocol);
148 ADD(alias, "ic",
149 id->match_flags&USB_DEVICE_ID_MATCH_INT_CLASS,
150 id->bInterfaceClass);
151 ADD(alias, "isc",
152 id->match_flags&USB_DEVICE_ID_MATCH_INT_SUBCLASS,
153 id->bInterfaceSubClass);
154 ADD(alias, "ip",
155 id->match_flags&USB_DEVICE_ID_MATCH_INT_PROTOCOL,
156 id->bInterfaceProtocol);
157
158 add_wildcard(alias);
159 buf_printf(&mod->dev_table_buf,
160 "MODULE_ALIAS(\"%s\");\n", alias);
161 }
162
163 /* Handles increment/decrement of BCD formatted integers */
164 /* Returns the previous value, so it works like i++ or i-- */
incbcd(unsigned int * bcd,int inc,unsigned char max,size_t chars)165 static unsigned int incbcd(unsigned int *bcd,
166 int inc,
167 unsigned char max,
168 size_t chars)
169 {
170 unsigned int init = *bcd, i, j;
171 unsigned long long c, dec = 0;
172
173 /* If bcd is not in BCD format, just increment */
174 if (max > 0x9) {
175 *bcd += inc;
176 return init;
177 }
178
179 /* Convert BCD to Decimal */
180 for (i=0 ; i < chars ; i++) {
181 c = (*bcd >> (i << 2)) & 0xf;
182 c = c > 9 ? 9 : c; /* force to bcd just in case */
183 for (j=0 ; j < i ; j++)
184 c = c * 10;
185 dec += c;
186 }
187
188 /* Do our increment/decrement */
189 dec += inc;
190 *bcd = 0;
191
192 /* Convert back to BCD */
193 for (i=0 ; i < chars ; i++) {
194 for (c=1,j=0 ; j < i ; j++)
195 c = c * 10;
196 c = (dec / c) % 10;
197 *bcd += c << (i << 2);
198 }
199 return init;
200 }
201
do_usb_entry_multi(struct usb_device_id * id,struct module * mod)202 static void do_usb_entry_multi(struct usb_device_id *id, struct module *mod)
203 {
204 unsigned int devlo, devhi;
205 unsigned char chi, clo, max;
206 int ndigits;
207
208 id->match_flags = TO_NATIVE(id->match_flags);
209 id->idVendor = TO_NATIVE(id->idVendor);
210 id->idProduct = TO_NATIVE(id->idProduct);
211
212 devlo = id->match_flags & USB_DEVICE_ID_MATCH_DEV_LO ?
213 TO_NATIVE(id->bcdDevice_lo) : 0x0U;
214 devhi = id->match_flags & USB_DEVICE_ID_MATCH_DEV_HI ?
215 TO_NATIVE(id->bcdDevice_hi) : ~0x0U;
216
217 /* Figure out if this entry is in bcd or hex format */
218 max = 0x9; /* Default to decimal format */
219 for (ndigits = 0 ; ndigits < sizeof(id->bcdDevice_lo) * 2 ; ndigits++) {
220 clo = (devlo >> (ndigits << 2)) & 0xf;
221 chi = ((devhi > 0x9999 ? 0x9999 : devhi) >> (ndigits << 2)) & 0xf;
222 if (clo > max || chi > max) {
223 max = 0xf;
224 break;
225 }
226 }
227
228 /*
229 * Some modules (visor) have empty slots as placeholder for
230 * run-time specification that results in catch-all alias
231 */
232 if (!(id->idVendor | id->idProduct | id->bDeviceClass | id->bInterfaceClass))
233 return;
234
235 /* Convert numeric bcdDevice range into fnmatch-able pattern(s) */
236 for (ndigits = sizeof(id->bcdDevice_lo) * 2 - 1; devlo <= devhi; ndigits--) {
237 clo = devlo & 0xf;
238 chi = devhi & 0xf;
239 if (chi > max) /* If we are in bcd mode, truncate if necessary */
240 chi = max;
241 devlo >>= 4;
242 devhi >>= 4;
243
244 if (devlo == devhi || !ndigits) {
245 do_usb_entry(id, devlo, ndigits, clo, chi, max, mod);
246 break;
247 }
248
249 if (clo > 0x0)
250 do_usb_entry(id,
251 incbcd(&devlo, 1, max,
252 sizeof(id->bcdDevice_lo) * 2),
253 ndigits, clo, max, max, mod);
254
255 if (chi < max)
256 do_usb_entry(id,
257 incbcd(&devhi, -1, max,
258 sizeof(id->bcdDevice_lo) * 2),
259 ndigits, 0x0, chi, max, mod);
260 }
261 }
262
do_usb_table(void * symval,unsigned long size,struct module * mod)263 static void do_usb_table(void *symval, unsigned long size,
264 struct module *mod)
265 {
266 unsigned int i;
267 const unsigned long id_size = sizeof(struct usb_device_id);
268
269 device_id_check(mod->name, "usb", size, id_size, symval);
270
271 /* Leave last one: it's the terminator. */
272 size -= id_size;
273
274 for (i = 0; i < size; i += id_size)
275 do_usb_entry_multi(symval + i, mod);
276 }
277
278 /* Looks like: hid:bNvNpN */
do_hid_entry(const char * filename,struct hid_device_id * id,char * alias)279 static int do_hid_entry(const char *filename,
280 struct hid_device_id *id, char *alias)
281 {
282 id->bus = TO_NATIVE(id->bus);
283 id->vendor = TO_NATIVE(id->vendor);
284 id->product = TO_NATIVE(id->product);
285
286 sprintf(alias, "hid:b%04X", id->bus);
287 ADD(alias, "v", id->vendor != HID_ANY_ID, id->vendor);
288 ADD(alias, "p", id->product != HID_ANY_ID, id->product);
289
290 return 1;
291 }
292
293 /* Looks like: ieee1394:venNmoNspNverN */
do_ieee1394_entry(const char * filename,struct ieee1394_device_id * id,char * alias)294 static int do_ieee1394_entry(const char *filename,
295 struct ieee1394_device_id *id, char *alias)
296 {
297 id->match_flags = TO_NATIVE(id->match_flags);
298 id->vendor_id = TO_NATIVE(id->vendor_id);
299 id->model_id = TO_NATIVE(id->model_id);
300 id->specifier_id = TO_NATIVE(id->specifier_id);
301 id->version = TO_NATIVE(id->version);
302
303 strcpy(alias, "ieee1394:");
304 ADD(alias, "ven", id->match_flags & IEEE1394_MATCH_VENDOR_ID,
305 id->vendor_id);
306 ADD(alias, "mo", id->match_flags & IEEE1394_MATCH_MODEL_ID,
307 id->model_id);
308 ADD(alias, "sp", id->match_flags & IEEE1394_MATCH_SPECIFIER_ID,
309 id->specifier_id);
310 ADD(alias, "ver", id->match_flags & IEEE1394_MATCH_VERSION,
311 id->version);
312
313 add_wildcard(alias);
314 return 1;
315 }
316
317 /* Looks like: pci:vNdNsvNsdNbcNscNiN. */
do_pci_entry(const char * filename,struct pci_device_id * id,char * alias)318 static int do_pci_entry(const char *filename,
319 struct pci_device_id *id, char *alias)
320 {
321 /* Class field can be divided into these three. */
322 unsigned char baseclass, subclass, interface,
323 baseclass_mask, subclass_mask, interface_mask;
324
325 id->vendor = TO_NATIVE(id->vendor);
326 id->device = TO_NATIVE(id->device);
327 id->subvendor = TO_NATIVE(id->subvendor);
328 id->subdevice = TO_NATIVE(id->subdevice);
329 id->class = TO_NATIVE(id->class);
330 id->class_mask = TO_NATIVE(id->class_mask);
331
332 strcpy(alias, "pci:");
333 ADD(alias, "v", id->vendor != PCI_ANY_ID, id->vendor);
334 ADD(alias, "d", id->device != PCI_ANY_ID, id->device);
335 ADD(alias, "sv", id->subvendor != PCI_ANY_ID, id->subvendor);
336 ADD(alias, "sd", id->subdevice != PCI_ANY_ID, id->subdevice);
337
338 baseclass = (id->class) >> 16;
339 baseclass_mask = (id->class_mask) >> 16;
340 subclass = (id->class) >> 8;
341 subclass_mask = (id->class_mask) >> 8;
342 interface = id->class;
343 interface_mask = id->class_mask;
344
345 if ((baseclass_mask != 0 && baseclass_mask != 0xFF)
346 || (subclass_mask != 0 && subclass_mask != 0xFF)
347 || (interface_mask != 0 && interface_mask != 0xFF)) {
348 warn("Can't handle masks in %s:%04X\n",
349 filename, id->class_mask);
350 return 0;
351 }
352
353 ADD(alias, "bc", baseclass_mask == 0xFF, baseclass);
354 ADD(alias, "sc", subclass_mask == 0xFF, subclass);
355 ADD(alias, "i", interface_mask == 0xFF, interface);
356 add_wildcard(alias);
357 return 1;
358 }
359
360 /* looks like: "ccw:tNmNdtNdmN" */
do_ccw_entry(const char * filename,struct ccw_device_id * id,char * alias)361 static int do_ccw_entry(const char *filename,
362 struct ccw_device_id *id, char *alias)
363 {
364 id->match_flags = TO_NATIVE(id->match_flags);
365 id->cu_type = TO_NATIVE(id->cu_type);
366 id->cu_model = TO_NATIVE(id->cu_model);
367 id->dev_type = TO_NATIVE(id->dev_type);
368 id->dev_model = TO_NATIVE(id->dev_model);
369
370 strcpy(alias, "ccw:");
371 ADD(alias, "t", id->match_flags&CCW_DEVICE_ID_MATCH_CU_TYPE,
372 id->cu_type);
373 ADD(alias, "m", id->match_flags&CCW_DEVICE_ID_MATCH_CU_MODEL,
374 id->cu_model);
375 ADD(alias, "dt", id->match_flags&CCW_DEVICE_ID_MATCH_DEVICE_TYPE,
376 id->dev_type);
377 ADD(alias, "dm", id->match_flags&CCW_DEVICE_ID_MATCH_DEVICE_MODEL,
378 id->dev_model);
379 add_wildcard(alias);
380 return 1;
381 }
382
383 /* looks like: "ap:tN" */
do_ap_entry(const char * filename,struct ap_device_id * id,char * alias)384 static int do_ap_entry(const char *filename,
385 struct ap_device_id *id, char *alias)
386 {
387 sprintf(alias, "ap:t%02X*", id->dev_type);
388 return 1;
389 }
390
391 /* looks like: "css:tN" */
do_css_entry(const char * filename,struct css_device_id * id,char * alias)392 static int do_css_entry(const char *filename,
393 struct css_device_id *id, char *alias)
394 {
395 sprintf(alias, "css:t%01X", id->type);
396 return 1;
397 }
398
399 /* Looks like: "serio:tyNprNidNexN" */
do_serio_entry(const char * filename,struct serio_device_id * id,char * alias)400 static int do_serio_entry(const char *filename,
401 struct serio_device_id *id, char *alias)
402 {
403 id->type = TO_NATIVE(id->type);
404 id->proto = TO_NATIVE(id->proto);
405 id->id = TO_NATIVE(id->id);
406 id->extra = TO_NATIVE(id->extra);
407
408 strcpy(alias, "serio:");
409 ADD(alias, "ty", id->type != SERIO_ANY, id->type);
410 ADD(alias, "pr", id->proto != SERIO_ANY, id->proto);
411 ADD(alias, "id", id->id != SERIO_ANY, id->id);
412 ADD(alias, "ex", id->extra != SERIO_ANY, id->extra);
413
414 add_wildcard(alias);
415 return 1;
416 }
417
418 /* looks like: "acpi:ACPI0003 or acpi:PNP0C0B" or "acpi:LNXVIDEO" */
do_acpi_entry(const char * filename,struct acpi_device_id * id,char * alias)419 static int do_acpi_entry(const char *filename,
420 struct acpi_device_id *id, char *alias)
421 {
422 sprintf(alias, "acpi*:%s:*", id->id);
423 return 1;
424 }
425
426 /* looks like: "pnp:dD" */
do_pnp_device_entry(void * symval,unsigned long size,struct module * mod)427 static void do_pnp_device_entry(void *symval, unsigned long size,
428 struct module *mod)
429 {
430 const unsigned long id_size = sizeof(struct pnp_device_id);
431 const unsigned int count = (size / id_size)-1;
432 const struct pnp_device_id *devs = symval;
433 unsigned int i;
434
435 device_id_check(mod->name, "pnp", size, id_size, symval);
436
437 for (i = 0; i < count; i++) {
438 const char *id = (char *)devs[i].id;
439 char acpi_id[sizeof(devs[0].id)];
440 int j;
441
442 buf_printf(&mod->dev_table_buf,
443 "MODULE_ALIAS(\"pnp:d%s*\");\n", id);
444
445 /* fix broken pnp bus lowercasing */
446 for (j = 0; j < sizeof(acpi_id); j++)
447 acpi_id[j] = toupper(id[j]);
448 buf_printf(&mod->dev_table_buf,
449 "MODULE_ALIAS(\"acpi*:%s:*\");\n", acpi_id);
450 }
451 }
452
453 /* looks like: "pnp:dD" for every device of the card */
do_pnp_card_entries(void * symval,unsigned long size,struct module * mod)454 static void do_pnp_card_entries(void *symval, unsigned long size,
455 struct module *mod)
456 {
457 const unsigned long id_size = sizeof(struct pnp_card_device_id);
458 const unsigned int count = (size / id_size)-1;
459 const struct pnp_card_device_id *cards = symval;
460 unsigned int i;
461
462 device_id_check(mod->name, "pnp", size, id_size, symval);
463
464 for (i = 0; i < count; i++) {
465 unsigned int j;
466 const struct pnp_card_device_id *card = &cards[i];
467
468 for (j = 0; j < PNP_MAX_DEVICES; j++) {
469 const char *id = (char *)card->devs[j].id;
470 int i2, j2;
471 int dup = 0;
472
473 if (!id[0])
474 break;
475
476 /* find duplicate, already added value */
477 for (i2 = 0; i2 < i && !dup; i2++) {
478 const struct pnp_card_device_id *card2 = &cards[i2];
479
480 for (j2 = 0; j2 < PNP_MAX_DEVICES; j2++) {
481 const char *id2 = (char *)card2->devs[j2].id;
482
483 if (!id2[0])
484 break;
485
486 if (!strcmp(id, id2)) {
487 dup = 1;
488 break;
489 }
490 }
491 }
492
493 /* add an individual alias for every device entry */
494 if (!dup) {
495 char acpi_id[sizeof(card->devs[0].id)];
496 int k;
497
498 buf_printf(&mod->dev_table_buf,
499 "MODULE_ALIAS(\"pnp:d%s*\");\n", id);
500
501 /* fix broken pnp bus lowercasing */
502 for (k = 0; k < sizeof(acpi_id); k++)
503 acpi_id[k] = toupper(id[k]);
504 buf_printf(&mod->dev_table_buf,
505 "MODULE_ALIAS(\"acpi*:%s:*\");\n", acpi_id);
506 }
507 }
508 }
509 }
510
511 /* Looks like: pcmcia:mNcNfNfnNpfnNvaNvbNvcNvdN. */
do_pcmcia_entry(const char * filename,struct pcmcia_device_id * id,char * alias)512 static int do_pcmcia_entry(const char *filename,
513 struct pcmcia_device_id *id, char *alias)
514 {
515 unsigned int i;
516
517 id->match_flags = TO_NATIVE(id->match_flags);
518 id->manf_id = TO_NATIVE(id->manf_id);
519 id->card_id = TO_NATIVE(id->card_id);
520 id->func_id = TO_NATIVE(id->func_id);
521 id->function = TO_NATIVE(id->function);
522 id->device_no = TO_NATIVE(id->device_no);
523
524 for (i=0; i<4; i++) {
525 id->prod_id_hash[i] = TO_NATIVE(id->prod_id_hash[i]);
526 }
527
528 strcpy(alias, "pcmcia:");
529 ADD(alias, "m", id->match_flags & PCMCIA_DEV_ID_MATCH_MANF_ID,
530 id->manf_id);
531 ADD(alias, "c", id->match_flags & PCMCIA_DEV_ID_MATCH_CARD_ID,
532 id->card_id);
533 ADD(alias, "f", id->match_flags & PCMCIA_DEV_ID_MATCH_FUNC_ID,
534 id->func_id);
535 ADD(alias, "fn", id->match_flags & PCMCIA_DEV_ID_MATCH_FUNCTION,
536 id->function);
537 ADD(alias, "pfn", id->match_flags & PCMCIA_DEV_ID_MATCH_DEVICE_NO,
538 id->device_no);
539 ADD(alias, "pa", id->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID1, id->prod_id_hash[0]);
540 ADD(alias, "pb", id->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID2, id->prod_id_hash[1]);
541 ADD(alias, "pc", id->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID3, id->prod_id_hash[2]);
542 ADD(alias, "pd", id->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID4, id->prod_id_hash[3]);
543
544 add_wildcard(alias);
545 return 1;
546 }
547
548
549
do_of_entry(const char * filename,struct of_device_id * of,char * alias)550 static int do_of_entry (const char *filename, struct of_device_id *of, char *alias)
551 {
552 int len;
553 char *tmp;
554 len = sprintf (alias, "of:N%sT%s",
555 of->name[0] ? of->name : "*",
556 of->type[0] ? of->type : "*");
557
558 if (of->compatible[0])
559 sprintf (&alias[len], "%sC%s",
560 of->type[0] ? "*" : "",
561 of->compatible);
562
563 /* Replace all whitespace with underscores */
564 for (tmp = alias; tmp && *tmp; tmp++)
565 if (isspace (*tmp))
566 *tmp = '_';
567
568 add_wildcard(alias);
569 return 1;
570 }
571
do_vio_entry(const char * filename,struct vio_device_id * vio,char * alias)572 static int do_vio_entry(const char *filename, struct vio_device_id *vio,
573 char *alias)
574 {
575 char *tmp;
576
577 sprintf(alias, "vio:T%sS%s", vio->type[0] ? vio->type : "*",
578 vio->compat[0] ? vio->compat : "*");
579
580 /* Replace all whitespace with underscores */
581 for (tmp = alias; tmp && *tmp; tmp++)
582 if (isspace (*tmp))
583 *tmp = '_';
584
585 add_wildcard(alias);
586 return 1;
587 }
588
589 #define ARRAY_SIZE(x) (sizeof(x) / sizeof((x)[0]))
590
do_input(char * alias,kernel_ulong_t * arr,unsigned int min,unsigned int max)591 static void do_input(char *alias,
592 kernel_ulong_t *arr, unsigned int min, unsigned int max)
593 {
594 unsigned int i;
595
596 for (i = min; i < max; i++)
597 if (arr[i / BITS_PER_LONG] & (1L << (i%BITS_PER_LONG)))
598 sprintf(alias + strlen(alias), "%X,*", i);
599 }
600
601 /* input:b0v0p0e0-eXkXrXaXmXlXsXfXwX where X is comma-separated %02X. */
do_input_entry(const char * filename,struct input_device_id * id,char * alias)602 static int do_input_entry(const char *filename, struct input_device_id *id,
603 char *alias)
604 {
605 sprintf(alias, "input:");
606
607 ADD(alias, "b", id->flags & INPUT_DEVICE_ID_MATCH_BUS, id->bustype);
608 ADD(alias, "v", id->flags & INPUT_DEVICE_ID_MATCH_VENDOR, id->vendor);
609 ADD(alias, "p", id->flags & INPUT_DEVICE_ID_MATCH_PRODUCT, id->product);
610 ADD(alias, "e", id->flags & INPUT_DEVICE_ID_MATCH_VERSION, id->version);
611
612 sprintf(alias + strlen(alias), "-e*");
613 if (id->flags & INPUT_DEVICE_ID_MATCH_EVBIT)
614 do_input(alias, id->evbit, 0, INPUT_DEVICE_ID_EV_MAX);
615 sprintf(alias + strlen(alias), "k*");
616 if (id->flags & INPUT_DEVICE_ID_MATCH_KEYBIT)
617 do_input(alias, id->keybit,
618 INPUT_DEVICE_ID_KEY_MIN_INTERESTING,
619 INPUT_DEVICE_ID_KEY_MAX);
620 sprintf(alias + strlen(alias), "r*");
621 if (id->flags & INPUT_DEVICE_ID_MATCH_RELBIT)
622 do_input(alias, id->relbit, 0, INPUT_DEVICE_ID_REL_MAX);
623 sprintf(alias + strlen(alias), "a*");
624 if (id->flags & INPUT_DEVICE_ID_MATCH_ABSBIT)
625 do_input(alias, id->absbit, 0, INPUT_DEVICE_ID_ABS_MAX);
626 sprintf(alias + strlen(alias), "m*");
627 if (id->flags & INPUT_DEVICE_ID_MATCH_MSCIT)
628 do_input(alias, id->mscbit, 0, INPUT_DEVICE_ID_MSC_MAX);
629 sprintf(alias + strlen(alias), "l*");
630 if (id->flags & INPUT_DEVICE_ID_MATCH_LEDBIT)
631 do_input(alias, id->ledbit, 0, INPUT_DEVICE_ID_LED_MAX);
632 sprintf(alias + strlen(alias), "s*");
633 if (id->flags & INPUT_DEVICE_ID_MATCH_SNDBIT)
634 do_input(alias, id->sndbit, 0, INPUT_DEVICE_ID_SND_MAX);
635 sprintf(alias + strlen(alias), "f*");
636 if (id->flags & INPUT_DEVICE_ID_MATCH_FFBIT)
637 do_input(alias, id->ffbit, 0, INPUT_DEVICE_ID_FF_MAX);
638 sprintf(alias + strlen(alias), "w*");
639 if (id->flags & INPUT_DEVICE_ID_MATCH_SWBIT)
640 do_input(alias, id->swbit, 0, INPUT_DEVICE_ID_SW_MAX);
641 return 1;
642 }
643
do_eisa_entry(const char * filename,struct eisa_device_id * eisa,char * alias)644 static int do_eisa_entry(const char *filename, struct eisa_device_id *eisa,
645 char *alias)
646 {
647 if (eisa->sig[0])
648 sprintf(alias, EISA_DEVICE_MODALIAS_FMT "*", eisa->sig);
649 else
650 strcat(alias, "*");
651 return 1;
652 }
653
654 /* Looks like: parisc:tNhvNrevNsvN */
do_parisc_entry(const char * filename,struct parisc_device_id * id,char * alias)655 static int do_parisc_entry(const char *filename, struct parisc_device_id *id,
656 char *alias)
657 {
658 id->hw_type = TO_NATIVE(id->hw_type);
659 id->hversion = TO_NATIVE(id->hversion);
660 id->hversion_rev = TO_NATIVE(id->hversion_rev);
661 id->sversion = TO_NATIVE(id->sversion);
662
663 strcpy(alias, "parisc:");
664 ADD(alias, "t", id->hw_type != PA_HWTYPE_ANY_ID, id->hw_type);
665 ADD(alias, "hv", id->hversion != PA_HVERSION_ANY_ID, id->hversion);
666 ADD(alias, "rev", id->hversion_rev != PA_HVERSION_REV_ANY_ID, id->hversion_rev);
667 ADD(alias, "sv", id->sversion != PA_SVERSION_ANY_ID, id->sversion);
668
669 add_wildcard(alias);
670 return 1;
671 }
672
673 /* Looks like: sdio:cNvNdN. */
do_sdio_entry(const char * filename,struct sdio_device_id * id,char * alias)674 static int do_sdio_entry(const char *filename,
675 struct sdio_device_id *id, char *alias)
676 {
677 id->class = TO_NATIVE(id->class);
678 id->vendor = TO_NATIVE(id->vendor);
679 id->device = TO_NATIVE(id->device);
680
681 strcpy(alias, "sdio:");
682 ADD(alias, "c", id->class != (__u8)SDIO_ANY_ID, id->class);
683 ADD(alias, "v", id->vendor != (__u16)SDIO_ANY_ID, id->vendor);
684 ADD(alias, "d", id->device != (__u16)SDIO_ANY_ID, id->device);
685 add_wildcard(alias);
686 return 1;
687 }
688
689 /* Looks like: ssb:vNidNrevN. */
do_ssb_entry(const char * filename,struct ssb_device_id * id,char * alias)690 static int do_ssb_entry(const char *filename,
691 struct ssb_device_id *id, char *alias)
692 {
693 id->vendor = TO_NATIVE(id->vendor);
694 id->coreid = TO_NATIVE(id->coreid);
695 id->revision = TO_NATIVE(id->revision);
696
697 strcpy(alias, "ssb:");
698 ADD(alias, "v", id->vendor != SSB_ANY_VENDOR, id->vendor);
699 ADD(alias, "id", id->coreid != SSB_ANY_ID, id->coreid);
700 ADD(alias, "rev", id->revision != SSB_ANY_REV, id->revision);
701 add_wildcard(alias);
702 return 1;
703 }
704
705 /* Looks like: virtio:dNvN */
do_virtio_entry(const char * filename,struct virtio_device_id * id,char * alias)706 static int do_virtio_entry(const char *filename, struct virtio_device_id *id,
707 char *alias)
708 {
709 id->device = TO_NATIVE(id->device);
710 id->vendor = TO_NATIVE(id->vendor);
711
712 strcpy(alias, "virtio:");
713 ADD(alias, "d", id->device != VIRTIO_DEV_ANY_ID, id->device);
714 ADD(alias, "v", id->vendor != VIRTIO_DEV_ANY_ID, id->vendor);
715
716 add_wildcard(alias);
717 return 1;
718 }
719
720 /* Looks like: i2c:S */
do_i2c_entry(const char * filename,struct i2c_device_id * id,char * alias)721 static int do_i2c_entry(const char *filename, struct i2c_device_id *id,
722 char *alias)
723 {
724 sprintf(alias, I2C_MODULE_PREFIX "%s", id->name);
725
726 return 1;
727 }
728
729 /* Looks like: spi:S */
do_spi_entry(const char * filename,struct spi_device_id * id,char * alias)730 static int do_spi_entry(const char *filename, struct spi_device_id *id,
731 char *alias)
732 {
733 sprintf(alias, SPI_MODULE_PREFIX "%s", id->name);
734
735 return 1;
736 }
737
738 static const struct dmifield {
739 const char *prefix;
740 int field;
741 } dmi_fields[] = {
742 { "bvn", DMI_BIOS_VENDOR },
743 { "bvr", DMI_BIOS_VERSION },
744 { "bd", DMI_BIOS_DATE },
745 { "svn", DMI_SYS_VENDOR },
746 { "pn", DMI_PRODUCT_NAME },
747 { "pvr", DMI_PRODUCT_VERSION },
748 { "rvn", DMI_BOARD_VENDOR },
749 { "rn", DMI_BOARD_NAME },
750 { "rvr", DMI_BOARD_VERSION },
751 { "cvn", DMI_CHASSIS_VENDOR },
752 { "ct", DMI_CHASSIS_TYPE },
753 { "cvr", DMI_CHASSIS_VERSION },
754 { NULL, DMI_NONE }
755 };
756
dmi_ascii_filter(char * d,const char * s)757 static void dmi_ascii_filter(char *d, const char *s)
758 {
759 /* Filter out characters we don't want to see in the modalias string */
760 for (; *s; s++)
761 if (*s > ' ' && *s < 127 && *s != ':')
762 *(d++) = *s;
763
764 *d = 0;
765 }
766
767
do_dmi_entry(const char * filename,struct dmi_system_id * id,char * alias)768 static int do_dmi_entry(const char *filename, struct dmi_system_id *id,
769 char *alias)
770 {
771 int i, j;
772
773 sprintf(alias, "dmi*");
774
775 for (i = 0; i < ARRAY_SIZE(dmi_fields); i++) {
776 for (j = 0; j < 4; j++) {
777 if (id->matches[j].slot &&
778 id->matches[j].slot == dmi_fields[i].field) {
779 sprintf(alias + strlen(alias), ":%s*",
780 dmi_fields[i].prefix);
781 dmi_ascii_filter(alias + strlen(alias),
782 id->matches[j].substr);
783 strcat(alias, "*");
784 }
785 }
786 }
787
788 strcat(alias, ":");
789 return 1;
790 }
791
do_platform_entry(const char * filename,struct platform_device_id * id,char * alias)792 static int do_platform_entry(const char *filename,
793 struct platform_device_id *id, char *alias)
794 {
795 sprintf(alias, PLATFORM_MODULE_PREFIX "%s", id->name);
796 return 1;
797 }
798
do_mdio_entry(const char * filename,struct mdio_device_id * id,char * alias)799 static int do_mdio_entry(const char *filename,
800 struct mdio_device_id *id, char *alias)
801 {
802 int i;
803
804 alias += sprintf(alias, MDIO_MODULE_PREFIX);
805
806 for (i = 0; i < 32; i++) {
807 if (!((id->phy_id_mask >> (31-i)) & 1))
808 *(alias++) = '?';
809 else if ((id->phy_id >> (31-i)) & 1)
810 *(alias++) = '1';
811 else
812 *(alias++) = '0';
813 }
814
815 /* Terminate the string */
816 *alias = 0;
817
818 return 1;
819 }
820
821 /* Looks like: zorro:iN. */
do_zorro_entry(const char * filename,struct zorro_device_id * id,char * alias)822 static int do_zorro_entry(const char *filename, struct zorro_device_id *id,
823 char *alias)
824 {
825 id->id = TO_NATIVE(id->id);
826 strcpy(alias, "zorro:");
827 ADD(alias, "i", id->id != ZORRO_WILDCARD, id->id);
828 return 1;
829 }
830
831 /* looks like: "pnp:dD" */
do_isapnp_entry(const char * filename,struct isapnp_device_id * id,char * alias)832 static int do_isapnp_entry(const char *filename,
833 struct isapnp_device_id *id, char *alias)
834 {
835 sprintf(alias, "pnp:d%c%c%c%x%x%x%x*",
836 'A' + ((id->vendor >> 2) & 0x3f) - 1,
837 'A' + (((id->vendor & 3) << 3) | ((id->vendor >> 13) & 7)) - 1,
838 'A' + ((id->vendor >> 8) & 0x1f) - 1,
839 (id->function >> 4) & 0x0f, id->function & 0x0f,
840 (id->function >> 12) & 0x0f, (id->function >> 8) & 0x0f);
841 return 1;
842 }
843
844 /* Ignore any prefix, eg. some architectures prepend _ */
sym_is(const char * symbol,const char * name)845 static inline int sym_is(const char *symbol, const char *name)
846 {
847 const char *match;
848
849 match = strstr(symbol, name);
850 if (!match)
851 return 0;
852 return match[strlen(name)] == '\0';
853 }
854
do_table(void * symval,unsigned long size,unsigned long id_size,const char * device_id,void * function,struct module * mod)855 static void do_table(void *symval, unsigned long size,
856 unsigned long id_size,
857 const char *device_id,
858 void *function,
859 struct module *mod)
860 {
861 unsigned int i;
862 char alias[500];
863 int (*do_entry)(const char *, void *entry, char *alias) = function;
864
865 device_id_check(mod->name, device_id, size, id_size, symval);
866 /* Leave last one: it's the terminator. */
867 size -= id_size;
868
869 for (i = 0; i < size; i += id_size) {
870 if (do_entry(mod->name, symval+i, alias)) {
871 buf_printf(&mod->dev_table_buf,
872 "MODULE_ALIAS(\"%s\");\n", alias);
873 }
874 }
875 }
876
877 /* Create MODULE_ALIAS() statements.
878 * At this time, we cannot write the actual output C source yet,
879 * so we write into the mod->dev_table_buf buffer. */
handle_moddevtable(struct module * mod,struct elf_info * info,Elf_Sym * sym,const char * symname)880 void handle_moddevtable(struct module *mod, struct elf_info *info,
881 Elf_Sym *sym, const char *symname)
882 {
883 void *symval;
884 char *zeros = NULL;
885
886 /* We're looking for a section relative symbol */
887 if (!sym->st_shndx || get_secindex(info, sym) >= info->num_sections)
888 return;
889
890 /* Handle all-NULL symbols allocated into .bss */
891 if (info->sechdrs[get_secindex(info, sym)].sh_type & SHT_NOBITS) {
892 zeros = calloc(1, sym->st_size);
893 symval = zeros;
894 } else {
895 symval = (void *)info->hdr
896 + info->sechdrs[get_secindex(info, sym)].sh_offset
897 + sym->st_value;
898 }
899
900 if (sym_is(symname, "__mod_pci_device_table"))
901 do_table(symval, sym->st_size,
902 sizeof(struct pci_device_id), "pci",
903 do_pci_entry, mod);
904 else if (sym_is(symname, "__mod_usb_device_table"))
905 /* special case to handle bcdDevice ranges */
906 do_usb_table(symval, sym->st_size, mod);
907 else if (sym_is(symname, "__mod_hid_device_table"))
908 do_table(symval, sym->st_size,
909 sizeof(struct hid_device_id), "hid",
910 do_hid_entry, mod);
911 else if (sym_is(symname, "__mod_ieee1394_device_table"))
912 do_table(symval, sym->st_size,
913 sizeof(struct ieee1394_device_id), "ieee1394",
914 do_ieee1394_entry, mod);
915 else if (sym_is(symname, "__mod_ccw_device_table"))
916 do_table(symval, sym->st_size,
917 sizeof(struct ccw_device_id), "ccw",
918 do_ccw_entry, mod);
919 else if (sym_is(symname, "__mod_ap_device_table"))
920 do_table(symval, sym->st_size,
921 sizeof(struct ap_device_id), "ap",
922 do_ap_entry, mod);
923 else if (sym_is(symname, "__mod_css_device_table"))
924 do_table(symval, sym->st_size,
925 sizeof(struct css_device_id), "css",
926 do_css_entry, mod);
927 else if (sym_is(symname, "__mod_serio_device_table"))
928 do_table(symval, sym->st_size,
929 sizeof(struct serio_device_id), "serio",
930 do_serio_entry, mod);
931 else if (sym_is(symname, "__mod_acpi_device_table"))
932 do_table(symval, sym->st_size,
933 sizeof(struct acpi_device_id), "acpi",
934 do_acpi_entry, mod);
935 else if (sym_is(symname, "__mod_pnp_device_table"))
936 do_pnp_device_entry(symval, sym->st_size, mod);
937 else if (sym_is(symname, "__mod_pnp_card_device_table"))
938 do_pnp_card_entries(symval, sym->st_size, mod);
939 else if (sym_is(symname, "__mod_pcmcia_device_table"))
940 do_table(symval, sym->st_size,
941 sizeof(struct pcmcia_device_id), "pcmcia",
942 do_pcmcia_entry, mod);
943 else if (sym_is(symname, "__mod_of_device_table"))
944 do_table(symval, sym->st_size,
945 sizeof(struct of_device_id), "of",
946 do_of_entry, mod);
947 else if (sym_is(symname, "__mod_vio_device_table"))
948 do_table(symval, sym->st_size,
949 sizeof(struct vio_device_id), "vio",
950 do_vio_entry, mod);
951 else if (sym_is(symname, "__mod_input_device_table"))
952 do_table(symval, sym->st_size,
953 sizeof(struct input_device_id), "input",
954 do_input_entry, mod);
955 else if (sym_is(symname, "__mod_eisa_device_table"))
956 do_table(symval, sym->st_size,
957 sizeof(struct eisa_device_id), "eisa",
958 do_eisa_entry, mod);
959 else if (sym_is(symname, "__mod_parisc_device_table"))
960 do_table(symval, sym->st_size,
961 sizeof(struct parisc_device_id), "parisc",
962 do_parisc_entry, mod);
963 else if (sym_is(symname, "__mod_sdio_device_table"))
964 do_table(symval, sym->st_size,
965 sizeof(struct sdio_device_id), "sdio",
966 do_sdio_entry, mod);
967 else if (sym_is(symname, "__mod_ssb_device_table"))
968 do_table(symval, sym->st_size,
969 sizeof(struct ssb_device_id), "ssb",
970 do_ssb_entry, mod);
971 else if (sym_is(symname, "__mod_virtio_device_table"))
972 do_table(symval, sym->st_size,
973 sizeof(struct virtio_device_id), "virtio",
974 do_virtio_entry, mod);
975 else if (sym_is(symname, "__mod_i2c_device_table"))
976 do_table(symval, sym->st_size,
977 sizeof(struct i2c_device_id), "i2c",
978 do_i2c_entry, mod);
979 else if (sym_is(symname, "__mod_spi_device_table"))
980 do_table(symval, sym->st_size,
981 sizeof(struct spi_device_id), "spi",
982 do_spi_entry, mod);
983 else if (sym_is(symname, "__mod_dmi_device_table"))
984 do_table(symval, sym->st_size,
985 sizeof(struct dmi_system_id), "dmi",
986 do_dmi_entry, mod);
987 else if (sym_is(symname, "__mod_platform_device_table"))
988 do_table(symval, sym->st_size,
989 sizeof(struct platform_device_id), "platform",
990 do_platform_entry, mod);
991 else if (sym_is(symname, "__mod_mdio_device_table"))
992 do_table(symval, sym->st_size,
993 sizeof(struct mdio_device_id), "mdio",
994 do_mdio_entry, mod);
995 else if (sym_is(symname, "__mod_zorro_device_table"))
996 do_table(symval, sym->st_size,
997 sizeof(struct zorro_device_id), "zorro",
998 do_zorro_entry, mod);
999 else if (sym_is(symname, "__mod_isapnp_device_table"))
1000 do_table(symval, sym->st_size,
1001 sizeof(struct isapnp_device_id), "isa",
1002 do_isapnp_entry, mod);
1003 free(zeros);
1004 }
1005
1006 /* Now add out buffered information to the generated C source */
add_moddevtable(struct buffer * buf,struct module * mod)1007 void add_moddevtable(struct buffer *buf, struct module *mod)
1008 {
1009 buf_printf(buf, "\n");
1010 buf_write(buf, mod->dev_table_buf.p, mod->dev_table_buf.pos);
1011 free(mod->dev_table_buf.p);
1012 }
1013