[linux-2.6-block.git] / drivers / pnp / quirks.c

/*
 *  This file contains quirk handling code for PnP devices
 *  Some devices do not report all their resources, and need to have extra
 *  resources added. This is most easily accomplished at initialisation time
 *  when building up the resource structure for the first time.
 *
 *  Copyright (c) 2000 Peter Denison <peterd@pnd-pc.demon.co.uk>
 *
 *  Heavily based on PCI quirks handling which is
 *
 *  Copyright (c) 1999 Martin Mares <mj@ucw.cz>
 */

#include <linux/types.h>
#include <linux/kernel.h>
#include <linux/string.h>
#include <linux/slab.h>
#include <linux/pnp.h>
#include <linux/io.h>
#include <linux/kallsyms.h>
#include "base.h"

static void quirk_awe32_resources(struct pnp_dev *dev)
{
	struct pnp_port *port, *port2, *port3;
	struct pnp_option *res = dev->dependent;

	/*
	 * Unfortunately the isapnp_add_port_resource is too tightly bound
	 * into the PnP discovery sequence, and cannot be used. Link in the
	 * two extra ports (at offset 0x400 and 0x800 from the one given) by
	 * hand.
	 */
	for (; res; res = res->next) {
		port2 = pnp_alloc(sizeof(struct pnp_port));
		if (!port2)
			return;
		port3 = pnp_alloc(sizeof(struct pnp_port));
		if (!port3) {
			kfree(port2);
			return;
		}
		port = res->port;
		memcpy(port2, port, sizeof(struct pnp_port));
		memcpy(port3, port, sizeof(struct pnp_port));
		port->next = port2;
		port2->next = port3;
		port2->min += 0x400;
		port2->max += 0x400;
		port3->min += 0x800;
		port3->max += 0x800;
		dev_info(&dev->dev,
			"AWE32 quirk - added ioports 0x%lx and 0x%lx\n",
			(unsigned long)port2->min,
			(unsigned long)port3->min);
	}
}

static void quirk_cmi8330_resources(struct pnp_dev *dev)
{
	struct pnp_option *res = dev->dependent;
	unsigned long tmp;

	for (; res; res = res->next) {

		struct pnp_irq *irq;
		struct pnp_dma *dma;

		for (irq = res->irq; irq; irq = irq->next) {	// Valid irqs are 5, 7, 10
			tmp = 0x04A0;
			bitmap_copy(irq->map, &tmp, 16);	// 0000 0100 1010 0000
		}

		for (dma = res->dma; dma; dma = dma->next)	// Valid 8bit dma channels are 1,3
			if ((dma->flags & IORESOURCE_DMA_TYPE_MASK) ==
			    IORESOURCE_DMA_8BIT)
				dma->map = 0x000A;
	}
	dev_info(&dev->dev, "CMI8330 quirk - forced possible IRQs to 5, 7, 10 "
		"and DMA channels to 1, 3\n");
}

static void quirk_sb16audio_resources(struct pnp_dev *dev)
{
	struct pnp_port *port;
	struct pnp_option *res = dev->dependent;
	int changed = 0;

	/*
	 * The default range on the mpu port for these devices is 0x388-0x388.
	 * Here we increase that range so that two such cards can be
	 * auto-configured.
	 */

	for (; res; res = res->next) {
		port = res->port;
		if (!port)
			continue;
		port = port->next;
		if (!port)
			continue;
		port = port->next;
		if (!port)
			continue;
		if (port->min != port->max)
			continue;
		port->max += 0x70;
		changed = 1;
	}
	if (changed)
		dev_info(&dev->dev, "SB audio device quirk - increased port range\n");
}

static struct pnp_option *quirk_isapnp_mpu_options(struct pnp_dev *dev)
{
	struct pnp_option *head = NULL;
	struct pnp_option *prev = NULL;
	struct pnp_option *res;

