drivers/net/plb2800_eth.c

   1 /*
   2  * PLB2800 internal switch ethernet driver.
   3  *
   4  * (C) Copyright 2003
   5  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
   6  *
   7  * SPDX-License-Identifier:     GPL-2.0+
   8  */
   9
  10 #include <common.h>
  11 #include <malloc.h>
  12 #include <net.h>
  13 #include <netdev.h>
  14 #include <asm/addrspace.h>
  15
  16
  17 #define NUM_RX_DESC     PKTBUFSRX
  18 #define TOUT_LOOP       1000000
  19
  20 #define LONG_REF(addr) (*((volatile unsigned long*)addr))
  21
  22 #define CMAC_CRX_CTRL   LONG_REF(0xb800c870)
  23 #define CMAC_CTX_CTRL   LONG_REF(0xb800c874)
  24 #define SYS_MAC_ADDR_0  LONG_REF(0xb800c878)
  25 #define SYS_MAC_ADDR_1  LONG_REF(0xb800c87c)
  26 #define MIPS_H_MASK     LONG_REF(0xB800C810)
  27
  28 #define MA_LEARN        LONG_REF(0xb8008004)
  29 #define DA_LOOKUP       LONG_REF(0xb8008008)
  30
  31 #define CMAC_CRX_CTRL_PD        0x00000001
  32 #define CMAC_CRX_CTRL_CG        0x00000002
  33 #define CMAC_CRX_CTRL_PL_SHIFT  2
  34 #define CMAC_CRIT               0x0
  35 #define CMAC_NON_CRIT           0x1
  36 #define MBOX_STAT_ID_SHF        28
  37 #define MBOX_STAT_CP            0x80000000
  38 #define MBOX_STAT_MB            0x00000001
  39 #define EN_MA_LEARN             0x02000000
  40 #define EN_DA_LKUP              0x01000000
  41 #define MA_DEST_SHF             11
  42 #define DA_DEST_SHF             11
  43 #define DA_STATE_SHF            19
  44 #define TSTAMP_MS               0x00000000
  45 #define SW_H_MBOX4_MASK         0x08000000
  46 #define SW_H_MBOX3_MASK         0x04000000
  47 #define SW_H_MBOX2_MASK         0x02000000
  48 #define SW_H_MBOX1_MASK         0x01000000
  49
  50 typedef volatile struct {
  51   unsigned int stat;
  52   unsigned int cmd;
  53   unsigned int cnt;
  54   unsigned int adr;
  55 } mailbox_t;
  56
  57 #define MBOX_REG(mb) ((mailbox_t*)(0xb800c830+(mb<<4)))
  58
  59 typedef volatile struct {
  60   unsigned int word0;
  61   unsigned int word1;
  62   unsigned int word2;
  63 } mbhdr_t;
  64
  65 #define MBOX_MEM(mb) ((void*)(0xb800a000+((3-mb)<<11)))
  66
  67
  68 static int plb2800_eth_init(struct eth_device *dev, bd_t * bis);
  69 static int plb2800_eth_send(struct eth_device *dev, void *packet, int length);
  70 static int plb2800_eth_recv(struct eth_device *dev);
  71 static void plb2800_eth_halt(struct eth_device *dev);
  72
  73 static void plb2800_set_mac_addr(struct eth_device *dev, unsigned char * addr);
  74 static unsigned char * plb2800_get_mac_addr(void);
  75
  76 static int rx_new;
  77 static int mac_addr_set = 0;
  78
  79
  80 int plb2800_eth_initialize(bd_t * bis)
  81 {
  82         struct eth_device *dev;
  83         ulong temp;
  84
  85 #ifdef DEBUG
  86         printf("Entered plb2800_eth_initialize()\n");
  87 #endif
  88
  89         if (!(dev = (struct eth_device *) malloc (sizeof *dev)))
  90         {
  91                 printf("Failed to allocate memory\n");
  92                 return -1;
  93         }
  94         memset(dev, 0, sizeof(*dev));
  95
  96         sprintf(dev->name, "PLB2800 Switch");
  97         dev->init = plb2800_eth_init;
  98         dev->halt = plb2800_eth_halt;
  99         dev->send = plb2800_eth_send;
 100         dev->recv = plb2800_eth_recv;
 101
 102         eth_register(dev);
 103
 104         /* bug fix */
 105         *(ulong *)0xb800e800 = 0x838;
 106
 107         /* Set MBOX ownership */
 108         temp = CMAC_CRIT << MBOX_STAT_ID_SHF;
 109         MBOX_REG(0)->stat = temp;
 110         MBOX_REG(1)->stat = temp;
 111
 112         temp = CMAC_NON_CRIT << MBOX_STAT_ID_SHF;
 113         MBOX_REG(2)->stat = temp;
 114         MBOX_REG(3)->stat = temp;
 115
 116         plb2800_set_mac_addr(dev, plb2800_get_mac_addr());
 117
 118         /* Disable all Mbox interrupt */
 119         temp = MIPS_H_MASK;
 120         temp &= ~ (SW_H_MBOX1_MASK | SW_H_MBOX2_MASK | SW_H_MBOX3_MASK | SW_H_MBOX4_MASK) ;
 121         MIPS_H_MASK = temp;
 122
 123 #ifdef DEBUG
 124         printf("Leaving plb2800_eth_initialize()\n");
 125 #endif
 126
 127         return 0;
 128 }
 129
 130 static int plb2800_eth_init(struct eth_device *dev, bd_t * bis)
 131 {
 132 #ifdef DEBUG
 133         printf("Entering plb2800_eth_init()\n");
 134 #endif
 135
 136         plb2800_set_mac_addr(dev, dev->enetaddr);
 137
 138         rx_new = 0;
 139
 140 #ifdef DEBUG
 141         printf("Leaving plb2800_eth_init()\n");
 142 #endif
 143
 144         return 0;
 145 }
 146
 147
 148 static int plb2800_eth_send(struct eth_device *dev, void *packet, int length)
 149 {
 150         int                    i;
 151         int                    res         = -1;
 152         u32                    temp;
 153         mailbox_t *            mb          = MBOX_REG(0);
 154         char      *            mem         = MBOX_MEM(0);
 155
 156 #ifdef DEBUG
 157         printf("Entered plb2800_eth_send()\n");
 158 #endif
 159
 160         if (length <= 0)
 161         {
 162                 printf ("%s: bad packet size: %d\n", dev->name, length);
 163                 goto Done;
 164         }
 165
 166         if (length < 64)
 167         {
 168                 length = 64;
 169         }
 170
 171         temp = CMAC_CRX_CTRL_CG | ((length + 4) << CMAC_CRX_CTRL_PL_SHIFT);
 172
 173 #ifdef DEBUG
 174         printf("0 mb->stat = 0x%x\n",  mb->stat);
 175 #endif
 176
 177         for(i = 0; mb->stat & (MBOX_STAT_CP | MBOX_STAT_MB); i++)
 178         {
 179                 if (i >= TOUT_LOOP)
 180                 {
 181                         printf("%s: tx buffer not ready\n", dev->name);
 182                         printf("1 mb->stat = 0x%x\n",  mb->stat);
 183                         goto Done;
 184                 }
 185         }
 186
 187                 /* For some strange reason, memcpy doesn't work, here!
 188                  */
 189         do
 190         {
 191                 int words = (length >> 2) + 1;
 192                 unsigned int* dst = (unsigned int*)(mem);
 193                 unsigned int* src = (unsigned int*)(packet);
 194                 for (i = 0; i < words; i++)
 195                 {
 196                         *dst = *src;
 197                         dst++;
 198                         src++;
 199                 };
 200         } while(0);
 201
 202         CMAC_CRX_CTRL = temp;
 203         mb->cmd = MBOX_STAT_CP;
 204
 205 #ifdef DEBUG
 206         printf("2 mb->stat = 0x%x\n",  mb->stat);
 207 #endif
 208
 209         res = length;
 210 Done:
 211
 212 #ifdef DEBUG
 213         printf("Leaving plb2800_eth_send()\n");
 214 #endif
 215
 216         return res;
 217 }
 218
 219
 220 static int plb2800_eth_recv(struct eth_device *dev)
 221 {
 222         int                    length  = 0;
 223         mailbox_t            * mbox    = MBOX_REG(3);
 224         unsigned char        * hdr     = MBOX_MEM(3);
 225         unsigned int           stat;
 226
 227 #ifdef DEBUG
 228         printf("Entered plb2800_eth_recv()\n");
 229 #endif
 230
 231         for (;;)
 232         {
 233                 stat = mbox->stat;
 234
 235                 if (!(stat & MBOX_STAT_CP))
 236                 {
 237                         break;
 238                 }
 239
 240                 length = ((*(hdr + 6) & 0x3f) << 8) + *(hdr + 7);
 241                 memcpy((void *)NetRxPackets[rx_new], hdr + 12, length);
 242
 243                 stat &= ~MBOX_STAT_CP;
 244                 mbox->stat = stat;
 245 #ifdef DEBUG
 246                 {
 247                         int i;
 248                         for (i=0;i<length - 4;i++)
 249                         {
 250                                 if (i % 16 == 0) printf("\n%04x: ", i);
 251                                 printf("%02X ", NetRxPackets[rx_new][i]);
 252                         }
 253                         printf("\n");
 254                 }
 255 #endif
 256
 257                 if (length)
 258                 {
 259 #ifdef DEBUG
 260                         printf("Received %d bytes\n", length);
 261 #endif
 262                         NetReceive((void*)(NetRxPackets[rx_new]),
 263                                     length - 4);
 264                 }
 265                 else
 266                 {
 267 #if 1
 268                         printf("Zero length!!!\n");
 269 #endif
 270                 }
 271
 272                 rx_new = (rx_new + 1) % NUM_RX_DESC;
 273         }
 274
 275 #ifdef DEBUG
 276         printf("Leaving plb2800_eth_recv()\n");
 277 #endif
 278
 279         return length;
 280 }
 281
 282
 283 static void plb2800_eth_halt(struct eth_device *dev)
 284 {
 285 #ifdef DEBUG
 286         printf("Entered plb2800_eth_halt()\n");
 287 #endif
 288
 289 #ifdef DEBUG
 290         printf("Leaving plb2800_eth_halt()\n");
 291 #endif
 292 }
 293
 294 static void plb2800_set_mac_addr(struct eth_device *dev, unsigned char * addr)
 295 {
 296         char packet[60];
 297         ulong temp;
 298         int ix;
 299
 300         if (mac_addr_set ||
 301             NULL == addr || memcmp(addr, "\0\0\0\0\0\0", 6) == 0)
 302         {
 303                 return;
 304         }
 305
 306         /* send one packet through CPU port
 307          * in order to learn system MAC address
 308          */
 309
 310         /* Set DA_LOOKUP register */
 311         temp = EN_MA_LEARN | (0 << DA_STATE_SHF) | (63 << DA_DEST_SHF);
 312         DA_LOOKUP = temp;
 313
 314         /* Set MA_LEARN register */
 315         temp = 50 << MA_DEST_SHF;       /* static entry */
 316         MA_LEARN = temp;
 317
 318         /* set destination address */
 319         for (ix=0;ix<6;ix++)
 320                 packet[ix] = 0xff;
 321
 322         /* set source address = system MAC address */
 323         for (ix=0;ix<6;ix++)
 324                 packet[6+ix] = addr[ix];
 325
 326         /* set type field */
 327         packet[12]=0xaa;
 328         packet[13]=0x55;
 329
 330         /* set data field */
 331         for(ix=14;ix<60;ix++)
 332                 packet[ix] = 0x00;
 333
 334 #ifdef DEBUG
 335         for (ix=0;ix<6;ix++)
 336                 printf("mac_addr[%d]=%02X\n", ix, (unsigned char)packet[6+ix]);
 337 #endif
 338
 339         /* set one packet */
 340         plb2800_eth_send(dev, packet, sizeof(packet));
 341
 342         /* delay for a while */
 343         for(ix=0;ix<65535;ix++)
 344                 temp = ~temp;
 345
 346         /* Set CMAC_CTX_CTRL register */
 347         temp = TSTAMP_MS;       /* no autocast */
 348         CMAC_CTX_CTRL = temp;
 349
 350         /* Set DA_LOOKUP register */
 351         temp = EN_DA_LKUP;
 352         DA_LOOKUP = temp;
 353
 354         mac_addr_set = 1;
 355 }
 356
 357 static unsigned char * plb2800_get_mac_addr(void)
 358 {
 359         static unsigned char addr[6];
 360         char *tmp, *end;
 361         int i;
 362
 363         tmp = getenv ("ethaddr");
 364         if (NULL == tmp) return NULL;
 365
 366         for (i=0; i<6; i++) {
 367                 addr[i] = tmp ? simple_strtoul(tmp, &end, 16) : 0;
 368                 if (tmp)
 369                         tmp = (*end) ? end+1 : end;
 370         }
 371
 372         return addr;
 373 }