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); 92