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 #include "devicetable-offsets.h"
15
16 /* We use the ELF typedefs for kernel_ulong_t but bite the bullet and
17 * use either stdint.h or inttypes.h for the rest. */
18 #if KERNEL_ELFCLASS == ELFCLASS32
19 typedef Elf32_Addr kernel_ulong_t;
20 #define BITS_PER_LONG 32
21 #else
22 typedef Elf64_Addr kernel_ulong_t;
23 #define BITS_PER_LONG 64
24 #endif
25 #ifdef __sun__
26 #include <inttypes.h>
27 #else
28 #include <stdint.h>
29 #endif
30
31 #include <ctype.h>
32 #include <stdbool.h>
33
34 typedef uint32_t __u32;
35 typedef uint16_t __u16;
36 typedef unsigned char __u8;
37
38 /* UUID types for backward compatibility, don't use in new code */
39 typedef struct {
40 __u8 b[16];
41 } guid_t;
42
43 typedef struct {
44 __u8 b[16];
45 } uuid_t;
46
47 #define UUID_STRING_LEN 36
48
49 /* MEI UUID type, don't use anywhere else */
50 typedef struct {
51 __u8 b[16];
52 } uuid_le;
53
54 /* Big exception to the "don't include kernel headers into userspace, which
55 * even potentially has different endianness and word sizes, since
56 * we handle those differences explicitly below */
57 #include "../../include/linux/mod_devicetable.h"
58
59 /* This array collects all instances that use the generic do_table */
60 struct devtable {
61 const char *device_id; /* name of table, __mod_<name>__*_device_table. */
62 unsigned long id_size;
63 int (*do_entry)(const char *filename, void *symval, char *alias);
64 };
65
66 /* Size of alias provided to do_entry functions */
67 #define ALIAS_SIZE 500
68
69 /* Define a variable f that holds the value of field f of struct devid
70 * based at address m.
71 */
72 #define DEF_FIELD(m, devid, f) \
73 typeof(((struct devid *)0)->f) f = TO_NATIVE(*(typeof(f) *)((m) + OFF_##devid##_##f))
74
75 /* Define a variable v that holds the address of field f of struct devid
76 * based at address m. Due to the way typeof works, for a field of type
77 * T[N] the variable has type T(*)[N], _not_ T*.
78 */
79 #define DEF_FIELD_ADDR_VAR(m, devid, f, v) \
80 typeof(((struct devid *)0)->f) *v = ((m) + OFF_##devid##_##f)
81
82 /* Define a variable f that holds the address of field f of struct devid
83 * based at address m. Due to the way typeof works, for a field of type
84 * T[N] the variable has type T(*)[N], _not_ T*.
85 */
86 #define DEF_FIELD_ADDR(m, devid, f) \
87 DEF_FIELD_ADDR_VAR(m, devid, f, f)
88
89 #define ADD(str, sep, cond, field) \
90 do { \
91 strcat(str, sep); \
92 if (cond) \
93 sprintf(str + strlen(str), \
94 sizeof(field) == 1 ? "%02X" : \
95 sizeof(field) == 2 ? "%04X" : \
96 sizeof(field) == 4 ? "%08X" : "", \
97 field); \
98 else \
99 sprintf(str + strlen(str), "*"); \
100 } while(0)
101
102 /* End in a wildcard, for future extension */
add_wildcard(char * str)103 static inline void add_wildcard(char *str)
104 {
105 int len = strlen(str);
106
107 if (str[len - 1] != '*')
108 strcat(str + len, "*");
109 }
110
add_uuid(char * str,uuid_le uuid)111 static inline void add_uuid(char *str, uuid_le uuid)
112 {
113 int len = strlen(str);
114
115 sprintf(str + len, "%02x%02x%02x%02x-%02x%02x-%02x%02x-%02x%02x-%02x%02x%02x%02x%02x%02x",
116 uuid.b[3], uuid.b[2], uuid.b[1], uuid.b[0],
117 uuid.b[5], uuid.b[4], uuid.b[7], uuid.b[6],
118 uuid.b[8], uuid.b[9], uuid.b[10], uuid.b[11],
119 uuid.b[12], uuid.b[13], uuid.b[14], uuid.b[15]);
120 }
121
add_guid(char * str,guid_t guid)122 static inline void add_guid(char *str, guid_t guid)
123 {
124 int len = strlen(str);
125
126 sprintf(str + len, "%02X%02X%02X%02X-%02X%02X-%02X%02X-%02X%02X-%02X%02X%02X%02X%02X%02X",
127 guid.b[3], guid.b[2], guid.b[1], guid.b[0],
128 guid.b[5], guid.b[4], guid.b[7], guid.b[6],
129 guid.b[8], guid.b[9], guid.b[10], guid.b[11],
130 guid.b[12], guid.b[13], guid.b[14], guid.b[15]);
131 }
132
133 /**
134 * Check that sizeof(device_id type) are consistent with size of section
135 * in .o file. If in-consistent then userspace and kernel does not agree
136 * on actual size which is a bug.
137 * Also verify that the final entry in the table is all zeros.
138 * Ignore both checks if build host differ from target host and size differs.
139 **/
device_id_check(const char * modname,const char * device_id,unsigned long size,unsigned long id_size,void * symval)140 static void device_id_check(const char *modname, const char *device_id,
141 unsigned long size, unsigned long id_size,
142 void *symval)
143 {
144 int i;
145
146 if (size % id_size || size < id_size) {
147 fatal("%s: sizeof(struct %s_device_id)=%lu is not a modulo of the size of section __mod_%s__<identifier>_device_table=%lu.\n"
148 "Fix definition of struct %s_device_id in mod_devicetable.h\n",
149 modname, device_id, id_size, device_id, size, device_id);
150 }
151 /* Verify last one is a terminator */
152 for (i = 0; i < id_size; i++ ) {
153 if (*(uint8_t*)(symval+size-id_size+i)) {
154 fprintf(stderr,
155 "%s: struct %s_device_id is %lu bytes. The last of %lu is:\n",
156 modname, device_id, id_size, size / id_size);
157 for (i = 0; i < id_size; i++ )
158 fprintf(stderr,"0x%02x ",
159 *(uint8_t*)(symval+size-id_size+i) );
160 fprintf(stderr,"\n");
161 fatal("%s: struct %s_device_id is not terminated with a NULL entry!\n",
162 modname, device_id);
163 }
164 }
165 }
166
167 /* USB is special because the bcdDevice can be matched against a numeric range */
168 /* Looks like "usb:vNpNdNdcNdscNdpNicNiscNipNinN" */
do_usb_entry(void * symval,unsigned int bcdDevice_initial,int bcdDevice_initial_digits,unsigned char range_lo,unsigned char range_hi,unsigned char max,struct module * mod)169 static void do_usb_entry(void *symval,
170 unsigned int bcdDevice_initial, int bcdDevice_initial_digits,
171 unsigned char range_lo, unsigned char range_hi,
172 unsigned char max, struct module *mod)
173 {
174 char alias[500];
175 DEF_FIELD(symval, usb_device_id, match_flags);
176 DEF_FIELD(symval, usb_device_id, idVendor);
177 DEF_FIELD(symval, usb_device_id, idProduct);
178 DEF_FIELD(symval, usb_device_id, bcdDevice_lo);
179 DEF_FIELD(symval, usb_device_id, bDeviceClass);
180 DEF_FIELD(symval, usb_device_id, bDeviceSubClass);
181 DEF_FIELD(symval, usb_device_id, bDeviceProtocol);
182 DEF_FIELD(symval, usb_device_id, bInterfaceClass);
183 DEF_FIELD(symval, usb_device_id, bInterfaceSubClass);
184 DEF_FIELD(symval, usb_device_id, bInterfaceProtocol);
185 DEF_FIELD(symval, usb_device_id, bInterfaceNumber);
186
187 strcpy(alias, "usb:");
188 ADD(alias, "v", match_flags&USB_DEVICE_ID_MATCH_VENDOR,
189 idVendor);
190 ADD(alias, "p", match_flags&USB_DEVICE_ID_MATCH_PRODUCT,
191 idProduct);
192
193 strcat(alias, "d");
194 if (bcdDevice_initial_digits)
195 sprintf(alias + strlen(alias), "%0*X",
196 bcdDevice_initial_digits, bcdDevice_initial);
197 if (range_lo == range_hi)
198 sprintf(alias + strlen(alias), "%X", range_lo);
199 else if (range_lo > 0 || range_hi < max) {
200 if (range_lo > 0x9 || range_hi < 0xA)
201 sprintf(alias + strlen(alias),
202 "[%X-%X]",
203 range_lo,
204 range_hi);
205 else {
206 sprintf(alias + strlen(alias),
207 range_lo < 0x9 ? "[%X-9" : "[%X",
208 range_lo);
209 sprintf(alias + strlen(alias),
210 range_hi > 0xA ? "A-%X]" : "%X]",
211 range_hi);
212 }
213 }
214 if (bcdDevice_initial_digits < (sizeof(bcdDevice_lo) * 2 - 1))
215 strcat(alias, "*");
216
217 ADD(alias, "dc", match_flags&USB_DEVICE_ID_MATCH_DEV_CLASS,
218 bDeviceClass);
219 ADD(alias, "dsc", match_flags&USB_DEVICE_ID_MATCH_DEV_SUBCLASS,
220 bDeviceSubClass);
221 ADD(alias, "dp", match_flags&USB_DEVICE_ID_MATCH_DEV_PROTOCOL,
222 bDeviceProtocol);
223 ADD(alias, "ic", match_flags&USB_DEVICE_ID_MATCH_INT_CLASS,
224 bInterfaceClass);
225 ADD(alias, "isc", match_flags&USB_DEVICE_ID_MATCH_INT_SUBCLASS,
226 bInterfaceSubClass);
227 ADD(alias, "ip", match_flags&USB_DEVICE_ID_MATCH_INT_PROTOCOL,
228 bInterfaceProtocol);
229 ADD(alias, "in", match_flags&USB_DEVICE_ID_MATCH_INT_NUMBER,
230 bInterfaceNumber);
231
232 add_wildcard(alias);
233 buf_printf(&mod->dev_table_buf,
234 "MODULE_ALIAS(\"%s\");\n", alias);
235 }
236
237 /* Handles increment/decrement of BCD formatted integers */
238 /* Returns the previous value, so it works like i++ or i-- */
incbcd(unsigned int * bcd,int inc,unsigned char max,size_t chars)239 static unsigned int incbcd(unsigned int *bcd,
240 int inc,
241 unsigned char max,
242 size_t chars)
243 {
244 unsigned int init = *bcd, i, j;
245 unsigned long long c, dec = 0;
246
247 /* If bcd is not in BCD format, just increment */
248 if (max > 0x9) {
249 *bcd += inc;
250 return init;
251 }
252
253 /* Convert BCD to Decimal */
254 for (i=0 ; i < chars ; i++) {
255 c = (*bcd >> (i << 2)) & 0xf;
256 c = c > 9 ? 9 : c; /* force to bcd just in case */
257 for (j=0 ; j < i ; j++)
258 c = c * 10;
259 dec += c;
260 }
261
262 /* Do our increment/decrement */
263 dec += inc;
264 *bcd = 0;
265
266 /* Convert back to BCD */
267 for (i=0 ; i < chars ; i++) {
268 for (c=1,j=0 ; j < i ; j++)
269 c = c * 10;
270 c = (dec / c) % 10;
271 *bcd += c << (i << 2);
272 }
273 return init;
274 }
275
do_usb_entry_multi(void * symval,struct module * mod)276 static void do_usb_entry_multi(void *symval, struct module *mod)
277 {
278 unsigned int devlo, devhi;
279 unsigned char chi, clo, max;
280 int ndigits;
281
282 DEF_FIELD(symval, usb_device_id, match_flags);
283 DEF_FIELD(symval, usb_device_id, idVendor);
284 DEF_FIELD(symval, usb_device_id, idProduct);
285 DEF_FIELD(symval, usb_device_id, bcdDevice_lo);
286 DEF_FIELD(symval, usb_device_id, bcdDevice_hi);
287 DEF_FIELD(symval, usb_device_id, bDeviceClass);
288 DEF_FIELD(symval, usb_device_id, bInterfaceClass);
289
290 devlo = match_flags & USB_DEVICE_ID_MATCH_DEV_LO ?
291 bcdDevice_lo : 0x0U;
292 devhi = match_flags & USB_DEVICE_ID_MATCH_DEV_HI ?
293 bcdDevice_hi : ~0x0U;
294
295 /* Figure out if this entry is in bcd or hex format */
296 max = 0x9; /* Default to decimal format */
297 for (ndigits = 0 ; ndigits < sizeof(bcdDevice_lo) * 2 ; ndigits++) {
298 clo = (devlo >> (ndigits << 2)) & 0xf;
299 chi = ((devhi > 0x9999 ? 0x9999 : devhi) >> (ndigits << 2)) & 0xf;
300 if (clo > max || chi > max) {
301 max = 0xf;
302 break;
303 }
304 }
305
306 /*
307 * Some modules (visor) have empty slots as placeholder for
308 * run-time specification that results in catch-all alias
309 */
310 if (!(idVendor | idProduct | bDeviceClass | bInterfaceClass))
311 return;
312
313 /* Convert numeric bcdDevice range into fnmatch-able pattern(s) */
314 for (ndigits = sizeof(bcdDevice_lo) * 2 - 1; devlo <= devhi; ndigits--) {
315 clo = devlo & 0xf;
316 chi = devhi & 0xf;
317 if (chi > max) /* If we are in bcd mode, truncate if necessary */
318 chi = max;
319 devlo >>= 4;
320 devhi >>= 4;
321
322 if (devlo == devhi || !ndigits) {
323 do_usb_entry(symval, devlo, ndigits, clo, chi, max, mod);
324 break;
325 }
326
327 if (clo > 0x0)
328 do_usb_entry(symval,
329 incbcd(&devlo, 1, max,
330 sizeof(bcdDevice_lo) * 2),
331 ndigits, clo, max, max, mod);
332
333 if (chi < max)
334 do_usb_entry(symval,
335 incbcd(&devhi, -1, max,
336 sizeof(bcdDevice_lo) * 2),
337 ndigits, 0x0, chi, max, mod);
338 }
339 }
340
do_usb_table(void * symval,unsigned long size,struct module * mod)341 static void do_usb_table(void *symval, unsigned long size,
342 struct module *mod)
343 {
344 unsigned int i;
345 const unsigned long id_size = SIZE_usb_device_id;
346
347 device_id_check(mod->name, "usb", size, id_size, symval);
348
349 /* Leave last one: it's the terminator. */
350 size -= id_size;
351
352 for (i = 0; i < size; i += id_size)
353 do_usb_entry_multi(symval + i, mod);
354 }
355
do_of_entry_multi(void * symval,struct module * mod)356 static void do_of_entry_multi(void *symval, struct module *mod)
357 {
358 char alias[500];
359 int len;
360 char *tmp;
361
362 DEF_FIELD_ADDR(symval, of_device_id, name);
363 DEF_FIELD_ADDR(symval, of_device_id, type);
364 DEF_FIELD_ADDR(symval, of_device_id, compatible);
365
366 len = sprintf(alias, "of:N%sT%s", (*name)[0] ? *name : "*",
367 (*type)[0] ? *type : "*");
368
369 if ((*compatible)[0])
370 sprintf(&alias[len], "%sC%s", (*type)[0] ? "*" : "",
371 *compatible);
372
373 /* Replace all whitespace with underscores */
374 for (tmp = alias; tmp && *tmp; tmp++)
375 if (isspace(*tmp))
376 *tmp = '_';
377
378 buf_printf(&mod->dev_table_buf, "MODULE_ALIAS(\"%s\");\n", alias);
379 strcat(alias, "C");
380 add_wildcard(alias);
381 buf_printf(&mod->dev_table_buf, "MODULE_ALIAS(\"%s\");\n", alias);
382 }
383
do_of_table(void * symval,unsigned long size,struct module * mod)384 static void do_of_table(void *symval, unsigned long size,
385 struct module *mod)
386 {
387 unsigned int i;
388 const unsigned long id_size = SIZE_of_device_id;
389
390 device_id_check(mod->name, "of", size, id_size, symval);
391
392 /* Leave last one: it's the terminator. */
393 size -= id_size;
394
395 for (i = 0; i < size; i += id_size)
396 do_of_entry_multi(symval + i, mod);
397 }
398
399 /* Looks like: hid:bNvNpN */
do_hid_entry(const char * filename,void * symval,char * alias)400 static int do_hid_entry(const char *filename,
401 void *symval, char *alias)
402 {
403 DEF_FIELD(symval, hid_device_id, bus);
404 DEF_FIELD(symval, hid_device_id, group);
405 DEF_FIELD(symval, hid_device_id, vendor);
406 DEF_FIELD(symval, hid_device_id, product);
407
408 sprintf(alias, "hid:");
409 ADD(alias, "b", bus != HID_BUS_ANY, bus);
410 ADD(alias, "g", group != HID_GROUP_ANY, group);
411 ADD(alias, "v", vendor != HID_ANY_ID, vendor);
412 ADD(alias, "p", product != HID_ANY_ID, product);
413
414 return 1;
415 }
416
417 /* Looks like: ieee1394:venNmoNspNverN */
do_ieee1394_entry(const char * filename,void * symval,char * alias)418 static int do_ieee1394_entry(const char *filename,
419 void *symval, char *alias)
420 {
421 DEF_FIELD(symval, ieee1394_device_id, match_flags);
422 DEF_FIELD(symval, ieee1394_device_id, vendor_id);
423 DEF_FIELD(symval, ieee1394_device_id, model_id);
424 DEF_FIELD(symval, ieee1394_device_id, specifier_id);
425 DEF_FIELD(symval, ieee1394_device_id, version);
426
427 strcpy(alias, "ieee1394:");
428 ADD(alias, "ven", match_flags & IEEE1394_MATCH_VENDOR_ID,
429 vendor_id);
430 ADD(alias, "mo", match_flags & IEEE1394_MATCH_MODEL_ID,
431 model_id);
432 ADD(alias, "sp", match_flags & IEEE1394_MATCH_SPECIFIER_ID,
433 specifier_id);
434 ADD(alias, "ver", match_flags & IEEE1394_MATCH_VERSION,
435 version);
436
437 add_wildcard(alias);
438 return 1;
439 }
440
441 /* Looks like: pci:vNdNsvNsdNbcNscNiN or <prefix>_pci:vNdNsvNsdNbcNscNiN. */
do_pci_entry(const char * filename,void * symval,char * alias)442 static int do_pci_entry(const char *filename,
443 void *symval, char *alias)
444 {
445 /* Class field can be divided into these three. */
446 unsigned char baseclass, subclass, interface,
447 baseclass_mask, subclass_mask, interface_mask;
448
449 DEF_FIELD(symval, pci_device_id, vendor);
450 DEF_FIELD(symval, pci_device_id, device);
451 DEF_FIELD(symval, pci_device_id, subvendor);
452 DEF_FIELD(symval, pci_device_id, subdevice);
453 DEF_FIELD(symval, pci_device_id, class);
454 DEF_FIELD(symval, pci_device_id, class_mask);
455 DEF_FIELD(symval, pci_device_id, override_only);
456
457 switch (override_only) {
458 case 0:
459 strcpy(alias, "pci:");
460 break;
461 case PCI_ID_F_VFIO_DRIVER_OVERRIDE:
462 strcpy(alias, "vfio_pci:");
463 break;
464 default:
465 warn("Unknown PCI driver_override alias %08X\n",
466 override_only);
467 return 0;
468 }
469
470 ADD(alias, "v", vendor != PCI_ANY_ID, vendor);
471 ADD(alias, "d", device != PCI_ANY_ID, device);
472 ADD(alias, "sv", subvendor != PCI_ANY_ID, subvendor);
473 ADD(alias, "sd", subdevice != PCI_ANY_ID, subdevice);
474
475 baseclass = (class) >> 16;
476 baseclass_mask = (class_mask) >> 16;
477 subclass = (class) >> 8;
478 subclass_mask = (class_mask) >> 8;
479 interface = class;
480 interface_mask = class_mask;
481
482 if ((baseclass_mask != 0 && baseclass_mask != 0xFF)
483 || (subclass_mask != 0 && subclass_mask != 0xFF)
484 || (interface_mask != 0 && interface_mask != 0xFF)) {
485 warn("Can't handle masks in %s:%04X\n",
486 filename, class_mask);
487 return 0;
488 }
489
490 ADD(alias, "bc", baseclass_mask == 0xFF, baseclass);
491 ADD(alias, "sc", subclass_mask == 0xFF, subclass);
492 ADD(alias, "i", interface_mask == 0xFF, interface);
493 add_wildcard(alias);
494 return 1;
495 }
496
497 /* looks like: "ccw:tNmNdtNdmN" */
do_ccw_entry(const char * filename,void * symval,char * alias)498 static int do_ccw_entry(const char *filename,
499 void *symval, char *alias)
500 {
501 DEF_FIELD(symval, ccw_device_id, match_flags);
502 DEF_FIELD(symval, ccw_device_id, cu_type);
503 DEF_FIELD(symval, ccw_device_id, cu_model);
504 DEF_FIELD(symval, ccw_device_id, dev_type);
505 DEF_FIELD(symval, ccw_device_id, dev_model);
506
507 strcpy(alias, "ccw:");
508 ADD(alias, "t", match_flags&CCW_DEVICE_ID_MATCH_CU_TYPE,
509 cu_type);
510 ADD(alias, "m", match_flags&CCW_DEVICE_ID_MATCH_CU_MODEL,
511 cu_model);
512 ADD(alias, "dt", match_flags&CCW_DEVICE_ID_MATCH_DEVICE_TYPE,
513 dev_type);
514 ADD(alias, "dm", match_flags&CCW_DEVICE_ID_MATCH_DEVICE_MODEL,
515 dev_model);
516 add_wildcard(alias);
517 return 1;
518 }
519
520 /* looks like: "ap:tN" */
do_ap_entry(const char * filename,void * symval,char * alias)521 static int do_ap_entry(const char *filename,
522 void *symval, char *alias)
523 {
524 DEF_FIELD(symval, ap_device_id, dev_type);
525
526 sprintf(alias, "ap:t%02X*", dev_type);
527 return 1;
528 }
529
530 /* looks like: "css:tN" */
do_css_entry(const char * filename,void * symval,char * alias)531 static int do_css_entry(const char *filename,
532 void *symval, char *alias)
533 {
534 DEF_FIELD(symval, css_device_id, type);
535
536 sprintf(alias, "css:t%01X", type);
537 return 1;
538 }
539
540 /* Looks like: "serio:tyNprNidNexN" */
do_serio_entry(const char * filename,void * symval,char * alias)541 static int do_serio_entry(const char *filename,
542 void *symval, char *alias)
543 {
544 DEF_FIELD(symval, serio_device_id, type);
545 DEF_FIELD(symval, serio_device_id, proto);
546 DEF_FIELD(symval, serio_device_id, id);
547 DEF_FIELD(symval, serio_device_id, extra);
548
549 strcpy(alias, "serio:");
550 ADD(alias, "ty", type != SERIO_ANY, type);
551 ADD(alias, "pr", proto != SERIO_ANY, proto);
552 ADD(alias, "id", id != SERIO_ANY, id);
553 ADD(alias, "ex", extra != SERIO_ANY, extra);
554
555 add_wildcard(alias);
556 return 1;
557 }
558
559 /* looks like: "acpi:ACPI0003" or "acpi:PNP0C0B" or "acpi:LNXVIDEO" or
560 * "acpi:bbsspp" (bb=base-class, ss=sub-class, pp=prog-if)
561 *
562 * NOTE: Each driver should use one of the following : _HID, _CIDs
563 * or _CLS. Also, bb, ss, and pp can be substituted with ??
564 * as don't care byte.
565 */
do_acpi_entry(const char * filename,void * symval,char * alias)566 static int do_acpi_entry(const char *filename,
567 void *symval, char *alias)
568 {
569 DEF_FIELD_ADDR(symval, acpi_device_id, id);
570 DEF_FIELD_ADDR(symval, acpi_device_id, cls);
571 DEF_FIELD_ADDR(symval, acpi_device_id, cls_msk);
572
573 if (id && strlen((const char *)*id))
574 sprintf(alias, "acpi*:%s:*", *id);
575 else if (cls) {
576 int i, byte_shift, cnt = 0;
577 unsigned int msk;
578
579 sprintf(&alias[cnt], "acpi*:");
580 cnt = 6;
581 for (i = 1; i <= 3; i++) {
582 byte_shift = 8 * (3-i);
583 msk = (*cls_msk >> byte_shift) & 0xFF;
584 if (msk)
585 sprintf(&alias[cnt], "%02x",
586 (*cls >> byte_shift) & 0xFF);
587 else
588 sprintf(&alias[cnt], "??");
589 cnt += 2;
590 }
591 sprintf(&alias[cnt], ":*");
592 }
593 return 1;
594 }
595
596 /* looks like: "pnp:dD" */
do_pnp_device_entry(void * symval,unsigned long size,struct module * mod)597 static void do_pnp_device_entry(void *symval, unsigned long size,
598 struct module *mod)
599 {
600 const unsigned long id_size = SIZE_pnp_device_id;
601 const unsigned int count = (size / id_size)-1;
602 unsigned int i;
603
604 device_id_check(mod->name, "pnp", size, id_size, symval);
605
606 for (i = 0; i < count; i++) {
607 DEF_FIELD_ADDR(symval + i*id_size, pnp_device_id, id);
608 char acpi_id[sizeof(*id)];
609 int j;
610
611 buf_printf(&mod->dev_table_buf,
612 "MODULE_ALIAS(\"pnp:d%s*\");\n", *id);
613
614 /* fix broken pnp bus lowercasing */
615 for (j = 0; j < sizeof(acpi_id); j++)
616 acpi_id[j] = toupper((*id)[j]);
617 buf_printf(&mod->dev_table_buf,
618 "MODULE_ALIAS(\"acpi*:%s:*\");\n", acpi_id);
619 }
620 }
621
622 /* looks like: "pnp:dD" for every device of the card */
do_pnp_card_entries(void * symval,unsigned long size,struct module * mod)623 static void do_pnp_card_entries(void *symval, unsigned long size,
624 struct module *mod)
625 {
626 const unsigned long id_size = SIZE_pnp_card_device_id;
627 const unsigned int count = (size / id_size)-1;
628 unsigned int i;
629
630 device_id_check(mod->name, "pnp", size, id_size, symval);
631
632 for (i = 0; i < count; i++) {
633 unsigned int j;
634 DEF_FIELD_ADDR(symval + i * id_size, pnp_card_device_id, devs);
635
636 for (j = 0; j < PNP_MAX_DEVICES; j++) {
637 const char *id = (char *)(*devs)[j].id;
638 int i2, j2;
639 int dup = 0;
640
641 if (!id[0])
642 break;
643
644 /* find duplicate, already added value */
645 for (i2 = 0; i2 < i && !dup; i2++) {
646 DEF_FIELD_ADDR_VAR(symval + i2 * id_size,
647 pnp_card_device_id,
648 devs, devs_dup);
649
650 for (j2 = 0; j2 < PNP_MAX_DEVICES; j2++) {
651 const char *id2 =
652 (char *)(*devs_dup)[j2].id;
653
654 if (!id2[0])
655 break;
656
657 if (!strcmp(id, id2)) {
658 dup = 1;
659 break;
660 }
661 }
662 }
663
664 /* add an individual alias for every device entry */
665 if (!dup) {
666 char acpi_id[PNP_ID_LEN];
667 int k;
668
669 buf_printf(&mod->dev_table_buf,
670 "MODULE_ALIAS(\"pnp:d%s*\");\n", id);
671
672 /* fix broken pnp bus lowercasing */
673 for (k = 0; k < sizeof(acpi_id); k++)
674 acpi_id[k] = toupper(id[k]);
675 buf_printf(&mod->dev_table_buf,
676 "MODULE_ALIAS(\"acpi*:%s:*\");\n", acpi_id);
677 }
678 }
679 }
680 }
681
682 /* Looks like: pcmcia:mNcNfNfnNpfnNvaNvbNvcNvdN. */
do_pcmcia_entry(const char * filename,void * symval,char * alias)683 static int do_pcmcia_entry(const char *filename,
684 void *symval, char *alias)
685 {
686 unsigned int i;
687 DEF_FIELD(symval, pcmcia_device_id, match_flags);
688 DEF_FIELD(symval, pcmcia_device_id, manf_id);
689 DEF_FIELD(symval, pcmcia_device_id, card_id);
690 DEF_FIELD(symval, pcmcia_device_id, func_id);
691 DEF_FIELD(symval, pcmcia_device_id, function);
692 DEF_FIELD(symval, pcmcia_device_id, device_no);
693 DEF_FIELD_ADDR(symval, pcmcia_device_id, prod_id_hash);
694
695 for (i=0; i<4; i++) {
696 (*prod_id_hash)[i] = TO_NATIVE((*prod_id_hash)[i]);
697 }
698
699 strcpy(alias, "pcmcia:");
700 ADD(alias, "m", match_flags & PCMCIA_DEV_ID_MATCH_MANF_ID,
701 manf_id);
702 ADD(alias, "c", match_flags & PCMCIA_DEV_ID_MATCH_CARD_ID,
703 card_id);
704 ADD(alias, "f", match_flags & PCMCIA_DEV_ID_MATCH_FUNC_ID,
705 func_id);
706 ADD(alias, "fn", match_flags & PCMCIA_DEV_ID_MATCH_FUNCTION,
707 function);
708 ADD(alias, "pfn", match_flags & PCMCIA_DEV_ID_MATCH_DEVICE_NO,
709 device_no);
710 ADD(alias, "pa", match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID1, (*prod_id_hash)[0]);
711 ADD(alias, "pb", match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID2, (*prod_id_hash)[1]);
712 ADD(alias, "pc", match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID3, (*prod_id_hash)[2]);
713 ADD(alias, "pd", match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID4, (*prod_id_hash)[3]);
714
715 add_wildcard(alias);
716 return 1;
717 }
718
do_vio_entry(const char * filename,void * symval,char * alias)719 static int do_vio_entry(const char *filename, void *symval,
720 char *alias)
721 {
722 char *tmp;
723 DEF_FIELD_ADDR(symval, vio_device_id, type);
724 DEF_FIELD_ADDR(symval, vio_device_id, compat);
725
726 sprintf(alias, "vio:T%sS%s", (*type)[0] ? *type : "*",
727 (*compat)[0] ? *compat : "*");
728
729 /* Replace all whitespace with underscores */
730 for (tmp = alias; tmp && *tmp; tmp++)
731 if (isspace (*tmp))
732 *tmp = '_';
733
734 add_wildcard(alias);
735 return 1;
736 }
737
do_input(char * alias,kernel_ulong_t * arr,unsigned int min,unsigned int max)738 static void do_input(char *alias,
739 kernel_ulong_t *arr, unsigned int min, unsigned int max)
740 {
741 unsigned int i;
742
743 for (i = min / BITS_PER_LONG; i < max / BITS_PER_LONG + 1; i++)
744 arr[i] = TO_NATIVE(arr[i]);
745 for (i = min; i <= max; i++)
746 if (arr[i / BITS_PER_LONG] & (1ULL << (i%BITS_PER_LONG)))
747 sprintf(alias + strlen(alias), "%X,*", i);
748 }
749
750 /* input:b0v0p0e0-eXkXrXaXmXlXsXfXwX where X is comma-separated %02X. */
do_input_entry(const char * filename,void * symval,char * alias)751 static int do_input_entry(const char *filename, void *symval,
752 char *alias)
753 {
754 DEF_FIELD(symval, input_device_id, flags);
755 DEF_FIELD(symval, input_device_id, bustype);
756 DEF_FIELD(symval, input_device_id, vendor);
757 DEF_FIELD(symval, input_device_id, product);
758 DEF_FIELD(symval, input_device_id, version);
759 DEF_FIELD_ADDR(symval, input_device_id, evbit);
760 DEF_FIELD_ADDR(symval, input_device_id, keybit);
761 DEF_FIELD_ADDR(symval, input_device_id, relbit);
762 DEF_FIELD_ADDR(symval, input_device_id, absbit);
763 DEF_FIELD_ADDR(symval, input_device_id, mscbit);
764 DEF_FIELD_ADDR(symval, input_device_id, ledbit);
765 DEF_FIELD_ADDR(symval, input_device_id, sndbit);
766 DEF_FIELD_ADDR(symval, input_device_id, ffbit);
767 DEF_FIELD_ADDR(symval, input_device_id, swbit);
768
769 sprintf(alias, "input:");
770
771 ADD(alias, "b", flags & INPUT_DEVICE_ID_MATCH_BUS, bustype);
772 ADD(alias, "v", flags & INPUT_DEVICE_ID_MATCH_VENDOR, vendor);
773 ADD(alias, "p", flags & INPUT_DEVICE_ID_MATCH_PRODUCT, product);
774 ADD(alias, "e", flags & INPUT_DEVICE_ID_MATCH_VERSION, version);
775
776 sprintf(alias + strlen(alias), "-e*");
777 if (flags & INPUT_DEVICE_ID_MATCH_EVBIT)
778 do_input(alias, *evbit, 0, INPUT_DEVICE_ID_EV_MAX);
779 sprintf(alias + strlen(alias), "k*");
780 if (flags & INPUT_DEVICE_ID_MATCH_KEYBIT)
781 do_input(alias, *keybit,
782 INPUT_DEVICE_ID_KEY_MIN_INTERESTING,
783 INPUT_DEVICE_ID_KEY_MAX);
784 sprintf(alias + strlen(alias), "r*");
785 if (flags & INPUT_DEVICE_ID_MATCH_RELBIT)
786 do_input(alias, *relbit, 0, INPUT_DEVICE_ID_REL_MAX);
787 sprintf(alias + strlen(alias), "a*");
788 if (flags & INPUT_DEVICE_ID_MATCH_ABSBIT)
789 do_input(alias, *absbit, 0, INPUT_DEVICE_ID_ABS_MAX);
790 sprintf(alias + strlen(alias), "m*");
791 if (flags & INPUT_DEVICE_ID_MATCH_MSCIT)
792 do_input(alias, *mscbit, 0, INPUT_DEVICE_ID_MSC_MAX);
793 sprintf(alias + strlen(alias), "l*");
794 if (flags & INPUT_DEVICE_ID_MATCH_LEDBIT)
795 do_input(alias, *ledbit, 0, INPUT_DEVICE_ID_LED_MAX);
796 sprintf(alias + strlen(alias), "s*");
797 if (flags & INPUT_DEVICE_ID_MATCH_SNDBIT)
798 do_input(alias, *sndbit, 0, INPUT_DEVICE_ID_SND_MAX);
799 sprintf(alias + strlen(alias), "f*");
800 if (flags & INPUT_DEVICE_ID_MATCH_FFBIT)
801 do_input(alias, *ffbit, 0, INPUT_DEVICE_ID_FF_MAX);
802 sprintf(alias + strlen(alias), "w*");
803 if (flags & INPUT_DEVICE_ID_MATCH_SWBIT)
804 do_input(alias, *swbit, 0, INPUT_DEVICE_ID_SW_MAX);
805 return 1;
806 }
807
do_eisa_entry(const char * filename,void * symval,char * alias)808 static int do_eisa_entry(const char *filename, void *symval,
809 char *alias)
810 {
811 DEF_FIELD_ADDR(symval, eisa_device_id, sig);
812 sprintf(alias, EISA_DEVICE_MODALIAS_FMT "*", *sig);
813 return 1;
814 }
815
816 /* Looks like: parisc:tNhvNrevNsvN */
do_parisc_entry(const char * filename,void * symval,char * alias)817 static int do_parisc_entry(const char *filename, void *symval,
818 char *alias)
819 {
820 DEF_FIELD(symval, parisc_device_id, hw_type);
821 DEF_FIELD(symval, parisc_device_id, hversion);
822 DEF_FIELD(symval, parisc_device_id, hversion_rev);
823 DEF_FIELD(symval, parisc_device_id, sversion);
824
825 strcpy(alias, "parisc:");
826 ADD(alias, "t", hw_type != PA_HWTYPE_ANY_ID, hw_type);
827 ADD(alias, "hv", hversion != PA_HVERSION_ANY_ID, hversion);
828 ADD(alias, "rev", hversion_rev != PA_HVERSION_REV_ANY_ID, hversion_rev);
829 ADD(alias, "sv", sversion != PA_SVERSION_ANY_ID, sversion);
830
831 add_wildcard(alias);
832 return 1;
833 }
834
835 /* Looks like: sdio:cNvNdN. */
do_sdio_entry(const char * filename,void * symval,char * alias)836 static int do_sdio_entry(const char *filename,
837 void *symval, char *alias)
838 {
839 DEF_FIELD(symval, sdio_device_id, class);
840 DEF_FIELD(symval, sdio_device_id, vendor);
841 DEF_FIELD(symval, sdio_device_id, device);
842
843 strcpy(alias, "sdio:");
844 ADD(alias, "c", class != (__u8)SDIO_ANY_ID, class);
845 ADD(alias, "v", vendor != (__u16)SDIO_ANY_ID, vendor);
846 ADD(alias, "d", device != (__u16)SDIO_ANY_ID, device);
847 add_wildcard(alias);
848 return 1;
849 }
850
851 /* Looks like: ssb:vNidNrevN. */
do_ssb_entry(const char * filename,void * symval,char * alias)852 static int do_ssb_entry(const char *filename,
853 void *symval, char *alias)
854 {
855 DEF_FIELD(symval, ssb_device_id, vendor);
856 DEF_FIELD(symval, ssb_device_id, coreid);
857 DEF_FIELD(symval, ssb_device_id, revision);
858
859 strcpy(alias, "ssb:");
860 ADD(alias, "v", vendor != SSB_ANY_VENDOR, vendor);
861 ADD(alias, "id", coreid != SSB_ANY_ID, coreid);
862 ADD(alias, "rev", revision != SSB_ANY_REV, revision);
863 add_wildcard(alias);
864 return 1;
865 }
866
867 /* Looks like: bcma:mNidNrevNclN. */
do_bcma_entry(const char * filename,void * symval,char * alias)868 static int do_bcma_entry(const char *filename,
869 void *symval, char *alias)
870 {
871 DEF_FIELD(symval, bcma_device_id, manuf);
872 DEF_FIELD(symval, bcma_device_id, id);
873 DEF_FIELD(symval, bcma_device_id, rev);
874 DEF_FIELD(symval, bcma_device_id, class);
875
876 strcpy(alias, "bcma:");
877 ADD(alias, "m", manuf != BCMA_ANY_MANUF, manuf);
878 ADD(alias, "id", id != BCMA_ANY_ID, id);
879 ADD(alias, "rev", rev != BCMA_ANY_REV, rev);
880 ADD(alias, "cl", class != BCMA_ANY_CLASS, class);
881 add_wildcard(alias);
882 return 1;
883 }
884
885 /* Looks like: virtio:dNvN */
do_virtio_entry(const char * filename,void * symval,char * alias)886 static int do_virtio_entry(const char *filename, void *symval,
887 char *alias)
888 {
889 DEF_FIELD(symval, virtio_device_id, device);
890 DEF_FIELD(symval, virtio_device_id, vendor);
891
892 strcpy(alias, "virtio:");
893 ADD(alias, "d", device != VIRTIO_DEV_ANY_ID, device);
894 ADD(alias, "v", vendor != VIRTIO_DEV_ANY_ID, vendor);
895
896 add_wildcard(alias);
897 return 1;
898 }
899
900 /*
901 * Looks like: vmbus:guid
902 * Each byte of the guid will be represented by two hex characters
903 * in the name.
904 */
905
do_vmbus_entry(const char * filename,void * symval,char * alias)906 static int do_vmbus_entry(const char *filename, void *symval,
907 char *alias)
908 {
909 int i;
910 DEF_FIELD_ADDR(symval, hv_vmbus_device_id, guid);
911 char guid_name[(sizeof(*guid) + 1) * 2];
912
913 for (i = 0; i < (sizeof(*guid) * 2); i += 2)
914 sprintf(&guid_name[i], "%02x", TO_NATIVE((guid->b)[i/2]));
915
916 strcpy(alias, "vmbus:");
917 strcat(alias, guid_name);
918
919 return 1;
920 }
921
922 /* Looks like: rpmsg:S */
do_rpmsg_entry(const char * filename,void * symval,char * alias)923 static int do_rpmsg_entry(const char *filename, void *symval,
924 char *alias)
925 {
926 DEF_FIELD_ADDR(symval, rpmsg_device_id, name);
927 sprintf(alias, RPMSG_DEVICE_MODALIAS_FMT, *name);
928
929 return 1;
930 }
931
932 /* Looks like: i2c:S */
do_i2c_entry(const char * filename,void * symval,char * alias)933 static int do_i2c_entry(const char *filename, void *symval,
934 char *alias)
935 {
936 DEF_FIELD_ADDR(symval, i2c_device_id, name);
937 sprintf(alias, I2C_MODULE_PREFIX "%s", *name);
938
939 return 1;
940 }
941
do_i3c_entry(const char * filename,void * symval,char * alias)942 static int do_i3c_entry(const char *filename, void *symval,
943 char *alias)
944 {
945 DEF_FIELD(symval, i3c_device_id, match_flags);
946 DEF_FIELD(symval, i3c_device_id, dcr);
947 DEF_FIELD(symval, i3c_device_id, manuf_id);
948 DEF_FIELD(symval, i3c_device_id, part_id);
949 DEF_FIELD(symval, i3c_device_id, extra_info);
950
951 strcpy(alias, "i3c:");
952 ADD(alias, "dcr", match_flags & I3C_MATCH_DCR, dcr);
953 ADD(alias, "manuf", match_flags & I3C_MATCH_MANUF, manuf_id);
954 ADD(alias, "part", match_flags & I3C_MATCH_PART, part_id);
955 ADD(alias, "ext", match_flags & I3C_MATCH_EXTRA_INFO, extra_info);
956
957 return 1;
958 }
959
960 /* Looks like: spi:S */
do_spi_entry(const char * filename,void * symval,char * alias)961 static int do_spi_entry(const char *filename, void *symval,
962 char *alias)
963 {
964 DEF_FIELD_ADDR(symval, spi_device_id, name);
965 sprintf(alias, SPI_MODULE_PREFIX "%s", *name);
966
967 return 1;
968 }
969
970 static const struct dmifield {
971 const char *prefix;
972 int field;
973 } dmi_fields[] = {
974 { "bvn", DMI_BIOS_VENDOR },
975 { "bvr", DMI_BIOS_VERSION },
976 { "bd", DMI_BIOS_DATE },
977 { "br", DMI_BIOS_RELEASE },
978 { "efr", DMI_EC_FIRMWARE_RELEASE },
979 { "svn", DMI_SYS_VENDOR },
980 { "pn", DMI_PRODUCT_NAME },
981 { "pvr", DMI_PRODUCT_VERSION },
982 { "rvn", DMI_BOARD_VENDOR },
983 { "rn", DMI_BOARD_NAME },
984 { "rvr", DMI_BOARD_VERSION },
985 { "cvn", DMI_CHASSIS_VENDOR },
986 { "ct", DMI_CHASSIS_TYPE },
987 { "cvr", DMI_CHASSIS_VERSION },
988 { NULL, DMI_NONE }
989 };
990
dmi_ascii_filter(char * d,const char * s)991 static void dmi_ascii_filter(char *d, const char *s)
992 {
993 /* Filter out characters we don't want to see in the modalias string */
994 for (; *s; s++)
995 if (*s > ' ' && *s < 127 && *s != ':')
996 *(d++) = *s;
997
998 *d = 0;
999 }
1000
1001
do_dmi_entry(const char * filename,void * symval,char * alias)1002 static int do_dmi_entry(const char *filename, void *symval,
1003 char *alias)
1004 {
1005 int i, j;
1006 DEF_FIELD_ADDR(symval, dmi_system_id, matches);
1007 sprintf(alias, "dmi*");
1008
1009 for (i = 0; i < ARRAY_SIZE(dmi_fields); i++) {
1010 for (j = 0; j < 4; j++) {
1011 if ((*matches)[j].slot &&
1012 (*matches)[j].slot == dmi_fields[i].field) {
1013 sprintf(alias + strlen(alias), ":%s*",
1014 dmi_fields[i].prefix);
1015 dmi_ascii_filter(alias + strlen(alias),
1016 (*matches)[j].substr);
1017 strcat(alias, "*");
1018 }
1019 }
1020 }
1021
1022 strcat(alias, ":");
1023 return 1;
1024 }
1025
do_platform_entry(const char * filename,void * symval,char * alias)1026 static int do_platform_entry(const char *filename,
1027 void *symval, char *alias)
1028 {
1029 DEF_FIELD_ADDR(symval, platform_device_id, name);
1030 sprintf(alias, PLATFORM_MODULE_PREFIX "%s", *name);
1031 return 1;
1032 }
1033
do_mdio_entry(const char * filename,void * symval,char * alias)1034 static int do_mdio_entry(const char *filename,
1035 void *symval, char *alias)
1036 {
1037 int i;
1038 DEF_FIELD(symval, mdio_device_id, phy_id);
1039 DEF_FIELD(symval, mdio_device_id, phy_id_mask);
1040
1041 alias += sprintf(alias, MDIO_MODULE_PREFIX);
1042
1043 for (i = 0; i < 32; i++) {
1044 if (!((phy_id_mask >> (31-i)) & 1))
1045 *(alias++) = '?';
1046 else if ((phy_id >> (31-i)) & 1)
1047 *(alias++) = '1';
1048 else
1049 *(alias++) = '0';
1050 }
1051
1052 /* Terminate the string */
1053 *alias = 0;
1054
1055 return 1;
1056 }
1057
1058 /* Looks like: zorro:iN. */
do_zorro_entry(const char * filename,void * symval,char * alias)1059 static int do_zorro_entry(const char *filename, void *symval,
1060 char *alias)
1061 {
1062 DEF_FIELD(symval, zorro_device_id, id);
1063 strcpy(alias, "zorro:");
1064 ADD(alias, "i", id != ZORRO_WILDCARD, id);
1065 return 1;
1066 }
1067
1068 /* looks like: "pnp:dD" */
do_isapnp_entry(const char * filename,void * symval,char * alias)1069 static int do_isapnp_entry(const char *filename,
1070 void *symval, char *alias)
1071 {
1072 DEF_FIELD(symval, isapnp_device_id, vendor);
1073 DEF_FIELD(symval, isapnp_device_id, function);
1074 sprintf(alias, "pnp:d%c%c%c%x%x%x%x*",
1075 'A' + ((vendor >> 2) & 0x3f) - 1,
1076 'A' + (((vendor & 3) << 3) | ((vendor >> 13) & 7)) - 1,
1077 'A' + ((vendor >> 8) & 0x1f) - 1,
1078 (function >> 4) & 0x0f, function & 0x0f,
1079 (function >> 12) & 0x0f, (function >> 8) & 0x0f);
1080 return 1;
1081 }
1082
1083 /* Looks like: "ipack:fNvNdN". */
do_ipack_entry(const char * filename,void * symval,char * alias)1084 static int do_ipack_entry(const char *filename,
1085 void *symval, char *alias)
1086 {
1087 DEF_FIELD(symval, ipack_device_id, format);
1088 DEF_FIELD(symval, ipack_device_id, vendor);
1089 DEF_FIELD(symval, ipack_device_id, device);
1090 strcpy(alias, "ipack:");
1091 ADD(alias, "f", format != IPACK_ANY_FORMAT, format);
1092 ADD(alias, "v", vendor != IPACK_ANY_ID, vendor);
1093 ADD(alias, "d", device != IPACK_ANY_ID, device);
1094 add_wildcard(alias);
1095 return 1;
1096 }
1097
1098 /*
1099 * Append a match expression for a single masked hex digit.
1100 * outp points to a pointer to the character at which to append.
1101 * *outp is updated on return to point just after the appended text,
1102 * to facilitate further appending.
1103 */
append_nibble_mask(char ** outp,unsigned int nibble,unsigned int mask)1104 static void append_nibble_mask(char **outp,
1105 unsigned int nibble, unsigned int mask)
1106 {
1107 char *p = *outp;
1108 unsigned int i;
1109
1110 switch (mask) {
1111 case 0:
1112 *p++ = '?';
1113 break;
1114
1115 case 0xf:
1116 p += sprintf(p, "%X", nibble);
1117 break;
1118
1119 default:
1120 /*
1121 * Dumbly emit a match pattern for all possible matching
1122 * digits. This could be improved in some cases using ranges,
1123 * but it has the advantage of being trivially correct, and is
1124 * often optimal.
1125 */
1126 *p++ = '[';
1127 for (i = 0; i < 0x10; i++)
1128 if ((i & mask) == nibble)
1129 p += sprintf(p, "%X", i);
1130 *p++ = ']';
1131 }
1132
1133 /* Ensure that the string remains NUL-terminated: */
1134 *p = '\0';
1135
1136 /* Advance the caller's end-of-string pointer: */
1137 *outp = p;
1138 }
1139
1140 /*
1141 * looks like: "amba:dN"
1142 *
1143 * N is exactly 8 digits, where each is an upper-case hex digit, or
1144 * a ? or [] pattern matching exactly one digit.
1145 */
do_amba_entry(const char * filename,void * symval,char * alias)1146 static int do_amba_entry(const char *filename,
1147 void *symval, char *alias)
1148 {
1149 unsigned int digit;
1150 char *p = alias;
1151 DEF_FIELD(symval, amba_id, id);
1152 DEF_FIELD(symval, amba_id, mask);
1153
1154 if ((id & mask) != id)
1155 fatal("%s: Masked-off bit(s) of AMBA device ID are non-zero: id=0x%08X, mask=0x%08X. Please fix this driver.\n",
1156 filename, id, mask);
1157
1158 p += sprintf(alias, "amba:d");
1159 for (digit = 0; digit < 8; digit++)
1160 append_nibble_mask(&p,
1161 (id >> (4 * (7 - digit))) & 0xf,
1162 (mask >> (4 * (7 - digit))) & 0xf);
1163
1164 return 1;
1165 }
1166
1167 /*
1168 * looks like: "mipscdmm:tN"
1169 *
1170 * N is exactly 2 digits, where each is an upper-case hex digit, or
1171 * a ? or [] pattern matching exactly one digit.
1172 */
do_mips_cdmm_entry(const char * filename,void * symval,char * alias)1173 static int do_mips_cdmm_entry(const char *filename,
1174 void *symval, char *alias)
1175 {
1176 DEF_FIELD(symval, mips_cdmm_device_id, type);
1177
1178 sprintf(alias, "mipscdmm:t%02X*", type);
1179 return 1;
1180 }
1181
1182 /* LOOKS like cpu:type:x86,venVVVVfamFFFFmodMMMM:feature:*,FEAT,*
1183 * All fields are numbers. It would be nicer to use strings for vendor
1184 * and feature, but getting those out of the build system here is too
1185 * complicated.
1186 */
1187
do_x86cpu_entry(const char * filename,void * symval,char * alias)1188 static int do_x86cpu_entry(const char *filename, void *symval,
1189 char *alias)
1190 {
1191 DEF_FIELD(symval, x86_cpu_id, feature);
1192 DEF_FIELD(symval, x86_cpu_id, family);
1193 DEF_FIELD(symval, x86_cpu_id, model);
1194 DEF_FIELD(symval, x86_cpu_id, vendor);
1195
1196 strcpy(alias, "cpu:type:x86,");
1197 ADD(alias, "ven", vendor != X86_VENDOR_ANY, vendor);
1198 ADD(alias, "fam", family != X86_FAMILY_ANY, family);
1199 ADD(alias, "mod", model != X86_MODEL_ANY, model);
1200 strcat(alias, ":feature:*");
1201 if (feature != X86_FEATURE_ANY)
1202 sprintf(alias + strlen(alias), "%04X*", feature);
1203 return 1;
1204 }
1205
1206 /* LOOKS like cpu:type:*:feature:*FEAT* */
do_cpu_entry(const char * filename,void * symval,char * alias)1207 static int do_cpu_entry(const char *filename, void *symval, char *alias)
1208 {
1209 DEF_FIELD(symval, cpu_feature, feature);
1210
1211 sprintf(alias, "cpu:type:*:feature:*%04X*", feature);
1212 return 1;
1213 }
1214
1215 /* Looks like: mei:S:uuid:N:* */
do_mei_entry(const char * filename,void * symval,char * alias)1216 static int do_mei_entry(const char *filename, void *symval,
1217 char *alias)
1218 {
1219 DEF_FIELD_ADDR(symval, mei_cl_device_id, name);
1220 DEF_FIELD_ADDR(symval, mei_cl_device_id, uuid);
1221 DEF_FIELD(symval, mei_cl_device_id, version);
1222
1223 sprintf(alias, MEI_CL_MODULE_PREFIX);
1224 sprintf(alias + strlen(alias), "%s:", (*name)[0] ? *name : "*");
1225 add_uuid(alias, *uuid);
1226 ADD(alias, ":", version != MEI_CL_VERSION_ANY, version);
1227
1228 strcat(alias, ":*");
1229
1230 return 1;
1231 }
1232
1233 /* Looks like: rapidio:vNdNavNadN */
do_rio_entry(const char * filename,void * symval,char * alias)1234 static int do_rio_entry(const char *filename,
1235 void *symval, char *alias)
1236 {
1237 DEF_FIELD(symval, rio_device_id, did);
1238 DEF_FIELD(symval, rio_device_id, vid);
1239 DEF_FIELD(symval, rio_device_id, asm_did);
1240 DEF_FIELD(symval, rio_device_id, asm_vid);
1241
1242 strcpy(alias, "rapidio:");
1243 ADD(alias, "v", vid != RIO_ANY_ID, vid);
1244 ADD(alias, "d", did != RIO_ANY_ID, did);
1245 ADD(alias, "av", asm_vid != RIO_ANY_ID, asm_vid);
1246 ADD(alias, "ad", asm_did != RIO_ANY_ID, asm_did);
1247
1248 add_wildcard(alias);
1249 return 1;
1250 }
1251
1252 /* Looks like: ulpi:vNpN */
do_ulpi_entry(const char * filename,void * symval,char * alias)1253 static int do_ulpi_entry(const char *filename, void *symval,
1254 char *alias)
1255 {
1256 DEF_FIELD(symval, ulpi_device_id, vendor);
1257 DEF_FIELD(symval, ulpi_device_id, product);
1258
1259 sprintf(alias, "ulpi:v%04xp%04x", vendor, product);
1260
1261 return 1;
1262 }
1263
1264 /* Looks like: hdaudio:vNrNaN */
do_hda_entry(const char * filename,void * symval,char * alias)1265 static int do_hda_entry(const char *filename, void *symval, char *alias)
1266 {
1267 DEF_FIELD(symval, hda_device_id, vendor_id);
1268 DEF_FIELD(symval, hda_device_id, rev_id);
1269 DEF_FIELD(symval, hda_device_id, api_version);
1270
1271 strcpy(alias, "hdaudio:");
1272 ADD(alias, "v", vendor_id != 0, vendor_id);
1273 ADD(alias, "r", rev_id != 0, rev_id);
1274 ADD(alias, "a", api_version != 0, api_version);
1275
1276 add_wildcard(alias);
1277 return 1;
1278 }
1279
1280 /* Looks like: sdw:mNpNvNcN */
do_sdw_entry(const char * filename,void * symval,char * alias)1281 static int do_sdw_entry(const char *filename, void *symval, char *alias)
1282 {
1283 DEF_FIELD(symval, sdw_device_id, mfg_id);
1284 DEF_FIELD(symval, sdw_device_id, part_id);
1285 DEF_FIELD(symval, sdw_device_id, sdw_version);
1286 DEF_FIELD(symval, sdw_device_id, class_id);
1287
1288 strcpy(alias, "sdw:");
1289 ADD(alias, "m", mfg_id != 0, mfg_id);
1290 ADD(alias, "p", part_id != 0, part_id);
1291 ADD(alias, "v", sdw_version != 0, sdw_version);
1292 ADD(alias, "c", class_id != 0, class_id);
1293
1294 add_wildcard(alias);
1295 return 1;
1296 }
1297
1298 /* Looks like: fsl-mc:vNdN */
do_fsl_mc_entry(const char * filename,void * symval,char * alias)1299 static int do_fsl_mc_entry(const char *filename, void *symval,
1300 char *alias)
1301 {
1302 DEF_FIELD(symval, fsl_mc_device_id, vendor);
1303 DEF_FIELD_ADDR(symval, fsl_mc_device_id, obj_type);
1304
1305 sprintf(alias, "fsl-mc:v%08Xd%s", vendor, *obj_type);
1306 return 1;
1307 }
1308
1309 /* Looks like: tbsvc:kSpNvNrN */
do_tbsvc_entry(const char * filename,void * symval,char * alias)1310 static int do_tbsvc_entry(const char *filename, void *symval, char *alias)
1311 {
1312 DEF_FIELD(symval, tb_service_id, match_flags);
1313 DEF_FIELD_ADDR(symval, tb_service_id, protocol_key);
1314 DEF_FIELD(symval, tb_service_id, protocol_id);
1315 DEF_FIELD(symval, tb_service_id, protocol_version);
1316 DEF_FIELD(symval, tb_service_id, protocol_revision);
1317
1318 strcpy(alias, "tbsvc:");
1319 if (match_flags & TBSVC_MATCH_PROTOCOL_KEY)
1320 sprintf(alias + strlen(alias), "k%s", *protocol_key);
1321 else
1322 strcat(alias + strlen(alias), "k*");
1323 ADD(alias, "p", match_flags & TBSVC_MATCH_PROTOCOL_ID, protocol_id);
1324 ADD(alias, "v", match_flags & TBSVC_MATCH_PROTOCOL_VERSION,
1325 protocol_version);
1326 ADD(alias, "r", match_flags & TBSVC_MATCH_PROTOCOL_REVISION,
1327 protocol_revision);
1328
1329 add_wildcard(alias);
1330 return 1;
1331 }
1332
1333 /* Looks like: typec:idNmN */
do_typec_entry(const char * filename,void * symval,char * alias)1334 static int do_typec_entry(const char *filename, void *symval, char *alias)
1335 {
1336 DEF_FIELD(symval, typec_device_id, svid);
1337 DEF_FIELD(symval, typec_device_id, mode);
1338
1339 sprintf(alias, "typec:id%04X", svid);
1340 ADD(alias, "m", mode != TYPEC_ANY_MODE, mode);
1341
1342 return 1;
1343 }
1344
1345 /* Looks like: tee:uuid */
do_tee_entry(const char * filename,void * symval,char * alias)1346 static int do_tee_entry(const char *filename, void *symval, char *alias)
1347 {
1348 DEF_FIELD_ADDR(symval, tee_client_device_id, uuid);
1349
1350 sprintf(alias, "tee:%02x%02x%02x%02x-%02x%02x-%02x%02x-%02x%02x-%02x%02x%02x%02x%02x%02x",
1351 uuid->b[0], uuid->b[1], uuid->b[2], uuid->b[3], uuid->b[4],
1352 uuid->b[5], uuid->b[6], uuid->b[7], uuid->b[8], uuid->b[9],
1353 uuid->b[10], uuid->b[11], uuid->b[12], uuid->b[13], uuid->b[14],
1354 uuid->b[15]);
1355
1356 add_wildcard(alias);
1357 return 1;
1358 }
1359
1360 /* Looks like: wmi:guid */
do_wmi_entry(const char * filename,void * symval,char * alias)1361 static int do_wmi_entry(const char *filename, void *symval, char *alias)
1362 {
1363 int len;
1364 DEF_FIELD_ADDR(symval, wmi_device_id, guid_string);
1365
1366 if (strlen(*guid_string) != UUID_STRING_LEN) {
1367 warn("Invalid WMI device id 'wmi:%s' in '%s'\n",
1368 *guid_string, filename);
1369 return 0;
1370 }
1371
1372 len = snprintf(alias, ALIAS_SIZE, WMI_MODULE_PREFIX "%s", *guid_string);
1373 if (len < 0 || len >= ALIAS_SIZE) {
1374 warn("Could not generate all MODULE_ALIAS's in '%s'\n",
1375 filename);
1376 return 0;
1377 }
1378 return 1;
1379 }
1380
1381 /* Looks like: mhi:S */
do_mhi_entry(const char * filename,void * symval,char * alias)1382 static int do_mhi_entry(const char *filename, void *symval, char *alias)
1383 {
1384 DEF_FIELD_ADDR(symval, mhi_device_id, chan);
1385 sprintf(alias, MHI_DEVICE_MODALIAS_FMT, *chan);
1386 return 1;
1387 }
1388
1389 /* Looks like: mhi_ep:S */
do_mhi_ep_entry(const char * filename,void * symval,char * alias)1390 static int do_mhi_ep_entry(const char *filename, void *symval, char *alias)
1391 {
1392 DEF_FIELD_ADDR(symval, mhi_device_id, chan);
1393 sprintf(alias, MHI_EP_DEVICE_MODALIAS_FMT, *chan);
1394
1395 return 1;
1396 }
1397
1398 /* Looks like: ishtp:{guid} */
do_ishtp_entry(const char * filename,void * symval,char * alias)1399 static int do_ishtp_entry(const char *filename, void *symval, char *alias)
1400 {
1401 DEF_FIELD_ADDR(symval, ishtp_device_id, guid);
1402
1403 strcpy(alias, ISHTP_MODULE_PREFIX "{");
1404 add_guid(alias, *guid);
1405 strcat(alias, "}");
1406
1407 return 1;
1408 }
1409
do_auxiliary_entry(const char * filename,void * symval,char * alias)1410 static int do_auxiliary_entry(const char *filename, void *symval, char *alias)
1411 {
1412 DEF_FIELD_ADDR(symval, auxiliary_device_id, name);
1413 sprintf(alias, AUXILIARY_MODULE_PREFIX "%s", *name);
1414
1415 return 1;
1416 }
1417
1418 /*
1419 * Looks like: ssam:dNcNtNiNfN
1420 *
1421 * N is exactly 2 digits, where each is an upper-case hex digit.
1422 */
do_ssam_entry(const char * filename,void * symval,char * alias)1423 static int do_ssam_entry(const char *filename, void *symval, char *alias)
1424 {
1425 DEF_FIELD(symval, ssam_device_id, match_flags);
1426 DEF_FIELD(symval, ssam_device_id, domain);
1427 DEF_FIELD(symval, ssam_device_id, category);
1428 DEF_FIELD(symval, ssam_device_id, target);
1429 DEF_FIELD(symval, ssam_device_id, instance);
1430 DEF_FIELD(symval, ssam_device_id, function);
1431
1432 sprintf(alias, "ssam:d%02Xc%02X", domain, category);
1433 ADD(alias, "t", match_flags & SSAM_MATCH_TARGET, target);
1434 ADD(alias, "i", match_flags & SSAM_MATCH_INSTANCE, instance);
1435 ADD(alias, "f", match_flags & SSAM_MATCH_FUNCTION, function);
1436
1437 return 1;
1438 }
1439
1440 /* Looks like: dfl:tNfN */
do_dfl_entry(const char * filename,void * symval,char * alias)1441 static int do_dfl_entry(const char *filename, void *symval, char *alias)
1442 {
1443 DEF_FIELD(symval, dfl_device_id, type);
1444 DEF_FIELD(symval, dfl_device_id, feature_id);
1445
1446 sprintf(alias, "dfl:t%04Xf%04X", type, feature_id);
1447
1448 add_wildcard(alias);
1449 return 1;
1450 }
1451
1452 /* Looks like: cdx:vNdN */
do_cdx_entry(const char * filename,void * symval,char * alias)1453 static int do_cdx_entry(const char *filename, void *symval,
1454 char *alias)
1455 {
1456 DEF_FIELD(symval, cdx_device_id, vendor);
1457 DEF_FIELD(symval, cdx_device_id, device);
1458 DEF_FIELD(symval, cdx_device_id, override_only);
1459
1460 switch (override_only) {
1461 case 0:
1462 strcpy(alias, "cdx:");
1463 break;
1464 case CDX_ID_F_VFIO_DRIVER_OVERRIDE:
1465 strcpy(alias, "vfio_cdx:");
1466 break;
1467 default:
1468 warn("Unknown CDX driver_override alias %08X\n",
1469 override_only);
1470 return 0;
1471 }
1472
1473 ADD(alias, "v", vendor != CDX_ANY_ID, vendor);
1474 ADD(alias, "d", device != CDX_ANY_ID, device);
1475 return 1;
1476 }
1477
1478 /* Does namelen bytes of name exactly match the symbol? */
sym_is(const char * name,unsigned namelen,const char * symbol)1479 static bool sym_is(const char *name, unsigned namelen, const char *symbol)
1480 {
1481 if (namelen != strlen(symbol))
1482 return false;
1483
1484 return memcmp(name, symbol, namelen) == 0;
1485 }
1486
do_table(void * symval,unsigned long size,unsigned long id_size,const char * device_id,int (* do_entry)(const char * filename,void * symval,char * alias),struct module * mod)1487 static void do_table(void *symval, unsigned long size,
1488 unsigned long id_size,
1489 const char *device_id,
1490 int (*do_entry)(const char *filename, void *symval, char *alias),
1491 struct module *mod)
1492 {
1493 unsigned int i;
1494 char alias[ALIAS_SIZE];
1495
1496 device_id_check(mod->name, device_id, size, id_size, symval);
1497 /* Leave last one: it's the terminator. */
1498 size -= id_size;
1499
1500 for (i = 0; i < size; i += id_size) {
1501 if (do_entry(mod->name, symval+i, alias)) {
1502 buf_printf(&mod->dev_table_buf,
1503 "MODULE_ALIAS(\"%s\");\n", alias);
1504 }
1505 }
1506 }
1507
1508 static const struct devtable devtable[] = {
1509 {"hid", SIZE_hid_device_id, do_hid_entry},
1510 {"ieee1394", SIZE_ieee1394_device_id, do_ieee1394_entry},
1511 {"pci", SIZE_pci_device_id, do_pci_entry},
1512 {"ccw", SIZE_ccw_device_id, do_ccw_entry},
1513 {"ap", SIZE_ap_device_id, do_ap_entry},
1514 {"css", SIZE_css_device_id, do_css_entry},
1515 {"serio", SIZE_serio_device_id, do_serio_entry},
1516 {"acpi", SIZE_acpi_device_id, do_acpi_entry},
1517 {"pcmcia", SIZE_pcmcia_device_id, do_pcmcia_entry},
1518 {"vio", SIZE_vio_device_id, do_vio_entry},
1519 {"input", SIZE_input_device_id, do_input_entry},
1520 {"eisa", SIZE_eisa_device_id, do_eisa_entry},
1521 {"parisc", SIZE_parisc_device_id, do_parisc_entry},
1522 {"sdio", SIZE_sdio_device_id, do_sdio_entry},
1523 {"ssb", SIZE_ssb_device_id, do_ssb_entry},
1524 {"bcma", SIZE_bcma_device_id, do_bcma_entry},
1525 {"virtio", SIZE_virtio_device_id, do_virtio_entry},
1526 {"vmbus", SIZE_hv_vmbus_device_id, do_vmbus_entry},
1527 {"rpmsg", SIZE_rpmsg_device_id, do_rpmsg_entry},
1528 {"i2c", SIZE_i2c_device_id, do_i2c_entry},
1529 {"i3c", SIZE_i3c_device_id, do_i3c_entry},
1530 {"spi", SIZE_spi_device_id, do_spi_entry},
1531 {"dmi", SIZE_dmi_system_id, do_dmi_entry},
1532 {"platform", SIZE_platform_device_id, do_platform_entry},
1533 {"mdio", SIZE_mdio_device_id, do_mdio_entry},
1534 {"zorro", SIZE_zorro_device_id, do_zorro_entry},
1535 {"isapnp", SIZE_isapnp_device_id, do_isapnp_entry},
1536 {"ipack", SIZE_ipack_device_id, do_ipack_entry},
1537 {"amba", SIZE_amba_id, do_amba_entry},
1538 {"mipscdmm", SIZE_mips_cdmm_device_id, do_mips_cdmm_entry},
1539 {"x86cpu", SIZE_x86_cpu_id, do_x86cpu_entry},
1540 {"cpu", SIZE_cpu_feature, do_cpu_entry},
1541 {"mei", SIZE_mei_cl_device_id, do_mei_entry},
1542 {"rapidio", SIZE_rio_device_id, do_rio_entry},
1543 {"ulpi", SIZE_ulpi_device_id, do_ulpi_entry},
1544 {"hdaudio", SIZE_hda_device_id, do_hda_entry},
1545 {"sdw", SIZE_sdw_device_id, do_sdw_entry},
1546 {"fslmc", SIZE_fsl_mc_device_id, do_fsl_mc_entry},
1547 {"tbsvc", SIZE_tb_service_id, do_tbsvc_entry},
1548 {"typec", SIZE_typec_device_id, do_typec_entry},
1549 {"tee", SIZE_tee_client_device_id, do_tee_entry},
1550 {"wmi", SIZE_wmi_device_id, do_wmi_entry},
1551 {"mhi", SIZE_mhi_device_id, do_mhi_entry},
1552 {"mhi_ep", SIZE_mhi_device_id, do_mhi_ep_entry},
1553 {"auxiliary", SIZE_auxiliary_device_id, do_auxiliary_entry},
1554 {"ssam", SIZE_ssam_device_id, do_ssam_entry},
1555 {"dfl", SIZE_dfl_device_id, do_dfl_entry},
1556 {"ishtp", SIZE_ishtp_device_id, do_ishtp_entry},
1557 {"cdx", SIZE_cdx_device_id, do_cdx_entry},
1558 };
1559
1560 /* Create MODULE_ALIAS() statements.
1561 * At this time, we cannot write the actual output C source yet,
1562 * 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)1563 void handle_moddevtable(struct module *mod, struct elf_info *info,
1564 Elf_Sym *sym, const char *symname)
1565 {
1566 void *symval;
1567 char *zeros = NULL;
1568 const char *name, *identifier;
1569 unsigned int namelen;
1570
1571 /* We're looking for a section relative symbol */
1572 if (!sym->st_shndx || get_secindex(info, sym) >= info->num_sections)
1573 return;
1574
1575 /* We're looking for an object */
1576 if (ELF_ST_TYPE(sym->st_info) != STT_OBJECT)
1577 return;
1578
1579 /* All our symbols are of form __mod_<name>__<identifier>_device_table. */
1580 if (strncmp(symname, "__mod_", strlen("__mod_")))
1581 return;
1582 name = symname + strlen("__mod_");
1583 namelen = strlen(name);
1584 if (namelen < strlen("_device_table"))
1585 return;
1586 if (strcmp(name + namelen - strlen("_device_table"), "_device_table"))
1587 return;
1588 identifier = strstr(name, "__");
1589 if (!identifier)
1590 return;
1591 namelen = identifier - name;
1592
1593 /* Handle all-NULL symbols allocated into .bss */
1594 if (info->sechdrs[get_secindex(info, sym)].sh_type & SHT_NOBITS) {
1595 zeros = calloc(1, sym->st_size);
1596 symval = zeros;
1597 } else {
1598 symval = sym_get_data(info, sym);
1599 }
1600
1601 /* First handle the "special" cases */
1602 if (sym_is(name, namelen, "usb"))
1603 do_usb_table(symval, sym->st_size, mod);
1604 else if (sym_is(name, namelen, "of"))
1605 do_of_table(symval, sym->st_size, mod);
1606 else if (sym_is(name, namelen, "pnp"))
1607 do_pnp_device_entry(symval, sym->st_size, mod);
1608 else if (sym_is(name, namelen, "pnp_card"))
1609 do_pnp_card_entries(symval, sym->st_size, mod);
1610 else {
1611 int i;
1612
1613 for (i = 0; i < ARRAY_SIZE(devtable); i++) {
1614 const struct devtable *p = &devtable[i];
1615
1616 if (sym_is(name, namelen, p->device_id)) {
1617 do_table(symval, sym->st_size, p->id_size,
1618 p->device_id, p->do_entry, mod);
1619 break;
1620 }
1621 }
1622 }
1623 free(zeros);
1624 }
1625
1626 /* Now add out buffered information to the generated C source */
add_moddevtable(struct buffer * buf,struct module * mod)1627 void add_moddevtable(struct buffer *buf, struct module *mod)
1628 {
1629 buf_printf(buf, "\n");
1630 buf_write(buf, mod->dev_table_buf.p, mod->dev_table_buf.pos);
1631 free(mod->dev_table_buf.p);
1632 }
1633