Root/
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 | /* Big exception to the "don't include kernel headers into userspace, which |
39 | * even potentially has different endianness and word sizes, since |
40 | * we handle those differences explicitly below */ |
41 | #include "../../include/linux/mod_devicetable.h" |
42 | |
43 | /* This array collects all instances that use the generic do_table */ |
44 | struct devtable { |
45 | const char *device_id; /* name of table, __mod_<name>__*_device_table. */ |
46 | unsigned long id_size; |
47 | void *function; |
48 | }; |
49 | |
50 | #define ___cat(a,b) a ## b |
51 | #define __cat(a,b) ___cat(a,b) |
52 | |
53 | /* we need some special handling for this host tool running eventually on |
54 | * Darwin. The Mach-O section handling is a bit different than ELF section |
55 | * handling. The differnces in detail are: |
56 | * a) we have segments which have sections |
57 | * b) we need a API call to get the respective section symbols */ |
58 | #if defined(__MACH__) |
59 | #include <mach-o/getsect.h> |
60 | |
61 | #define INIT_SECTION(name) do { \ |
62 | unsigned long name ## _len; \ |
63 | char *__cat(pstart_,name) = getsectdata("__TEXT", \ |
64 | #name, &__cat(name,_len)); \ |
65 | char *__cat(pstop_,name) = __cat(pstart_,name) + \ |
66 | __cat(name, _len); \ |
67 | __cat(__start_,name) = (void *)__cat(pstart_,name); \ |
68 | __cat(__stop_,name) = (void *)__cat(pstop_,name); \ |
69 | } while (0) |
70 | #define SECTION(name) __attribute__((section("__TEXT, " #name))) |
71 | |
72 | struct devtable **__start___devtable, **__stop___devtable; |
73 | #else |
74 | #define INIT_SECTION(name) /* no-op for ELF */ |
75 | #define SECTION(name) __attribute__((section(#name))) |
76 | |
77 | /* We construct a table of pointers in an ELF section (pointers generally |
78 | * go unpadded by gcc). ld creates boundary syms for us. */ |
79 | extern struct devtable *__start___devtable[], *__stop___devtable[]; |
80 | #endif /* __MACH__ */ |
81 | |
82 | #if !defined(__used) |
83 | # if __GNUC__ == 3 && __GNUC_MINOR__ < 3 |
84 | # define __used __attribute__((__unused__)) |
85 | # else |
86 | # define __used __attribute__((__used__)) |
87 | # endif |
88 | #endif |
89 | |
90 | /* Define a variable f that holds the value of field f of struct devid |
91 | * based at address m. |
92 | */ |
93 | #define DEF_FIELD(m, devid, f) \ |
94 | typeof(((struct devid *)0)->f) f = TO_NATIVE(*(typeof(f) *)((m) + OFF_##devid##_##f)) |
95 | /* Define a variable f that holds the address of field f of struct devid |
96 | * based at address m. Due to the way typeof works, for a field of type |
97 | * T[N] the variable has type T(*)[N], _not_ T*. |
98 | */ |
99 | #define DEF_FIELD_ADDR(m, devid, f) \ |
100 | typeof(((struct devid *)0)->f) *f = ((m) + OFF_##devid##_##f) |
101 | |
102 | /* Add a table entry. We test function type matches while we're here. */ |
103 | #define ADD_TO_DEVTABLE(device_id, type, function) \ |
104 | static struct devtable __cat(devtable,__LINE__) = { \ |
105 | device_id + 0*sizeof((function)((const char *)NULL, \ |
106 | (void *)NULL, \ |
107 | (char *)NULL)), \ |
108 | SIZE_##type, (function) }; \ |
109 | static struct devtable *SECTION(__devtable) __used \ |
110 | __cat(devtable_ptr,__LINE__) = &__cat(devtable,__LINE__) |
111 | |
112 | #define ADD(str, sep, cond, field) \ |
113 | do { \ |
114 | strcat(str, sep); \ |
115 | if (cond) \ |
116 | sprintf(str + strlen(str), \ |
117 | sizeof(field) == 1 ? "%02X" : \ |
118 | sizeof(field) == 2 ? "%04X" : \ |
119 | sizeof(field) == 4 ? "%08X" : "", \ |
120 | field); \ |
121 | else \ |
122 | sprintf(str + strlen(str), "*"); \ |
123 | } while(0) |
124 | |
125 | /* Always end in a wildcard, for future extension */ |
126 | static inline void add_wildcard(char *str) |
127 | { |
128 | int len = strlen(str); |
129 | |
130 | if (str[len - 1] != '*') |
131 | strcat(str + len, "*"); |
132 | } |
133 | |
134 | /** |
135 | * Check that sizeof(device_id type) are consistent with size of section |
136 | * in .o file. If in-consistent then userspace and kernel does not agree |
137 | * on actual size which is a bug. |
138 | * Also verify that the final entry in the table is all zeros. |
139 | * Ignore both checks if build host differ from target host and size differs. |
140 | **/ |
141 | static void device_id_check(const char *modname, const char *device_id, |
142 | unsigned long size, unsigned long id_size, |
143 | void *symval) |
144 | { |
145 | int i; |
146 | |
147 | if (size % id_size || size < id_size) { |
148 | fatal("%s: sizeof(struct %s_device_id)=%lu is not a modulo " |
149 | "of the size of " |
150 | "section __mod_%s__<identifier>_device_table=%lu.\n" |
151 | "Fix definition of struct %s_device_id " |
152 | "in mod_devicetable.h\n", |
153 | modname, device_id, id_size, device_id, size, device_id); |
154 | } |
155 | /* Verify last one is a terminator */ |
156 | for (i = 0; i < id_size; i++ ) { |
157 | if (*(uint8_t*)(symval+size-id_size+i)) { |
158 | fprintf(stderr,"%s: struct %s_device_id is %lu bytes. " |
159 | "The last of %lu is:\n", |
160 | modname, device_id, id_size, size / id_size); |
161 | for (i = 0; i < id_size; i++ ) |
162 | fprintf(stderr,"0x%02x ", |
163 | *(uint8_t*)(symval+size-id_size+i) ); |
164 | fprintf(stderr,"\n"); |
165 | fatal("%s: struct %s_device_id is not terminated " |
166 | "with a NULL entry!\n", modname, device_id); |
167 | } |
168 | } |
169 | } |
170 | |
171 | /* USB is special because the bcdDevice can be matched against a numeric range */ |
172 | /* Looks like "usb:vNpNdNdcNdscNdpNicNiscNipNinN" */ |
173 | static void do_usb_entry(void *symval, |
174 | unsigned int bcdDevice_initial, int bcdDevice_initial_digits, |
175 | unsigned char range_lo, unsigned char range_hi, |
176 | unsigned char max, struct module *mod) |
177 | { |
178 | char alias[500]; |
179 | DEF_FIELD(symval, usb_device_id, match_flags); |
180 | DEF_FIELD(symval, usb_device_id, idVendor); |
181 | DEF_FIELD(symval, usb_device_id, idProduct); |
182 | DEF_FIELD(symval, usb_device_id, bcdDevice_lo); |
183 | DEF_FIELD(symval, usb_device_id, bDeviceClass); |
184 | DEF_FIELD(symval, usb_device_id, bDeviceSubClass); |
185 | DEF_FIELD(symval, usb_device_id, bDeviceProtocol); |
186 | DEF_FIELD(symval, usb_device_id, bInterfaceClass); |
187 | DEF_FIELD(symval, usb_device_id, bInterfaceSubClass); |
188 | DEF_FIELD(symval, usb_device_id, bInterfaceProtocol); |
189 | DEF_FIELD(symval, usb_device_id, bInterfaceNumber); |
190 | |
191 | strcpy(alias, "usb:"); |
192 | ADD(alias, "v", match_flags&USB_DEVICE_ID_MATCH_VENDOR, |
193 | idVendor); |
194 | ADD(alias, "p", match_flags&USB_DEVICE_ID_MATCH_PRODUCT, |
195 | idProduct); |
196 | |
197 | strcat(alias, "d"); |
198 | if (bcdDevice_initial_digits) |
199 | sprintf(alias + strlen(alias), "%0*X", |
200 | bcdDevice_initial_digits, bcdDevice_initial); |
201 | if (range_lo == range_hi) |
202 | sprintf(alias + strlen(alias), "%X", range_lo); |
203 | else if (range_lo > 0 || range_hi < max) { |
204 | if (range_lo > 0x9 || range_hi < 0xA) |
205 | sprintf(alias + strlen(alias), |
206 | "[%X-%X]", |
207 | range_lo, |
208 | range_hi); |
209 | else { |
210 | sprintf(alias + strlen(alias), |
211 | range_lo < 0x9 ? "[%X-9" : "[%X", |
212 | range_lo); |
213 | sprintf(alias + strlen(alias), |
214 | range_hi > 0xA ? "A-%X]" : "%X]", |
215 | range_hi); |
216 | } |
217 | } |
218 | if (bcdDevice_initial_digits < (sizeof(bcdDevice_lo) * 2 - 1)) |
219 | strcat(alias, "*"); |
220 | |
221 | ADD(alias, "dc", match_flags&USB_DEVICE_ID_MATCH_DEV_CLASS, |
222 | bDeviceClass); |
223 | ADD(alias, "dsc", match_flags&USB_DEVICE_ID_MATCH_DEV_SUBCLASS, |
224 | bDeviceSubClass); |
225 | ADD(alias, "dp", match_flags&USB_DEVICE_ID_MATCH_DEV_PROTOCOL, |
226 | bDeviceProtocol); |
227 | ADD(alias, "ic", match_flags&USB_DEVICE_ID_MATCH_INT_CLASS, |
228 | bInterfaceClass); |
229 | ADD(alias, "isc", match_flags&USB_DEVICE_ID_MATCH_INT_SUBCLASS, |
230 | bInterfaceSubClass); |
231 | ADD(alias, "ip", match_flags&USB_DEVICE_ID_MATCH_INT_PROTOCOL, |
232 | bInterfaceProtocol); |
233 | ADD(alias, "in", match_flags&USB_DEVICE_ID_MATCH_INT_NUMBER, |
234 | bInterfaceNumber); |
235 | |
236 | add_wildcard(alias); |
237 | buf_printf(&mod->dev_table_buf, |
238 | "MODULE_ALIAS(\"%s\");\n", alias); |
239 | } |
240 | |
241 | /* Handles increment/decrement of BCD formatted integers */ |
242 | /* Returns the previous value, so it works like i++ or i-- */ |
243 | static unsigned int incbcd(unsigned int *bcd, |
244 | int inc, |
245 | unsigned char max, |
246 | size_t chars) |
247 | { |
248 | unsigned int init = *bcd, i, j; |
249 | unsigned long long c, dec = 0; |
250 | |
251 | /* If bcd is not in BCD format, just increment */ |
252 | if (max > 0x9) { |
253 | *bcd += inc; |
254 | return init; |
255 | } |
256 | |
257 | /* Convert BCD to Decimal */ |
258 | for (i=0 ; i < chars ; i++) { |
259 | c = (*bcd >> (i << 2)) & 0xf; |
260 | c = c > 9 ? 9 : c; /* force to bcd just in case */ |
261 | for (j=0 ; j < i ; j++) |
262 | c = c * 10; |
263 | dec += c; |
264 | } |
265 | |
266 | /* Do our increment/decrement */ |
267 | dec += inc; |
268 | *bcd = 0; |
269 | |
270 | /* Convert back to BCD */ |
271 | for (i=0 ; i < chars ; i++) { |
272 | for (c=1,j=0 ; j < i ; j++) |
273 | c = c * 10; |
274 | c = (dec / c) % 10; |
275 | *bcd += c << (i << 2); |
276 | } |
277 | return init; |
278 | } |
279 | |
280 | static void do_usb_entry_multi(void *symval, struct module *mod) |
281 | { |
282 | unsigned int devlo, devhi; |
283 | unsigned char chi, clo, max; |
284 | int ndigits; |
285 | |
286 | DEF_FIELD(symval, usb_device_id, match_flags); |
287 | DEF_FIELD(symval, usb_device_id, idVendor); |
288 | DEF_FIELD(symval, usb_device_id, idProduct); |
289 | DEF_FIELD(symval, usb_device_id, bcdDevice_lo); |
290 | DEF_FIELD(symval, usb_device_id, bcdDevice_hi); |
291 | DEF_FIELD(symval, usb_device_id, bDeviceClass); |
292 | DEF_FIELD(symval, usb_device_id, bInterfaceClass); |
293 | |
294 | devlo = match_flags & USB_DEVICE_ID_MATCH_DEV_LO ? |
295 | bcdDevice_lo : 0x0U; |
296 | devhi = match_flags & USB_DEVICE_ID_MATCH_DEV_HI ? |
297 | bcdDevice_hi : ~0x0U; |
298 | |
299 | /* Figure out if this entry is in bcd or hex format */ |
300 | max = 0x9; /* Default to decimal format */ |
301 | for (ndigits = 0 ; ndigits < sizeof(bcdDevice_lo) * 2 ; ndigits++) { |
302 | clo = (devlo >> (ndigits << 2)) & 0xf; |
303 | chi = ((devhi > 0x9999 ? 0x9999 : devhi) >> (ndigits << 2)) & 0xf; |
304 | if (clo > max || chi > max) { |
305 | max = 0xf; |
306 | break; |
307 | } |
308 | } |
309 | |
310 | /* |
311 | * Some modules (visor) have empty slots as placeholder for |
312 | * run-time specification that results in catch-all alias |
313 | */ |
314 | if (!(idVendor | idProduct | bDeviceClass | bInterfaceClass)) |
315 | return; |
316 | |
317 | /* Convert numeric bcdDevice range into fnmatch-able pattern(s) */ |
318 | for (ndigits = sizeof(bcdDevice_lo) * 2 - 1; devlo <= devhi; ndigits--) { |
319 | clo = devlo & 0xf; |
320 | chi = devhi & 0xf; |
321 | if (chi > max) /* If we are in bcd mode, truncate if necessary */ |
322 | chi = max; |
323 | devlo >>= 4; |
324 | devhi >>= 4; |
325 | |
326 | if (devlo == devhi || !ndigits) { |
327 | do_usb_entry(symval, devlo, ndigits, clo, chi, max, mod); |
328 | break; |
329 | } |
330 | |
331 | if (clo > 0x0) |
332 | do_usb_entry(symval, |
333 | incbcd(&devlo, 1, max, |
334 | sizeof(bcdDevice_lo) * 2), |
335 | ndigits, clo, max, max, mod); |
336 | |
337 | if (chi < max) |
338 | do_usb_entry(symval, |
339 | incbcd(&devhi, -1, max, |
340 | sizeof(bcdDevice_lo) * 2), |
341 | ndigits, 0x0, chi, max, mod); |
342 | } |
343 | } |
344 | |
345 | static void do_usb_table(void *symval, unsigned long size, |
346 | struct module *mod) |
347 | { |
348 | unsigned int i; |
349 | const unsigned long id_size = SIZE_usb_device_id; |
350 | |
351 | device_id_check(mod->name, "usb", size, id_size, symval); |
352 | |
353 | /* Leave last one: it's the terminator. */ |
354 | size -= id_size; |
355 | |
356 | for (i = 0; i < size; i += id_size) |
357 | do_usb_entry_multi(symval + i, mod); |
358 | } |
359 | |
360 | /* Looks like: hid:bNvNpN */ |
361 | static int do_hid_entry(const char *filename, |
362 | void *symval, char *alias) |
363 | { |
364 | DEF_FIELD(symval, hid_device_id, bus); |
365 | DEF_FIELD(symval, hid_device_id, group); |
366 | DEF_FIELD(symval, hid_device_id, vendor); |
367 | DEF_FIELD(symval, hid_device_id, product); |
368 | |
369 | sprintf(alias, "hid:"); |
370 | ADD(alias, "b", bus != HID_BUS_ANY, bus); |
371 | ADD(alias, "g", group != HID_GROUP_ANY, group); |
372 | ADD(alias, "v", vendor != HID_ANY_ID, vendor); |
373 | ADD(alias, "p", product != HID_ANY_ID, product); |
374 | |
375 | return 1; |
376 | } |
377 | ADD_TO_DEVTABLE("hid", hid_device_id, do_hid_entry); |
378 | |
379 | /* Looks like: ieee1394:venNmoNspNverN */ |
380 | static int do_ieee1394_entry(const char *filename, |
381 | void *symval, char *alias) |
382 | { |
383 | DEF_FIELD(symval, ieee1394_device_id, match_flags); |
384 | DEF_FIELD(symval, ieee1394_device_id, vendor_id); |
385 | DEF_FIELD(symval, ieee1394_device_id, model_id); |
386 | DEF_FIELD(symval, ieee1394_device_id, specifier_id); |
387 | DEF_FIELD(symval, ieee1394_device_id, version); |
388 | |
389 | strcpy(alias, "ieee1394:"); |
390 | ADD(alias, "ven", match_flags & IEEE1394_MATCH_VENDOR_ID, |
391 | vendor_id); |
392 | ADD(alias, "mo", match_flags & IEEE1394_MATCH_MODEL_ID, |
393 | model_id); |
394 | ADD(alias, "sp", match_flags & IEEE1394_MATCH_SPECIFIER_ID, |
395 | specifier_id); |
396 | ADD(alias, "ver", match_flags & IEEE1394_MATCH_VERSION, |
397 | version); |
398 | |
399 | add_wildcard(alias); |
400 | return 1; |
401 | } |
402 | ADD_TO_DEVTABLE("ieee1394", ieee1394_device_id, do_ieee1394_entry); |
403 | |
404 | /* Looks like: pci:vNdNsvNsdNbcNscNiN. */ |
405 | static int do_pci_entry(const char *filename, |
406 | void *symval, char *alias) |
407 | { |
408 | /* Class field can be divided into these three. */ |
409 | unsigned char baseclass, subclass, interface, |
410 | baseclass_mask, subclass_mask, interface_mask; |
411 | |
412 | DEF_FIELD(symval, pci_device_id, vendor); |
413 | DEF_FIELD(symval, pci_device_id, device); |
414 | DEF_FIELD(symval, pci_device_id, subvendor); |
415 | DEF_FIELD(symval, pci_device_id, subdevice); |
416 | DEF_FIELD(symval, pci_device_id, class); |
417 | DEF_FIELD(symval, pci_device_id, class_mask); |
418 | |
419 | strcpy(alias, "pci:"); |
420 | ADD(alias, "v", vendor != PCI_ANY_ID, vendor); |
421 | ADD(alias, "d", device != PCI_ANY_ID, device); |
422 | ADD(alias, "sv", subvendor != PCI_ANY_ID, subvendor); |
423 | ADD(alias, "sd", subdevice != PCI_ANY_ID, subdevice); |
424 | |
425 | baseclass = (class) >> 16; |
426 | baseclass_mask = (class_mask) >> 16; |
427 | subclass = (class) >> 8; |
428 | subclass_mask = (class_mask) >> 8; |
429 | interface = class; |
430 | interface_mask = class_mask; |
431 | |
432 | if ((baseclass_mask != 0 && baseclass_mask != 0xFF) |
433 | || (subclass_mask != 0 && subclass_mask != 0xFF) |
434 | || (interface_mask != 0 && interface_mask != 0xFF)) { |
435 | warn("Can't handle masks in %s:%04X\n", |
436 | filename, class_mask); |
437 | return 0; |
438 | } |
439 | |
440 | ADD(alias, "bc", baseclass_mask == 0xFF, baseclass); |
441 | ADD(alias, "sc", subclass_mask == 0xFF, subclass); |
442 | ADD(alias, "i", interface_mask == 0xFF, interface); |
443 | add_wildcard(alias); |
444 | return 1; |
445 | } |
446 | ADD_TO_DEVTABLE("pci", pci_device_id, do_pci_entry); |
447 | |
448 | /* looks like: "ccw:tNmNdtNdmN" */ |
449 | static int do_ccw_entry(const char *filename, |
450 | void *symval, char *alias) |
451 | { |
452 | DEF_FIELD(symval, ccw_device_id, match_flags); |
453 | DEF_FIELD(symval, ccw_device_id, cu_type); |
454 | DEF_FIELD(symval, ccw_device_id, cu_model); |
455 | DEF_FIELD(symval, ccw_device_id, dev_type); |
456 | DEF_FIELD(symval, ccw_device_id, dev_model); |
457 | |
458 | strcpy(alias, "ccw:"); |
459 | ADD(alias, "t", match_flags&CCW_DEVICE_ID_MATCH_CU_TYPE, |
460 | cu_type); |
461 | ADD(alias, "m", match_flags&CCW_DEVICE_ID_MATCH_CU_MODEL, |
462 | cu_model); |
463 | ADD(alias, "dt", match_flags&CCW_DEVICE_ID_MATCH_DEVICE_TYPE, |
464 | dev_type); |
465 | ADD(alias, "dm", match_flags&CCW_DEVICE_ID_MATCH_DEVICE_MODEL, |
466 | dev_model); |
467 | add_wildcard(alias); |
468 | return 1; |
469 | } |
470 | ADD_TO_DEVTABLE("ccw", ccw_device_id, do_ccw_entry); |
471 | |
472 | /* looks like: "ap:tN" */ |
473 | static int do_ap_entry(const char *filename, |
474 | void *symval, char *alias) |
475 | { |
476 | DEF_FIELD(symval, ap_device_id, dev_type); |
477 | |
478 | sprintf(alias, "ap:t%02X*", dev_type); |
479 | return 1; |
480 | } |
481 | ADD_TO_DEVTABLE("ap", ap_device_id, do_ap_entry); |
482 | |
483 | /* looks like: "css:tN" */ |
484 | static int do_css_entry(const char *filename, |
485 | void *symval, char *alias) |
486 | { |
487 | DEF_FIELD(symval, css_device_id, type); |
488 | |
489 | sprintf(alias, "css:t%01X", type); |
490 | return 1; |
491 | } |
492 | ADD_TO_DEVTABLE("css", css_device_id, do_css_entry); |
493 | |
494 | /* Looks like: "serio:tyNprNidNexN" */ |
495 | static int do_serio_entry(const char *filename, |
496 | void *symval, char *alias) |
497 | { |
498 | DEF_FIELD(symval, serio_device_id, type); |
499 | DEF_FIELD(symval, serio_device_id, proto); |
500 | DEF_FIELD(symval, serio_device_id, id); |
501 | DEF_FIELD(symval, serio_device_id, extra); |
502 | |
503 | strcpy(alias, "serio:"); |
504 | ADD(alias, "ty", type != SERIO_ANY, type); |
505 | ADD(alias, "pr", proto != SERIO_ANY, proto); |
506 | ADD(alias, "id", id != SERIO_ANY, id); |
507 | ADD(alias, "ex", extra != SERIO_ANY, extra); |
508 | |
509 | add_wildcard(alias); |
510 | return 1; |
511 | } |
512 | ADD_TO_DEVTABLE("serio", serio_device_id, do_serio_entry); |
513 | |
514 | /* looks like: "acpi:ACPI0003 or acpi:PNP0C0B" or "acpi:LNXVIDEO" */ |
515 | static int do_acpi_entry(const char *filename, |
516 | void *symval, char *alias) |
517 | { |
518 | DEF_FIELD_ADDR(symval, acpi_device_id, id); |
519 | sprintf(alias, "acpi*:%s:*", *id); |
520 | return 1; |
521 | } |
522 | ADD_TO_DEVTABLE("acpi", acpi_device_id, do_acpi_entry); |
523 | |
524 | /* looks like: "pnp:dD" */ |
525 | static void do_pnp_device_entry(void *symval, unsigned long size, |
526 | struct module *mod) |
527 | { |
528 | const unsigned long id_size = SIZE_pnp_device_id; |
529 | const unsigned int count = (size / id_size)-1; |
530 | unsigned int i; |
531 | |
532 | device_id_check(mod->name, "pnp", size, id_size, symval); |
533 | |
534 | for (i = 0; i < count; i++) { |
535 | DEF_FIELD_ADDR(symval + i*id_size, pnp_device_id, id); |
536 | char acpi_id[sizeof(*id)]; |
537 | int j; |
538 | |
539 | buf_printf(&mod->dev_table_buf, |
540 | "MODULE_ALIAS(\"pnp:d%s*\");\n", *id); |
541 | |
542 | /* fix broken pnp bus lowercasing */ |
543 | for (j = 0; j < sizeof(acpi_id); j++) |
544 | acpi_id[j] = toupper((*id)[j]); |
545 | buf_printf(&mod->dev_table_buf, |
546 | "MODULE_ALIAS(\"acpi*:%s:*\");\n", acpi_id); |
547 | } |
548 | } |
549 | |
550 | /* looks like: "pnp:dD" for every device of the card */ |
551 | static void do_pnp_card_entries(void *symval, unsigned long size, |
552 | struct module *mod) |
553 | { |
554 | const unsigned long id_size = SIZE_pnp_card_device_id; |
555 | const unsigned int count = (size / id_size)-1; |
556 | unsigned int i; |
557 | |
558 | device_id_check(mod->name, "pnp", size, id_size, symval); |
559 | |
560 | for (i = 0; i < count; i++) { |
561 | unsigned int j; |
562 | DEF_FIELD_ADDR(symval + i*id_size, pnp_card_device_id, devs); |
563 | |
564 | for (j = 0; j < PNP_MAX_DEVICES; j++) { |
565 | const char *id = (char *)(*devs)[j].id; |
566 | int i2, j2; |
567 | int dup = 0; |
568 | |
569 | if (!id[0]) |
570 | break; |
571 | |
572 | /* find duplicate, already added value */ |
573 | for (i2 = 0; i2 < i && !dup; i2++) { |
574 | DEF_FIELD_ADDR(symval + i2*id_size, pnp_card_device_id, devs); |
575 | |
576 | for (j2 = 0; j2 < PNP_MAX_DEVICES; j2++) { |
577 | const char *id2 = (char *)(*devs)[j2].id; |
578 | |
579 | if (!id2[0]) |
580 | break; |
581 | |
582 | if (!strcmp(id, id2)) { |
583 | dup = 1; |
584 | break; |
585 | } |
586 | } |
587 | } |
588 | |
589 | /* add an individual alias for every device entry */ |
590 | if (!dup) { |
591 | char acpi_id[PNP_ID_LEN]; |
592 | int k; |
593 | |
594 | buf_printf(&mod->dev_table_buf, |
595 | "MODULE_ALIAS(\"pnp:d%s*\");\n", id); |
596 | |
597 | /* fix broken pnp bus lowercasing */ |
598 | for (k = 0; k < sizeof(acpi_id); k++) |
599 | acpi_id[k] = toupper(id[k]); |
600 | buf_printf(&mod->dev_table_buf, |
601 | "MODULE_ALIAS(\"acpi*:%s:*\");\n", acpi_id); |
602 | } |
603 | } |
604 | } |
605 | } |
606 | |
607 | /* Looks like: pcmcia:mNcNfNfnNpfnNvaNvbNvcNvdN. */ |
608 | static int do_pcmcia_entry(const char *filename, |
609 | void *symval, char *alias) |
610 | { |
611 | unsigned int i; |
612 | DEF_FIELD(symval, pcmcia_device_id, match_flags); |
613 | DEF_FIELD(symval, pcmcia_device_id, manf_id); |
614 | DEF_FIELD(symval, pcmcia_device_id, card_id); |
615 | DEF_FIELD(symval, pcmcia_device_id, func_id); |
616 | DEF_FIELD(symval, pcmcia_device_id, function); |
617 | DEF_FIELD(symval, pcmcia_device_id, device_no); |
618 | DEF_FIELD_ADDR(symval, pcmcia_device_id, prod_id_hash); |
619 | |
620 | for (i=0; i<4; i++) { |
621 | (*prod_id_hash)[i] = TO_NATIVE((*prod_id_hash)[i]); |
622 | } |
623 | |
624 | strcpy(alias, "pcmcia:"); |
625 | ADD(alias, "m", match_flags & PCMCIA_DEV_ID_MATCH_MANF_ID, |
626 | manf_id); |
627 | ADD(alias, "c", match_flags & PCMCIA_DEV_ID_MATCH_CARD_ID, |
628 | card_id); |
629 | ADD(alias, "f", match_flags & PCMCIA_DEV_ID_MATCH_FUNC_ID, |
630 | func_id); |
631 | ADD(alias, "fn", match_flags & PCMCIA_DEV_ID_MATCH_FUNCTION, |
632 | function); |
633 | ADD(alias, "pfn", match_flags & PCMCIA_DEV_ID_MATCH_DEVICE_NO, |
634 | device_no); |
635 | ADD(alias, "pa", match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID1, (*prod_id_hash)[0]); |
636 | ADD(alias, "pb", match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID2, (*prod_id_hash)[1]); |
637 | ADD(alias, "pc", match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID3, (*prod_id_hash)[2]); |
638 | ADD(alias, "pd", match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID4, (*prod_id_hash)[3]); |
639 | |
640 | add_wildcard(alias); |
641 | return 1; |
642 | } |
643 | ADD_TO_DEVTABLE("pcmcia", pcmcia_device_id, do_pcmcia_entry); |
644 | |
645 | static int do_of_entry (const char *filename, void *symval, char *alias) |
646 | { |
647 | int len; |
648 | char *tmp; |
649 | DEF_FIELD_ADDR(symval, of_device_id, name); |
650 | DEF_FIELD_ADDR(symval, of_device_id, type); |
651 | DEF_FIELD_ADDR(symval, of_device_id, compatible); |
652 | |
653 | len = sprintf(alias, "of:N%sT%s", (*name)[0] ? *name : "*", |
654 | (*type)[0] ? *type : "*"); |
655 | |
656 | if (compatible[0]) |
657 | sprintf(&alias[len], "%sC%s", (*type)[0] ? "*" : "", |
658 | *compatible); |
659 | |
660 | /* Replace all whitespace with underscores */ |
661 | for (tmp = alias; tmp && *tmp; tmp++) |
662 | if (isspace (*tmp)) |
663 | *tmp = '_'; |
664 | |
665 | add_wildcard(alias); |
666 | return 1; |
667 | } |
668 | ADD_TO_DEVTABLE("of", of_device_id, do_of_entry); |
669 | |
670 | static int do_vio_entry(const char *filename, void *symval, |
671 | char *alias) |
672 | { |
673 | char *tmp; |
674 | DEF_FIELD_ADDR(symval, vio_device_id, type); |
675 | DEF_FIELD_ADDR(symval, vio_device_id, compat); |
676 | |
677 | sprintf(alias, "vio:T%sS%s", (*type)[0] ? *type : "*", |
678 | (*compat)[0] ? *compat : "*"); |
679 | |
680 | /* Replace all whitespace with underscores */ |
681 | for (tmp = alias; tmp && *tmp; tmp++) |
682 | if (isspace (*tmp)) |
683 | *tmp = '_'; |
684 | |
685 | add_wildcard(alias); |
686 | return 1; |
687 | } |
688 | ADD_TO_DEVTABLE("vio", vio_device_id, do_vio_entry); |
689 | |
690 | #define ARRAY_SIZE(x) (sizeof(x) / sizeof((x)[0])) |
691 | |
692 | static void do_input(char *alias, |
693 | kernel_ulong_t *arr, unsigned int min, unsigned int max) |
694 | { |
695 | unsigned int i; |
696 | |
697 | for (i = min / BITS_PER_LONG; i < max / BITS_PER_LONG + 1; i++) |
698 | arr[i] = TO_NATIVE(arr[i]); |
699 | for (i = min; i < max; i++) |
700 | if (arr[i / BITS_PER_LONG] & (1L << (i%BITS_PER_LONG))) |
701 | sprintf(alias + strlen(alias), "%X,*", i); |
702 | } |
703 | |
704 | /* input:b0v0p0e0-eXkXrXaXmXlXsXfXwX where X is comma-separated %02X. */ |
705 | static int do_input_entry(const char *filename, void *symval, |
706 | char *alias) |
707 | { |
708 | DEF_FIELD(symval, input_device_id, flags); |
709 | DEF_FIELD(symval, input_device_id, bustype); |
710 | DEF_FIELD(symval, input_device_id, vendor); |
711 | DEF_FIELD(symval, input_device_id, product); |
712 | DEF_FIELD(symval, input_device_id, version); |
713 | DEF_FIELD_ADDR(symval, input_device_id, evbit); |
714 | DEF_FIELD_ADDR(symval, input_device_id, keybit); |
715 | DEF_FIELD_ADDR(symval, input_device_id, relbit); |
716 | DEF_FIELD_ADDR(symval, input_device_id, absbit); |
717 | DEF_FIELD_ADDR(symval, input_device_id, mscbit); |
718 | DEF_FIELD_ADDR(symval, input_device_id, ledbit); |
719 | DEF_FIELD_ADDR(symval, input_device_id, sndbit); |
720 | DEF_FIELD_ADDR(symval, input_device_id, ffbit); |
721 | DEF_FIELD_ADDR(symval, input_device_id, swbit); |
722 | |
723 | sprintf(alias, "input:"); |
724 | |
725 | ADD(alias, "b", flags & INPUT_DEVICE_ID_MATCH_BUS, bustype); |
726 | ADD(alias, "v", flags & INPUT_DEVICE_ID_MATCH_VENDOR, vendor); |
727 | ADD(alias, "p", flags & INPUT_DEVICE_ID_MATCH_PRODUCT, product); |
728 | ADD(alias, "e", flags & INPUT_DEVICE_ID_MATCH_VERSION, version); |
729 | |
730 | sprintf(alias + strlen(alias), "-e*"); |
731 | if (flags & INPUT_DEVICE_ID_MATCH_EVBIT) |
732 | do_input(alias, *evbit, 0, INPUT_DEVICE_ID_EV_MAX); |
733 | sprintf(alias + strlen(alias), "k*"); |
734 | if (flags & INPUT_DEVICE_ID_MATCH_KEYBIT) |
735 | do_input(alias, *keybit, |
736 | INPUT_DEVICE_ID_KEY_MIN_INTERESTING, |
737 | INPUT_DEVICE_ID_KEY_MAX); |
738 | sprintf(alias + strlen(alias), "r*"); |
739 | if (flags & INPUT_DEVICE_ID_MATCH_RELBIT) |
740 | do_input(alias, *relbit, 0, INPUT_DEVICE_ID_REL_MAX); |
741 | sprintf(alias + strlen(alias), "a*"); |
742 | if (flags & INPUT_DEVICE_ID_MATCH_ABSBIT) |
743 | do_input(alias, *absbit, 0, INPUT_DEVICE_ID_ABS_MAX); |
744 | sprintf(alias + strlen(alias), "m*"); |
745 | if (flags & INPUT_DEVICE_ID_MATCH_MSCIT) |
746 | do_input(alias, *mscbit, 0, INPUT_DEVICE_ID_MSC_MAX); |
747 | sprintf(alias + strlen(alias), "l*"); |
748 | if (flags & INPUT_DEVICE_ID_MATCH_LEDBIT) |
749 | do_input(alias, *ledbit, 0, INPUT_DEVICE_ID_LED_MAX); |
750 | sprintf(alias + strlen(alias), "s*"); |
751 | if (flags & INPUT_DEVICE_ID_MATCH_SNDBIT) |
752 | do_input(alias, *sndbit, 0, INPUT_DEVICE_ID_SND_MAX); |
753 | sprintf(alias + strlen(alias), "f*"); |
754 | if (flags & INPUT_DEVICE_ID_MATCH_FFBIT) |
755 | do_input(alias, *ffbit, 0, INPUT_DEVICE_ID_FF_MAX); |
756 | sprintf(alias + strlen(alias), "w*"); |
757 | if (flags & INPUT_DEVICE_ID_MATCH_SWBIT) |
758 | do_input(alias, *swbit, 0, INPUT_DEVICE_ID_SW_MAX); |
759 | return 1; |
760 | } |
761 | ADD_TO_DEVTABLE("input", input_device_id, do_input_entry); |
762 | |
763 | static int do_eisa_entry(const char *filename, void *symval, |
764 | char *alias) |
765 | { |
766 | DEF_FIELD_ADDR(symval, eisa_device_id, sig); |
767 | if (sig[0]) |
768 | sprintf(alias, EISA_DEVICE_MODALIAS_FMT "*", *sig); |
769 | else |
770 | strcat(alias, "*"); |
771 | return 1; |
772 | } |
773 | ADD_TO_DEVTABLE("eisa", eisa_device_id, do_eisa_entry); |
774 | |
775 | /* Looks like: parisc:tNhvNrevNsvN */ |
776 | static int do_parisc_entry(const char *filename, void *symval, |
777 | char *alias) |
778 | { |
779 | DEF_FIELD(symval, parisc_device_id, hw_type); |
780 | DEF_FIELD(symval, parisc_device_id, hversion); |
781 | DEF_FIELD(symval, parisc_device_id, hversion_rev); |
782 | DEF_FIELD(symval, parisc_device_id, sversion); |
783 | |
784 | strcpy(alias, "parisc:"); |
785 | ADD(alias, "t", hw_type != PA_HWTYPE_ANY_ID, hw_type); |
786 | ADD(alias, "hv", hversion != PA_HVERSION_ANY_ID, hversion); |
787 | ADD(alias, "rev", hversion_rev != PA_HVERSION_REV_ANY_ID, hversion_rev); |
788 | ADD(alias, "sv", sversion != PA_SVERSION_ANY_ID, sversion); |
789 | |
790 | add_wildcard(alias); |
791 | return 1; |
792 | } |
793 | ADD_TO_DEVTABLE("parisc", parisc_device_id, do_parisc_entry); |
794 | |
795 | /* Looks like: sdio:cNvNdN. */ |
796 | static int do_sdio_entry(const char *filename, |
797 | void *symval, char *alias) |
798 | { |
799 | DEF_FIELD(symval, sdio_device_id, class); |
800 | DEF_FIELD(symval, sdio_device_id, vendor); |
801 | DEF_FIELD(symval, sdio_device_id, device); |
802 | |
803 | strcpy(alias, "sdio:"); |
804 | ADD(alias, "c", class != (__u8)SDIO_ANY_ID, class); |
805 | ADD(alias, "v", vendor != (__u16)SDIO_ANY_ID, vendor); |
806 | ADD(alias, "d", device != (__u16)SDIO_ANY_ID, device); |
807 | add_wildcard(alias); |
808 | return 1; |
809 | } |
810 | ADD_TO_DEVTABLE("sdio", sdio_device_id, do_sdio_entry); |
811 | |
812 | /* Looks like: ssb:vNidNrevN. */ |
813 | static int do_ssb_entry(const char *filename, |
814 | void *symval, char *alias) |
815 | { |
816 | DEF_FIELD(symval, ssb_device_id, vendor); |
817 | DEF_FIELD(symval, ssb_device_id, coreid); |
818 | DEF_FIELD(symval, ssb_device_id, revision); |
819 | |
820 | strcpy(alias, "ssb:"); |
821 | ADD(alias, "v", vendor != SSB_ANY_VENDOR, vendor); |
822 | ADD(alias, "id", coreid != SSB_ANY_ID, coreid); |
823 | ADD(alias, "rev", revision != SSB_ANY_REV, revision); |
824 | add_wildcard(alias); |
825 | return 1; |
826 | } |
827 | ADD_TO_DEVTABLE("ssb", ssb_device_id, do_ssb_entry); |
828 | |
829 | /* Looks like: bcma:mNidNrevNclN. */ |
830 | static int do_bcma_entry(const char *filename, |
831 | void *symval, char *alias) |
832 | { |
833 | DEF_FIELD(symval, bcma_device_id, manuf); |
834 | DEF_FIELD(symval, bcma_device_id, id); |
835 | DEF_FIELD(symval, bcma_device_id, rev); |
836 | DEF_FIELD(symval, bcma_device_id, class); |
837 | |
838 | strcpy(alias, "bcma:"); |
839 | ADD(alias, "m", manuf != BCMA_ANY_MANUF, manuf); |
840 | ADD(alias, "id", id != BCMA_ANY_ID, id); |
841 | ADD(alias, "rev", rev != BCMA_ANY_REV, rev); |
842 | ADD(alias, "cl", class != BCMA_ANY_CLASS, class); |
843 | add_wildcard(alias); |
844 | return 1; |
845 | } |
846 | ADD_TO_DEVTABLE("bcma", bcma_device_id, do_bcma_entry); |
847 | |
848 | /* Looks like: virtio:dNvN */ |
849 | static int do_virtio_entry(const char *filename, void *symval, |
850 | char *alias) |
851 | { |
852 | DEF_FIELD(symval, virtio_device_id, device); |
853 | DEF_FIELD(symval, virtio_device_id, vendor); |
854 | |
855 | strcpy(alias, "virtio:"); |
856 | ADD(alias, "d", device != VIRTIO_DEV_ANY_ID, device); |
857 | ADD(alias, "v", vendor != VIRTIO_DEV_ANY_ID, vendor); |
858 | |
859 | add_wildcard(alias); |
860 | return 1; |
861 | } |
862 | ADD_TO_DEVTABLE("virtio", virtio_device_id, do_virtio_entry); |
863 | |
864 | /* |
865 | * Looks like: vmbus:guid |
866 | * Each byte of the guid will be represented by two hex characters |
867 | * in the name. |
868 | */ |
869 | |
870 | static int do_vmbus_entry(const char *filename, void *symval, |
871 | char *alias) |
872 | { |
873 | int i; |
874 | DEF_FIELD_ADDR(symval, hv_vmbus_device_id, guid); |
875 | char guid_name[(sizeof(*guid) + 1) * 2]; |
876 | |
877 | for (i = 0; i < (sizeof(*guid) * 2); i += 2) |
878 | sprintf(&guid_name[i], "%02x", TO_NATIVE((*guid)[i/2])); |
879 | |
880 | strcpy(alias, "vmbus:"); |
881 | strcat(alias, guid_name); |
882 | |
883 | return 1; |
884 | } |
885 | ADD_TO_DEVTABLE("vmbus", hv_vmbus_device_id, do_vmbus_entry); |
886 | |
887 | /* Looks like: i2c:S */ |
888 | static int do_i2c_entry(const char *filename, void *symval, |
889 | char *alias) |
890 | { |
891 | DEF_FIELD_ADDR(symval, i2c_device_id, name); |
892 | sprintf(alias, I2C_MODULE_PREFIX "%s", *name); |
893 | |
894 | return 1; |
895 | } |
896 | ADD_TO_DEVTABLE("i2c", i2c_device_id, do_i2c_entry); |
897 | |
898 | /* Looks like: spi:S */ |
899 | static int do_spi_entry(const char *filename, void *symval, |
900 | char *alias) |
901 | { |
902 | DEF_FIELD_ADDR(symval, spi_device_id, name); |
903 | sprintf(alias, SPI_MODULE_PREFIX "%s", *name); |
904 | |
905 | return 1; |
906 | } |
907 | ADD_TO_DEVTABLE("spi", spi_device_id, do_spi_entry); |
908 | |
909 | static const struct dmifield { |
910 | const char *prefix; |
911 | int field; |
912 | } dmi_fields[] = { |
913 | { "bvn", DMI_BIOS_VENDOR }, |
914 | { "bvr", DMI_BIOS_VERSION }, |
915 | { "bd", DMI_BIOS_DATE }, |
916 | { "svn", DMI_SYS_VENDOR }, |
917 | { "pn", DMI_PRODUCT_NAME }, |
918 | { "pvr", DMI_PRODUCT_VERSION }, |
919 | { "rvn", DMI_BOARD_VENDOR }, |
920 | { "rn", DMI_BOARD_NAME }, |
921 | { "rvr", DMI_BOARD_VERSION }, |
922 | { "cvn", DMI_CHASSIS_VENDOR }, |
923 | { "ct", DMI_CHASSIS_TYPE }, |
924 | { "cvr", DMI_CHASSIS_VERSION }, |
925 | { NULL, DMI_NONE } |
926 | }; |
927 | |
928 | static void dmi_ascii_filter(char *d, const char *s) |
929 | { |
930 | /* Filter out characters we don't want to see in the modalias string */ |
931 | for (; *s; s++) |
932 | if (*s > ' ' && *s < 127 && *s != ':') |
933 | *(d++) = *s; |
934 | |
935 | *d = 0; |
936 | } |
937 | |
938 | |
939 | static int do_dmi_entry(const char *filename, void *symval, |
940 | char *alias) |
941 | { |
942 | int i, j; |
943 | DEF_FIELD_ADDR(symval, dmi_system_id, matches); |
944 | sprintf(alias, "dmi*"); |
945 | |
946 | for (i = 0; i < ARRAY_SIZE(dmi_fields); i++) { |
947 | for (j = 0; j < 4; j++) { |
948 | if ((*matches)[j].slot && |
949 | (*matches)[j].slot == dmi_fields[i].field) { |
950 | sprintf(alias + strlen(alias), ":%s*", |
951 | dmi_fields[i].prefix); |
952 | dmi_ascii_filter(alias + strlen(alias), |
953 | (*matches)[j].substr); |
954 | strcat(alias, "*"); |
955 | } |
956 | } |
957 | } |
958 | |
959 | strcat(alias, ":"); |
960 | return 1; |
961 | } |
962 | ADD_TO_DEVTABLE("dmi", dmi_system_id, do_dmi_entry); |
963 | |
964 | static int do_platform_entry(const char *filename, |
965 | void *symval, char *alias) |
966 | { |
967 | DEF_FIELD_ADDR(symval, platform_device_id, name); |
968 | sprintf(alias, PLATFORM_MODULE_PREFIX "%s", *name); |
969 | return 1; |
970 | } |
971 | ADD_TO_DEVTABLE("platform", platform_device_id, do_platform_entry); |
972 | |
973 | static int do_mdio_entry(const char *filename, |
974 | void *symval, char *alias) |
975 | { |
976 | int i; |
977 | DEF_FIELD(symval, mdio_device_id, phy_id); |
978 | DEF_FIELD(symval, mdio_device_id, phy_id_mask); |
979 | |
980 | alias += sprintf(alias, MDIO_MODULE_PREFIX); |
981 | |
982 | for (i = 0; i < 32; i++) { |
983 | if (!((phy_id_mask >> (31-i)) & 1)) |
984 | *(alias++) = '?'; |
985 | else if ((phy_id >> (31-i)) & 1) |
986 | *(alias++) = '1'; |
987 | else |
988 | *(alias++) = '0'; |
989 | } |
990 | |
991 | /* Terminate the string */ |
992 | *alias = 0; |
993 | |
994 | return 1; |
995 | } |
996 | ADD_TO_DEVTABLE("mdio", mdio_device_id, do_mdio_entry); |
997 | |
998 | /* Looks like: zorro:iN. */ |
999 | static int do_zorro_entry(const char *filename, void *symval, |
1000 | char *alias) |
1001 | { |
1002 | DEF_FIELD(symval, zorro_device_id, id); |
1003 | strcpy(alias, "zorro:"); |
1004 | ADD(alias, "i", id != ZORRO_WILDCARD, id); |
1005 | return 1; |
1006 | } |
1007 | ADD_TO_DEVTABLE("zorro", zorro_device_id, do_zorro_entry); |
1008 | |
1009 | /* looks like: "pnp:dD" */ |
1010 | static int do_isapnp_entry(const char *filename, |
1011 | void *symval, char *alias) |
1012 | { |
1013 | DEF_FIELD(symval, isapnp_device_id, vendor); |
1014 | DEF_FIELD(symval, isapnp_device_id, function); |
1015 | sprintf(alias, "pnp:d%c%c%c%x%x%x%x*", |
1016 | 'A' + ((vendor >> 2) & 0x3f) - 1, |
1017 | 'A' + (((vendor & 3) << 3) | ((vendor >> 13) & 7)) - 1, |
1018 | 'A' + ((vendor >> 8) & 0x1f) - 1, |
1019 | (function >> 4) & 0x0f, function & 0x0f, |
1020 | (function >> 12) & 0x0f, (function >> 8) & 0x0f); |
1021 | return 1; |
1022 | } |
1023 | ADD_TO_DEVTABLE("isapnp", isapnp_device_id, do_isapnp_entry); |
1024 | |
1025 | /* Looks like: "ipack:fNvNdN". */ |
1026 | static int do_ipack_entry(const char *filename, |
1027 | void *symval, char *alias) |
1028 | { |
1029 | DEF_FIELD(symval, ipack_device_id, format); |
1030 | DEF_FIELD(symval, ipack_device_id, vendor); |
1031 | DEF_FIELD(symval, ipack_device_id, device); |
1032 | strcpy(alias, "ipack:"); |
1033 | ADD(alias, "f", format != IPACK_ANY_FORMAT, format); |
1034 | ADD(alias, "v", vendor != IPACK_ANY_ID, vendor); |
1035 | ADD(alias, "d", device != IPACK_ANY_ID, device); |
1036 | add_wildcard(alias); |
1037 | return 1; |
1038 | } |
1039 | ADD_TO_DEVTABLE("ipack", ipack_device_id, do_ipack_entry); |
1040 | |
1041 | /* |
1042 | * Append a match expression for a single masked hex digit. |
1043 | * outp points to a pointer to the character at which to append. |
1044 | * *outp is updated on return to point just after the appended text, |
1045 | * to facilitate further appending. |
1046 | */ |
1047 | static void append_nibble_mask(char **outp, |
1048 | unsigned int nibble, unsigned int mask) |
1049 | { |
1050 | char *p = *outp; |
1051 | unsigned int i; |
1052 | |
1053 | switch (mask) { |
1054 | case 0: |
1055 | *p++ = '?'; |
1056 | break; |
1057 | |
1058 | case 0xf: |
1059 | p += sprintf(p, "%X", nibble); |
1060 | break; |
1061 | |
1062 | default: |
1063 | /* |
1064 | * Dumbly emit a match pattern for all possible matching |
1065 | * digits. This could be improved in some cases using ranges, |
1066 | * but it has the advantage of being trivially correct, and is |
1067 | * often optimal. |
1068 | */ |
1069 | *p++ = '['; |
1070 | for (i = 0; i < 0x10; i++) |
1071 | if ((i & mask) == nibble) |
1072 | p += sprintf(p, "%X", i); |
1073 | *p++ = ']'; |
1074 | } |
1075 | |
1076 | /* Ensure that the string remains NUL-terminated: */ |
1077 | *p = '\0'; |
1078 | |
1079 | /* Advance the caller's end-of-string pointer: */ |
1080 | *outp = p; |
1081 | } |
1082 | |
1083 | /* |
1084 | * looks like: "amba:dN" |
1085 | * |
1086 | * N is exactly 8 digits, where each is an upper-case hex digit, or |
1087 | * a ? or [] pattern matching exactly one digit. |
1088 | */ |
1089 | static int do_amba_entry(const char *filename, |
1090 | void *symval, char *alias) |
1091 | { |
1092 | unsigned int digit; |
1093 | char *p = alias; |
1094 | DEF_FIELD(symval, amba_id, id); |
1095 | DEF_FIELD(symval, amba_id, mask); |
1096 | |
1097 | if ((id & mask) != id) |
1098 | fatal("%s: Masked-off bit(s) of AMBA device ID are non-zero: " |
1099 | "id=0x%08X, mask=0x%08X. Please fix this driver.\n", |
1100 | filename, id, mask); |
1101 | |
1102 | p += sprintf(alias, "amba:d"); |
1103 | for (digit = 0; digit < 8; digit++) |
1104 | append_nibble_mask(&p, |
1105 | (id >> (4 * (7 - digit))) & 0xf, |
1106 | (mask >> (4 * (7 - digit))) & 0xf); |
1107 | |
1108 | return 1; |
1109 | } |
1110 | ADD_TO_DEVTABLE("amba", amba_id, do_amba_entry); |
1111 | |
1112 | /* LOOKS like cpu:type:x86,venVVVVfamFFFFmodMMMM:feature:*,FEAT,* |
1113 | * All fields are numbers. It would be nicer to use strings for vendor |
1114 | * and feature, but getting those out of the build system here is too |
1115 | * complicated. |
1116 | */ |
1117 | |
1118 | static int do_x86cpu_entry(const char *filename, void *symval, |
1119 | char *alias) |
1120 | { |
1121 | DEF_FIELD(symval, x86_cpu_id, feature); |
1122 | DEF_FIELD(symval, x86_cpu_id, family); |
1123 | DEF_FIELD(symval, x86_cpu_id, model); |
1124 | DEF_FIELD(symval, x86_cpu_id, vendor); |
1125 | |
1126 | strcpy(alias, "cpu:type:x86,"); |
1127 | ADD(alias, "ven", vendor != X86_VENDOR_ANY, vendor); |
1128 | ADD(alias, "fam", family != X86_FAMILY_ANY, family); |
1129 | ADD(alias, "mod", model != X86_MODEL_ANY, model); |
1130 | strcat(alias, ":feature:*"); |
1131 | if (feature != X86_FEATURE_ANY) |
1132 | sprintf(alias + strlen(alias), "%04X*", feature); |
1133 | return 1; |
1134 | } |
1135 | ADD_TO_DEVTABLE("x86cpu", x86_cpu_id, do_x86cpu_entry); |
1136 | |
1137 | /* LOOKS like cpu:type:*:feature:*FEAT* */ |
1138 | static int do_cpu_entry(const char *filename, void *symval, char *alias) |
1139 | { |
1140 | DEF_FIELD(symval, cpu_feature, feature); |
1141 | |
1142 | sprintf(alias, "cpu:type:*:feature:*%04X*", feature); |
1143 | return 1; |
1144 | } |
1145 | ADD_TO_DEVTABLE("cpu", cpu_feature, do_cpu_entry); |
1146 | |
1147 | /* Looks like: mei:S */ |
1148 | static int do_mei_entry(const char *filename, void *symval, |
1149 | char *alias) |
1150 | { |
1151 | DEF_FIELD_ADDR(symval, mei_cl_device_id, name); |
1152 | |
1153 | sprintf(alias, MEI_CL_MODULE_PREFIX "%s", *name); |
1154 | |
1155 | return 1; |
1156 | } |
1157 | ADD_TO_DEVTABLE("mei", mei_cl_device_id, do_mei_entry); |
1158 | |
1159 | /* Looks like: rapidio:vNdNavNadN */ |
1160 | static int do_rio_entry(const char *filename, |
1161 | void *symval, char *alias) |
1162 | { |
1163 | DEF_FIELD(symval, rio_device_id, did); |
1164 | DEF_FIELD(symval, rio_device_id, vid); |
1165 | DEF_FIELD(symval, rio_device_id, asm_did); |
1166 | DEF_FIELD(symval, rio_device_id, asm_vid); |
1167 | |
1168 | strcpy(alias, "rapidio:"); |
1169 | ADD(alias, "v", vid != RIO_ANY_ID, vid); |
1170 | ADD(alias, "d", did != RIO_ANY_ID, did); |
1171 | ADD(alias, "av", asm_vid != RIO_ANY_ID, asm_vid); |
1172 | ADD(alias, "ad", asm_did != RIO_ANY_ID, asm_did); |
1173 | |
1174 | add_wildcard(alias); |
1175 | return 1; |
1176 | } |
1177 | ADD_TO_DEVTABLE("rapidio", rio_device_id, do_rio_entry); |
1178 | |
1179 | /* Does namelen bytes of name exactly match the symbol? */ |
1180 | static bool sym_is(const char *name, unsigned namelen, const char *symbol) |
1181 | { |
1182 | if (namelen != strlen(symbol)) |
1183 | return false; |
1184 | |
1185 | return memcmp(name, symbol, namelen) == 0; |
1186 | } |
1187 | |
1188 | static void do_table(void *symval, unsigned long size, |
1189 | unsigned long id_size, |
1190 | const char *device_id, |
1191 | void *function, |
1192 | struct module *mod) |
1193 | { |
1194 | unsigned int i; |
1195 | char alias[500]; |
1196 | int (*do_entry)(const char *, void *entry, char *alias) = function; |
1197 | |
1198 | device_id_check(mod->name, device_id, size, id_size, symval); |
1199 | /* Leave last one: it's the terminator. */ |
1200 | size -= id_size; |
1201 | |
1202 | for (i = 0; i < size; i += id_size) { |
1203 | if (do_entry(mod->name, symval+i, alias)) { |
1204 | buf_printf(&mod->dev_table_buf, |
1205 | "MODULE_ALIAS(\"%s\");\n", alias); |
1206 | } |
1207 | } |
1208 | } |
1209 | |
1210 | /* Create MODULE_ALIAS() statements. |
1211 | * At this time, we cannot write the actual output C source yet, |
1212 | * so we write into the mod->dev_table_buf buffer. */ |
1213 | void handle_moddevtable(struct module *mod, struct elf_info *info, |
1214 | Elf_Sym *sym, const char *symname) |
1215 | { |
1216 | void *symval; |
1217 | char *zeros = NULL; |
1218 | const char *name, *identifier; |
1219 | unsigned int namelen; |
1220 | |
1221 | /* We're looking for a section relative symbol */ |
1222 | if (!sym->st_shndx || get_secindex(info, sym) >= info->num_sections) |
1223 | return; |
1224 | |
1225 | /* We're looking for an object */ |
1226 | if (ELF_ST_TYPE(sym->st_info) != STT_OBJECT) |
1227 | return; |
1228 | |
1229 | /* All our symbols are of form <prefix>__mod_<name>__<identifier>_device_table. */ |
1230 | name = strstr(symname, "__mod_"); |
1231 | if (!name) |
1232 | return; |
1233 | name += strlen("__mod_"); |
1234 | namelen = strlen(name); |
1235 | if (namelen < strlen("_device_table")) |
1236 | return; |
1237 | if (strcmp(name + namelen - strlen("_device_table"), "_device_table")) |
1238 | return; |
1239 | identifier = strstr(name, "__"); |
1240 | if (!identifier) |
1241 | return; |
1242 | namelen = identifier - name; |
1243 | |
1244 | /* Handle all-NULL symbols allocated into .bss */ |
1245 | if (info->sechdrs[get_secindex(info, sym)].sh_type & SHT_NOBITS) { |
1246 | zeros = calloc(1, sym->st_size); |
1247 | symval = zeros; |
1248 | } else { |
1249 | symval = (void *)info->hdr |
1250 | + info->sechdrs[get_secindex(info, sym)].sh_offset |
1251 | + sym->st_value; |
1252 | } |
1253 | |
1254 | /* First handle the "special" cases */ |
1255 | if (sym_is(name, namelen, "usb")) |
1256 | do_usb_table(symval, sym->st_size, mod); |
1257 | else if (sym_is(name, namelen, "pnp")) |
1258 | do_pnp_device_entry(symval, sym->st_size, mod); |
1259 | else if (sym_is(name, namelen, "pnp_card")) |
1260 | do_pnp_card_entries(symval, sym->st_size, mod); |
1261 | else { |
1262 | struct devtable **p; |
1263 | INIT_SECTION(__devtable); |
1264 | |
1265 | for (p = __start___devtable; p < __stop___devtable; p++) { |
1266 | if (sym_is(name, namelen, (*p)->device_id)) { |
1267 | do_table(symval, sym->st_size, (*p)->id_size, |
1268 | (*p)->device_id, (*p)->function, mod); |
1269 | break; |
1270 | } |
1271 | } |
1272 | } |
1273 | free(zeros); |
1274 | } |
1275 | |
1276 | /* Now add out buffered information to the generated C source */ |
1277 | void add_moddevtable(struct buffer *buf, struct module *mod) |
1278 | { |
1279 | buf_printf(buf, "\n"); |
1280 | buf_write(buf, mod->dev_table_buf.p, mod->dev_table_buf.pos); |
1281 | free(mod->dev_table_buf.p); |
1282 | } |
1283 |
Branches:
ben-wpan
ben-wpan-stefan
javiroman/ks7010
jz-2.6.34
jz-2.6.34-rc5
jz-2.6.34-rc6
jz-2.6.34-rc7
jz-2.6.35
jz-2.6.36
jz-2.6.37
jz-2.6.38
jz-2.6.39
jz-3.0
jz-3.1
jz-3.11
jz-3.12
jz-3.13
jz-3.15
jz-3.16
jz-3.18-dt
jz-3.2
jz-3.3
jz-3.4
jz-3.5
jz-3.6
jz-3.6-rc2-pwm
jz-3.9
jz-3.9-clk
jz-3.9-rc8
jz47xx
jz47xx-2.6.38
master
Tags:
od-2011-09-04
od-2011-09-18
v2.6.34-rc5
v2.6.34-rc6
v2.6.34-rc7
v3.9