Adding module tree to git, added SYS_LOADMOD to allow usermode module loading
[tpg/acess2.git] / Modules / NE2000 / ne2000.c
diff --git a/Modules/NE2000/ne2000.c b/Modules/NE2000/ne2000.c
new file mode 100644 (file)
index 0000000..a032191
--- /dev/null
@@ -0,0 +1,313 @@
+/* Acess2
+ * NE2000 Driver
+ * 
+ * See: ~/Sources/bochs/bochs.../iodev/ne2k.cc
+ */
+#define        DEBUG   1
+#include <common.h>
+#include <modules.h>
+#include <fs_devfs.h>
+#include <drv_pci.h>
+
+// === CONSTANTS ===
+#define        MEM_START       0x40
+#define        MEM_END         0xC0
+#define RX_FIRST       (MEM_START)
+#define RX_LAST                (MEM_START+RX_BUF_SIZE-1)
+#define        RX_BUF_SIZE     0x40
+#define TX_FIRST       (MEM_START+RX_BUF_SIZE)
+#define TX_LAST                (MEM_END)
+#define        TX_BUF_SIZE     0x40
+
+static const struct {
+       Uint16  Vendor;
+       Uint16  Device;
+} csaCOMPAT_DEVICES[] = {
+       {0x10EC, 0x8029},       // Realtek 8029
+       {0x10EC, 0x8129}        // Realtek 8129
+};
+#define NUM_COMPAT_DEVICES     (sizeof(csaCOMPAT_DEVICES)/sizeof(csaCOMPAT_DEVICES[0]))
+
+enum eNe2k_Page0Read {
+       CMD = 0,        //!< the master command register
+       CLDA0,          //!< Current Local DMA Address 0
+       CLDA1,          //!< Current Local DMA Address 1
+       BNRY,           //!< Boundary Pointer (for ringbuffer)
+       TSR,            //!< Transmit Status Register
+       NCR,            //!< collisions counter
+       FIFO,           //!< (for what purpose ??)
+       ISR,            //!< Interrupt Status Register
+       CRDA0,          //!< Current Remote DMA Address 0
+       CRDA1,          //!< Current Remote DMA Address 1
+       RSR = 0xC       //!< Receive Status Register
+};
+
+enum eNe2k_Page0Write {
+       PSTART = 1,     //!< page start (init only)
+       PSTOP,          //!< page stop  (init only)
+       TPSR = 4,       //!< transmit page start address
+       TBCR0,          //!< transmit byte count (low)
+       TBCR1,          //!< transmit byte count (high)
+       RSAR0 = 8,      //!< remote start address (lo)
+       RSAR1,  //!< remote start address (hi)
+       RBCR0,  //!< remote byte count (lo)
+       RBCR1,  //!< remote byte count (hi)
+       RCR,    //!< receive config register
+       TCR,    //!< transmit config register
+       DCR,    //!< data config register    (init)
+       IMR             //!< interrupt mask register (init)
+};
+
+// === TYPES ===
+typedef struct sNe2k_Card {
+       Uint16  IOBase; //!< IO Port Address from PCI
+       Uint8   IRQ;    //!< IRQ Assigned from PCI
+       
+        int    NextMemPage;    //!< Next Card Memory page to use
+       
+       Uint8   Buffer[RX_BUF_SIZE];
+       
+       char    Name[2];        // "0"
+       tVFS_Node       Node;
+       Uint8   MacAddr[6];
+} tCard;
+
+// === PROTOTYPES ===
+ int   Ne2k_Install(char **Arguments);
+char   *Ne2k_ReadDir(tVFS_Node *Node, int Pos);
+tVFS_Node      *Ne2k_FindDir(tVFS_Node *Node, char *Name);
+Uint64 Ne2k_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer);
+Uint8  Ne2k_int_GetWritePage(tCard *Card, Uint16 Length);
+void   Ne2k_IRQHandler(int IntNum);
+
+// === GLOBALS ===
+MODULE_DEFINE(0, 0x0032, Ne2k, Ne2k_Install, NULL, NULL);
+tDevFS_Driver  gNe2k_DriverInfo = {
+       NULL, "ne2k",
+       {
+       .NumACLs = 1,
+       .ACLs = &gVFS_ACL_EveryoneRX,
+       .Flags = VFS_FFLAG_DIRECTORY,
+       .ReadDir = Ne2k_ReadDir,
+       .FindDir = Ne2k_FindDir
+       }
+};
+Uint16 gNe2k_BaseAddress;
+ int   giNe2k_CardCount = 0;
+tCard  *gpNe2k_Cards = NULL;
+
+// === CODE ===
+/**
+ * \fn int Ne2k_Install(char **Options)
+ * \brief Installs the NE2000 Driver
+ */
+int Ne2k_Install(char **Options)
+{
+        int    i, j, k;
+        int    count, id, base;
+       
+       // --- Scan PCI Bus ---
+       // Count Cards
+       giNe2k_CardCount = 0;
+       for( i = 0; i < NUM_COMPAT_DEVICES; i ++ )
+       {
+               giNe2k_CardCount += PCI_CountDevices( csaCOMPAT_DEVICES[i].Vendor, csaCOMPAT_DEVICES[i].Device, 0 );
+       }
+       
+       // Enumerate Cards
+       k = 0;
+       gpNe2k_Cards = malloc( giNe2k_CardCount * sizeof(tCard) );
+       memsetd(gpNe2k_Cards, 0, giNe2k_CardCount * sizeof(tCard) / 4);
+       for( i = 0; i < NUM_COMPAT_DEVICES; i ++ )
+       {
+               count = PCI_CountDevices( csaCOMPAT_DEVICES[i].Vendor, csaCOMPAT_DEVICES[i].Device, 0 );
+               for( j = 0; j < count; j ++,k ++ )
+               {
+                       id = PCI_GetDevice( csaCOMPAT_DEVICES[i].Vendor, csaCOMPAT_DEVICES[i].Device, 0, j );
+                       // Create Structure
+                       base = PCI_AssignPort( id, 0, 0x20 );
+                       gpNe2k_Cards[ k ].IOBase = base;
+                       gpNe2k_Cards[ k ].IRQ = PCI_GetIRQ( id );
+                       gpNe2k_Cards[ k ].NextMemPage = 64;
+                       
+                       // Install IRQ Handler
+                       IRQ_AddHandler(gpNe2k_Cards[ k ].IRQ, Ne2k_IRQHandler);
+                       
+                       // Reset Card
+                       outb( base + 0x1F, inb(base + 0x1F) );
+                       while( (inb( base+ISR ) & 0x80) == 0 );
+                       outb( base + ISR, 0x80 );
+                       
+                       // Initialise Card
+                       outb( base + CMD, 0x21 );       // No DMA and Stop
+                       outb( base + DCR, 0x49 );       // Set WORD mode
+                       outb( base + IMR, 0x00 );
+                       outb( base + ISR, 0xFF );
+                       outb( base + RCR, 0x20 );       // Reciever to Monitor
+                       outb( base + TCR, 0x02 );       // Transmitter OFF (TCR.LB = 1, Internal Loopback)
+                       outb( base + RBCR0, 6*4 );      // Remote Byte Count
+                       outb( base + RBCR1, 0 );
+                       outb( base + RSAR0, 0 );        // Clear Source Address
+                       outb( base + RSAR1, 0 );
+                       outb( base + CMD, 0x0A );       // Remote Read, Start
+                       
+                       // Read MAC Address
+                       gpNe2k_Cards[ k ].MacAddr[0] = inb(base+0x10);  inb(base+0x10);
+                       gpNe2k_Cards[ k ].MacAddr[1] = inb(base+0x10);  inb(base+0x10);
+                       gpNe2k_Cards[ k ].MacAddr[2] = inb(base+0x10);  inb(base+0x10);
+                       gpNe2k_Cards[ k ].MacAddr[3] = inb(base+0x10);  inb(base+0x10);
+                       gpNe2k_Cards[ k ].MacAddr[4] = inb(base+0x10);  inb(base+0x10);
+                       gpNe2k_Cards[ k ].MacAddr[5] = inb(base+0x10);  inb(base+0x10);
+                       
+                       outb( base+PSTART, RX_FIRST);   // Set Receive Start
+                       outb( base+BNRY, RX_LAST-1);    // Set Boundary Page
+                       outb( base+PSTOP, RX_LAST);     // Set Stop Page
+                       outb( base+ISR, 0xFF ); // Clear all ints
+                       outb( base+CMD, 0x22 ); // No DMA, Start
+                       outb( base+IMR, 0x3F ); // Set Interupt Mask
+                       outb( base+RCR, 0x0F ); // Set WRAP and allow all packet matches
+                       outb( base+TCR, 0x00 ); // Set Normal Transmitter mode
+                       outb( base+TPSR, 0x40); // Set Transmit Start
+                       // Set MAC Address
+                       /*
+                       Ne2k_WriteReg(base, MAC0, gpNe2k_Cards[ k ].MacAddr[0]);
+                       Ne2k_WriteReg(base, MAC1, gpNe2k_Cards[ k ].MacAddr[1]);
+                       Ne2k_WriteReg(base, MAC2, gpNe2k_Cards[ k ].MacAddr[2]);
+                       Ne2k_WriteReg(base, MAC3, gpNe2k_Cards[ k ].MacAddr[3]);
+                       Ne2k_WriteReg(base, MAC4, gpNe2k_Cards[ k ].MacAddr[4]);
+                       Ne2k_WriteReg(base, MAC5, gpNe2k_Cards[ k ].MacAddr[5]);
+                       */
+                       
+                       Log("[NE2K]: Card #%i: IRQ=%i, IOBase=0x%x",
+                               k, gpNe2k_Cards[ k ].IRQ, gpNe2k_Cards[ k ].IOBase);
+                       Log("MAC Address %x:%x:%x:%x:%x:%x",
+                               gpNe2k_Cards[ k ].MacAddr[0], gpNe2k_Cards[ k ].MacAddr[1],
+                               gpNe2k_Cards[ k ].MacAddr[2], gpNe2k_Cards[ k ].MacAddr[3],
+                               gpNe2k_Cards[ k ].MacAddr[4], gpNe2k_Cards[ k ].MacAddr[5]
+                               );
+                       
+                       // Set VFS Node
+                       gpNe2k_Cards[ k ].Name[0] = '0'+k;
+                       gpNe2k_Cards[ k ].Name[1] = '\0';
+                       gpNe2k_Cards[ k ].Node.ImplPtr = &gpNe2k_Cards[ k ];
+                       gpNe2k_Cards[ k ].Node.NumACLs = 0;     // Root Only
+                       gpNe2k_Cards[ k ].Node.CTime = now();
+                       gpNe2k_Cards[ k ].Node.Write = Ne2k_Write;
+               }
+       }
+       
+       gNe2k_DriverInfo.RootNode.Size = giNe2k_CardCount;
+       DevFS_AddDevice( &gNe2k_DriverInfo );
+       return 0;
+}
+
+/**
+ * \fn char *Ne2k_ReadDir(tVFS_Node *Node, int Pos)
+ */
+char *Ne2k_ReadDir(tVFS_Node *Node, int Pos)
+{
+       char    ret[2];
+       if(Pos < 0 || Pos >= giNe2k_CardCount)  return NULL;
+       ret[0] = '0'+Pos;
+       ret[1] = '\0';
+       return strdup(ret);
+}
+
+/**
+ * \fn tVFS_Node *Ne2k_FindDir(tVFS_Node *Node, char *Name)
+ */
+tVFS_Node *Ne2k_FindDir(tVFS_Node *Node, char *Name)
+{
+       if(Name[0] == '\0' || Name[1] != '\0')  return NULL;
+       
+       return &gpNe2k_Cards[ Name[0]-'0' ].Node;
+}
+
+/**
+ * \fn Uint64 Ne2k_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
+ */
+Uint64 Ne2k_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
+{
+       tCard   *Card = (tCard*)Node->ImplPtr;
+       Uint16  *buf = Buffer;
+        int    rem = Length;
+       
+       ENTER("pNode XOffset XLength pBuffer", Node, Offset, Length, Buffer);
+       
+       // Sanity Check Length
+       if(Length > TX_BUF_SIZE) {
+               LEAVE('i', 0);
+               return 0;
+       }
+       
+       // Make sure that the card is in page 0
+       outb(Card->IOBase + CMD, 0|0x22);       // Page 0, Start, NoDMA
+       
+       // Clear Remote DMA Flag
+       outb(Card->IOBase + ISR, 0x40); // Bit 6
+       
+       // Send Size - Remote Byte Count Register
+       outb(Card->IOBase + TBCR0, Length & 0xFF);
+       outb(Card->IOBase + TBCR1, Length >> 8);
+       
+       // Send Size - Remote Byte Count Register
+       outb(Card->IOBase + RBCR0, Length & 0xFF);
+       outb(Card->IOBase + RBCR1, Length >> 8);
+       
+       // Set up transfer
+       outb(Card->IOBase + RSAR0, 0x00);       // Page Offset
+       outb(Card->IOBase + RSAR1, Ne2k_int_GetWritePage(Card, Length));        // Page Offset
+       // Start
+       //outb(Card->IOBase + CMD, 0|0x18|0x4|0x2);     // Page 0, Transmit Packet, TXP, Start
+       outb(Card->IOBase + CMD, 0|0x10|0x2);   // Page 0, Remote Write, Start
+       
+       // Send Data
+       for(rem = Length; rem; rem -= 2)
+               outw(Card->IOBase + 0x10, *buf++);
+       
+       while( inb(Card->IOBase + ISR) == 0)    // Wait for Remote DMA Complete
+               ;       //Proc_Yield();
+       
+       outb( Card->IOBase + ISR, 0x40 );       // ACK Interrupt
+       
+       // Send Packet
+       outb(Card->IOBase + CMD, 0|0x10|0x4|0x2);
+       
+       // Complete DMA
+       //outb(Card->IOBase + CMD, 0|0x20);
+       
+       LEAVE('i', Length);
+       return Length;
+}
+
+/**
+ * \fn Uint8 Ne2k_int_GetWritePage(tCard *Card, Uint16 Length)
+ */
+Uint8 Ne2k_int_GetWritePage(tCard *Card, Uint16 Length)
+{
+       Uint8   ret = Card->NextMemPage;
+       
+       Card->NextMemPage += (Length + 0xFF) >> 8;
+       if(Card->NextMemPage >= TX_LAST) {
+               Card->NextMemPage -= TX_BUF_SIZE;
+       }
+       
+       return ret;
+}
+
+/**
+ * \fn void Ne2k_IRQHandler(int IntNum)
+ */
+void Ne2k_IRQHandler(int IntNum)
+{
+        int    i;
+       for( i = 0; i < giNe2k_CardCount; i++ )
+       {
+               if(gpNe2k_Cards[i].IRQ == IntNum) {
+                       LOG("Clearing interrupts on card %i (0x%x)\n", i, inb( gpNe2k_Cards[i].IOBase + ISR ));
+                       outb( gpNe2k_Cards[i].IOBase + ISR, 0xFF );     // Reset All
+                       return ;
+               }
+       }
+       Warning("[NE2K ] Recieved Unknown IRQ %i", IntNum);
+}

UCC git Repository :: git.ucc.asn.au