aboutsummaryrefslogtreecommitdiffstats
diff options
context:
space:
mode:
-rw-r--r--drivers/pnp/base.h2
-rw-r--r--drivers/pnp/card.c27
-rw-r--r--drivers/pnp/isapnp/core.c21
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);
4void pnp_eisa_id_to_string(u32 id, char *str); 4void pnp_eisa_id_to_string(u32 id, char *str);
5struct pnp_dev *pnp_alloc_dev(struct pnp_protocol *, int id, char *pnpid); 5struct pnp_dev *pnp_alloc_dev(struct pnp_protocol *, int id, char *pnpid);
6struct pnp_id *pnp_add_id(struct pnp_dev *dev, char *id); 6struct pnp_id *pnp_add_id(struct pnp_dev *dev, char *id);
7int pnp_add_card_id(struct pnp_id *id, struct pnp_card *card); 7struct pnp_id *pnp_add_card_id(struct pnp_card *card, char *id);
8int pnp_interface_attach_device(struct pnp_dev *dev); 8int pnp_interface_attach_device(struct pnp_dev *dev);
9void pnp_fixup_device(struct pnp_dev *dev); 9void pnp_fixup_device(struct pnp_dev *dev);
10void pnp_free_option(struct pnp_option *option); 10void 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 */
103int pnp_add_card_id(struct pnp_id *id, struct pnp_card *card) 104struct 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
118static void pnp_free_card_ids(struct pnp_card *card) 133static 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)
822static void isapnp_parse_card_id(struct pnp_card *card, unsigned short vendor, 822static 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/*