#include <video_defines.h>
#include <minilib.h>
#include <smi.h>
- #include "3c905.h"
+#include <pci-bother.h>
+ #include "../net/net.h"
#include "vga-overlay.h"
#include "packet.h"
pcisave = inl(0xCF8);
vgasave = inb(0x3D4);
+ pci_unbother_all();
counter++;
sprintf(statstr, "15-412! %08x %08x", smi_status(), counter);
smi_poll();
+ pci_bother_all();
outl(0xCF8, pcisave);
outb(0x3D4, vgasave);
}
#include <pci.h>
+#include <pci-bother.h>
#include <output.h>
#include "net.h"
-static int found = 0, _bus, _dev, _fn;
-
+ struct nic nic;
+
static int bother_3c905(pci_dev_t *dev, void *nutrinus)
{
if (dev->vid == 0x10B7 || dev->did == 0x9200)
{
outputf("Found a 3c905 to bother");
- _bus = dev->bus;
- _dev = dev->dev;
- _fn = dev->fn;
- found = 1;
-
+ pci_bother_add(dev);
return 1;
}
return 0;
void eth_poll()
{
- if (!found)
- return;
-
- pci_write16(_bus, _dev, _fn, 0x04, 0xFF);
-
- pci_write16(_bus, _dev, _fn, 0x04, 0x00);
+ /* ... */
}
void eth_init()
--- /dev/null
- pci_write16(bothers[i].bus, bothers[i].dev, bothers[i].fn, 0x0);
+#include <pci.h>
++#include <pci-bother.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, bothers[i].origstate);
++ pci_write16(bothers[i].bus, bothers[i].dev, bothers[i].fn, 0x04, 0x0);
+}
+
+void pci_unbother_all()
+{
+ int i;
+
+ for (i = 0; i < nbothers; i++)
++ pci_write16(bothers[i].bus, bothers[i].dev, bothers[i].fn, 0x04, bothers[i].origstate);
+}