KernelLand/Modules/Network/RTL8169/rtl8169.c

   1 /*
   2  * Acess2 RealTek 8169 Gigabit Network Controller Driver
   3  * - By John Hodge (thePowersGang)
   4  *
   5  * rtl8169.c
   6  * - Driver source
   7  */
   8 #define DEBUG   0
   9 #define VERSION 0x001
  10 #include <acess.h>
  11 #include <fs_devfs.h>
  12 #include <drv_pci.h>
  13 #include <api_drv_network.h>
  14 #include "rtl8169.h"
  15
  16 #define N_RX_DESCS      128
  17 #define N_TX_DESCS      (256-N_RX_DESCS)        // 256 * 16 = 4096 (1 page)
  18 #define RX_BUF_SIZE     1024    // Most packets will fit in one buffer
  19
  20 #define INT_SYSERR      (1 << 15)       // System Error
  21 #define INT_TIMEOUT     (1 << 14)       // Timer fire (TCTR reg)
  22 #define INT_LINKCHANGE  (1 << 5)
  23 #define INT_TXERR       (1 << 3)
  24 #define INT_TXOK        (1 << 2)
  25 #define INT_RXERR       (1 << 1)
  26 #define INT_RXOK        (1 << 0)
  27
  28 enum eRegisters
  29 {
  30         REG_TXC = 0x40,
  31         REG_RXC = 0x44,
  32 }
  33
  34 // === PROTOTYPES ===
  35  int    RTL8169_Initialise(char **Arguments);
  36 void    RTL8169_Cleanup(void);
  37 void    RTL8169_InterruptHandler(int IRQ, void *CardPtr);
  38
  39 // === GLOBALS ===
  40 MODULE_DEFINE(0, RTL8169, RTL8169_Initialise, RTL8169_Cleanup, NULL);
  41  int    giRTL8169_CardCount;
  42 tCard   *gaRTL8169_Cards;
  43
  44 // === CODE ===
  45 int RTL8169_Initialise(char **Arguments)
  46 {
  47         const Uint16    vendor_id = 0x10EC;
  48         const Uint16    device_id = 0x8129;     // 8169 = 0x8129 PCI?
  49         giRTL8169_CardCount = PCI_CountDevices(vendor_id, device_id);
  50         if( !giRTL8169_CardCount )      return MODULE_ERR_NOTNEEDED;
  51
  52         // Allocate card structures
  53         gaRTL8169_Cards = malloc( sizeof(tCard) * giRTL8169_CardCount );
  54
  55         // Initialise devices
  56         for( int id = -1, int i = 0 ; (id = PCI_GetDevice(vendor_id, device_id, id)) != -1; i ++ )
  57         {
  58                 tCard   *card = &gaRTL8169_Cards[i];
  59                 card->PCIId = id;
  60
  61                 card->IOAddr = PCI_GetBAR(id, 0);
  62                 if( !(card->IOAddr & 1) ) {
  63                         // Invalid IO address
  64                         Log_Warning("RTL8169", "Card %i doesn't have BAR0 as an IO space", i);
  65                         continue;
  66                 }
  67
  68                 if(card->IOAddr == 1 )
  69                 {
  70                         // Try MMIO
  71                         card->PMemAddr = PCI_GetBAR(id, 1);
  72                         if( card->PMemAddr == 0 ) {
  73                                 Log_Warning("RTL8169", "TODO: Allocate MMIO space");
  74                                 continue ;
  75                         }
  76                         card->MemAddr = MM_MapHWPages(card->PMemAddr, 1);
  77                 }
  78
  79                 card->IRQNum = PCI_GetIRQ(card);
  80                 IRQ_AddHandler( card->IRQNum, RTL8169_InterruptHandler, card );
  81
  82                 RTL8169_int_SetupCard(card);
  83         }
  84 }
  85
  86 void RTL8169_int_SetupCard(tCard *Card)
  87 {
  88         // Initialise RX/TX Descs
  89         // TODO: Handle non-64-bit PCI
  90         Card->RXDescs = MM_AllocDMA(1, -1, &Card->RXDescsPhys);
  91         Card->TXDescs = Card->RXDescs + N_RX_DESCS;
  92
  93         // - RX Descs - Max of 4096 bytes per packet (1 page)
  94         tPAddr  paddr;
  95         for( int i = 0; i < N_RX_DESCS; i += 2 )
  96         {
  97                 t8169_Desc      *desc;
  98
  99                 desc = &Card->RXDescs[i];
 100                 if( i % (PAGE_SIZE/RX_BUF_SIZE) == 0 )
 101                         Card->RXBufs[i] = MM_AllocDMA(1, 64, &paddr);
 102                 else
 103                         Card->RXBufs[i] = Card->RXBufs[i-1] + RX_BUF_SIZE;
 104                 desc->FrameLength = RX_BUF_SIZE;
 105                 desc->Flags = TXD_FLAG_OWN;
 106                 desc->VLANTag = 0;
 107                 desc->VLANFlags = 0;
 108                 desc->AddressLow = paddr & 0xFFFFFFFF;
 109                 desc->AddressHigh = paddr >> 32;
 110                 paddr += RX_BUF_SIZE;
 111         }
 112         Card->RXDescs[N_RX_DESCS-1].Flags |= TXD_FLAG_EOR;
 113         // - TX Descs - Just clear
 114         memset(Card->TXDescs, 0, sizeof(t8169_Desc)*N_TX_DESCS);
 115         Card->TXDescs[N_TX_DESCS-1].Flags |= TXD_FLAG_EOR;
 116
 117         // Reset
 118         _WriteB(Card, 0x37, 0x10);
 119         while( _ReadB(Card, 0x37) & 0x10 )
 120                 ;       // TODO: Timeout
 121
 122         // Read MAC address
 123         for( int i = 0; i < 6; i ++ )
 124                 Card->MacAddr[i] = _ReadB(Card, i);
 125
 126         // Initialise
 127 //      _WriteB(Card, 0x50, 0xC0);
 128         _WriteD(Card, 0x40, 0x03000700);        // TX Config
 129         _WriteD(Card, 0x44, 0x0000E70F);        // RX Config
 130         _WriteW(Card, 0xDA, RX_BUF_SIZE-1);     // Max RX Size
 131         _WriteW(Card, 0xEC, 2048/32);   // Max TX size (in units of 32/128 bytes)
 132
 133         _WriteQ(Card, 0x20, MM_GetPhysAddr( (tVAddr)Card->TXDescs ));
 134 //      _WriteQ(Card, 0x28, MM_GetPhysAddr( (tVAddr)Card->TXHighDescs ));
 135         _WriteQ(Card, 0xE4, MM_GetPhysAddr( (tVAddr)Card->RXDescs ));
 136
 137         _WriteW(Card, 0x3C, INT_LINKCHANGE|INT_TXOK|INT_RXOK);  // Set interrupt mask
 138
 139         _WriteB(card, 0x37, 0x0C);      // Enable
 140 }
 141
 142 void RTL8169_InterruptHandler(int IRQ, void *CardPtr)
 143 {
 144
 145 }
 146
 147 // --- IO ---
 148 void _WriteW(tCard *Card, int Offset, Uint16 Value)
 149 {
 150         if( Card->MemAddr )
 151                 ((Uint16*)Card->MemAddr)[Offset/2] = Value;
 152         else
 153                 outw(Card->IOAddr & ~1, Offset, Value);
 154 }
 155
 156 void _WriteD(tCard *Card, int Offset, Uint32 Value)
 157 {
 158         if( Card->MemAddr )
 159                 ((Uint32*)Card->MemAddr)[Offset/4] = Value;
 160         else
 161                 outl(Card->IOAddr & ~1, Offset, Value);
 162 }
 163
 164 void _WriteQ(tCard *Card, int Offset, Uint64 Value)
 165 {
 166         if( Card->MemAddr ) {
 167                 ((Uint32*)Card->MemAddr)[Offset/4+0] = Value;
 168                 ((Uint32*)Card->MemAddr)[Offset/4+1] = Value>>32;
 169         }
 170         else {
 171                 outd(Card->IOAddr & ~1, Offset, Value);
 172                 outd(Card->IOAddr & ~1, Offset+4, Value>>32);
 173         }
 174 }