	/*
	 * Build a functional IRQ-less variant of each MPU option.
	 */

	for (res = dev->dependent; res; res = res->next) {
		struct pnp_option *curr;
		struct pnp_port *port;
		struct pnp_port *copy;

		port = res->port;
		if (!port || !res->irq)
			continue;

		copy = pnp_alloc(sizeof *copy);
		if (!copy)
			break;

		copy->min = port->min;
		copy->max = port->max;
		copy->align = port->align;
		copy->size = port->size;
		copy->flags = port->flags;

		curr = pnp_build_option(PNP_RES_PRIORITY_FUNCTIONAL);
		if (!curr) {
			kfree(copy);
			break;
		}
		curr->port = copy;

		if (prev)
			prev->next = curr;
		else
			head = curr;
		prev = curr;
	}
	if (head)
		dev_info(&dev->dev, "adding IRQ-less MPU options\n");

	return head;
}

static void quirk_ad1815_mpu_resources(struct pnp_dev *dev)
{
	struct pnp_option *res;
	struct pnp_irq *irq;

	/*
	 * Distribute the independent IRQ over the dependent options
	 */

	res = dev->independent;
	if (!res)
		return;

	irq = res->irq;
	if (!irq || irq->next)
		return;

	res = dev->dependent;
	if (!res)
		return;

	while (1) {
		struct pnp_irq *copy;

		copy = pnp_alloc(sizeof *copy);
		if (!copy)
			break;

		memcpy(copy->map, irq->map, sizeof copy->map);
		copy->flags = irq->flags;

		copy->next = res->irq; /* Yes, this is NULL */
		res->irq = copy;

		if (!res->next)
			break;
		res = res->next;
	}
	kfree(irq);

	res->next = quirk_isapnp_mpu_options(dev);

	res = dev->independent;
	res->irq = NULL;
}

static void quirk_isapnp_mpu_resources(struct pnp_dev *dev)
{
	struct pnp_option *res;

	res = dev->dependent;
	if (!res)
		return;

	while (res->next)
		res = res->next;

	res->next = quirk_isapnp_mpu_options(dev);
}

#include <linux/pci.h>

static void quirk_system_pci_resources(struct pnp_dev *dev)
{
	struct pci_dev *pdev = NULL;
	struct resource *res;
	resource_size_t pnp_start, pnp_end, pci_start, pci_end;
	int i, j;

	/*
	 * Some BIOSes have PNP motherboard devices with resources that
	 * partially overlap PCI BARs.  The PNP system driver claims these
	 * motherboard resources, which prevents the normal PCI driver from
	 * requesting them later.
	 *
	 * This patch disables the PNP resources that conflict with PCI BARs
	 * so they won't be claimed by the PNP system driver.
	 */
	for_each_pci_dev(pdev) {
		for (i = 0; i < DEVICE_COUNT_RESOURCE; i++) {
			if (!(pci_resource_flags(pdev, i) & IORESOURCE_MEM) ||
			    pci_resource_len(pdev, i) == 0)
				continue;

			pci_start = pci_resource_start(pdev, i);
			pci_end = pci_resource_end(pdev, i);
			for (j = 0;
			     (res = pnp_get_resource(dev, IORESOURCE_MEM, j));
			     j++) {
				if (res->start == 0 && res->end == 0)
					continue;

				pnp_start = res->start;
				pnp_end = res->end;

				/*
				 * If the PNP region doesn't overlap the PCI
				 * region at all, there's no problem.
				 */
				if (pnp_end < pci_start || pnp_start > pci_end)
					continue;

				/*
				 * If the PNP region completely encloses (or is
				 * at least as large as) the PCI region, that's
				 * also OK.  For example, this happens when the
				 * PNP device describes a bridge with PCI
				 * behind it.
				 */
				if (pnp_start <= pci_start &&
				    pnp_end >= pci_end)
					continue;

				/*
				 * Otherwise, the PNP region overlaps *part* of
				 * the PCI region, and that might prevent a PCI
				 * driver from requesting its resources.
				 */
				dev_warn(&dev->dev, "mem resource "
					"(0x%llx-0x%llx) overlaps %s BAR %d "
					"(0x%llx-0x%llx), disabling\n",
					(unsigned long long) pnp_start,
					(unsigned long long) pnp_end,
					pci_name(pdev), i,
					(unsigned long long) pci_start,
					(unsigned long long) pci_end);
				res->flags |= IORESOURCE_DISABLED;
			}
		}
	}
}

