|
@@ -1,373 +0,0 @@
|
|
|
-/*
|
|
|
- * PLB2800 internal switch ethernet driver.
|
|
|
- *
|
|
|
- * (C) Copyright 2003
|
|
|
- * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
|
|
|
- *
|
|
|
- * SPDX-License-Identifier: GPL-2.0+
|
|
|
- */
|
|
|
-
|
|
|
-#include <common.h>
|
|
|
-#include <malloc.h>
|
|
|
-#include <net.h>
|
|
|
-#include <netdev.h>
|
|
|
-#include <asm/addrspace.h>
|
|
|
-
|
|
|
-
|
|
|
-#define NUM_RX_DESC PKTBUFSRX
|
|
|
-#define TOUT_LOOP 1000000
|
|
|
-
|
|
|
-#define LONG_REF(addr) (*((volatile unsigned long*)addr))
|
|
|
-
|
|
|
-#define CMAC_CRX_CTRL LONG_REF(0xb800c870)
|
|
|
-#define CMAC_CTX_CTRL LONG_REF(0xb800c874)
|
|
|
-#define SYS_MAC_ADDR_0 LONG_REF(0xb800c878)
|
|
|
-#define SYS_MAC_ADDR_1 LONG_REF(0xb800c87c)
|
|
|
-#define MIPS_H_MASK LONG_REF(0xB800C810)
|
|
|
-
|
|
|
-#define MA_LEARN LONG_REF(0xb8008004)
|
|
|
-#define DA_LOOKUP LONG_REF(0xb8008008)
|
|
|
-
|
|
|
-#define CMAC_CRX_CTRL_PD 0x00000001
|
|
|
-#define CMAC_CRX_CTRL_CG 0x00000002
|
|
|
-#define CMAC_CRX_CTRL_PL_SHIFT 2
|
|
|
-#define CMAC_CRIT 0x0
|
|
|
-#define CMAC_NON_CRIT 0x1
|
|
|
-#define MBOX_STAT_ID_SHF 28
|
|
|
-#define MBOX_STAT_CP 0x80000000
|
|
|
-#define MBOX_STAT_MB 0x00000001
|
|
|
-#define EN_MA_LEARN 0x02000000
|
|
|
-#define EN_DA_LKUP 0x01000000
|
|
|
-#define MA_DEST_SHF 11
|
|
|
-#define DA_DEST_SHF 11
|
|
|
-#define DA_STATE_SHF 19
|
|
|
-#define TSTAMP_MS 0x00000000
|
|
|
-#define SW_H_MBOX4_MASK 0x08000000
|
|
|
-#define SW_H_MBOX3_MASK 0x04000000
|
|
|
-#define SW_H_MBOX2_MASK 0x02000000
|
|
|
-#define SW_H_MBOX1_MASK 0x01000000
|
|
|
-
|
|
|
-typedef volatile struct {
|
|
|
- unsigned int stat;
|
|
|
- unsigned int cmd;
|
|
|
- unsigned int cnt;
|
|
|
- unsigned int adr;
|
|
|
-} mailbox_t;
|
|
|
-
|
|
|
-#define MBOX_REG(mb) ((mailbox_t*)(0xb800c830+(mb<<4)))
|
|
|
-
|
|
|
-typedef volatile struct {
|
|
|
- unsigned int word0;
|
|
|
- unsigned int word1;
|
|
|
- unsigned int word2;
|
|
|
-} mbhdr_t;
|
|
|
-
|
|
|
-#define MBOX_MEM(mb) ((void*)(0xb800a000+((3-mb)<<11)))
|
|
|
-
|
|
|
-
|
|
|
-static int plb2800_eth_init(struct eth_device *dev, bd_t * bis);
|
|
|
-static int plb2800_eth_send(struct eth_device *dev, void *packet, int length);
|
|
|
-static int plb2800_eth_recv(struct eth_device *dev);
|
|
|
-static void plb2800_eth_halt(struct eth_device *dev);
|
|
|
-
|
|
|
-static void plb2800_set_mac_addr(struct eth_device *dev, unsigned char * addr);
|
|
|
-static unsigned char * plb2800_get_mac_addr(void);
|
|
|
-
|
|
|
-static int rx_new;
|
|
|
-static int mac_addr_set = 0;
|
|
|
-
|
|
|
-
|
|
|
-int plb2800_eth_initialize(bd_t * bis)
|
|
|
-{
|
|
|
- struct eth_device *dev;
|
|
|
- ulong temp;
|
|
|
-
|
|
|
-#ifdef DEBUG
|
|
|
- printf("Entered plb2800_eth_initialize()\n");
|
|
|
-#endif
|
|
|
-
|
|
|
- if (!(dev = (struct eth_device *) malloc (sizeof *dev)))
|
|
|
- {
|
|
|
- printf("Failed to allocate memory\n");
|
|
|
- return -1;
|
|
|
- }
|
|
|
- memset(dev, 0, sizeof(*dev));
|
|
|
-
|
|
|
- sprintf(dev->name, "PLB2800 Switch");
|
|
|
- dev->init = plb2800_eth_init;
|
|
|
- dev->halt = plb2800_eth_halt;
|
|
|
- dev->send = plb2800_eth_send;
|
|
|
- dev->recv = plb2800_eth_recv;
|
|
|
-
|
|
|
- eth_register(dev);
|
|
|
-
|
|
|
- /* bug fix */
|
|
|
- *(ulong *)0xb800e800 = 0x838;
|
|
|
-
|
|
|
- /* Set MBOX ownership */
|
|
|
- temp = CMAC_CRIT << MBOX_STAT_ID_SHF;
|
|
|
- MBOX_REG(0)->stat = temp;
|
|
|
- MBOX_REG(1)->stat = temp;
|
|
|
-
|
|
|
- temp = CMAC_NON_CRIT << MBOX_STAT_ID_SHF;
|
|
|
- MBOX_REG(2)->stat = temp;
|
|
|
- MBOX_REG(3)->stat = temp;
|
|
|
-
|
|
|
- plb2800_set_mac_addr(dev, plb2800_get_mac_addr());
|
|
|
-
|
|
|
- /* Disable all Mbox interrupt */
|
|
|
- temp = MIPS_H_MASK;
|
|
|
- temp &= ~ (SW_H_MBOX1_MASK | SW_H_MBOX2_MASK | SW_H_MBOX3_MASK | SW_H_MBOX4_MASK) ;
|
|
|
- MIPS_H_MASK = temp;
|
|
|
-
|
|
|
-#ifdef DEBUG
|
|
|
- printf("Leaving plb2800_eth_initialize()\n");
|
|
|
-#endif
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-static int plb2800_eth_init(struct eth_device *dev, bd_t * bis)
|
|
|
-{
|
|
|
-#ifdef DEBUG
|
|
|
- printf("Entering plb2800_eth_init()\n");
|
|
|
-#endif
|
|
|
-
|
|
|
- plb2800_set_mac_addr(dev, dev->enetaddr);
|
|
|
-
|
|
|
- rx_new = 0;
|
|
|
-
|
|
|
-#ifdef DEBUG
|
|
|
- printf("Leaving plb2800_eth_init()\n");
|
|
|
-#endif
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-
|
|
|
-static int plb2800_eth_send(struct eth_device *dev, void *packet, int length)
|
|
|
-{
|
|
|
- int i;
|
|
|
- int res = -1;
|
|
|
- u32 temp;
|
|
|
- mailbox_t * mb = MBOX_REG(0);
|
|
|
- char * mem = MBOX_MEM(0);
|
|
|
-
|
|
|
-#ifdef DEBUG
|
|
|
- printf("Entered plb2800_eth_send()\n");
|
|
|
-#endif
|
|
|
-
|
|
|
- if (length <= 0)
|
|
|
- {
|
|
|
- printf ("%s: bad packet size: %d\n", dev->name, length);
|
|
|
- goto Done;
|
|
|
- }
|
|
|
-
|
|
|
- if (length < 64)
|
|
|
- {
|
|
|
- length = 64;
|
|
|
- }
|
|
|
-
|
|
|
- temp = CMAC_CRX_CTRL_CG | ((length + 4) << CMAC_CRX_CTRL_PL_SHIFT);
|
|
|
-
|
|
|
-#ifdef DEBUG
|
|
|
- printf("0 mb->stat = 0x%x\n", mb->stat);
|
|
|
-#endif
|
|
|
-
|
|
|
- for(i = 0; mb->stat & (MBOX_STAT_CP | MBOX_STAT_MB); i++)
|
|
|
- {
|
|
|
- if (i >= TOUT_LOOP)
|
|
|
- {
|
|
|
- printf("%s: tx buffer not ready\n", dev->name);
|
|
|
- printf("1 mb->stat = 0x%x\n", mb->stat);
|
|
|
- goto Done;
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- /* For some strange reason, memcpy doesn't work, here!
|
|
|
- */
|
|
|
- do
|
|
|
- {
|
|
|
- int words = (length >> 2) + 1;
|
|
|
- unsigned int* dst = (unsigned int*)(mem);
|
|
|
- unsigned int* src = (unsigned int*)(packet);
|
|
|
- for (i = 0; i < words; i++)
|
|
|
- {
|
|
|
- *dst = *src;
|
|
|
- dst++;
|
|
|
- src++;
|
|
|
- };
|
|
|
- } while(0);
|
|
|
-
|
|
|
- CMAC_CRX_CTRL = temp;
|
|
|
- mb->cmd = MBOX_STAT_CP;
|
|
|
-
|
|
|
-#ifdef DEBUG
|
|
|
- printf("2 mb->stat = 0x%x\n", mb->stat);
|
|
|
-#endif
|
|
|
-
|
|
|
- res = length;
|
|
|
-Done:
|
|
|
-
|
|
|
-#ifdef DEBUG
|
|
|
- printf("Leaving plb2800_eth_send()\n");
|
|
|
-#endif
|
|
|
-
|
|
|
- return res;
|
|
|
-}
|
|
|
-
|
|
|
-
|
|
|
-static int plb2800_eth_recv(struct eth_device *dev)
|
|
|
-{
|
|
|
- int length = 0;
|
|
|
- mailbox_t * mbox = MBOX_REG(3);
|
|
|
- unsigned char * hdr = MBOX_MEM(3);
|
|
|
- unsigned int stat;
|
|
|
-
|
|
|
-#ifdef DEBUG
|
|
|
- printf("Entered plb2800_eth_recv()\n");
|
|
|
-#endif
|
|
|
-
|
|
|
- for (;;)
|
|
|
- {
|
|
|
- stat = mbox->stat;
|
|
|
-
|
|
|
- if (!(stat & MBOX_STAT_CP))
|
|
|
- {
|
|
|
- break;
|
|
|
- }
|
|
|
-
|
|
|
- length = ((*(hdr + 6) & 0x3f) << 8) + *(hdr + 7);
|
|
|
- memcpy((void *)NetRxPackets[rx_new], hdr + 12, length);
|
|
|
-
|
|
|
- stat &= ~MBOX_STAT_CP;
|
|
|
- mbox->stat = stat;
|
|
|
-#ifdef DEBUG
|
|
|
- {
|
|
|
- int i;
|
|
|
- for (i=0;i<length - 4;i++)
|
|
|
- {
|
|
|
- if (i % 16 == 0) printf("\n%04x: ", i);
|
|
|
- printf("%02X ", NetRxPackets[rx_new][i]);
|
|
|
- }
|
|
|
- printf("\n");
|
|
|
- }
|
|
|
-#endif
|
|
|
-
|
|
|
- if (length)
|
|
|
- {
|
|
|
-#ifdef DEBUG
|
|
|
- printf("Received %d bytes\n", length);
|
|
|
-#endif
|
|
|
- NetReceive((void*)(NetRxPackets[rx_new]),
|
|
|
- length - 4);
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
-#if 1
|
|
|
- printf("Zero length!!!\n");
|
|
|
-#endif
|
|
|
- }
|
|
|
-
|
|
|
- rx_new = (rx_new + 1) % NUM_RX_DESC;
|
|
|
- }
|
|
|
-
|
|
|
-#ifdef DEBUG
|
|
|
- printf("Leaving plb2800_eth_recv()\n");
|
|
|
-#endif
|
|
|
-
|
|
|
- return length;
|
|
|
-}
|
|
|
-
|
|
|
-
|
|
|
-static void plb2800_eth_halt(struct eth_device *dev)
|
|
|
-{
|
|
|
-#ifdef DEBUG
|
|
|
- printf("Entered plb2800_eth_halt()\n");
|
|
|
-#endif
|
|
|
-
|
|
|
-#ifdef DEBUG
|
|
|
- printf("Leaving plb2800_eth_halt()\n");
|
|
|
-#endif
|
|
|
-}
|
|
|
-
|
|
|
-static void plb2800_set_mac_addr(struct eth_device *dev, unsigned char * addr)
|
|
|
-{
|
|
|
- char packet[60];
|
|
|
- ulong temp;
|
|
|
- int ix;
|
|
|
-
|
|
|
- if (mac_addr_set ||
|
|
|
- NULL == addr || memcmp(addr, "\0\0\0\0\0\0", 6) == 0)
|
|
|
- {
|
|
|
- return;
|
|
|
- }
|
|
|
-
|
|
|
- /* send one packet through CPU port
|
|
|
- * in order to learn system MAC address
|
|
|
- */
|
|
|
-
|
|
|
- /* Set DA_LOOKUP register */
|
|
|
- temp = EN_MA_LEARN | (0 << DA_STATE_SHF) | (63 << DA_DEST_SHF);
|
|
|
- DA_LOOKUP = temp;
|
|
|
-
|
|
|
- /* Set MA_LEARN register */
|
|
|
- temp = 50 << MA_DEST_SHF; /* static entry */
|
|
|
- MA_LEARN = temp;
|
|
|
-
|
|
|
- /* set destination address */
|
|
|
- for (ix=0;ix<6;ix++)
|
|
|
- packet[ix] = 0xff;
|
|
|
-
|
|
|
- /* set source address = system MAC address */
|
|
|
- for (ix=0;ix<6;ix++)
|
|
|
- packet[6+ix] = addr[ix];
|
|
|
-
|
|
|
- /* set type field */
|
|
|
- packet[12]=0xaa;
|
|
|
- packet[13]=0x55;
|
|
|
-
|
|
|
- /* set data field */
|
|
|
- for(ix=14;ix<60;ix++)
|
|
|
- packet[ix] = 0x00;
|
|
|
-
|
|
|
-#ifdef DEBUG
|
|
|
- for (ix=0;ix<6;ix++)
|
|
|
- printf("mac_addr[%d]=%02X\n", ix, (unsigned char)packet[6+ix]);
|
|
|
-#endif
|
|
|
-
|
|
|
- /* set one packet */
|
|
|
- plb2800_eth_send(dev, packet, sizeof(packet));
|
|
|
-
|
|
|
- /* delay for a while */
|
|
|
- for(ix=0;ix<65535;ix++)
|
|
|
- temp = ~temp;
|
|
|
-
|
|
|
- /* Set CMAC_CTX_CTRL register */
|
|
|
- temp = TSTAMP_MS; /* no autocast */
|
|
|
- CMAC_CTX_CTRL = temp;
|
|
|
-
|
|
|
- /* Set DA_LOOKUP register */
|
|
|
- temp = EN_DA_LKUP;
|
|
|
- DA_LOOKUP = temp;
|
|
|
-
|
|
|
- mac_addr_set = 1;
|
|
|
-}
|
|
|
-
|
|
|
-static unsigned char * plb2800_get_mac_addr(void)
|
|
|
-{
|
|
|
- static unsigned char addr[6];
|
|
|
- char *tmp, *end;
|
|
|
- int i;
|
|
|
-
|
|
|
- tmp = getenv ("ethaddr");
|
|
|
- if (NULL == tmp) return NULL;
|
|
|
-
|
|
|
- for (i=0; i<6; i++) {
|
|
|
- addr[i] = tmp ? simple_strtoul(tmp, &end, 16) : 0;
|
|
|
- if (tmp)
|
|
|
- tmp = (*end) ? end+1 : end;
|
|
|
- }
|
|
|
-
|
|
|
- return addr;
|
|
|
-}
|