1 /* Simple code to turn various tables in an ELF file into alias definitions. 2 * This deals with kernel datastructures where they should be 3 * dealt with: in the kernel source. 4 * 5 * Copyright 2002-2003 Rusty Russell, IBM Corporation 6 * 2003 Kai Germaschewski 7 * 8 * 9 * This software may be used and distributed according to the terms 10 * of the GNU General Public License, incorporated herein by reference. 11 */ 12 13 #include "modpost.h" 14 15 /* We use the ELF typedefs for kernel_ulong_t but bite the bullet and 16 * use either stdint.h or inttypes.h for the rest. */ 17 #if KERNEL_ELFCLASS == ELFCLASS32 18 typedef Elf32_Addr kernel_ulong_t; 19 #define BITS_PER_LONG 32 20 #else 21 typedef Elf64_Addr kernel_ulong_t; 22 #define BITS_PER_LONG 64 23 #endif 24 #ifdef __sun__ 25 #include <inttypes.h> 26 #else 27 #include <stdint.h> 28 #endif 29 30 #include <ctype.h> 31 32 typedef uint32_t __u32; 33 typedef uint16_t __u16; 34 typedef unsigned char __u8; 35 36 /* Big exception to the "don't include kernel headers into userspace, which 37 * even potentially has different endianness and word sizes, since 38 * we handle those differences explicitly below */ 39 #include "../../include/linux/mod_devicetable.h" 40 #include "../../include/linux/input.h" 41 42 #define ADD(str, sep, cond, field) \ 43 do { \ 44 strcat(str, sep); \ 45 if (cond) \ 46 sprintf(str + strlen(str), \ 47 sizeof(field) == 1 ? "%02X" : \ 48 sizeof(field) == 2 ? "%04X" : \ 49 sizeof(field) == 4 ? "%08X" : "", \ 50 field); \ 51 else \ 52 sprintf(str + strlen(str), "*"); \ 53 } while(0) 54 55 /** 56 * Check that sizeof(device_id type) are consistent with size of section 57 * in .o file. If in-consistent then userspace and kernel does not agree 58 * on actual size which is a bug. 59 **/ 60 static void device_id_size_check(const char *modname, const char *device_id, 61 unsigned long size, unsigned long id_size) 62 { 63 if (size % id_size || size < id_size) { 64 fatal("%s: sizeof(struct %s_device_id)=%lu is not a modulo " 65 "of the size of section __mod_%s_device_table=%lu.\n" 66 "Fix definition of struct %s_device_id " 67 "in mod_devicetable.h\n", 68 modname, device_id, id_size, device_id, size, device_id); 69 } 70 } 71 72 /* USB is special because the bcdDevice can be matched against a numeric range */ 73 /* Looks like "usb:vNpNdNdcNdscNdpNicNiscNipN" */ 74 static void do_usb_entry(struct usb_device_id *id, 75 unsigned int bcdDevice_initial, int bcdDevice_initial_digits, 76 unsigned char range_lo, unsigned char range_hi, 77 struct module *mod) 78 { 79 char alias[500]; 80 strcpy(alias, "usb:"); 81 ADD(alias, "v", id->match_flags&USB_DEVICE_ID_MATCH_VENDOR, 82 id->idVendor); 83 ADD(alias, "p", id->match_flags&USB_DEVICE_ID_MATCH_PRODUCT, 84 id->idProduct); 85 86 strcat(alias, "d"); 87 if (bcdDevice_initial_digits) 88 sprintf(alias + strlen(alias), "%0*X", 89 bcdDevice_initial_digits, bcdDevice_initial); 90 if (range_lo == range_hi) 91 sprintf(alias + strlen(alias), "%u", range_lo); 92 else if (range_lo > 0 || range_hi < 9) 93 sprintf(alias + strlen(alias), "[%u-%u]", range_lo, range_hi); 94 if (bcdDevice_initial_digits < (sizeof(id->bcdDevice_lo) * 2 - 1)) 95 strcat(alias, "*"); 96 97 ADD(alias, "dc", id->match_flags&USB_DEVICE_ID_MATCH_DEV_CLASS, 98 id->bDeviceClass); 99 ADD(alias, "dsc", 100 id->match_flags&USB_DEVICE_ID_MATCH_DEV_SUBCLASS, 101 id->bDeviceSubClass); 102 ADD(alias, "dp", 103 id->match_flags&USB_DEVICE_ID_MATCH_DEV_PROTOCOL, 104 id->bDeviceProtocol); 105 ADD(alias, "ic", 106 id->match_flags&USB_DEVICE_ID_MATCH_INT_CLASS, 107 id->bInterfaceClass); 108 ADD(alias, "isc", 109 id->match_flags&USB_DEVICE_ID_MATCH_INT_SUBCLASS, 110 id->bInterfaceSubClass); 111 ADD(alias, "ip", 112 id->match_flags&USB_DEVICE_ID_MATCH_INT_PROTOCOL, 113 id->bInterfaceProtocol); 114 115 /* Always end in a wildcard, for future extension */ 116 if (alias[strlen(alias)-1] != '*') 117 strcat(alias, "*"); 118 buf_printf(&mod->dev_table_buf, 119 "MODULE_ALIAS(\"%s\");\n", alias); 120 } 121 122 static void do_usb_entry_multi(struct usb_device_id *id, struct module *mod) 123 { 124 unsigned int devlo, devhi; 125 unsigned char chi, clo; 126 int ndigits; 127 128 id->match_flags = TO_NATIVE(id->match_flags); 129 id->idVendor = TO_NATIVE(id->idVendor); 130 id->idProduct = TO_NATIVE(id->idProduct); 131 132 devlo = id->match_flags & USB_DEVICE_ID_MATCH_DEV_LO ? 133 TO_NATIVE(id->bcdDevice_lo) : 0x0U; 134 devhi = id->match_flags & USB_DEVICE_ID_MATCH_DEV_HI ? 135 TO_NATIVE(id->bcdDevice_hi) : ~0x0U; 136 137 /* 138 * Some modules (visor) have empty slots as placeholder for 139 * run-time specification that results in catch-all alias 140 */ 141 if (!(id->idVendor | id->bDeviceClass | id->bInterfaceClass)) 142 return; 143 144 /* Convert numeric bcdDevice range into fnmatch-able pattern(s) */ 145 for (ndigits = sizeof(id->bcdDevice_lo) * 2 - 1; devlo <= devhi; ndigits--) { 146 clo = devlo & 0xf; 147 chi = devhi & 0xf; 148 if (chi > 9) /* it's bcd not hex */ 149 chi = 9; 150 devlo >>= 4; 151 devhi >>= 4; 152 153 if (devlo == devhi || !ndigits) { 154 do_usb_entry(id, devlo, ndigits, clo, chi, mod); 155 break; 156 } 157 158 if (clo > 0) 159 do_usb_entry(id, devlo++, ndigits, clo, 9, mod); 160 161 if (chi < 9) 162 do_usb_entry(id, devhi--, ndigits, 0, chi, mod); 163 } 164 } 165 166 static void do_usb_table(void *symval, unsigned long size, 167 struct module *mod) 168 { 169 unsigned int i; 170 const unsigned long id_size = sizeof(struct usb_device_id); 171 172 device_id_size_check(mod->name, "usb", size, id_size); 173 174 /* Leave last one: it's the terminator. */ 175 size -= id_size; 176 177 for (i = 0; i < size; i += id_size) 178 do_usb_entry_multi(symval + i, mod); 179 } 180 181 /* Looks like: ieee1394:venNmoNspNverN */ 182 static int do_ieee1394_entry(const char *filename, 183 struct ieee1394_device_id *id, char *alias) 184 { 185 id->match_flags = TO_NATIVE(id->match_flags); 186 id->vendor_id = TO_NATIVE(id->vendor_id); 187 id->model_id = TO_NATIVE(id->model_id); 188 id->specifier_id = TO_NATIVE(id->specifier_id); 189 id->version = TO_NATIVE(id->version); 190 191 strcpy(alias, "ieee1394:"); 192 ADD(alias, "ven", id->match_flags & IEEE1394_MATCH_VENDOR_ID, 193 id->vendor_id); 194 ADD(alias, "mo", id->match_flags & IEEE1394_MATCH_MODEL_ID, 195 id->model_id); 196 ADD(alias, "sp", id->match_flags & IEEE1394_MATCH_SPECIFIER_ID, 197 id->specifier_id); 198 ADD(alias, "ver", id->match_flags & IEEE1394_MATCH_VERSION, 199 id->version); 200 201 return 1; 202 } 203 204 /* Looks like: pci:vNdNsvNsdNbcNscNiN. */ 205 static int do_pci_entry(const char *filename, 206 struct pci_device_id *id, char *alias) 207 { 208 /* Class field can be divided into these three. */ 209 unsigned char baseclass, subclass, interface, 210 baseclass_mask, subclass_mask, interface_mask; 211 212 id->vendor = TO_NATIVE(id->vendor); 213 id->device = TO_NATIVE(id->device); 214 id->subvendor = TO_NATIVE(id->subvendor); 215 id->subdevice = TO_NATIVE(id->subdevice); 216 id->class = TO_NATIVE(id->class); 217 id->class_mask = TO_NATIVE(id->class_mask); 218 219 strcpy(alias, "pci:"); 220 ADD(alias, "v", id->vendor != PCI_ANY_ID, id->vendor); 221 ADD(alias, "d", id->device != PCI_ANY_ID, id->device); 222 ADD(alias, "sv", id->subvendor != PCI_ANY_ID, id->subvendor); 223 ADD(alias, "sd", id->subdevice != PCI_ANY_ID, id->subdevice); 224 225 baseclass = (id->class) >> 16; 226 baseclass_mask = (id->class_mask) >> 16; 227 subclass = (id->class) >> 8; 228 subclass_mask = (id->class_mask) >> 8; 229 interface = id->class; 230 interface_mask = id->class_mask; 231 232 if ((baseclass_mask != 0 && baseclass_mask != 0xFF) 233 || (subclass_mask != 0 && subclass_mask != 0xFF) 234 || (interface_mask != 0 && interface_mask != 0xFF)) { 235 warn("Can't handle masks in %s:%04X\n", 236 filename, id->class_mask); 237 return 0; 238 } 239 240 ADD(alias, "bc", baseclass_mask == 0xFF, baseclass); 241 ADD(alias, "sc", subclass_mask == 0xFF, subclass); 242 ADD(alias, "i", interface_mask == 0xFF, interface); 243 return 1; 244 } 245 246 /* looks like: "ccw:tNmNdtNdmN" */ 247 static int do_ccw_entry(const char *filename, 248 struct ccw_device_id *id, char *alias) 249 { 250 id->match_flags = TO_NATIVE(id->match_flags); 251 id->cu_type = TO_NATIVE(id->cu_type); 252 id->cu_model = TO_NATIVE(id->cu_model); 253 id->dev_type = TO_NATIVE(id->dev_type); 254 id->dev_model = TO_NATIVE(id->dev_model); 255 256 strcpy(alias, "ccw:"); 257 ADD(alias, "t", id->match_flags&CCW_DEVICE_ID_MATCH_CU_TYPE, 258 id->cu_type); 259 ADD(alias, "m", id->match_flags&CCW_DEVICE_ID_MATCH_CU_MODEL, 260 id->cu_model); 261 ADD(alias, "dt", id->match_flags&CCW_DEVICE_ID_MATCH_DEVICE_TYPE, 262 id->dev_type); 263 ADD(alias, "dm", id->match_flags&CCW_DEVICE_ID_MATCH_DEVICE_MODEL, 264 id->dev_model); 265 return 1; 266 } 267 268 /* looks like: "ap:tN" */ 269 static int do_ap_entry(const char *filename, 270 struct ap_device_id *id, char *alias) 271 { 272 sprintf(alias, "ap:t%02X", id->dev_type); 273 return 1; 274 } 275 276 /* Looks like: "serio:tyNprNidNexN" */ 277 static int do_serio_entry(const char *filename, 278 struct serio_device_id *id, char *alias) 279 { 280 id->type = TO_NATIVE(id->type); 281 id->proto = TO_NATIVE(id->proto); 282 id->id = TO_NATIVE(id->id); 283 id->extra = TO_NATIVE(id->extra); 284 285 strcpy(alias, "serio:"); 286 ADD(alias, "ty", id->type != SERIO_ANY, id->type); 287 ADD(alias, "pr", id->proto != SERIO_ANY, id->proto); 288 ADD(alias, "id", id->id != SERIO_ANY, id->id); 289 ADD(alias, "ex", id->extra != SERIO_ANY, id->extra); 290 291 return 1; 292 } 293 294 /* looks like: "pnp:dD" */ 295 static int do_pnp_entry(const char *filename, 296 struct pnp_device_id *id, char *alias) 297 { 298 sprintf(alias, "pnp:d%s", id->id); 299 return 1; 300 } 301 302 /* looks like: "pnp:cCdD..." */ 303 static int do_pnp_card_entry(const char *filename, 304 struct pnp_card_device_id *id, char *alias) 305 { 306 int i; 307 308 sprintf(alias, "pnp:c%s", id->id); 309 for (i = 0; i < PNP_MAX_DEVICES; i++) { 310 if (! *id->devs[i].id) 311 break; 312 sprintf(alias + strlen(alias), "d%s", id->devs[i].id); 313 } 314 return 1; 315 } 316 317 /* Looks like: pcmcia:mNcNfNfnNpfnNvaNvbNvcNvdN. */ 318 static int do_pcmcia_entry(const char *filename, 319 struct pcmcia_device_id *id, char *alias) 320 { 321 unsigned int i; 322 323 id->match_flags = TO_NATIVE(id->match_flags); 324 id->manf_id = TO_NATIVE(id->manf_id); 325 id->card_id = TO_NATIVE(id->card_id); 326 id->func_id = TO_NATIVE(id->func_id); 327 id->function = TO_NATIVE(id->function); 328 id->device_no = TO_NATIVE(id->device_no); 329 330 for (i=0; i<4; i++) { 331 id->prod_id_hash[i] = TO_NATIVE(id->prod_id_hash[i]); 332 } 333 334 strcpy(alias, "pcmcia:"); 335 ADD(alias, "m", id->match_flags & PCMCIA_DEV_ID_MATCH_MANF_ID, 336 id->manf_id); 337 ADD(alias, "c", id->match_flags & PCMCIA_DEV_ID_MATCH_CARD_ID, 338 id->card_id); 339 ADD(alias, "f", id->match_flags & PCMCIA_DEV_ID_MATCH_FUNC_ID, 340 id->func_id); 341 ADD(alias, "fn", id->match_flags & PCMCIA_DEV_ID_MATCH_FUNCTION, 342 id->function); 343 ADD(alias, "pfn", id->match_flags & PCMCIA_DEV_ID_MATCH_DEVICE_NO, 344 id->device_no); 345 ADD(alias, "pa", id->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID1, id->prod_id_hash[0]); 346 ADD(alias, "pb", id->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID2, id->prod_id_hash[1]); 347 ADD(alias, "pc", id->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID3, id->prod_id_hash[2]); 348 ADD(alias, "pd", id->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID4, id->prod_id_hash[3]); 349 350 return 1; 351 } 352 353 354 355 static int do_of_entry (const char *filename, struct of_device_id *of, char *alias) 356 { 357 char *tmp; 358 sprintf (alias, "of:N%sT%sC%s", 359 of->name[0] ? of->name : "*", 360 of->type[0] ? of->type : "*", 361 of->compatible[0] ? of->compatible : "*"); 362 363 /* Replace all whitespace with underscores */ 364 for (tmp = alias; tmp && *tmp; tmp++) 365 if (isspace (*tmp)) 366 *tmp = '_'; 367 368 return 1; 369 } 370 371 static int do_vio_entry(const char *filename, struct vio_device_id *vio, 372 char *alias) 373 { 374 char *tmp; 375 376 sprintf(alias, "vio:T%sS%s", vio->type[0] ? vio->type : "*", 377 vio->compat[0] ? vio->compat : "*"); 378 379 /* Replace all whitespace with underscores */ 380 for (tmp = alias; tmp && *tmp; tmp++) 381 if (isspace (*tmp)) 382 *tmp = '_'; 383 384 return 1; 385 } 386 387 static int do_i2c_entry(const char *filename, struct i2c_device_id *i2c, char *alias) 388 { 389 strcpy(alias, "i2c:"); 390 ADD(alias, "id", 1, i2c->id); 391 return 1; 392 } 393 394 #define ARRAY_SIZE(x) (sizeof(x) / sizeof((x)[0])) 395 396 static void do_input(char *alias, 397 kernel_ulong_t *arr, unsigned int min, unsigned int max) 398 { 399 unsigned int i; 400 401 for (i = min; i < max; i++) 402 if (arr[i / BITS_PER_LONG] & (1L << (i%BITS_PER_LONG))) 403 sprintf(alias + strlen(alias), "%X,*", i); 404 } 405 406 /* input:b0v0p0e0-eXkXrXaXmXlXsXfXwX where X is comma-separated %02X. */ 407 static int do_input_entry(const char *filename, struct input_device_id *id, 408 char *alias) 409 { 410 sprintf(alias, "input:"); 411 412 ADD(alias, "b", id->flags & INPUT_DEVICE_ID_MATCH_BUS, id->bustype); 413 ADD(alias, "v", id->flags & INPUT_DEVICE_ID_MATCH_VENDOR, id->vendor); 414 ADD(alias, "p", id->flags & INPUT_DEVICE_ID_MATCH_PRODUCT, id->product); 415 ADD(alias, "e", id->flags & INPUT_DEVICE_ID_MATCH_VERSION, id->version); 416 417 sprintf(alias + strlen(alias), "-e*"); 418 if (id->flags & INPUT_DEVICE_ID_MATCH_EVBIT) 419 do_input(alias, id->evbit, 0, EV_MAX); 420 sprintf(alias + strlen(alias), "k*"); 421 if (id->flags & INPUT_DEVICE_ID_MATCH_KEYBIT) 422 do_input(alias, id->keybit, KEY_MIN_INTERESTING, KEY_MAX); 423 sprintf(alias + strlen(alias), "r*"); 424 if (id->flags & INPUT_DEVICE_ID_MATCH_RELBIT) 425 do_input(alias, id->relbit, 0, REL_MAX); 426 sprintf(alias + strlen(alias), "a*"); 427 if (id->flags & INPUT_DEVICE_ID_MATCH_ABSBIT) 428 do_input(alias, id->absbit, 0, ABS_MAX); 429 sprintf(alias + strlen(alias), "m*"); 430 if (id->flags & INPUT_DEVICE_ID_MATCH_MSCIT) 431 do_input(alias, id->mscbit, 0, MSC_MAX); 432 sprintf(alias + strlen(alias), "l*"); 433 if (id->flags & INPUT_DEVICE_ID_MATCH_LEDBIT) 434 do_input(alias, id->ledbit, 0, LED_MAX); 435 sprintf(alias + strlen(alias), "s*"); 436 if (id->flags & INPUT_DEVICE_ID_MATCH_SNDBIT) 437 do_input(alias, id->sndbit, 0, SND_MAX); 438 sprintf(alias + strlen(alias), "f*"); 439 if (id->flags & INPUT_DEVICE_ID_MATCH_FFBIT) 440 do_input(alias, id->ffbit, 0, FF_MAX); 441 sprintf(alias + strlen(alias), "w*"); 442 if (id->flags & INPUT_DEVICE_ID_MATCH_SWBIT) 443 do_input(alias, id->swbit, 0, SW_MAX); 444 return 1; 445 } 446 447 /* Ignore any prefix, eg. v850 prepends _ */ 448 static inline int sym_is(const char *symbol, const char *name) 449 { 450 const char *match; 451 452 match = strstr(symbol, name); 453 if (!match) 454 return 0; 455 return match[strlen(symbol)] == '\0'; 456 } 457 458 static void do_table(void *symval, unsigned long size, 459 unsigned long id_size, 460 const char *device_id, 461 void *function, 462 struct module *mod) 463 { 464 unsigned int i; 465 char alias[500]; 466 int (*do_entry)(const char *, void *entry, char *alias) = function; 467 468 device_id_size_check(mod->name, device_id, size, id_size); 469 /* Leave last one: it's the terminator. */ 470 size -= id_size; 471 472 for (i = 0; i < size; i += id_size) { 473 if (do_entry(mod->name, symval+i, alias)) { 474 /* Always end in a wildcard, for future extension */ 475 if (alias[strlen(alias)-1] != '*') 476 strcat(alias, "*"); 477 buf_printf(&mod->dev_table_buf, 478 "MODULE_ALIAS(\"%s\");\n", alias); 479 } 480 } 481 } 482 483 /* Create MODULE_ALIAS() statements. 484 * At this time, we cannot write the actual output C source yet, 485 * so we write into the mod->dev_table_buf buffer. */ 486 void handle_moddevtable(struct module *mod, struct elf_info *info, 487 Elf_Sym *sym, const char *symname) 488 { 489 void *symval; 490 491 /* We're looking for a section relative symbol */ 492 if (!sym->st_shndx || sym->st_shndx >= info->hdr->e_shnum) 493 return; 494 495 symval = (void *)info->hdr 496 + info->sechdrs[sym->st_shndx].sh_offset 497 + sym->st_value; 498 499 if (sym_is(symname, "__mod_pci_device_table")) 500 do_table(symval, sym->st_size, 501 sizeof(struct pci_device_id), "pci", 502 do_pci_entry, mod); 503 else if (sym_is(symname, "__mod_usb_device_table")) 504 /* special case to handle bcdDevice ranges */ 505 do_usb_table(symval, sym->st_size, mod); 506 else if (sym_is(symname, "__mod_ieee1394_device_table")) 507 do_table(symval, sym->st_size, 508 sizeof(struct ieee1394_device_id), "ieee1394", 509 do_ieee1394_entry, mod); 510 else if (sym_is(symname, "__mod_ccw_device_table")) 511 do_table(symval, sym->st_size, 512 sizeof(struct ccw_device_id), "ccw", 513 do_ccw_entry, mod); 514 else if (sym_is(symname, "__mod_ap_device_table")) 515 do_table(symval, sym->st_size, 516 sizeof(struct ap_device_id), "ap", 517 do_ap_entry, mod); 518 else if (sym_is(symname, "__mod_serio_device_table")) 519 do_table(symval, sym->st_size, 520 sizeof(struct serio_device_id), "serio", 521 do_serio_entry, mod); 522 else if (sym_is(symname, "__mod_pnp_device_table")) 523 do_table(symval, sym->st_size, 524 sizeof(struct pnp_device_id), "pnp", 525 do_pnp_entry, mod); 526 else if (sym_is(symname, "__mod_pnp_card_device_table")) 527 do_table(symval, sym->st_size, 528 sizeof(struct pnp_card_device_id), "pnp_card", 529 do_pnp_card_entry, mod); 530 else if (sym_is(symname, "__mod_pcmcia_device_table")) 531 do_table(symval, sym->st_size, 532 sizeof(struct pcmcia_device_id), "pcmcia", 533 do_pcmcia_entry, mod); 534 else if (sym_is(symname, "__mod_of_device_table")) 535 do_table(symval, sym->st_size, 536 sizeof(struct of_device_id), "of", 537 do_of_entry, mod); 538 else if (sym_is(symname, "__mod_vio_device_table")) 539 do_table(symval, sym->st_size, 540 sizeof(struct vio_device_id), "vio", 541 do_vio_entry, mod); 542 else if (sym_is(symname, "__mod_i2c_device_table")) 543 do_table(symval, sym->st_size, 544 sizeof(struct i2c_device_id), "i2c", 545 do_i2c_entry, mod); 546 else if (sym_is(symname, "__mod_input_device_table")) 547 do_table(symval, sym->st_size, 548 sizeof(struct input_device_id), "input", 549 do_input_entry, mod); 550 } 551 552 /* Now add out buffered information to the generated C source */ 553 void add_moddevtable(struct buffer *buf, struct module *mod) 554 { 555 buf_printf(buf, "\n"); 556 buf_write(buf, mod->dev_table_buf.p, mod->dev_table_buf.pos); 557 free(mod->dev_table_buf.p); 558 } 559