Modules/Network - Added PCnet-FASTIII driver (untested,incomplete)
authorJohn Hodge <[email protected]>
Sun, 21 Aug 2011 08:48:12 +0000 (16:48 +0800)
committerJohn Hodge <[email protected]>
Sun, 21 Aug 2011 08:48:12 +0000 (16:48 +0800)
Modules/Network/PCnet-FASTIII/Makefile [new file with mode: 0644]
Modules/Network/PCnet-FASTIII/pcnet-fast3.c [new file with mode: 0644]

diff --git a/Modules/Network/PCnet-FASTIII/Makefile b/Modules/Network/PCnet-FASTIII/Makefile
new file mode 100644 (file)
index 0000000..1c7f3e9
--- /dev/null
@@ -0,0 +1,7 @@
+#
+#
+
+OBJ = rtl8139.o
+NAME = RTL8139
+
+-include ../Makefile.tpl
diff --git a/Modules/Network/PCnet-FASTIII/pcnet-fast3.c b/Modules/Network/PCnet-FASTIII/pcnet-fast3.c
new file mode 100644 (file)
index 0000000..ebb4011
--- /dev/null
@@ -0,0 +1,386 @@
+/*
+ * Acess2 PCnet-FAST III Driver
+ * - By John Hodge (thePowersGang)
+ */
+#define        DEBUG   0
+#define VERSION        ((0<<8)|10)
+#include <acess.h>
+#include <modules.h>
+#include <fs_devfs.h>
+#include <drv_pci.h>
+#include <tpl_drv_network.h>
+#include <semaphore.h>
+
+// === CONSTANTS ===
+#define VENDOR_ID      0x1022
+#define DEVICE_ID      0x2000
+
+enum eRegs
+{
+       REG_APROM0      = 0x00,
+       REG_APROM4      = 0x04,
+       REG_APROM8      = 0x08,
+       REG_APROMC      = 0x0C,
+       REG_RDP         = 0x10, // 16 bit
+       REG_RAP         = 0x14, // 8-bit
+       REG_RESET       = 0x18, // 16-bit
+       REG_BDP         = 0x1C, // 16-bit
+};
+
+enum eCSR_Regs
+{
+       CSR_STATUS,     // CSR0 - Am79C973/Am79C975 Controller Status
+       CSR_IBA0,       // CSR1 - Initialization Block Address[15:0]
+       CSR_IBA1,       // CSR2 - Initialization Block Address[31:16]
+       CSR_INTMASK,    // CSR3 - Interrupt Masks and Deferral Control
+       
+       CSR_MAC0 = 12,  // CSR12 - Physical Address[15:0]
+       CSR_MAC1 = 13,  // CSR13 - Physical Address[31:16]
+       CSR_MAC2 = 14,  // CSR14 - Physical Address[47:32]
+       CSR_MODE = 15,  // CSR15 - Mode
+       
+       CSR_RXBASE0 = 24,       // CSR24 - Base Address of Receive Ring Lower
+       CSR_RXBASE1 = 25,       // CSR25 - Base Address of Receive Ring Upper
+       CSR_TXBASE0 = 30,       // CSR26 - Base Address of Transmit Ring Lower
+       CSR_TXBASE1 = 31,       // CSR27 - Base Address of Transmit Ring Upper
+       
+       CSR_RXLENGTH = 76,      // CSR76 - Receive Ring Length
+       CSR_TXLENGTH = 78,      // CSR78 - Transmit Ring Length
+};
+
+enum eBCR_Regs
+{
+       BCR_PHYCS = 32, // BCR32 - Internal PHY Control and Status
+       BCR_PHYADDR,    // BCR33 - Internal PHY Address
+       BCR_PHYMGMT,    // BCR34 - Internal PHY Management Data
+};
+
+// === TYPES ===
+typedef struct sCard
+{
+       Uint16  IOBase;
+       Uint8   IRQ;
+       
+        int    NumWaitingPackets;
+       
+       char    Name[2];
+       tVFS_Node       Node;
+       Uint8   MacAddr[6];
+}      tCard;
+
+// === PROTOTYPES ===
+ int   PCnet3_Install(char **Options);
+char   *PCnet3_ReadDir(tVFS_Node *Node, int Pos);
+tVFS_Node      *PCnet3_FindDir(tVFS_Node *Node, const char *Filename);
+ int   PCnet3_RootIOCtl(tVFS_Node *Node, int ID, void *Arg);
+Uint64 PCnet3_Read(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer);
+Uint64 PCnet3_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer);
+ int   PCnet3_IOCtl(tVFS_Node *Node, int ID, void *Arg);
+void   PCnet3_IRQHandler(int Num);
+
+// === GLOBALS ===
+MODULE_DEFINE(0, VERSION, PCnet3, PCnet3_Install, NULL, NULL);
+tDevFS_Driver  gPCnet3_DriverInfo = {
+       NULL, "PCnet3",
+       {
+       .NumACLs = 1,
+       .ACLs = &gVFS_ACL_EveryoneRX,
+       .Flags = VFS_FFLAG_DIRECTORY,
+       .ReadDir = PCnet3_ReadDir,
+       .FindDir = PCnet3_FindDir,
+       .IOCtl = PCnet3_RootIOCtl
+       }
+};
+ int   giPCnet3_CardCount;
+tCard  *gaPCnet3_Cards;
+
+// === CODE ===
+/**
+ * \brief Installs the PCnet3 Driver
+ */
+int PCnet3_Install(char **Options)
+{
+        int    id = -1;
+        int    i = 0;
+       Uint16  base;
+       tCard   *card;
+       
+       giPCnet3_CardCount = PCI_CountDevices(VENDOR_ID, DEVICE_ID);
+       Log_Debug("PCnet3", "%i cards", giPCnet3_CardCount);
+       
+       if( giPCnet3_CardCount == 0 )   return MODULE_ERR_NOTNEEDED;
+       
+       gaPCnet3_Cards = calloc( giPCnet3_CardCount, sizeof(tCard) );
+       
+       while( (id = PCI_GetDevice(VENDOR_ID, DEVICE_ID, i)) != -1 )
+       {
+               card = &gaPCnet3_Cards[i];
+               base = PCI_GetBAR( id, 0 );
+               if( !(base & 1) ) {
+                       Log_Warning("PCnet3", "Driver does not support MMIO, skipping card");
+                       card->IOBase = 0;
+                       card->IRQ = 0;
+                       continue ;
+               }
+               base &= ~1;
+               card->IOBase = base;
+               card->IRQ = PCI_GetIRQ( id );
+               
+               // Install IRQ Handler
+               IRQ_AddHandler(card->IRQ, PCnet3_IRQHandler);
+               
+               
+               
+               Log_Log("PCnet3", "Card %i 0x%04x, IRQ %i %02x:%02x:%02x:%02x:%02x:%02x",
+                       i, card->IOBase, card->IRQ,
+                       card->MacAddr[0], card->MacAddr[1], card->MacAddr[2],
+                       card->MacAddr[3], card->MacAddr[4], card->MacAddr[5]
+                       );
+               
+               i ++;
+       }
+       
+       gPCnet3_DriverInfo.RootNode.Size = giPCnet3_CardCount;
+       DevFS_AddDevice( &gPCnet3_DriverInfo );
+       
+       return MODULE_ERR_OK;
+}
+
+// --- Root Functions ---
+char *PCnet3_ReadDir(tVFS_Node *Node, int Pos)
+{
+       if( Pos < 0 || Pos >= giPCnet3_CardCount )      return NULL;
+       
+       return strdup( gaPCnet3_Cards[Pos].Name );
+}
+
+tVFS_Node *PCnet3_FindDir(tVFS_Node *Node, const char *Filename)
+{
+       //TODO: It might be an idea to supprt >10 cards
+       if(Filename[0] == '\0' || Filename[1] != '\0')  return NULL;
+       if(Filename[0] < '0' || Filename[0] > '9')      return NULL;
+       return &gaPCnet3_Cards[ Filename[0]-'0' ].Node;
+}
+
+const char *csaPCnet3_RootIOCtls[] = {DRV_IOCTLNAMES, NULL};
+int PCnet3_RootIOCtl(tVFS_Node *Node, int ID, void *Data)
+{
+       ENTER("pNode iID pData", Node, ID, Data);
+       switch(ID)
+       {
+       BASE_IOCTLS(DRV_TYPE_NETWORK, "PCnet3", VERSION, csaPCnet3_RootIOCtls);
+       }
+       LEAVE('i', 0);
+       return 0;
+}
+
+// --- File Functions ---
+Uint64 PCnet3_Read(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
+{
+       tCard   *card = Node->ImplPtr;
+       Uint16  read_ofs, pkt_length;
+        int    new_read_ofs;
+
+       ENTER("pNode XOffset XLength pBuffer", Node, Offset, Length, Buffer);
+
+retry:
+       if( Semaphore_Wait( &card->ReadSemaphore, 1 ) != 1 )
+       {
+               LEAVE_RET('i', 0);
+       }
+       
+       Mutex_Acquire( &card->ReadMutex );
+       
+       read_ofs = inw( card->IOBase + CAPR );
+       LOG("raw read_ofs = %i", read_ofs);
+       read_ofs = (read_ofs + 0x10) & 0xFFFF;
+       LOG("read_ofs = %i", read_ofs);
+       
+       pkt_length = *(Uint16*)&card->ReceiveBuffer[read_ofs+2];
+       
+       // Calculate new read offset
+       new_read_ofs = read_ofs + pkt_length + 4;
+       new_read_ofs = (new_read_ofs + 3) & ~3; // Align
+       if(new_read_ofs > card->ReceiveBufferLength) {
+               LOG("wrapping read_ofs");
+               new_read_ofs -= card->ReceiveBufferLength;
+       }
+       new_read_ofs -= 0x10;   // I dunno
+       LOG("new_read_ofs = %i", new_read_ofs);
+       
+       // Check for errors
+       if( *(Uint16*)&card->ReceiveBuffer[read_ofs] & 0x1E ) {
+               // Update CAPR
+               outw(card->IOBase + CAPR, new_read_ofs);
+               Mutex_Release( &card->ReadMutex );
+               goto retry;     // I feel evil
+       }
+       
+       // Get packet
+       if( Length > pkt_length )       Length = pkt_length;
+       memcpy(Buffer, &card->ReceiveBuffer[read_ofs+4], Length);
+       
+       // Update CAPR
+       outw(card->IOBase + CAPR, new_read_ofs);
+       
+       Mutex_Release( &card->ReadMutex );
+       
+       LEAVE('i', Length);
+       
+       return Length;
+}
+
+Uint64 PCnet3_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
+{
+        int    td;
+       Uint32  status;
+       tCard   *card = Node->ImplPtr;
+       
+       if( Length > 1500 )     return 0;       // MTU exceeded
+       
+       ENTER("pNode XLength pBuffer", Node, Length, Buffer);
+       
+       // TODO: Implement a semaphore for avaliable transmit buffers
+
+       // Find an avaliable descriptor
+       Mutex_Acquire(&card->CurTXProtector);
+       td = card->CurTXDescriptor;
+       card->CurTXDescriptor ++;
+       card->CurTXDescriptor %= 4;
+       Mutex_Release(&card->CurTXProtector);
+       // - Lock it
+       Mutex_Acquire( &card->TransmitInUse[td] );
+       
+       LOG("td = %i", td);
+       
+       // Transmit using descriptor `td`
+       LOG("card->PhysTransmitBuffers[td] = %P", card->PhysTransmitBuffers[td]);
+       outd(card->IOBase + TSAD0 + td*4, card->PhysTransmitBuffers[td]);
+       LOG("card->TransmitBuffers[td] = %p", card->TransmitBuffers[td]);
+       // Copy to buffer
+       memcpy(card->TransmitBuffers[td], Buffer, Length);
+       // Start
+       status = 0;
+       status |= Length & 0x1FFF;      // 0-12: Length
+       status |= 0 << 13;      // 13: OWN bit
+       status |= (0 & 0x3F) << 16;     // 16-21: Early TX threshold (zero atm, TODO: check)
+       LOG("status = 0x%08x", status);
+       outd(card->IOBase + TSD0 + td*4, status);
+       
+       LEAVE('i', (int)Length);
+       
+       return Length;
+}
+
+const char *csaPCnet3_NodeIOCtls[] = {DRV_IOCTLNAMES, NULL};
+int PCnet3_IOCtl(tVFS_Node *Node, int ID, void *Data)
+{
+       tCard   *card = Node->ImplPtr;
+       ENTER("pNode iID pData", Node, ID, Data);
+       switch(ID)
+       {
+       BASE_IOCTLS(DRV_TYPE_NETWORK, "PCnet3", VERSION, csaPCnet3_NodeIOCtls);
+       case NET_IOCTL_GETMAC:
+               if( !CheckMem(Data, 6) ) {
+                       LEAVE('i', -1);
+                       return -1;
+               }
+               memcpy( Data, card->MacAddr, 6 );
+               LEAVE('i', 1);
+               return 1;
+       }
+       LEAVE('i', 0);
+       return 0;
+}
+
+void PCnet3_IRQHandler(int Num)
+{
+        int    i, j;
+       tCard   *card;
+       Uint16  status;
+
+       LOG("Num = %i", Num);
+       
+       for( i = 0; i < giPCnet3_CardCount; i ++ )
+       {
+               card = &gaPCnet3_Cards[i];
+               if( Num != card->IRQ )  break;
+               
+               status = inw(card->IOBase + ISR);
+               LOG("status = 0x%02x", status);
+               
+               // Transmit OK, a transmit descriptor is now free
+               if( status & FLAG_ISR_TOK )
+               {
+                       for( j = 0; j < 4; j ++ )
+                       {
+                               if( ind(card->IOBase + TSD0 + j*4) & 0x8000 ) { // TSD TOK
+                                       Mutex_Release( &card->TransmitInUse[j] );
+                                       // TODO: Update semaphore once implemented
+                               }
+                       }
+                       outw(card->IOBase + ISR, FLAG_ISR_TOK);
+               }
+               
+               // Recieve OK, inform read
+               if( status & FLAG_ISR_ROK )
+               {
+                        int    read_ofs, end_ofs;
+                        int    packet_count = 0;
+                        int    len;
+                       
+                       // Scan recieve buffer for packets
+                       end_ofs = inw(card->IOBase + CBA);
+                       read_ofs = card->SeenOfs;
+                       LOG("read_ofs = %i, end_ofs = %i", read_ofs, end_ofs);
+                       if( read_ofs > end_ofs )
+                       {
+                               while( read_ofs < card->ReceiveBufferLength )
+                               {
+                                       packet_count ++;
+                                       len = *(Uint16*)&card->ReceiveBuffer[read_ofs+2];
+                                       LOG("%i 0x%x Pkt Hdr: 0x%04x, len: 0x%04x",
+                                               packet_count, read_ofs,
+                                               *(Uint16*)&card->ReceiveBuffer[read_ofs],
+                                               len
+                                               );
+                                       if(len > 2000) {
+                                               Log_Warning("PCnet3", "IRQ: Packet in buffer exceeds sanity (%i>2000)", len);
+                                       }
+                                       read_ofs += len + 4;
+                                       read_ofs = (read_ofs + 3) & ~3; // Align
+                               }
+                               read_ofs -= card->ReceiveBufferLength;
+                               LOG("wrapped read_ofs");
+                       }
+                       while( read_ofs < end_ofs )
+                       {
+                               packet_count ++;
+                               LOG("%i 0x%x Pkt Hdr: 0x%04x, len: 0x%04x",
+                                       packet_count, read_ofs,
+                                       *(Uint16*)&card->ReceiveBuffer[read_ofs],
+                                       *(Uint16*)&card->ReceiveBuffer[read_ofs+2]
+                                       );
+                               read_ofs += *(Uint16*)&card->ReceiveBuffer[read_ofs+2] + 4;
+                               read_ofs = (read_ofs + 3) & ~3; // Align
+                       }
+                       if( read_ofs != end_ofs ) {
+                               Log_Warning("PCnet3", "IRQ: read_ofs (%i) != end_ofs(%i)", read_ofs, end_ofs);
+                               read_ofs = end_ofs;
+                       }
+                       card->SeenOfs = read_ofs;
+                       
+                       LOG("packet_count = %i, read_ofs = 0x%x", packet_count, read_ofs);
+                       
+                       if( packet_count )
+                       {
+                               if( Semaphore_Signal( &card->ReadSemaphore, packet_count ) != packet_count ) {
+                                       // Oops?
+                               }
+                               VFS_MarkAvaliable( &card->Node, 1 );
+                       }
+                       
+                       outw(card->IOBase + ISR, FLAG_ISR_ROK);
+               }
+       }
+}

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