/*
 *  PnP Quirks
 *  Cards or devices that need some tweaking due to incomplete resource info
 */

static struct pnp_fixup pnp_fixups[] = {
	/* Soundblaster awe io port quirk */
	{"CTL0021", quirk_awe32_resources},
	{"CTL0022", quirk_awe32_resources},
	{"CTL0023", quirk_awe32_resources},
	/* CMI 8330 interrupt and dma fix */
	{"@X@0001", quirk_cmi8330_resources},
	/* Soundblaster audio device io port range quirk */
	{"CTL0001", quirk_sb16audio_resources},
	{"CTL0031", quirk_sb16audio_resources},
	{"CTL0041", quirk_sb16audio_resources},
	{"CTL0042", quirk_sb16audio_resources},
	{"CTL0043", quirk_sb16audio_resources},
	{"CTL0044", quirk_sb16audio_resources},
	{"CTL0045", quirk_sb16audio_resources},
	/* Add IRQ-less MPU options */
	{"ADS7151", quirk_ad1815_mpu_resources},
	{"ADS7181", quirk_isapnp_mpu_resources},
	{"AZT0002", quirk_isapnp_mpu_resources},
	/* PnP resources that might overlap PCI BARs */
	{"PNP0c01", quirk_system_pci_resources},
	{"PNP0c02", quirk_system_pci_resources},
	{""}
};

void pnp_fixup_device(struct pnp_dev *dev)
{
	struct pnp_fixup *f;

	for (f = pnp_fixups; *f->id; f++) {
		if (!compare_pnp_id(dev->id, f->id))
			continue;
#ifdef DEBUG
		dev_dbg(&dev->dev, "%s: calling ", f->id);
		print_fn_descriptor_symbol("%s\n", f->quirk_function);
#endif
		f->quirk_function(dev);
	}
}
Commit	Line	Data
1da177e4 LT	1	/*
	2	* This file contains quirk handling code for PnP devices
	3	* Some devices do not report all their resources, and need to have extra
	4	* resources added. This is most easily accomplished at initialisation time
	5	* when building up the resource structure for the first time.
	6	*
	7	* Copyright (c) 2000 Peter Denison <peterd@pnd-pc.demon.co.uk>
	8	*
	9	* Heavily based on PCI quirks handling which is
	10	*
	11	* Copyright (c) 1999 Martin Mares <mj@ucw.cz>
	12	*/
	13
1da177e4 LT	14	#include <linux/types.h>
	15	#include <linux/kernel.h>
	16	#include <linux/string.h>
	17	#include <linux/slab.h>
