diff options
Diffstat (limited to 'drivers/pnp/card.c')
-rw-r--r-- | drivers/pnp/card.c | 55 |
1 files changed, 46 insertions, 9 deletions
diff --git a/drivers/pnp/card.c b/drivers/pnp/card.c index da1c9909eb44..a762a4176736 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) |
@@ -136,6 +151,31 @@ static void pnp_release_card(struct device *dmdev) | |||
136 | kfree(card); | 151 | kfree(card); |
137 | } | 152 | } |
138 | 153 | ||
154 | struct pnp_card *pnp_alloc_card(struct pnp_protocol *protocol, int id, char *pnpid) | ||
155 | { | ||
156 | struct pnp_card *card; | ||
157 | struct pnp_id *dev_id; | ||
158 | |||
159 | card = kzalloc(sizeof(struct pnp_card), GFP_KERNEL); | ||
160 | if (!card) | ||
161 | return NULL; | ||
162 | |||
163 | card->protocol = protocol; | ||
164 | card->number = id; | ||
165 | |||
166 | card->dev.parent = &card->protocol->dev; | ||
167 | sprintf(card->dev.bus_id, "%02x:%02x", card->protocol->number, | ||
168 | card->number); | ||
169 | |||
170 | dev_id = pnp_add_card_id(card, pnpid); | ||
171 | if (!dev_id) { | ||
172 | kfree(card); | ||
173 | return NULL; | ||
174 | } | ||
175 | |||
176 | return card; | ||
177 | } | ||
178 | |||
139 | static ssize_t pnp_show_card_name(struct device *dmdev, | 179 | static ssize_t pnp_show_card_name(struct device *dmdev, |
140 | struct device_attribute *attr, char *buf) | 180 | struct device_attribute *attr, char *buf) |
141 | { | 181 | { |
@@ -191,9 +231,6 @@ int pnp_add_card(struct pnp_card *card) | |||
191 | int error; | 231 | int error; |
192 | struct list_head *pos, *temp; | 232 | struct list_head *pos, *temp; |
193 | 233 | ||
194 | sprintf(card->dev.bus_id, "%02x:%02x", card->protocol->number, | ||
195 | card->number); | ||
196 | card->dev.parent = &card->protocol->dev; | ||
197 | card->dev.bus = NULL; | 234 | card->dev.bus = NULL; |
198 | card->dev.release = &pnp_release_card; | 235 | card->dev.release = &pnp_release_card; |
199 | error = device_register(&card->dev); | 236 | error = device_register(&card->dev); |