[netwatch.git] / pci / pci-bother.c

#include <pci.h>

struct pci_bother {
	int bus, dev, fn;
	unsigned short origstate;
};

static struct pci_bother bothers[MAX_BOTHERS];
static int nbothers = 0;

int pci_bother_add(pci_dev_t *dev)
{
	if (nbothers == MAX_BOTHERS)
		return -1;
	
	bothers[nbothers].bus = dev->bus;
	bothers[nbothers].dev = dev->dev;
	bothers[nbothers].fn = dev->fn;
	
	bothers[nbothers].origstate = pci_read16(dev->bus, dev->dev, dev->fn, 0x04);
	
	nbothers++;
	
	return 0;
}

void pci_bother_all()
{
	int i;
	
	for (i = 0; i < nbothers; i++)
		pci_write16(bothers[i].bus, bothers[i].dev, bothers[i].fn, 0x0);
}

void pci_unbother_all()
{
	int i;
	
	for (i = 0; i < nbothers; i++)
		pci_write16(bothers[i].bus, bothers[i].dev, bothers[i].fn, bothers[i].origstate);
}
Commit	Line	Data
ec2d6189 JW	1	#include <pci.h>
	2
	3	struct pci_bother {
	4	int bus, dev, fn;
	5	unsigned short origstate;
	6	};
	7
	8	static struct pci_bother bothers[MAX_BOTHERS];
	9	static int nbothers = 0;
	10
	11	int pci_bother_add(pci_dev_t *dev)
	12	{
	13	if (nbothers == MAX_BOTHERS)
	14	return -1;
	15
	16	bothers[nbothers].bus = dev->bus;
	17	bothers[nbothers].dev = dev->dev;
	18	bothers[nbothers].fn = dev->fn;
	19
	20	bothers[nbothers].origstate = pci_read16(dev->bus, dev->dev, dev->fn, 0x04);
	21
	22	nbothers++;
	23
	24	return 0;
	25	}
	26
	27	void pci_bother_all()
	28	{
	29	int i;
	30
	31	for (i = 0; i < nbothers; i++)
	32	pci_write16(bothers[i].bus, bothers[i].dev, bothers[i].fn, 0x0);
	33	}
	34
	35	void pci_unbother_all()
	36	{
	37	int i;
	38
	39	for (i = 0; i < nbothers; i++)
	40	pci_write16(bothers[i].bus, bothers[i].dev, bothers[i].fn, bothers[i].origstate);
	41	}