1da177e4	18	#include <linux/pnp.h>
a1e7e636	19	#include <linux/io.h>
a05d0781	20	#include <linux/kallsyms.h>
1da177e4 LT	21	#include "base.h"
1da177e4 LT	22
1da177e4 LT	23	static void quirk_awe32_resources(struct pnp_dev *dev)
	24	{
	25	struct pnp_port port, port2, *port3;
	26	struct pnp_option *res = dev->dependent;
	27
	28	/*
	29	* Unfortunately the isapnp_add_port_resource is too tightly bound
	30	* into the PnP discovery sequence, and cannot be used. Link in the
	31	* two extra ports (at offset 0x400 and 0x800 from the one given) by
	32	* hand.
	33	*/
9dd78466	34	for (; res; res = res->next) {
1da177e4 LT	35	port2 = pnp_alloc(sizeof(struct pnp_port));
	36	if (!port2)
	37	return;
	38	port3 = pnp_alloc(sizeof(struct pnp_port));
	39	if (!port3) {
	40	kfree(port2);
	41	return;
	42	}
	43	port = res->port;
	44	memcpy(port2, port, sizeof(struct pnp_port));
	45	memcpy(port3, port, sizeof(struct pnp_port));
	46	port->next = port2;
	47	port2->next = port3;
	48	port2->min += 0x400;
	49	port2->max += 0x400;
	50	port3->min += 0x800;
	51	port3->max += 0x800;
1e3832b0 BH	52	dev_info(&dev->dev,
	53	"AWE32 quirk - added ioports 0x%lx and 0x%lx\n",
	54	(unsigned long)port2->min,
	55	(unsigned long)port3->min);
1da177e4	56	}
1da177e4 LT	57	}
	58
	59	static void quirk_cmi8330_resources(struct pnp_dev *dev)
	60	{
	61	struct pnp_option *res = dev->dependent;
	62	unsigned long tmp;
	63
9dd78466	64	for (; res; res = res->next) {
1da177e4 LT	65
	66	struct pnp_irq *irq;
	67	struct pnp_dma *dma;
	68
9dd78466	69	for (irq = res->irq; irq; irq = irq->next) { // Valid irqs are 5, 7, 10
1da177e4 LT	70	tmp = 0x04A0;
	71	bitmap_copy(irq->map, &tmp, 16); // 0000 0100 1010 0000
	72	}
	73
9dd78466 BH	74	for (dma = res->dma; dma; dma = dma->next) // Valid 8bit dma channels are 1,3
	75	if ((dma->flags & IORESOURCE_DMA_TYPE_MASK) ==
	76	IORESOURCE_DMA_8BIT)
1da177e4 LT	77	dma->map = 0x000A;
1da177e4 LT	78	}
1e3832b0 BH	79	dev_info(&dev->dev, "CMI8330 quirk - forced possible IRQs to 5, 7, 10 "
1e3832b0 BH	80	"and DMA channels to 1, 3\n");
1da177e4 LT	81	}
	82
	83	static void quirk_sb16audio_resources(struct pnp_dev *dev)
	84	{
	85	struct pnp_port *port;
	86	struct pnp_option *res = dev->dependent;
9dd78466	87	int changed = 0;
1da177e4 LT	88
	89	/*
	90	* The default range on the mpu port for these devices is 0x388-0x388.
	91	* Here we increase that range so that two such cards can be
	92	* auto-configured.
	93	*/
	94
9dd78466	95	for (; res; res = res->next) {
1da177e4	96	port = res->port;
9dd78466	97	if (!port)
1da177e4 LT	98	continue;
1da177e4 LT	99	port = port->next;
9dd78466	100	if (!port)
1da177e4 LT	101	continue;
1da177e4 LT	102	port = port->next;
9dd78466	103	if (!port)
1da177e4	104	continue;
9dd78466	105	if (port->min != port->max)
1da177e4 LT	106	continue;
	107	port->max += 0x70;
	108	changed = 1;
	109	}
9dd78466	110	if (changed)
1e3832b0	111	dev_info(&dev->dev, "SB audio device quirk - increased port range\n");
1da177e4 LT	112	}
1da177e4 LT	113
3b73a223 RH	114	static struct pnp_option quirk_isapnp_mpu_options(struct pnp_dev dev)
	115	{
	116	struct pnp_option *head = NULL;
	117	struct pnp_option *prev = NULL;
	118	struct pnp_option *res;
	119
	120	/*
	121	* Build a functional IRQ-less variant of each MPU option.
	122	*/
	123
	124	for (res = dev->dependent; res; res = res->next) {
	125	struct pnp_option *curr;
	126	struct pnp_port *port;
	127	struct pnp_port *copy;
	128
	129	port = res->port;
	130	if (!port \|\| !res->irq)
	131	continue;
	132
	133	copy = pnp_alloc(sizeof *copy);
	134	if (!copy)
	135	break;
	136
	137	copy->min = port->min;
	138	copy->max = port->max;
	139	copy->align = port->align;
	140	copy->size = port->size;
	141	copy->flags = port->flags;
	142
	143	curr = pnp_build_option(PNP_RES_PRIORITY_FUNCTIONAL);
	144	if (!curr) {
	145	kfree(copy);
	146	break;
	147	}
	148	curr->port = copy;
	149
	150	if (prev)
	151	prev->next = curr;
	152	else
	153	head = curr;
	154	prev = curr;
	155	}
	156	if (head)
	157	dev_info(&dev->dev, "adding IRQ-less MPU options\n");
	158
	159	return head;
	160	}
	161
	162	static void quirk_ad1815_mpu_resources(struct pnp_dev *dev)
	163	{
	164	struct pnp_option *res;
	165	struct pnp_irq *irq;
	166
	167	/*
	168	* Distribute the independent IRQ over the dependent options
	169	*/
	170
	171	res = dev->independent;
	172	if (!res)
	173	return;
	174
	175	irq = res->irq;
	176	if (!irq \|\| irq->next)
	177	return;
178
179	res = dev->dependent;
180	if (!res)
181	return;
182
183	while (1) {
184	struct pnp_irq *copy;
185
186	copy = pnp_alloc(sizeof *copy);
187	if (!copy)
188	break;
189
190	memcpy(copy->map, irq->map, sizeof copy->map);
191	copy->flags = irq->flags;
192
193	copy->next = res->irq; /* Yes, this is NULL */
194	res->irq = copy;
195
196	if (!res->next)
197	break;
198	res = res->next;
199	}
200	kfree(irq);
201
202	res->next = quirk_isapnp_mpu_options(dev);
203
204	res = dev->independent;
205	res->irq = NULL;
206	}
207
208	static void quirk_isapnp_mpu_resources(struct pnp_dev *dev)
209	{
210	struct pnp_option *res;
211
212	res = dev->dependent;
213	if (!res)
214	return;
215
216	while (res->next)
217	res = res->next;
218
219	res->next = quirk_isapnp_mpu_options(dev);
220	}
0509ad5e BH	221
	222	#include <linux/pci.h>
	223
	224	static void quirk_system_pci_resources(struct pnp_dev *dev)
	225	{
	226	struct pci_dev *pdev = NULL;
53052feb	227	struct resource *res;
0509ad5e BH	228	resource_size_t pnp_start, pnp_end, pci_start, pci_end;
	229	int i, j;
	230
	231	/*
	232	* Some BIOSes have PNP motherboard devices with resources that
	233	* partially overlap PCI BARs. The PNP system driver claims these
	234	* motherboard resources, which prevents the normal PCI driver from
	235	* requesting them later.
	236	*
	237	* This patch disables the PNP resources that conflict with PCI BARs
	238	* so they won't be claimed by the PNP system driver.
	239	*/
	240	for_each_pci_dev(pdev) {
	241	for (i = 0; i < DEVICE_COUNT_RESOURCE; i++) {
	242	if (!(pci_resource_flags(pdev, i) & IORESOURCE_MEM) \|\|
	243	pci_resource_len(pdev, i) == 0)
	244	continue;
	245
	246	pci_start = pci_resource_start(pdev, i);
	247	pci_end = pci_resource_end(pdev, i);
95ab3669 BH	248	for (j = 0;
	249	(res = pnp_get_resource(dev, IORESOURCE_MEM, j));
	250	j++) {
aee3ad81	251	if (res->start == 0 && res->end == 0)
0509ad5e BH	252	continue;
0509ad5e BH	253
95ab3669 BH	254	pnp_start = res->start;
95ab3669 BH	255	pnp_end = res->end;
0509ad5e BH	256
	257	/*
	258	* If the PNP region doesn't overlap the PCI
	259	* region at all, there's no problem.
	260	*/
	261	if (pnp_end < pci_start \|\| pnp_start > pci_end)
	262	continue;
	263
	264	/*
	265	* If the PNP region completely encloses (or is
	266	* at least as large as) the PCI region, that's
	267	* also OK. For example, this happens when the
	268	* PNP device describes a bridge with PCI
	269	* behind it.
	270	*/
	271	if (pnp_start <= pci_start &&
	272	pnp_end >= pci_end)
	273	continue;
	274
	275	/*
	276	* Otherwise, the PNP region overlaps part of
	277	* the PCI region, and that might prevent a PCI
	278	* driver from requesting its resources.
	279	*/
	280	dev_warn(&dev->dev, "mem resource "
	281	"(0x%llx-0x%llx) overlaps %s BAR %d "
	282	"(0x%llx-0x%llx), disabling\n",
	283	(unsigned long long) pnp_start,
	284	(unsigned long long) pnp_end,
	285	pci_name(pdev), i,
	286	(unsigned long long) pci_start,
	287	(unsigned long long) pci_end);
4b34fe15	288	res->flags \|= IORESOURCE_DISABLED;
0509ad5e BH	289	}
	290	}
	291	}
	292	}
	293
