1*b2441318SGreg Kroah-Hartman // SPDX-License-Identifier: GPL-2.0
21da177e4SLinus Torvalds /*
31da177e4SLinus Torvalds * compat.c - A series of functions to make it easier to convert drivers that use
41da177e4SLinus Torvalds * the old isapnp APIs. If possible use the new APIs instead.
51da177e4SLinus Torvalds *
61da177e4SLinus Torvalds * Copyright 2002 Adam Belay <ambx1@neo.rr.com>
71da177e4SLinus Torvalds */
81da177e4SLinus Torvalds
91da177e4SLinus Torvalds #include <linux/module.h>
101da177e4SLinus Torvalds #include <linux/isapnp.h>
111da177e4SLinus Torvalds #include <linux/string.h>
121da177e4SLinus Torvalds
pnp_convert_id(char * buf,unsigned short vendor,unsigned short device)139dd78466SBjorn Helgaas static void pnp_convert_id(char *buf, unsigned short vendor,
149dd78466SBjorn Helgaas unsigned short device)
151da177e4SLinus Torvalds {
161da177e4SLinus Torvalds sprintf(buf, "%c%c%c%x%x%x%x",
171da177e4SLinus Torvalds 'A' + ((vendor >> 2) & 0x3f) - 1,
181da177e4SLinus Torvalds 'A' + (((vendor & 3) << 3) | ((vendor >> 13) & 7)) - 1,
191da177e4SLinus Torvalds 'A' + ((vendor >> 8) & 0x1f) - 1,
2007d4e9afSBjorn Helgaas (device >> 4) & 0x0f, device & 0x0f,
2107d4e9afSBjorn Helgaas (device >> 12) & 0x0f, (device >> 8) & 0x0f);
221da177e4SLinus Torvalds }
231da177e4SLinus Torvalds
pnp_find_dev(struct pnp_card * card,unsigned short vendor,unsigned short function,struct pnp_dev * from)2407d4e9afSBjorn Helgaas struct pnp_dev *pnp_find_dev(struct pnp_card *card, unsigned short vendor,
259dd78466SBjorn Helgaas unsigned short function, struct pnp_dev *from)
261da177e4SLinus Torvalds {
271da177e4SLinus Torvalds char id[8];
281da177e4SLinus Torvalds char any[8];
2907d4e9afSBjorn Helgaas
301da177e4SLinus Torvalds pnp_convert_id(id, vendor, function);
311da177e4SLinus Torvalds pnp_convert_id(any, ISAPNP_ANY_ID, ISAPNP_ANY_ID);
321da177e4SLinus Torvalds if (card == NULL) { /* look for a logical device from all cards */
331da177e4SLinus Torvalds struct list_head *list;
341da177e4SLinus Torvalds
351da177e4SLinus Torvalds list = pnp_global.next;
361da177e4SLinus Torvalds if (from)
371da177e4SLinus Torvalds list = from->global_list.next;
381da177e4SLinus Torvalds
391da177e4SLinus Torvalds while (list != &pnp_global) {
401da177e4SLinus Torvalds struct pnp_dev *dev = global_to_pnp_dev(list);
4107d4e9afSBjorn Helgaas
4207d4e9afSBjorn Helgaas if (compare_pnp_id(dev->id, id) ||
4307d4e9afSBjorn Helgaas (memcmp(id, any, 7) == 0))
441da177e4SLinus Torvalds return dev;
451da177e4SLinus Torvalds list = list->next;
461da177e4SLinus Torvalds }
471da177e4SLinus Torvalds } else {
481da177e4SLinus Torvalds struct list_head *list;
491da177e4SLinus Torvalds
501da177e4SLinus Torvalds list = card->devices.next;
511da177e4SLinus Torvalds if (from) {
521da177e4SLinus Torvalds list = from->card_list.next;
531da177e4SLinus Torvalds if (from->card != card) /* something is wrong */
541da177e4SLinus Torvalds return NULL;
551da177e4SLinus Torvalds }
561da177e4SLinus Torvalds while (list != &card->devices) {
571da177e4SLinus Torvalds struct pnp_dev *dev = card_to_pnp_dev(list);
5807d4e9afSBjorn Helgaas
591da177e4SLinus Torvalds if (compare_pnp_id(dev->id, id))
601da177e4SLinus Torvalds return dev;
611da177e4SLinus Torvalds list = list->next;
621da177e4SLinus Torvalds }
631da177e4SLinus Torvalds }
641da177e4SLinus Torvalds return NULL;
651da177e4SLinus Torvalds }
661da177e4SLinus Torvalds EXPORT_SYMBOL(pnp_find_dev);
67