11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * compat.c - A series of functions to make it easier to convert drivers that use 31da177e4SLinus Torvalds * the old isapnp APIs. If possible use the new APIs instead. 41da177e4SLinus Torvalds * 51da177e4SLinus Torvalds * Copyright 2002 Adam Belay <ambx1@neo.rr.com> 61da177e4SLinus Torvalds */ 71da177e4SLinus Torvalds 81da177e4SLinus Torvalds #include <linux/module.h> 91da177e4SLinus Torvalds #include <linux/isapnp.h> 101da177e4SLinus Torvalds #include <linux/string.h> 111da177e4SLinus Torvalds 129dd78466SBjorn Helgaas static void pnp_convert_id(char *buf, unsigned short vendor, 139dd78466SBjorn Helgaas unsigned short device) 141da177e4SLinus Torvalds { 151da177e4SLinus Torvalds sprintf(buf, "%c%c%c%x%x%x%x", 161da177e4SLinus Torvalds 'A' + ((vendor >> 2) & 0x3f) - 1, 171da177e4SLinus Torvalds 'A' + (((vendor & 3) << 3) | ((vendor >> 13) & 7)) - 1, 181da177e4SLinus Torvalds 'A' + ((vendor >> 8) & 0x1f) - 1, 19*07d4e9afSBjorn Helgaas (device >> 4) & 0x0f, device & 0x0f, 20*07d4e9afSBjorn Helgaas (device >> 12) & 0x0f, (device >> 8) & 0x0f); 211da177e4SLinus Torvalds } 221da177e4SLinus Torvalds 23*07d4e9afSBjorn Helgaas struct pnp_card *pnp_find_card(unsigned short vendor, unsigned short device, 24*07d4e9afSBjorn Helgaas struct pnp_card *from) 251da177e4SLinus Torvalds { 261da177e4SLinus Torvalds char id[8]; 271da177e4SLinus Torvalds char any[8]; 281da177e4SLinus Torvalds struct list_head *list; 29*07d4e9afSBjorn Helgaas 301da177e4SLinus Torvalds pnp_convert_id(id, vendor, device); 311da177e4SLinus Torvalds pnp_convert_id(any, ISAPNP_ANY_ID, ISAPNP_ANY_ID); 321da177e4SLinus Torvalds 331da177e4SLinus Torvalds list = from ? from->global_list.next : pnp_cards.next; 341da177e4SLinus Torvalds 351da177e4SLinus Torvalds while (list != &pnp_cards) { 361da177e4SLinus Torvalds struct pnp_card *card = global_to_pnp_card(list); 37*07d4e9afSBjorn Helgaas 381da177e4SLinus Torvalds if (compare_pnp_id(card->id, id) || (memcmp(id, any, 7) == 0)) 391da177e4SLinus Torvalds return card; 401da177e4SLinus Torvalds list = list->next; 411da177e4SLinus Torvalds } 421da177e4SLinus Torvalds return NULL; 431da177e4SLinus Torvalds } 441da177e4SLinus Torvalds 45*07d4e9afSBjorn Helgaas struct pnp_dev *pnp_find_dev(struct pnp_card *card, unsigned short vendor, 469dd78466SBjorn Helgaas unsigned short function, struct pnp_dev *from) 471da177e4SLinus Torvalds { 481da177e4SLinus Torvalds char id[8]; 491da177e4SLinus Torvalds char any[8]; 50*07d4e9afSBjorn Helgaas 511da177e4SLinus Torvalds pnp_convert_id(id, vendor, function); 521da177e4SLinus Torvalds pnp_convert_id(any, ISAPNP_ANY_ID, ISAPNP_ANY_ID); 531da177e4SLinus Torvalds if (card == NULL) { /* look for a logical device from all cards */ 541da177e4SLinus Torvalds struct list_head *list; 551da177e4SLinus Torvalds 561da177e4SLinus Torvalds list = pnp_global.next; 571da177e4SLinus Torvalds if (from) 581da177e4SLinus Torvalds list = from->global_list.next; 591da177e4SLinus Torvalds 601da177e4SLinus Torvalds while (list != &pnp_global) { 611da177e4SLinus Torvalds struct pnp_dev *dev = global_to_pnp_dev(list); 62*07d4e9afSBjorn Helgaas 63*07d4e9afSBjorn Helgaas if (compare_pnp_id(dev->id, id) || 64*07d4e9afSBjorn Helgaas (memcmp(id, any, 7) == 0)) 651da177e4SLinus Torvalds return dev; 661da177e4SLinus Torvalds list = list->next; 671da177e4SLinus Torvalds } 681da177e4SLinus Torvalds } else { 691da177e4SLinus Torvalds struct list_head *list; 701da177e4SLinus Torvalds 711da177e4SLinus Torvalds list = card->devices.next; 721da177e4SLinus Torvalds if (from) { 731da177e4SLinus Torvalds list = from->card_list.next; 741da177e4SLinus Torvalds if (from->card != card) /* something is wrong */ 751da177e4SLinus Torvalds return NULL; 761da177e4SLinus Torvalds } 771da177e4SLinus Torvalds while (list != &card->devices) { 781da177e4SLinus Torvalds struct pnp_dev *dev = card_to_pnp_dev(list); 79*07d4e9afSBjorn Helgaas 801da177e4SLinus Torvalds if (compare_pnp_id(dev->id, id)) 811da177e4SLinus Torvalds return dev; 821da177e4SLinus Torvalds list = list->next; 831da177e4SLinus Torvalds } 841da177e4SLinus Torvalds } 851da177e4SLinus Torvalds return NULL; 861da177e4SLinus Torvalds } 871da177e4SLinus Torvalds 881da177e4SLinus Torvalds EXPORT_SYMBOL(pnp_find_card); 891da177e4SLinus Torvalds EXPORT_SYMBOL(pnp_find_dev); 90