This source file includes following definitions.
- pnp_convert_id
- pnp_find_card
- pnp_find_dev
1
2
3
4
5
6
7
8
9 #include <linux/module.h>
10 #include <linux/isapnp.h>
11 #include <linux/string.h>
12
13 static void pnp_convert_id(char *buf, unsigned short vendor,
14 unsigned short device)
15 {
16 sprintf(buf, "%c%c%c%x%x%x%x",
17 'A' + ((vendor >> 2) & 0x3f) - 1,
18 'A' + (((vendor & 3) << 3) | ((vendor >> 13) & 7)) - 1,
19 'A' + ((vendor >> 8) & 0x1f) - 1,
20 (device >> 4) & 0x0f, device & 0x0f,
21 (device >> 12) & 0x0f, (device >> 8) & 0x0f);
22 }
23
24 struct pnp_card *pnp_find_card(unsigned short vendor, unsigned short device,
25 struct pnp_card *from)
26 {
27 char id[8];
28 char any[8];
29 struct list_head *list;
30
31 pnp_convert_id(id, vendor, device);
32 pnp_convert_id(any, ISAPNP_ANY_ID, ISAPNP_ANY_ID);
33
34 list = from ? from->global_list.next : pnp_cards.next;
35
36 while (list != &pnp_cards) {
37 struct pnp_card *card = global_to_pnp_card(list);
38
39 if (compare_pnp_id(card->id, id) || (memcmp(id, any, 7) == 0))
40 return card;
41 list = list->next;
42 }
43 return NULL;
44 }
45
46 struct pnp_dev *pnp_find_dev(struct pnp_card *card, unsigned short vendor,
47 unsigned short function, struct pnp_dev *from)
48 {
49 char id[8];
50 char any[8];
51
52 pnp_convert_id(id, vendor, function);
53 pnp_convert_id(any, ISAPNP_ANY_ID, ISAPNP_ANY_ID);
54 if (card == NULL) {
55 struct list_head *list;
56
57 list = pnp_global.next;
58 if (from)
59 list = from->global_list.next;
60
61 while (list != &pnp_global) {
62 struct pnp_dev *dev = global_to_pnp_dev(list);
63
64 if (compare_pnp_id(dev->id, id) ||
65 (memcmp(id, any, 7) == 0))
66 return dev;
67 list = list->next;
68 }
69 } else {
70 struct list_head *list;
71
72 list = card->devices.next;
73 if (from) {
74 list = from->card_list.next;
75 if (from->card != card)
76 return NULL;
77 }
78 while (list != &card->devices) {
79 struct pnp_dev *dev = card_to_pnp_dev(list);
80
81 if (compare_pnp_id(dev->id, id))
82 return dev;
83 list = list->next;
84 }
85 }
86 return NULL;
87 }
88
89 EXPORT_SYMBOL(pnp_find_card);
90 EXPORT_SYMBOL(pnp_find_dev);