diff options
-rw-r--r-- | drivers/pnp/base.h | 2 | ||||
-rw-r--r-- | drivers/pnp/card.c | 27 | ||||
-rw-r--r-- | drivers/pnp/isapnp/core.c | 21 |
3 files changed, 33 insertions, 17 deletions
diff --git a/drivers/pnp/base.h b/drivers/pnp/base.h index b492569bcdf4..37f7d85fc4bc 100644 --- a/drivers/pnp/base.h +++ b/drivers/pnp/base.h | |||
@@ -4,7 +4,7 @@ void *pnp_alloc(long size); | |||
4 | void pnp_eisa_id_to_string(u32 id, char *str); | 4 | void pnp_eisa_id_to_string(u32 id, char *str); |
5 | struct pnp_dev *pnp_alloc_dev(struct pnp_protocol *, int id, char *pnpid); | 5 | struct pnp_dev *pnp_alloc_dev(struct pnp_protocol *, int id, char *pnpid); |
6 | struct pnp_id *pnp_add_id(struct pnp_dev *dev, char *id); | 6 | struct pnp_id *pnp_add_id(struct pnp_dev *dev, char *id); |
7 | int pnp_add_card_id(struct pnp_id *id, struct pnp_card *card); | 7 | struct pnp_id *pnp_add_card_id(struct pnp_card *card, char *id); |
8 | int pnp_interface_attach_device(struct pnp_dev *dev); | 8 | int pnp_interface_attach_device(struct pnp_dev *dev); |
9 | void pnp_fixup_device(struct pnp_dev *dev); | 9 | void pnp_fixup_device(struct pnp_dev *dev); |
10 | void pnp_free_option(struct pnp_option *option); | 10 | void pnp_free_option(struct pnp_option *option); |
diff --git a/drivers/pnp/card.c b/drivers/pnp/card.c index da1c9909eb44..d606a163b1d7 100644 --- a/drivers/pnp/card.c +++ b/drivers/pnp/card.c | |||
@@ -5,6 +5,7 @@ | |||
5 | */ | 5 | */ |
6 | 6 | ||
7 | #include <linux/module.h> | 7 | #include <linux/module.h> |
8 | #include <linux/ctype.h> | ||
8 | #include <linux/slab.h> | 9 | #include <linux/slab.h> |
9 | #include <linux/pnp.h> | 10 | #include <linux/pnp.h> |
10 | #include "base.h" | 11 | #include "base.h" |
@@ -100,19 +101,33 @@ static int card_probe(struct pnp_card *card, struct pnp_card_driver *drv) | |||
100 | * @id: pointer to a pnp_id structure | 101 | * @id: pointer to a pnp_id structure |
101 | * @card: pointer to the desired card | 102 | * @card: pointer to the desired card |
102 | */ | 103 | */ |
103 | int pnp_add_card_id(struct pnp_id *id, struct pnp_card *card) | 104 | struct pnp_id *pnp_add_card_id(struct pnp_card *card, char *id) |
104 | { | 105 | { |
105 | struct pnp_id *ptr; | 106 | struct pnp_id *dev_id, *ptr; |
106 | 107 | ||
107 | id->next = NULL; | 108 | dev_id = kzalloc(sizeof(struct pnp_id), GFP_KERNEL); |
109 | if (!dev_id) | ||
110 | return NULL; | ||
111 | |||
112 | dev_id->id[0] = id[0]; | ||
113 | dev_id->id[1] = id[1]; | ||
114 | dev_id->id[2] = id[2]; | ||
115 | dev_id->id[3] = tolower(id[3]); | ||
116 | dev_id->id[4] = tolower(id[4]); | ||
117 | dev_id->id[5] = tolower(id[5]); | ||
118 | dev_id->id[6] = tolower(id[6]); | ||
119 | dev_id->id[7] = '\0'; | ||
120 | |||
121 | dev_id->next = NULL; | ||
108 | ptr = card->id; | 122 | ptr = card->id; |
109 | while (ptr && ptr->next) | 123 | while (ptr && ptr->next) |
110 | ptr = ptr->next; | 124 | ptr = ptr->next; |
111 | if (ptr) | 125 | if (ptr) |
112 | ptr->next = id; | 126 | ptr->next = dev_id; |
113 | else | 127 | else |
114 | card->id = id; | 128 | card->id = dev_id; |
115 | return 0; | 129 | |
130 | return dev_id; | ||
116 | } | 131 | } |
117 | 132 | ||
118 | static void pnp_free_card_ids(struct pnp_card *card) | 133 | static void pnp_free_card_ids(struct pnp_card *card) |
diff --git a/drivers/pnp/isapnp/core.c b/drivers/pnp/isapnp/core.c index 727936a6befb..1949c18a7365 100644 --- a/drivers/pnp/isapnp/core.c +++ b/drivers/pnp/isapnp/core.c | |||
@@ -822,17 +822,18 @@ static unsigned char __init isapnp_checksum(unsigned char *data) | |||
822 | static void isapnp_parse_card_id(struct pnp_card *card, unsigned short vendor, | 822 | static void isapnp_parse_card_id(struct pnp_card *card, unsigned short vendor, |
823 | unsigned short device) | 823 | unsigned short device) |
824 | { | 824 | { |
825 | struct pnp_id *id = kzalloc(sizeof(struct pnp_id), GFP_KERNEL); | 825 | char id[8]; |
826 | 826 | ||
827 | if (!id) | 827 | id[0] = 'A' + ((vendor >> 2) & 0x3f) - 1; |
828 | return; | 828 | id[1] = 'A' + (((vendor & 3) << 3) | ((vendor >> 13) & 7)) - 1; |
829 | sprintf(id->id, "%c%c%c%x%x%x%x", | 829 | id[2] = 'A' + ((vendor >> 8) & 0x1f) - 1; |
830 | 'A' + ((vendor >> 2) & 0x3f) - 1, | 830 | id[3] = hex_asc((device >> 4) & 0x0f); |
831 | 'A' + (((vendor & 3) << 3) | ((vendor >> 13) & 7)) - 1, | 831 | id[4] = hex_asc(device & 0x0f); |
832 | 'A' + ((vendor >> 8) & 0x1f) - 1, | 832 | id[5] = hex_asc((device >> 12) & 0x0f); |
833 | (device >> 4) & 0x0f, | 833 | id[6] = hex_asc((device >> 8) & 0x0f); |
834 | device & 0x0f, (device >> 12) & 0x0f, (device >> 8) & 0x0f); | 834 | id[7] = '\0'; |
835 | pnp_add_card_id(id, card); | 835 | |
836 | pnp_add_card_id(card, id); | ||
836 | } | 837 | } |
837 | 838 | ||
838 | /* | 839 | /* |