1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * compat.c - A series of functions to make it easier to convert drivers that use 4 * the old isapnp APIs. If possible use the new APIs instead. 5 * 6 * Copyright 2002 Adam Belay <ambx1@neo.rr.com> 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) { /* look for a logical device from all cards */ 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) /* something is wrong */ 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); 91