Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * compat.c - A series of functions to make it easier to convert drivers that use | |
3 | * the old isapnp APIs. If possible use the new APIs instead. | |
4 | * | |
5 | * Copyright 2002 Adam Belay <ambx1@neo.rr.com> | |
6 | * | |
7 | */ | |
8 | ||
9 | /* TODO: see if more isapnp functions are needed here */ | |
10 | ||
11 | #include <linux/config.h> | |
12 | #include <linux/module.h> | |
13 | #include <linux/isapnp.h> | |
14 | #include <linux/string.h> | |
15 | ||
16 | static void pnp_convert_id(char *buf, unsigned short vendor, unsigned short device) | |
17 | { | |
18 | sprintf(buf, "%c%c%c%x%x%x%x", | |
19 | 'A' + ((vendor >> 2) & 0x3f) - 1, | |
20 | 'A' + (((vendor & 3) << 3) | ((vendor >> 13) & 7)) - 1, | |
21 | 'A' + ((vendor >> 8) & 0x1f) - 1, | |
22 | (device >> 4) & 0x0f, | |
23 | device & 0x0f, | |
24 | (device >> 12) & 0x0f, | |
25 | (device >> 8) & 0x0f); | |
26 | } | |
27 | ||
28 | struct pnp_card *pnp_find_card(unsigned short vendor, | |
29 | unsigned short device, | |
30 | struct pnp_card *from) | |
31 | { | |
32 | char id[8]; | |
33 | char any[8]; | |
34 | struct list_head *list; | |
35 | pnp_convert_id(id, vendor, device); | |
36 | pnp_convert_id(any, ISAPNP_ANY_ID, ISAPNP_ANY_ID); | |
37 | ||
38 | list = from ? from->global_list.next : pnp_cards.next; | |
39 | ||
40 | while (list != &pnp_cards) { | |
41 | struct pnp_card *card = global_to_pnp_card(list); | |
42 | if (compare_pnp_id(card->id,id) || (memcmp(id,any,7)==0)) | |
43 | return card; | |
44 | list = list->next; | |
45 | } | |
46 | return NULL; | |
47 | } | |
48 | ||
49 | struct pnp_dev *pnp_find_dev(struct pnp_card *card, | |
50 | unsigned short vendor, | |
51 | unsigned short function, | |
52 | struct pnp_dev *from) | |
53 | { | |
54 | char id[8]; | |
55 | char any[8]; | |
56 | pnp_convert_id(id, vendor, function); | |
57 | pnp_convert_id(any, ISAPNP_ANY_ID, ISAPNP_ANY_ID); | |
58 | if (card == NULL) { /* look for a logical device from all cards */ | |
59 | struct list_head *list; | |
60 | ||
61 | list = pnp_global.next; | |
62 | if (from) | |
63 | list = from->global_list.next; | |
64 | ||
65 | while (list != &pnp_global) { | |
66 | struct pnp_dev *dev = global_to_pnp_dev(list); | |
67 | if (compare_pnp_id(dev->id,id) || (memcmp(id,any,7)==0)) | |
68 | return dev; | |
69 | list = list->next; | |
70 | } | |
71 | } else { | |
72 | struct list_head *list; | |
73 | ||
74 | list = card->devices.next; | |
75 | if (from) { | |
76 | list = from->card_list.next; | |
77 | if (from->card != card) /* something is wrong */ | |
78 | return NULL; | |
79 | } | |
80 | while (list != &card->devices) { | |
81 | struct pnp_dev *dev = card_to_pnp_dev(list); | |
82 | if (compare_pnp_id(dev->id,id)) | |
83 | return dev; | |
84 | list = list->next; | |
85 | } | |
86 | } | |
87 | return NULL; | |
88 | } | |
89 | ||
90 | EXPORT_SYMBOL(pnp_find_card); | |
91 | EXPORT_SYMBOL(pnp_find_dev); |