From 57f0f512b273f60d52568b8c6b77e17f5636edc0 Mon Sep 17 00:00:00 2001 From: André Fabian Silva Delgado Date: Wed, 5 Aug 2015 17:04:01 -0300 Subject: Initial import --- drivers/pnp/isapnp/compat.c | 89 +++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 89 insertions(+) create mode 100644 drivers/pnp/isapnp/compat.c (limited to 'drivers/pnp/isapnp/compat.c') diff --git a/drivers/pnp/isapnp/compat.c b/drivers/pnp/isapnp/compat.c new file mode 100644 index 000000000..10bdcc4d4 --- /dev/null +++ b/drivers/pnp/isapnp/compat.c @@ -0,0 +1,89 @@ +/* + * compat.c - A series of functions to make it easier to convert drivers that use + * the old isapnp APIs. If possible use the new APIs instead. + * + * Copyright 2002 Adam Belay + */ + +#include +#include +#include + +static void pnp_convert_id(char *buf, unsigned short vendor, + unsigned short device) +{ + sprintf(buf, "%c%c%c%x%x%x%x", + 'A' + ((vendor >> 2) & 0x3f) - 1, + 'A' + (((vendor & 3) << 3) | ((vendor >> 13) & 7)) - 1, + 'A' + ((vendor >> 8) & 0x1f) - 1, + (device >> 4) & 0x0f, device & 0x0f, + (device >> 12) & 0x0f, (device >> 8) & 0x0f); +} + +struct pnp_card *pnp_find_card(unsigned short vendor, unsigned short device, + struct pnp_card *from) +{ + char id[8]; + char any[8]; + struct list_head *list; + + pnp_convert_id(id, vendor, device); + pnp_convert_id(any, ISAPNP_ANY_ID, ISAPNP_ANY_ID); + + list = from ? from->global_list.next : pnp_cards.next; + + while (list != &pnp_cards) { + struct pnp_card *card = global_to_pnp_card(list); + + if (compare_pnp_id(card->id, id) || (memcmp(id, any, 7) == 0)) + return card; + list = list->next; + } + return NULL; +} + +struct pnp_dev *pnp_find_dev(struct pnp_card *card, unsigned short vendor, + unsigned short function, struct pnp_dev *from) +{ + char id[8]; + char any[8]; + + pnp_convert_id(id, vendor, function); + pnp_convert_id(any, ISAPNP_ANY_ID, ISAPNP_ANY_ID); + if (card == NULL) { /* look for a logical device from all cards */ + struct list_head *list; + + list = pnp_global.next; + if (from) + list = from->global_list.next; + + while (list != &pnp_global) { + struct pnp_dev *dev = global_to_pnp_dev(list); + + if (compare_pnp_id(dev->id, id) || + (memcmp(id, any, 7) == 0)) + return dev; + list = list->next; + } + } else { + struct list_head *list; + + list = card->devices.next; + if (from) { + list = from->card_list.next; + if (from->card != card) /* something is wrong */ + return NULL; + } + while (list != &card->devices) { + struct pnp_dev *dev = card_to_pnp_dev(list); + + if (compare_pnp_id(dev->id, id)) + return dev; + list = list->next; + } + } + return NULL; +} + +EXPORT_SYMBOL(pnp_find_card); +EXPORT_SYMBOL(pnp_find_dev); -- cgit v1.2.3-54-g00ecf