blob: c684c1481e2fb76c54485ee6e007243e0510303e [file] [log] [blame]
Nicholas Flintham1e3d3112013-04-10 10:48:38 +01001/* 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#if KERNEL_ELFCLASS == ELFCLASS32
16typedef Elf32_Addr kernel_ulong_t;
17#define BITS_PER_LONG 32
18#else
19typedef Elf64_Addr kernel_ulong_t;
20#define BITS_PER_LONG 64
21#endif
22#ifdef __sun__
23#include <inttypes.h>
24#else
25#include <stdint.h>
26#endif
27
28#include <ctype.h>
29#include <stdbool.h>
30
31typedef uint32_t __u32;
32typedef uint16_t __u16;
33typedef unsigned char __u8;
34
35#include "../../include/linux/mod_devicetable.h"
36
37struct devtable {
38 const char *device_id;
39 unsigned long id_size;
40 void *function;
41};
42
43#define ___cat(a,b) a ## b
44#define __cat(a,b) ___cat(a,b)
45
46#if defined(__MACH__)
47#include <mach-o/getsect.h>
48
49#define INIT_SECTION(name) do { \
50 unsigned long name ## _len; \
51 char *__cat(pstart_,name) = getsectdata("__TEXT", \
52 #name, &__cat(name,_len)); \
53 char *__cat(pstop_,name) = __cat(pstart_,name) + \
54 __cat(name, _len); \
55 __cat(__start_,name) = (void *)__cat(pstart_,name); \
56 __cat(__stop_,name) = (void *)__cat(pstop_,name); \
57 } while (0)
58#define SECTION(name) __attribute__((section("__TEXT, " #name)))
59
60struct devtable **__start___devtable, **__stop___devtable;
61#else
62#define INIT_SECTION(name)
63#define SECTION(name) __attribute__((section(#name)))
64
65extern struct devtable *__start___devtable[], *__stop___devtable[];
66#endif
67
68#if __GNUC__ == 3 && __GNUC_MINOR__ < 3
69# define __used __attribute__((__unused__))
70#else
71# define __used __attribute__((__used__))
72#endif
73
74#define ADD_TO_DEVTABLE(device_id, type, function) \
75 static struct devtable __cat(devtable,__LINE__) = { \
76 device_id + 0*sizeof((function)((const char *)NULL, \
77 (type *)NULL, \
78 (char *)NULL)), \
79 sizeof(type), (function) }; \
80 static struct devtable *SECTION(__devtable) __used \
81 __cat(devtable_ptr,__LINE__) = &__cat(devtable,__LINE__)
82
83#define ADD(str, sep, cond, field) \
84do { \
85 strcat(str, sep); \
86 if (cond) \
87 sprintf(str + strlen(str), \
88 sizeof(field) == 1 ? "%02X" : \
89 sizeof(field) == 2 ? "%04X" : \
90 sizeof(field) == 4 ? "%08X" : "", \
91 field); \
92 else \
93 sprintf(str + strlen(str), "*"); \
94} while(0)
95
96static inline void add_wildcard(char *str)
97{
98 int len = strlen(str);
99
100 if (str[len - 1] != '*')
101 strcat(str + len, "*");
102}
103
104unsigned int cross_build = 0;
105static void device_id_check(const char *modname, const char *device_id,
106 unsigned long size, unsigned long id_size,
107 void *symval)
108{
109 int i;
110
111 if (size % id_size || size < id_size) {
112 if (cross_build != 0)
113 return;
114 fatal("%s: sizeof(struct %s_device_id)=%lu is not a modulo "
115 "of the size of section __mod_%s_device_table=%lu.\n"
116 "Fix definition of struct %s_device_id "
117 "in mod_devicetable.h\n",
118 modname, device_id, id_size, device_id, size, device_id);
119 }
120
121 for (i = 0; i < id_size; i++ ) {
122 if (*(uint8_t*)(symval+size-id_size+i)) {
123 fprintf(stderr,"%s: struct %s_device_id is %lu bytes. "
124 "The last of %lu is:\n",
125 modname, device_id, id_size, size / id_size);
126 for (i = 0; i < id_size; i++ )
127 fprintf(stderr,"0x%02x ",
128 *(uint8_t*)(symval+size-id_size+i) );
129 fprintf(stderr,"\n");
130 fatal("%s: struct %s_device_id is not terminated "
131 "with a NULL entry!\n", modname, device_id);
132 }
133 }
134}
135
136static void do_usb_entry(struct usb_device_id *id,
137 unsigned int bcdDevice_initial, int bcdDevice_initial_digits,
138 unsigned char range_lo, unsigned char range_hi,
139 unsigned char max, struct module *mod)
140{
141 char alias[500];
142 strcpy(alias, "usb:");
143 ADD(alias, "v", id->match_flags&USB_DEVICE_ID_MATCH_VENDOR,
144 id->idVendor);
145 ADD(alias, "p", id->match_flags&USB_DEVICE_ID_MATCH_PRODUCT,
146 id->idProduct);
147
148 strcat(alias, "d");
149 if (bcdDevice_initial_digits)
150 sprintf(alias + strlen(alias), "%0*X",
151 bcdDevice_initial_digits, bcdDevice_initial);
152 if (range_lo == range_hi)
153 sprintf(alias + strlen(alias), "%X", range_lo);
154 else if (range_lo > 0 || range_hi < max) {
155 if (range_lo > 0x9 || range_hi < 0xA)
156 sprintf(alias + strlen(alias),
157 "[%X-%X]",
158 range_lo,
159 range_hi);
160 else {
161 sprintf(alias + strlen(alias),
162 range_lo < 0x9 ? "[%X-9" : "[%X",
163 range_lo);
164 sprintf(alias + strlen(alias),
165 range_hi > 0xA ? "a-%X]" : "%X]",
166 range_lo);
167 }
168 }
169 if (bcdDevice_initial_digits < (sizeof(id->bcdDevice_lo) * 2 - 1))
170 strcat(alias, "*");
171
172 ADD(alias, "dc", id->match_flags&USB_DEVICE_ID_MATCH_DEV_CLASS,
173 id->bDeviceClass);
174 ADD(alias, "dsc",
175 id->match_flags&USB_DEVICE_ID_MATCH_DEV_SUBCLASS,
176 id->bDeviceSubClass);
177 ADD(alias, "dp",
178 id->match_flags&USB_DEVICE_ID_MATCH_DEV_PROTOCOL,
179 id->bDeviceProtocol);
180 ADD(alias, "ic",
181 id->match_flags&USB_DEVICE_ID_MATCH_INT_CLASS,
182 id->bInterfaceClass);
183 ADD(alias, "isc",
184 id->match_flags&USB_DEVICE_ID_MATCH_INT_SUBCLASS,
185 id->bInterfaceSubClass);
186 ADD(alias, "ip",
187 id->match_flags&USB_DEVICE_ID_MATCH_INT_PROTOCOL,
188 id->bInterfaceProtocol);
189
190 add_wildcard(alias);
191 buf_printf(&mod->dev_table_buf,
192 "MODULE_ALIAS(\"%s\");\n", alias);
193}
194
195static unsigned int incbcd(unsigned int *bcd,
196 int inc,
197 unsigned char max,
198 size_t chars)
199{
200 unsigned int init = *bcd, i, j;
201 unsigned long long c, dec = 0;
202
203
204 if (max > 0x9) {
205 *bcd += inc;
206 return init;
207 }
208
209
210 for (i=0 ; i < chars ; i++) {
211 c = (*bcd >> (i << 2)) & 0xf;
212 c = c > 9 ? 9 : c;
213 for (j=0 ; j < i ; j++)
214 c = c * 10;
215 dec += c;
216 }
217
218
219 dec += inc;
220 *bcd = 0;
221
222
223 for (i=0 ; i < chars ; i++) {
224 for (c=1,j=0 ; j < i ; j++)
225 c = c * 10;
226 c = (dec / c) % 10;
227 *bcd += c << (i << 2);
228 }
229 return init;
230}
231
232static void do_usb_entry_multi(struct usb_device_id *id, struct module *mod)
233{
234 unsigned int devlo, devhi;
235 unsigned char chi, clo, max;
236 int ndigits;
237
238 id->match_flags = TO_NATIVE(id->match_flags);
239 id->idVendor = TO_NATIVE(id->idVendor);
240 id->idProduct = TO_NATIVE(id->idProduct);
241
242 devlo = id->match_flags & USB_DEVICE_ID_MATCH_DEV_LO ?
243 TO_NATIVE(id->bcdDevice_lo) : 0x0U;
244 devhi = id->match_flags & USB_DEVICE_ID_MATCH_DEV_HI ?
245 TO_NATIVE(id->bcdDevice_hi) : ~0x0U;
246
247
248 max = 0x9;
249 for (ndigits = 0 ; ndigits < sizeof(id->bcdDevice_lo) * 2 ; ndigits++) {
250 clo = (devlo >> (ndigits << 2)) & 0xf;
251 chi = ((devhi > 0x9999 ? 0x9999 : devhi) >> (ndigits << 2)) & 0xf;
252 if (clo > max || chi > max) {
253 max = 0xf;
254 break;
255 }
256 }
257
258 if (!(id->idVendor | id->idProduct | id->bDeviceClass | id->bInterfaceClass))
259 return;
260
261
262 for (ndigits = sizeof(id->bcdDevice_lo) * 2 - 1; devlo <= devhi; ndigits--) {
263 clo = devlo & 0xf;
264 chi = devhi & 0xf;
265 if (chi > max)
266 chi = max;
267 devlo >>= 4;
268 devhi >>= 4;
269
270 if (devlo == devhi || !ndigits) {
271 do_usb_entry(id, devlo, ndigits, clo, chi, max, mod);
272 break;
273 }
274
275 if (clo > 0x0)
276 do_usb_entry(id,
277 incbcd(&devlo, 1, max,
278 sizeof(id->bcdDevice_lo) * 2),
279 ndigits, clo, max, max, mod);
280
281 if (chi < max)
282 do_usb_entry(id,
283 incbcd(&devhi, -1, max,
284 sizeof(id->bcdDevice_lo) * 2),
285 ndigits, 0x0, chi, max, mod);
286 }
287}
288
289static void do_usb_table(void *symval, unsigned long size,
290 struct module *mod)
291{
292 unsigned int i;
293 const unsigned long id_size = sizeof(struct usb_device_id);
294
295 device_id_check(mod->name, "usb", size, id_size, symval);
296
297
298 size -= id_size;
299
300 for (i = 0; i < size; i += id_size)
301 do_usb_entry_multi(symval + i, mod);
302}
303
304static int do_hid_entry(const char *filename,
305 struct hid_device_id *id, char *alias)
306{
307 id->bus = TO_NATIVE(id->bus);
308 id->vendor = TO_NATIVE(id->vendor);
309 id->product = TO_NATIVE(id->product);
310
311 sprintf(alias, "hid:b%04X", id->bus);
312 ADD(alias, "v", id->vendor != HID_ANY_ID, id->vendor);
313 ADD(alias, "p", id->product != HID_ANY_ID, id->product);
314
315 return 1;
316}
317ADD_TO_DEVTABLE("hid", struct hid_device_id, do_hid_entry);
318
319static int do_ieee1394_entry(const char *filename,
320 struct ieee1394_device_id *id, char *alias)
321{
322 id->match_flags = TO_NATIVE(id->match_flags);
323 id->vendor_id = TO_NATIVE(id->vendor_id);
324 id->model_id = TO_NATIVE(id->model_id);
325 id->specifier_id = TO_NATIVE(id->specifier_id);
326 id->version = TO_NATIVE(id->version);
327
328 strcpy(alias, "ieee1394:");
329 ADD(alias, "ven", id->match_flags & IEEE1394_MATCH_VENDOR_ID,
330 id->vendor_id);
331 ADD(alias, "mo", id->match_flags & IEEE1394_MATCH_MODEL_ID,
332 id->model_id);
333 ADD(alias, "sp", id->match_flags & IEEE1394_MATCH_SPECIFIER_ID,
334 id->specifier_id);
335 ADD(alias, "ver", id->match_flags & IEEE1394_MATCH_VERSION,
336 id->version);
337
338 add_wildcard(alias);
339 return 1;
340}
341ADD_TO_DEVTABLE("ieee1394", struct ieee1394_device_id, do_ieee1394_entry);
342
343static int do_pci_entry(const char *filename,
344 struct pci_device_id *id, char *alias)
345{
346
347 unsigned char baseclass, subclass, interface,
348 baseclass_mask, subclass_mask, interface_mask;
349
350 id->vendor = TO_NATIVE(id->vendor);
351 id->device = TO_NATIVE(id->device);
352 id->subvendor = TO_NATIVE(id->subvendor);
353 id->subdevice = TO_NATIVE(id->subdevice);
354 id->class = TO_NATIVE(id->class);
355 id->class_mask = TO_NATIVE(id->class_mask);
356
357 strcpy(alias, "pci:");
358 ADD(alias, "v", id->vendor != PCI_ANY_ID, id->vendor);
359 ADD(alias, "d", id->device != PCI_ANY_ID, id->device);
360 ADD(alias, "sv", id->subvendor != PCI_ANY_ID, id->subvendor);
361 ADD(alias, "sd", id->subdevice != PCI_ANY_ID, id->subdevice);
362
363 baseclass = (id->class) >> 16;
364 baseclass_mask = (id->class_mask) >> 16;
365 subclass = (id->class) >> 8;
366 subclass_mask = (id->class_mask) >> 8;
367 interface = id->class;
368 interface_mask = id->class_mask;
369
370 if ((baseclass_mask != 0 && baseclass_mask != 0xFF)
371 || (subclass_mask != 0 && subclass_mask != 0xFF)
372 || (interface_mask != 0 && interface_mask != 0xFF)) {
373 warn("Can't handle masks in %s:%04X\n",
374 filename, id->class_mask);
375 return 0;
376 }
377
378 ADD(alias, "bc", baseclass_mask == 0xFF, baseclass);
379 ADD(alias, "sc", subclass_mask == 0xFF, subclass);
380 ADD(alias, "i", interface_mask == 0xFF, interface);
381 add_wildcard(alias);
382 return 1;
383}
384ADD_TO_DEVTABLE("pci", struct pci_device_id, do_pci_entry);
385
386static int do_ccw_entry(const char *filename,
387 struct ccw_device_id *id, char *alias)
388{
389 id->match_flags = TO_NATIVE(id->match_flags);
390 id->cu_type = TO_NATIVE(id->cu_type);
391 id->cu_model = TO_NATIVE(id->cu_model);
392 id->dev_type = TO_NATIVE(id->dev_type);
393 id->dev_model = TO_NATIVE(id->dev_model);
394
395 strcpy(alias, "ccw:");
396 ADD(alias, "t", id->match_flags&CCW_DEVICE_ID_MATCH_CU_TYPE,
397 id->cu_type);
398 ADD(alias, "m", id->match_flags&CCW_DEVICE_ID_MATCH_CU_MODEL,
399 id->cu_model);
400 ADD(alias, "dt", id->match_flags&CCW_DEVICE_ID_MATCH_DEVICE_TYPE,
401 id->dev_type);
402 ADD(alias, "dm", id->match_flags&CCW_DEVICE_ID_MATCH_DEVICE_MODEL,
403 id->dev_model);
404 add_wildcard(alias);
405 return 1;
406}
407ADD_TO_DEVTABLE("ccw", struct ccw_device_id, do_ccw_entry);
408
409static int do_ap_entry(const char *filename,
410 struct ap_device_id *id, char *alias)
411{
412 sprintf(alias, "ap:t%02X*", id->dev_type);
413 return 1;
414}
415ADD_TO_DEVTABLE("ap", struct ap_device_id, do_ap_entry);
416
417static int do_css_entry(const char *filename,
418 struct css_device_id *id, char *alias)
419{
420 sprintf(alias, "css:t%01X", id->type);
421 return 1;
422}
423ADD_TO_DEVTABLE("css", struct css_device_id, do_css_entry);
424
425static int do_serio_entry(const char *filename,
426 struct serio_device_id *id, char *alias)
427{
428 id->type = TO_NATIVE(id->type);
429 id->proto = TO_NATIVE(id->proto);
430 id->id = TO_NATIVE(id->id);
431 id->extra = TO_NATIVE(id->extra);
432
433 strcpy(alias, "serio:");
434 ADD(alias, "ty", id->type != SERIO_ANY, id->type);
435 ADD(alias, "pr", id->proto != SERIO_ANY, id->proto);
436 ADD(alias, "id", id->id != SERIO_ANY, id->id);
437 ADD(alias, "ex", id->extra != SERIO_ANY, id->extra);
438
439 add_wildcard(alias);
440 return 1;
441}
442ADD_TO_DEVTABLE("serio", struct serio_device_id, do_serio_entry);
443
444static int do_acpi_entry(const char *filename,
445 struct acpi_device_id *id, char *alias)
446{
447 sprintf(alias, "acpi*:%s:*", id->id);
448 return 1;
449}
450ADD_TO_DEVTABLE("acpi", struct acpi_device_id, do_acpi_entry);
451
452static void do_pnp_device_entry(void *symval, unsigned long size,
453 struct module *mod)
454{
455 const unsigned long id_size = sizeof(struct pnp_device_id);
456 const unsigned int count = (size / id_size)-1;
457 const struct pnp_device_id *devs = symval;
458 unsigned int i;
459
460 device_id_check(mod->name, "pnp", size, id_size, symval);
461
462 for (i = 0; i < count; i++) {
463 const char *id = (char *)devs[i].id;
464 char acpi_id[sizeof(devs[0].id)];
465 int j;
466
467 buf_printf(&mod->dev_table_buf,
468 "MODULE_ALIAS(\"pnp:d%s*\");\n", id);
469
470
471 for (j = 0; j < sizeof(acpi_id); j++)
472 acpi_id[j] = toupper(id[j]);
473 buf_printf(&mod->dev_table_buf,
474 "MODULE_ALIAS(\"acpi*:%s:*\");\n", acpi_id);
475 }
476}
477
478static void do_pnp_card_entries(void *symval, unsigned long size,
479 struct module *mod)
480{
481 const unsigned long id_size = sizeof(struct pnp_card_device_id);
482 const unsigned int count = (size / id_size)-1;
483 const struct pnp_card_device_id *cards = symval;
484 unsigned int i;
485
486 device_id_check(mod->name, "pnp", size, id_size, symval);
487
488 for (i = 0; i < count; i++) {
489 unsigned int j;
490 const struct pnp_card_device_id *card = &cards[i];
491
492 for (j = 0; j < PNP_MAX_DEVICES; j++) {
493 const char *id = (char *)card->devs[j].id;
494 int i2, j2;
495 int dup = 0;
496
497 if (!id[0])
498 break;
499
500
501 for (i2 = 0; i2 < i && !dup; i2++) {
502 const struct pnp_card_device_id *card2 = &cards[i2];
503
504 for (j2 = 0; j2 < PNP_MAX_DEVICES; j2++) {
505 const char *id2 = (char *)card2->devs[j2].id;
506
507 if (!id2[0])
508 break;
509
510 if (!strcmp(id, id2)) {
511 dup = 1;
512 break;
513 }
514 }
515 }
516
517
518 if (!dup) {
519 char acpi_id[sizeof(card->devs[0].id)];
520 int k;
521
522 buf_printf(&mod->dev_table_buf,
523 "MODULE_ALIAS(\"pnp:d%s*\");\n", id);
524
525
526 for (k = 0; k < sizeof(acpi_id); k++)
527 acpi_id[k] = toupper(id[k]);
528 buf_printf(&mod->dev_table_buf,
529 "MODULE_ALIAS(\"acpi*:%s:*\");\n", acpi_id);
530 }
531 }
532 }
533}
534
535static int do_pcmcia_entry(const char *filename,
536 struct pcmcia_device_id *id, char *alias)
537{
538 unsigned int i;
539
540 id->match_flags = TO_NATIVE(id->match_flags);
541 id->manf_id = TO_NATIVE(id->manf_id);
542 id->card_id = TO_NATIVE(id->card_id);
543 id->func_id = TO_NATIVE(id->func_id);
544 id->function = TO_NATIVE(id->function);
545 id->device_no = TO_NATIVE(id->device_no);
546
547 for (i=0; i<4; i++) {
548 id->prod_id_hash[i] = TO_NATIVE(id->prod_id_hash[i]);
549 }
550
551 strcpy(alias, "pcmcia:");
552 ADD(alias, "m", id->match_flags & PCMCIA_DEV_ID_MATCH_MANF_ID,
553 id->manf_id);
554 ADD(alias, "c", id->match_flags & PCMCIA_DEV_ID_MATCH_CARD_ID,
555 id->card_id);
556 ADD(alias, "f", id->match_flags & PCMCIA_DEV_ID_MATCH_FUNC_ID,
557 id->func_id);
558 ADD(alias, "fn", id->match_flags & PCMCIA_DEV_ID_MATCH_FUNCTION,
559 id->function);
560 ADD(alias, "pfn", id->match_flags & PCMCIA_DEV_ID_MATCH_DEVICE_NO,
561 id->device_no);
562 ADD(alias, "pa", id->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID1, id->prod_id_hash[0]);
563 ADD(alias, "pb", id->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID2, id->prod_id_hash[1]);
564 ADD(alias, "pc", id->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID3, id->prod_id_hash[2]);
565 ADD(alias, "pd", id->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID4, id->prod_id_hash[3]);
566
567 add_wildcard(alias);
568 return 1;
569}
570ADD_TO_DEVTABLE("pcmcia", struct pcmcia_device_id, do_pcmcia_entry);
571
572static int do_of_entry (const char *filename, struct of_device_id *of, char *alias)
573{
574 int len;
575 char *tmp;
576 len = sprintf (alias, "of:N%sT%s",
577 of->name[0] ? of->name : "*",
578 of->type[0] ? of->type : "*");
579
580 if (of->compatible[0])
581 sprintf (&alias[len], "%sC%s",
582 of->type[0] ? "*" : "",
583 of->compatible);
584
585
586 for (tmp = alias; tmp && *tmp; tmp++)
587 if (isspace (*tmp))
588 *tmp = '_';
589
590 add_wildcard(alias);
591 return 1;
592}
593ADD_TO_DEVTABLE("of", struct of_device_id, do_of_entry);
594
595static int do_vio_entry(const char *filename, struct vio_device_id *vio,
596 char *alias)
597{
598 char *tmp;
599
600 sprintf(alias, "vio:T%sS%s", vio->type[0] ? vio->type : "*",
601 vio->compat[0] ? vio->compat : "*");
602
603
604 for (tmp = alias; tmp && *tmp; tmp++)
605 if (isspace (*tmp))
606 *tmp = '_';
607
608 add_wildcard(alias);
609 return 1;
610}
611ADD_TO_DEVTABLE("vio", struct vio_device_id, do_vio_entry);
612
613#define ARRAY_SIZE(x) (sizeof(x) / sizeof((x)[0]))
614
615static void do_input(char *alias,
616 kernel_ulong_t *arr, unsigned int min, unsigned int max)
617{
618 unsigned int i;
619
620 for (i = min; i < max; i++)
621 if (arr[i / BITS_PER_LONG] & (1L << (i%BITS_PER_LONG)))
622 sprintf(alias + strlen(alias), "%X,*", i);
623}
624
625static int do_input_entry(const char *filename, struct input_device_id *id,
626 char *alias)
627{
628 sprintf(alias, "input:");
629
630 ADD(alias, "b", id->flags & INPUT_DEVICE_ID_MATCH_BUS, id->bustype);
631 ADD(alias, "v", id->flags & INPUT_DEVICE_ID_MATCH_VENDOR, id->vendor);
632 ADD(alias, "p", id->flags & INPUT_DEVICE_ID_MATCH_PRODUCT, id->product);
633 ADD(alias, "e", id->flags & INPUT_DEVICE_ID_MATCH_VERSION, id->version);
634
635 sprintf(alias + strlen(alias), "-e*");
636 if (id->flags & INPUT_DEVICE_ID_MATCH_EVBIT)
637 do_input(alias, id->evbit, 0, INPUT_DEVICE_ID_EV_MAX);
638 sprintf(alias + strlen(alias), "k*");
639 if (id->flags & INPUT_DEVICE_ID_MATCH_KEYBIT)
640 do_input(alias, id->keybit,
641 INPUT_DEVICE_ID_KEY_MIN_INTERESTING,
642 INPUT_DEVICE_ID_KEY_MAX);
643 sprintf(alias + strlen(alias), "r*");
644 if (id->flags & INPUT_DEVICE_ID_MATCH_RELBIT)
645 do_input(alias, id->relbit, 0, INPUT_DEVICE_ID_REL_MAX);
646 sprintf(alias + strlen(alias), "a*");
647 if (id->flags & INPUT_DEVICE_ID_MATCH_ABSBIT)
648 do_input(alias, id->absbit, 0, INPUT_DEVICE_ID_ABS_MAX);
649 sprintf(alias + strlen(alias), "m*");
650 if (id->flags & INPUT_DEVICE_ID_MATCH_MSCIT)
651 do_input(alias, id->mscbit, 0, INPUT_DEVICE_ID_MSC_MAX);
652 sprintf(alias + strlen(alias), "l*");
653 if (id->flags & INPUT_DEVICE_ID_MATCH_LEDBIT)
654 do_input(alias, id->ledbit, 0, INPUT_DEVICE_ID_LED_MAX);
655 sprintf(alias + strlen(alias), "s*");
656 if (id->flags & INPUT_DEVICE_ID_MATCH_SNDBIT)
657 do_input(alias, id->sndbit, 0, INPUT_DEVICE_ID_SND_MAX);
658 sprintf(alias + strlen(alias), "f*");
659 if (id->flags & INPUT_DEVICE_ID_MATCH_FFBIT)
660 do_input(alias, id->ffbit, 0, INPUT_DEVICE_ID_FF_MAX);
661 sprintf(alias + strlen(alias), "w*");
662 if (id->flags & INPUT_DEVICE_ID_MATCH_SWBIT)
663 do_input(alias, id->swbit, 0, INPUT_DEVICE_ID_SW_MAX);
664 return 1;
665}
666ADD_TO_DEVTABLE("input", struct input_device_id, do_input_entry);
667
668static int do_eisa_entry(const char *filename, struct eisa_device_id *eisa,
669 char *alias)
670{
671 if (eisa->sig[0])
672 sprintf(alias, EISA_DEVICE_MODALIAS_FMT "*", eisa->sig);
673 else
674 strcat(alias, "*");
675 return 1;
676}
677ADD_TO_DEVTABLE("eisa", struct eisa_device_id, do_eisa_entry);
678
679static int do_parisc_entry(const char *filename, struct parisc_device_id *id,
680 char *alias)
681{
682 id->hw_type = TO_NATIVE(id->hw_type);
683 id->hversion = TO_NATIVE(id->hversion);
684 id->hversion_rev = TO_NATIVE(id->hversion_rev);
685 id->sversion = TO_NATIVE(id->sversion);
686
687 strcpy(alias, "parisc:");
688 ADD(alias, "t", id->hw_type != PA_HWTYPE_ANY_ID, id->hw_type);
689 ADD(alias, "hv", id->hversion != PA_HVERSION_ANY_ID, id->hversion);
690 ADD(alias, "rev", id->hversion_rev != PA_HVERSION_REV_ANY_ID, id->hversion_rev);
691 ADD(alias, "sv", id->sversion != PA_SVERSION_ANY_ID, id->sversion);
692
693 add_wildcard(alias);
694 return 1;
695}
696ADD_TO_DEVTABLE("parisc", struct parisc_device_id, do_parisc_entry);
697
698static int do_sdio_entry(const char *filename,
699 struct sdio_device_id *id, char *alias)
700{
701 id->class = TO_NATIVE(id->class);
702 id->vendor = TO_NATIVE(id->vendor);
703 id->device = TO_NATIVE(id->device);
704
705 strcpy(alias, "sdio:");
706 ADD(alias, "c", id->class != (__u8)SDIO_ANY_ID, id->class);
707 ADD(alias, "v", id->vendor != (__u16)SDIO_ANY_ID, id->vendor);
708 ADD(alias, "d", id->device != (__u16)SDIO_ANY_ID, id->device);
709 add_wildcard(alias);
710 return 1;
711}
712ADD_TO_DEVTABLE("sdio", struct sdio_device_id, do_sdio_entry);
713
714static int do_ssb_entry(const char *filename,
715 struct ssb_device_id *id, char *alias)
716{
717 id->vendor = TO_NATIVE(id->vendor);
718 id->coreid = TO_NATIVE(id->coreid);
719 id->revision = TO_NATIVE(id->revision);
720
721 strcpy(alias, "ssb:");
722 ADD(alias, "v", id->vendor != SSB_ANY_VENDOR, id->vendor);
723 ADD(alias, "id", id->coreid != SSB_ANY_ID, id->coreid);
724 ADD(alias, "rev", id->revision != SSB_ANY_REV, id->revision);
725 add_wildcard(alias);
726 return 1;
727}
728ADD_TO_DEVTABLE("ssb", struct ssb_device_id, do_ssb_entry);
729
730static int do_bcma_entry(const char *filename,
731 struct bcma_device_id *id, char *alias)
732{
733 id->manuf = TO_NATIVE(id->manuf);
734 id->id = TO_NATIVE(id->id);
735 id->rev = TO_NATIVE(id->rev);
736 id->class = TO_NATIVE(id->class);
737
738 strcpy(alias, "bcma:");
739 ADD(alias, "m", id->manuf != BCMA_ANY_MANUF, id->manuf);
740 ADD(alias, "id", id->id != BCMA_ANY_ID, id->id);
741 ADD(alias, "rev", id->rev != BCMA_ANY_REV, id->rev);
742 ADD(alias, "cl", id->class != BCMA_ANY_CLASS, id->class);
743 add_wildcard(alias);
744 return 1;
745}
746ADD_TO_DEVTABLE("bcma", struct bcma_device_id, do_bcma_entry);
747
748static int do_virtio_entry(const char *filename, struct virtio_device_id *id,
749 char *alias)
750{
751 id->device = TO_NATIVE(id->device);
752 id->vendor = TO_NATIVE(id->vendor);
753
754 strcpy(alias, "virtio:");
755 ADD(alias, "d", id->device != VIRTIO_DEV_ANY_ID, id->device);
756 ADD(alias, "v", id->vendor != VIRTIO_DEV_ANY_ID, id->vendor);
757
758 add_wildcard(alias);
759 return 1;
760}
761ADD_TO_DEVTABLE("virtio", struct virtio_device_id, do_virtio_entry);
762
763
764static int do_vmbus_entry(const char *filename, struct hv_vmbus_device_id *id,
765 char *alias)
766{
767 int i;
768 char guid_name[((sizeof(id->guid) + 1)) * 2];
769
770 for (i = 0; i < (sizeof(id->guid) * 2); i += 2)
771 sprintf(&guid_name[i], "%02x", id->guid[i/2]);
772
773 strcpy(alias, "vmbus:");
774 strcat(alias, guid_name);
775
776 return 1;
777}
778ADD_TO_DEVTABLE("vmbus", struct hv_vmbus_device_id, do_vmbus_entry);
779
780static int do_i2c_entry(const char *filename, struct i2c_device_id *id,
781 char *alias)
782{
783 sprintf(alias, I2C_MODULE_PREFIX "%s", id->name);
784
785 return 1;
786}
787ADD_TO_DEVTABLE("i2c", struct i2c_device_id, do_i2c_entry);
788
789static int do_spi_entry(const char *filename, struct spi_device_id *id,
790 char *alias)
791{
792 sprintf(alias, SPI_MODULE_PREFIX "%s", id->name);
793
794 return 1;
795}
796ADD_TO_DEVTABLE("spi", struct spi_device_id, do_spi_entry);
797
798static const struct dmifield {
799 const char *prefix;
800 int field;
801} dmi_fields[] = {
802 { "bvn", DMI_BIOS_VENDOR },
803 { "bvr", DMI_BIOS_VERSION },
804 { "bd", DMI_BIOS_DATE },
805 { "svn", DMI_SYS_VENDOR },
806 { "pn", DMI_PRODUCT_NAME },
807 { "pvr", DMI_PRODUCT_VERSION },
808 { "rvn", DMI_BOARD_VENDOR },
809 { "rn", DMI_BOARD_NAME },
810 { "rvr", DMI_BOARD_VERSION },
811 { "cvn", DMI_CHASSIS_VENDOR },
812 { "ct", DMI_CHASSIS_TYPE },
813 { "cvr", DMI_CHASSIS_VERSION },
814 { NULL, DMI_NONE }
815};
816
817static void dmi_ascii_filter(char *d, const char *s)
818{
819
820 for (; *s; s++)
821 if (*s > ' ' && *s < 127 && *s != ':')
822 *(d++) = *s;
823
824 *d = 0;
825}
826
827
828static int do_dmi_entry(const char *filename, struct dmi_system_id *id,
829 char *alias)
830{
831 int i, j;
832
833 sprintf(alias, "dmi*");
834
835 for (i = 0; i < ARRAY_SIZE(dmi_fields); i++) {
836 for (j = 0; j < 4; j++) {
837 if (id->matches[j].slot &&
838 id->matches[j].slot == dmi_fields[i].field) {
839 sprintf(alias + strlen(alias), ":%s*",
840 dmi_fields[i].prefix);
841 dmi_ascii_filter(alias + strlen(alias),
842 id->matches[j].substr);
843 strcat(alias, "*");
844 }
845 }
846 }
847
848 strcat(alias, ":");
849 return 1;
850}
851ADD_TO_DEVTABLE("dmi", struct dmi_system_id, do_dmi_entry);
852
853static int do_platform_entry(const char *filename,
854 struct platform_device_id *id, char *alias)
855{
856 sprintf(alias, PLATFORM_MODULE_PREFIX "%s", id->name);
857 return 1;
858}
859ADD_TO_DEVTABLE("platform", struct platform_device_id, do_platform_entry);
860
861static int do_mdio_entry(const char *filename,
862 struct mdio_device_id *id, char *alias)
863{
864 int i;
865
866 alias += sprintf(alias, MDIO_MODULE_PREFIX);
867
868 for (i = 0; i < 32; i++) {
869 if (!((id->phy_id_mask >> (31-i)) & 1))
870 *(alias++) = '?';
871 else if ((id->phy_id >> (31-i)) & 1)
872 *(alias++) = '1';
873 else
874 *(alias++) = '0';
875 }
876
877
878 *alias = 0;
879
880 return 1;
881}
882ADD_TO_DEVTABLE("mdio", struct mdio_device_id, do_mdio_entry);
883
884static int do_zorro_entry(const char *filename, struct zorro_device_id *id,
885 char *alias)
886{
887 id->id = TO_NATIVE(id->id);
888 strcpy(alias, "zorro:");
889 ADD(alias, "i", id->id != ZORRO_WILDCARD, id->id);
890 return 1;
891}
892ADD_TO_DEVTABLE("zorro", struct zorro_device_id, do_zorro_entry);
893
894static int do_isapnp_entry(const char *filename,
895 struct isapnp_device_id *id, char *alias)
896{
897 sprintf(alias, "pnp:d%c%c%c%x%x%x%x*",
898 'A' + ((id->vendor >> 2) & 0x3f) - 1,
899 'A' + (((id->vendor & 3) << 3) | ((id->vendor >> 13) & 7)) - 1,
900 'A' + ((id->vendor >> 8) & 0x1f) - 1,
901 (id->function >> 4) & 0x0f, id->function & 0x0f,
902 (id->function >> 12) & 0x0f, (id->function >> 8) & 0x0f);
903 return 1;
904}
905ADD_TO_DEVTABLE("isapnp", struct isapnp_device_id, do_isapnp_entry);
906
907static void append_nibble_mask(char **outp,
908 unsigned int nibble, unsigned int mask)
909{
910 char *p = *outp;
911 unsigned int i;
912
913 switch (mask) {
914 case 0:
915 *p++ = '?';
916 break;
917
918 case 0xf:
919 p += sprintf(p, "%X", nibble);
920 break;
921
922 default:
923 *p++ = '[';
924 for (i = 0; i < 0x10; i++)
925 if ((i & mask) == nibble)
926 p += sprintf(p, "%X", i);
927 *p++ = ']';
928 }
929
930
931 *p = '\0';
932
933
934 *outp = p;
935}
936
937static int do_amba_entry(const char *filename,
938 struct amba_id *id, char *alias)
939{
940 unsigned int digit;
941 char *p = alias;
942
943 if ((id->id & id->mask) != id->id)
944 fatal("%s: Masked-off bit(s) of AMBA device ID are non-zero: "
945 "id=0x%08X, mask=0x%08X. Please fix this driver.\n",
946 filename, id->id, id->mask);
947
948 p += sprintf(alias, "amba:d");
949 for (digit = 0; digit < 8; digit++)
950 append_nibble_mask(&p,
951 (id->id >> (4 * (7 - digit))) & 0xf,
952 (id->mask >> (4 * (7 - digit))) & 0xf);
953
954 return 1;
955}
956ADD_TO_DEVTABLE("amba", struct amba_id, do_amba_entry);
957
958
959static int do_x86cpu_entry(const char *filename, struct x86_cpu_id *id,
960 char *alias)
961{
962 id->feature = TO_NATIVE(id->feature);
963 id->family = TO_NATIVE(id->family);
964 id->model = TO_NATIVE(id->model);
965 id->vendor = TO_NATIVE(id->vendor);
966
967 strcpy(alias, "x86cpu:");
968 ADD(alias, "vendor:", id->vendor != X86_VENDOR_ANY, id->vendor);
969 ADD(alias, ":family:", id->family != X86_FAMILY_ANY, id->family);
970 ADD(alias, ":model:", id->model != X86_MODEL_ANY, id->model);
971 strcat(alias, ":feature:*");
972 if (id->feature != X86_FEATURE_ANY)
973 sprintf(alias + strlen(alias), "%04X*", id->feature);
974 return 1;
975}
976ADD_TO_DEVTABLE("x86cpu", struct x86_cpu_id, do_x86cpu_entry);
977
978static bool sym_is(const char *name, unsigned namelen, const char *symbol)
979{
980 if (namelen != strlen(symbol))
981 return false;
982
983 return memcmp(name, symbol, namelen) == 0;
984}
985
986static void do_table(void *symval, unsigned long size,
987 unsigned long id_size,
988 const char *device_id,
989 void *function,
990 struct module *mod)
991{
992 unsigned int i;
993 char alias[500];
994 int (*do_entry)(const char *, void *entry, char *alias) = function;
995
996 device_id_check(mod->name, device_id, size, id_size, symval);
997
998 size -= id_size;
999
1000 for (i = 0; i < size; i += id_size) {
1001 if (do_entry(mod->name, symval+i, alias)) {
1002 buf_printf(&mod->dev_table_buf,
1003 "MODULE_ALIAS(\"%s\");\n", alias);
1004 }
1005 }
1006}
1007
1008void handle_moddevtable(struct module *mod, struct elf_info *info,
1009 Elf_Sym *sym, const char *symname)
1010{
1011 void *symval;
1012 char *zeros = NULL;
1013 const char *name;
1014 unsigned int namelen;
1015
1016
1017 if (!sym->st_shndx || get_secindex(info, sym) >= info->num_sections)
1018 return;
1019
1020
1021 if (ELF_ST_TYPE(sym->st_info) != STT_OBJECT)
1022 return;
1023
1024
1025 name = strstr(symname, "__mod_");
1026 if (!name)
1027 return;
1028 name += strlen("__mod_");
1029 namelen = strlen(name);
1030 if (namelen < strlen("_device_table"))
1031 return;
1032 if (strcmp(name + namelen - strlen("_device_table"), "_device_table"))
1033 return;
1034 namelen -= strlen("_device_table");
1035
1036
1037 if (info->sechdrs[get_secindex(info, sym)].sh_type & SHT_NOBITS) {
1038 zeros = calloc(1, sym->st_size);
1039 symval = zeros;
1040 } else {
1041 symval = (void *)info->hdr
1042 + info->sechdrs[get_secindex(info, sym)].sh_offset
1043 + sym->st_value;
1044 }
1045
1046
1047 if (sym_is(name, namelen, "usb"))
1048 do_usb_table(symval, sym->st_size, mod);
1049 else if (sym_is(name, namelen, "pnp"))
1050 do_pnp_device_entry(symval, sym->st_size, mod);
1051 else if (sym_is(name, namelen, "pnp_card"))
1052 do_pnp_card_entries(symval, sym->st_size, mod);
1053 else {
1054 struct devtable **p;
1055 INIT_SECTION(__devtable);
1056
1057 for (p = __start___devtable; p < __stop___devtable; p++) {
1058 if (sym_is(name, namelen, (*p)->device_id)) {
1059 do_table(symval, sym->st_size, (*p)->id_size,
1060 (*p)->device_id, (*p)->function, mod);
1061 break;
1062 }
1063 }
1064 }
1065 free(zeros);
1066}
1067
1068void add_moddevtable(struct buffer *buf, struct module *mod)
1069{
1070 buf_printf(buf, "\n");
1071 buf_write(buf, mod->dev_table_buf.p, mod->dev_table_buf.pos);
1072 free(mod->dev_table_buf.p);
1073}