diff options
Diffstat (limited to 'drivers')
| -rw-r--r-- | drivers/pnp/base.h | 2 | ||||
| -rw-r--r-- | drivers/pnp/isapnp/core.c | 32 | ||||
| -rw-r--r-- | drivers/pnp/pnpbios/core.c | 2 | ||||
| -rw-r--r-- | drivers/pnp/pnpbios/rsparser.c | 26 | ||||
| -rw-r--r-- | drivers/pnp/support.c | 26 |
5 files changed, 43 insertions, 45 deletions
diff --git a/drivers/pnp/base.h b/drivers/pnp/base.h index ba55b0623f7e..9af0a6c7dd41 100644 --- a/drivers/pnp/base.h +++ b/drivers/pnp/base.h | |||
| @@ -1,5 +1,7 @@ | |||
| 1 | extern spinlock_t pnp_lock; | 1 | extern spinlock_t pnp_lock; |
| 2 | void *pnp_alloc(long size); | 2 | void *pnp_alloc(long size); |
| 3 | #define PNP_EISA_ID_MASK 0x7fffffff | ||
| 4 | void pnp_eisa_id_to_string(u32 id, char *str); | ||
| 3 | struct pnp_id *pnp_add_id(struct pnp_dev *dev, char *id); | 5 | struct pnp_id *pnp_add_id(struct pnp_dev *dev, char *id); |
| 4 | int pnp_interface_attach_device(struct pnp_dev *dev); | 6 | int pnp_interface_attach_device(struct pnp_dev *dev); |
| 5 | void pnp_fixup_device(struct pnp_dev *dev); | 7 | void pnp_fixup_device(struct pnp_dev *dev); |
diff --git a/drivers/pnp/isapnp/core.c b/drivers/pnp/isapnp/core.c index 10cade831433..ccb04190044b 100644 --- a/drivers/pnp/isapnp/core.c +++ b/drivers/pnp/isapnp/core.c | |||
| @@ -398,24 +398,6 @@ static void __init isapnp_skip_bytes(int count) | |||
| 398 | } | 398 | } |
| 399 | 399 | ||
| 400 | /* | 400 | /* |
| 401 | * Parse EISA id. | ||
| 402 | */ | ||
| 403 | static void isapnp_parse_id(struct pnp_dev *dev, unsigned short vendor, | ||
| 404 | unsigned short device) | ||
| 405 | { | ||
| 406 | char id[8]; | ||
| 407 | |||
| 408 | sprintf(id, "%c%c%c%x%x%x%x", | ||
| 409 | 'A' + ((vendor >> 2) & 0x3f) - 1, | ||
| 410 | 'A' + (((vendor & 3) << 3) | ((vendor >> 13) & 7)) - 1, | ||
| 411 | 'A' + ((vendor >> 8) & 0x1f) - 1, | ||
| 412 | (device >> 4) & 0x0f, | ||
| 413 | device & 0x0f, (device >> 12) & 0x0f, (device >> 8) & 0x0f); | ||
| 414 | |||
| 415 | pnp_add_id(dev, id); | ||
| 416 | } | ||
| 417 | |||
| 418 | /* | ||
| 419 | * Parse logical device tag. | 401 | * Parse logical device tag. |
| 420 | */ | 402 | */ |
| 421 | static struct pnp_dev *__init isapnp_parse_device(struct pnp_card *card, | 403 | static struct pnp_dev *__init isapnp_parse_device(struct pnp_card *card, |
| @@ -423,13 +405,17 @@ static struct pnp_dev *__init isapnp_parse_device(struct pnp_card *card, | |||
| 423 | { | 405 | { |
| 424 | unsigned char tmp[6]; | 406 | unsigned char tmp[6]; |
| 425 | struct pnp_dev *dev; | 407 | struct pnp_dev *dev; |
| 408 | u32 eisa_id; | ||
| 409 | char id[8]; | ||
| 426 | 410 | ||
| 427 | isapnp_peek(tmp, size); | 411 | isapnp_peek(tmp, size); |
| 428 | dev = kzalloc(sizeof(struct pnp_dev), GFP_KERNEL); | 412 | dev = kzalloc(sizeof(struct pnp_dev), GFP_KERNEL); |
| 429 | if (!dev) | 413 | if (!dev) |
| 430 | return NULL; | 414 | return NULL; |
| 431 | dev->number = number; | 415 | dev->number = number; |
| 432 | isapnp_parse_id(dev, (tmp[1] << 8) | tmp[0], (tmp[3] << 8) | tmp[2]); | 416 | eisa_id = tmp[0] | tmp[1] << 8 | tmp[2] << 16 | tmp[3] << 24; |
| 417 | pnp_eisa_id_to_string(eisa_id, id); | ||
| 418 | pnp_add_id(dev, id); | ||
| 433 | dev->regs = tmp[4]; | 419 | dev->regs = tmp[4]; |
| 434 | dev->card = card; | 420 | dev->card = card; |
| 435 | if (size > 5) | 421 | if (size > 5) |
| @@ -619,6 +605,8 @@ static int __init isapnp_create_device(struct pnp_card *card, | |||
| 619 | unsigned char type, tmp[17]; | 605 | unsigned char type, tmp[17]; |
| 620 | struct pnp_option *option; | 606 | struct pnp_option *option; |
| 621 | struct pnp_dev *dev; | 607 | struct pnp_dev *dev; |
| 608 | u32 eisa_id; | ||
| 609 | char id[8]; | ||
| 622 | 610 | ||
| 623 | if ((dev = isapnp_parse_device(card, size, number++)) == NULL) | 611 | if ((dev = isapnp_parse_device(card, size, number++)) == NULL) |
| 624 | return 1; | 612 | return 1; |
| @@ -658,8 +646,10 @@ static int __init isapnp_create_device(struct pnp_card *card, | |||
| 658 | case _STAG_COMPATDEVID: | 646 | case _STAG_COMPATDEVID: |
| 659 | if (size == 4 && compat < DEVICE_COUNT_COMPATIBLE) { | 647 | if (size == 4 && compat < DEVICE_COUNT_COMPATIBLE) { |
| 660 | isapnp_peek(tmp, 4); | 648 | isapnp_peek(tmp, 4); |
| 661 | isapnp_parse_id(dev, (tmp[1] << 8) | tmp[0], | 649 | eisa_id = tmp[0] | tmp[1] << 8 | |
| 662 | (tmp[3] << 8) | tmp[2]); | 650 | tmp[2] << 16 | tmp[3] << 24; |
| 651 | pnp_eisa_id_to_string(eisa_id, id); | ||
| 652 | pnp_add_id(dev, id); | ||
| 663 | compat++; | 653 | compat++; |
| 664 | size = 0; | 654 | size = 0; |
| 665 | } | 655 | } |
diff --git a/drivers/pnp/pnpbios/core.c b/drivers/pnp/pnpbios/core.c index 2d592aea0aa7..3ee5ed437385 100644 --- a/drivers/pnp/pnpbios/core.c +++ b/drivers/pnp/pnpbios/core.c | |||
| @@ -332,7 +332,7 @@ static int __init insert_device(struct pnp_bios_node *node) | |||
| 332 | if (!dev) | 332 | if (!dev) |
| 333 | return -1; | 333 | return -1; |
| 334 | 334 | ||
| 335 | pnpid32_to_pnpid(node->eisa_id, id); | 335 | pnp_eisa_id_to_string(node->eisa_id & PNP_EISA_ID_MASK, id); |
| 336 | dev_id = pnp_add_id(dev, id); | 336 | dev_id = pnp_add_id(dev, id); |
| 337 | if (!dev_id) { | 337 | if (!dev_id) { |
| 338 | kfree(dev); | 338 | kfree(dev); |
diff --git a/drivers/pnp/pnpbios/rsparser.c b/drivers/pnp/pnpbios/rsparser.c index dbc88412c12e..948a661280d7 100644 --- a/drivers/pnp/pnpbios/rsparser.c +++ b/drivers/pnp/pnpbios/rsparser.c | |||
| @@ -494,32 +494,12 @@ len_err: | |||
| 494 | * Compatible Device IDs | 494 | * Compatible Device IDs |
| 495 | */ | 495 | */ |
| 496 | 496 | ||
| 497 | #define HEX(id,a) hex[((id)>>a) & 15] | ||
| 498 | #define CHAR(id,a) (0x40 + (((id)>>a) & 31)) | ||
| 499 | |||
| 500 | void pnpid32_to_pnpid(u32 id, char *str) | ||
| 501 | { | ||
| 502 | const char *hex = "0123456789abcdef"; | ||
| 503 | |||
| 504 | id = be32_to_cpu(id); | ||
| 505 | str[0] = CHAR(id, 26); | ||
| 506 | str[1] = CHAR(id, 21); | ||
| 507 | str[2] = CHAR(id, 16); | ||
| 508 | str[3] = HEX(id, 12); | ||
| 509 | str[4] = HEX(id, 8); | ||
| 510 | str[5] = HEX(id, 4); | ||
| 511 | str[6] = HEX(id, 0); | ||
| 512 | str[7] = '\0'; | ||
| 513 | } | ||
| 514 | |||
| 515 | #undef CHAR | ||
| 516 | #undef HEX | ||
| 517 | |||
| 518 | static unsigned char *pnpbios_parse_compatible_ids(unsigned char *p, | 497 | static unsigned char *pnpbios_parse_compatible_ids(unsigned char *p, |
| 519 | unsigned char *end, | 498 | unsigned char *end, |
| 520 | struct pnp_dev *dev) | 499 | struct pnp_dev *dev) |
| 521 | { | 500 | { |
| 522 | int len, tag; | 501 | int len, tag; |
| 502 | u32 eisa_id; | ||
| 523 | char id[8]; | 503 | char id[8]; |
| 524 | struct pnp_id *dev_id; | 504 | struct pnp_id *dev_id; |
| 525 | 505 | ||
| @@ -549,8 +529,8 @@ static unsigned char *pnpbios_parse_compatible_ids(unsigned char *p, | |||
| 549 | case SMALL_TAG_COMPATDEVID: /* compatible ID */ | 529 | case SMALL_TAG_COMPATDEVID: /* compatible ID */ |
| 550 | if (len != 4) | 530 | if (len != 4) |
| 551 | goto len_err; | 531 | goto len_err; |
| 552 | pnpid32_to_pnpid(p[1] | p[2] << 8 | p[3] << 16 | p[4] << | 532 | eisa_id = p[1] | p[2] << 8 | p[3] << 16 | p[4] << 24; |
| 553 | 24, id); | 533 | pnp_eisa_id_to_string(eisa_id & PNP_EISA_ID_MASK, id); |
| 554 | dev_id = pnp_add_id(dev, id); | 534 | dev_id = pnp_add_id(dev, id); |
| 555 | if (!dev_id) | 535 | if (!dev_id) |
| 556 | return NULL; | 536 | return NULL; |
diff --git a/drivers/pnp/support.c b/drivers/pnp/support.c index 13c608f5fb30..e848b794e312 100644 --- a/drivers/pnp/support.c +++ b/drivers/pnp/support.c | |||
| @@ -25,3 +25,29 @@ int pnp_is_active(struct pnp_dev *dev) | |||
| 25 | } | 25 | } |
| 26 | 26 | ||
| 27 | EXPORT_SYMBOL(pnp_is_active); | 27 | EXPORT_SYMBOL(pnp_is_active); |
| 28 | |||
| 29 | /* | ||
| 30 | * Functionally similar to acpi_ex_eisa_id_to_string(), but that's | ||
| 31 | * buried in the ACPI CA, and we can't depend on it being present. | ||
| 32 | */ | ||
| 33 | void pnp_eisa_id_to_string(u32 id, char *str) | ||
| 34 | { | ||
| 35 | id = be32_to_cpu(id); | ||
| 36 | |||
| 37 | /* | ||
| 38 | * According to the specs, the first three characters are five-bit | ||
| 39 | * compressed ASCII, and the left-over high order bit should be zero. | ||
| 40 | * However, the Linux ISAPNP code historically used six bits for the | ||
| 41 | * first character, and there seem to be IDs that depend on that, | ||
| 42 | * e.g., "nEC8241" in the Linux 8250_pnp serial driver and the | ||
| 43 | * FreeBSD sys/pc98/cbus/sio_cbus.c driver. | ||
| 44 | */ | ||
| 45 | str[0] = 'A' + ((id >> 26) & 0x3f) - 1; | ||
| 46 | str[1] = 'A' + ((id >> 21) & 0x1f) - 1; | ||
| 47 | str[2] = 'A' + ((id >> 16) & 0x1f) - 1; | ||
| 48 | str[3] = hex_asc((id >> 12) & 0xf); | ||
| 49 | str[4] = hex_asc((id >> 8) & 0xf); | ||
| 50 | str[5] = hex_asc((id >> 4) & 0xf); | ||
| 51 | str[6] = hex_asc((id >> 0) & 0xf); | ||
| 52 | str[7] = '\0'; | ||
| 53 | } | ||
