1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * compat.c - A series of functions to make it easier to convert drivers that use
4*4882a593Smuzhiyun * the old isapnp APIs. If possible use the new APIs instead.
5*4882a593Smuzhiyun *
6*4882a593Smuzhiyun * Copyright 2002 Adam Belay <ambx1@neo.rr.com>
7*4882a593Smuzhiyun */
8*4882a593Smuzhiyun
9*4882a593Smuzhiyun #include <linux/module.h>
10*4882a593Smuzhiyun #include <linux/isapnp.h>
11*4882a593Smuzhiyun #include <linux/string.h>
12*4882a593Smuzhiyun
pnp_convert_id(char * buf,unsigned short vendor,unsigned short device)13*4882a593Smuzhiyun static void pnp_convert_id(char *buf, unsigned short vendor,
14*4882a593Smuzhiyun unsigned short device)
15*4882a593Smuzhiyun {
16*4882a593Smuzhiyun sprintf(buf, "%c%c%c%x%x%x%x",
17*4882a593Smuzhiyun 'A' + ((vendor >> 2) & 0x3f) - 1,
18*4882a593Smuzhiyun 'A' + (((vendor & 3) << 3) | ((vendor >> 13) & 7)) - 1,
19*4882a593Smuzhiyun 'A' + ((vendor >> 8) & 0x1f) - 1,
20*4882a593Smuzhiyun (device >> 4) & 0x0f, device & 0x0f,
21*4882a593Smuzhiyun (device >> 12) & 0x0f, (device >> 8) & 0x0f);
22*4882a593Smuzhiyun }
23*4882a593Smuzhiyun
pnp_find_dev(struct pnp_card * card,unsigned short vendor,unsigned short function,struct pnp_dev * from)24*4882a593Smuzhiyun struct pnp_dev *pnp_find_dev(struct pnp_card *card, unsigned short vendor,
25*4882a593Smuzhiyun unsigned short function, struct pnp_dev *from)
26*4882a593Smuzhiyun {
27*4882a593Smuzhiyun char id[8];
28*4882a593Smuzhiyun char any[8];
29*4882a593Smuzhiyun
30*4882a593Smuzhiyun pnp_convert_id(id, vendor, function);
31*4882a593Smuzhiyun pnp_convert_id(any, ISAPNP_ANY_ID, ISAPNP_ANY_ID);
32*4882a593Smuzhiyun if (card == NULL) { /* look for a logical device from all cards */
33*4882a593Smuzhiyun struct list_head *list;
34*4882a593Smuzhiyun
35*4882a593Smuzhiyun list = pnp_global.next;
36*4882a593Smuzhiyun if (from)
37*4882a593Smuzhiyun list = from->global_list.next;
38*4882a593Smuzhiyun
39*4882a593Smuzhiyun while (list != &pnp_global) {
40*4882a593Smuzhiyun struct pnp_dev *dev = global_to_pnp_dev(list);
41*4882a593Smuzhiyun
42*4882a593Smuzhiyun if (compare_pnp_id(dev->id, id) ||
43*4882a593Smuzhiyun (memcmp(id, any, 7) == 0))
44*4882a593Smuzhiyun return dev;
45*4882a593Smuzhiyun list = list->next;
46*4882a593Smuzhiyun }
47*4882a593Smuzhiyun } else {
48*4882a593Smuzhiyun struct list_head *list;
49*4882a593Smuzhiyun
50*4882a593Smuzhiyun list = card->devices.next;
51*4882a593Smuzhiyun if (from) {
52*4882a593Smuzhiyun list = from->card_list.next;
53*4882a593Smuzhiyun if (from->card != card) /* something is wrong */
54*4882a593Smuzhiyun return NULL;
55*4882a593Smuzhiyun }
56*4882a593Smuzhiyun while (list != &card->devices) {
57*4882a593Smuzhiyun struct pnp_dev *dev = card_to_pnp_dev(list);
58*4882a593Smuzhiyun
59*4882a593Smuzhiyun if (compare_pnp_id(dev->id, id))
60*4882a593Smuzhiyun return dev;
61*4882a593Smuzhiyun list = list->next;
62*4882a593Smuzhiyun }
63*4882a593Smuzhiyun }
64*4882a593Smuzhiyun return NULL;
65*4882a593Smuzhiyun }
66*4882a593Smuzhiyun
67*4882a593Smuzhiyun EXPORT_SYMBOL(pnp_find_dev);
68