[mirror_ubuntu-artful-kernel.git] / drivers / pnp / isapnp / compat.c

/*
 * 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 <ambx1@neo.rr.com>
 */

#include <linux/module.h>
#include <linux/isapnp.h>
#include <linux/string.h>

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