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