1da177e4 LT	294	/*
	295	* PnP Quirks
	296	* Cards or devices that need some tweaking due to incomplete resource info
	297	*/
	298
	299	static struct pnp_fixup pnp_fixups[] = {
	300	/* Soundblaster awe io port quirk */
9dd78466 BH	301	{"CTL0021", quirk_awe32_resources},
	302	{"CTL0022", quirk_awe32_resources},
	303	{"CTL0023", quirk_awe32_resources},
1da177e4	304	/* CMI 8330 interrupt and dma fix */
9dd78466	305	{"@X@0001", quirk_cmi8330_resources},
1da177e4	306	/* Soundblaster audio device io port range quirk */
9dd78466 BH	307	{"CTL0001", quirk_sb16audio_resources},
	308	{"CTL0031", quirk_sb16audio_resources},
	309	{"CTL0041", quirk_sb16audio_resources},
	310	{"CTL0042", quirk_sb16audio_resources},
	311	{"CTL0043", quirk_sb16audio_resources},
	312	{"CTL0044", quirk_sb16audio_resources},
	313	{"CTL0045", quirk_sb16audio_resources},
3b73a223 RH	314	/* Add IRQ-less MPU options */
	315	{"ADS7151", quirk_ad1815_mpu_resources},
	316	{"ADS7181", quirk_isapnp_mpu_resources},
	317	{"AZT0002", quirk_isapnp_mpu_resources},
	318	/* PnP resources that might overlap PCI BARs */
0509ad5e BH	319	{"PNP0c01", quirk_system_pci_resources},
0509ad5e BH	320	{"PNP0c02", quirk_system_pci_resources},
9dd78466	321	{""}
1da177e4 LT	322	};
	323
	324	void pnp_fixup_device(struct pnp_dev *dev)
	325	{
726a7a3d	326	struct pnp_fixup *f;
a05d0781	327
726a7a3d RH	328	for (f = pnp_fixups; *f->id; f++) {
	329	if (!compare_pnp_id(dev->id, f->id))
	330	continue;
a05d0781	331	#ifdef DEBUG
726a7a3d	332	dev_dbg(&dev->dev, "%s: calling ", f->id);
a442ac51	333	print_fn_descriptor_symbol("%s\n", f->quirk_function);
a05d0781	334	#endif
726a7a3d	335	f->quirk_function(dev);
1da177e4 LT	336	}
1da177e4 LT	337	}