|
|
|
@ -11,24 +11,29 @@ |
|
|
|
|
#include <common.h> |
|
|
|
|
#include <malloc.h> |
|
|
|
|
#include <net.h> |
|
|
|
|
#include <asm/io.h> |
|
|
|
|
#include <linux/io.h> |
|
|
|
|
|
|
|
|
|
#include "ftmac100.h" |
|
|
|
|
|
|
|
|
|
#ifdef CONFIG_DM_ETH |
|
|
|
|
#include <dm.h> |
|
|
|
|
DECLARE_GLOBAL_DATA_PTR; |
|
|
|
|
#endif |
|
|
|
|
#define ETH_ZLEN 60 |
|
|
|
|
|
|
|
|
|
struct ftmac100_data { |
|
|
|
|
struct ftmac100_txdes txdes[1]; |
|
|
|
|
struct ftmac100_rxdes rxdes[PKTBUFSRX]; |
|
|
|
|
int rx_index; |
|
|
|
|
const char *name; |
|
|
|
|
phys_addr_t iobase; |
|
|
|
|
}; |
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* Reset MAC |
|
|
|
|
*/ |
|
|
|
|
static void ftmac100_reset (struct eth_device *dev) |
|
|
|
|
static void ftmac100_reset(struct ftmac100_data *priv) |
|
|
|
|
{ |
|
|
|
|
struct ftmac100 *ftmac100 = (struct ftmac100 *)dev->iobase; |
|
|
|
|
struct ftmac100 *ftmac100 = (struct ftmac100 *)priv->iobase; |
|
|
|
|
|
|
|
|
|
debug ("%s()\n", __func__); |
|
|
|
|
|
|
|
|
@ -41,9 +46,10 @@ static void ftmac100_reset (struct eth_device *dev) |
|
|
|
|
/*
|
|
|
|
|
* Set MAC address |
|
|
|
|
*/ |
|
|
|
|
static void ftmac100_set_mac (struct eth_device *dev, const unsigned char *mac) |
|
|
|
|
static void ftmac100_set_mac(struct ftmac100_data *priv , |
|
|
|
|
const unsigned char *mac) |
|
|
|
|
{ |
|
|
|
|
struct ftmac100 *ftmac100 = (struct ftmac100 *)dev->iobase; |
|
|
|
|
struct ftmac100 *ftmac100 = (struct ftmac100 *)priv->iobase; |
|
|
|
|
unsigned int maddr = mac[0] << 8 | mac[1]; |
|
|
|
|
unsigned int laddr = mac[2] << 24 | mac[3] << 16 | mac[4] << 8 | mac[5]; |
|
|
|
|
|
|
|
|
@ -53,29 +59,22 @@ static void ftmac100_set_mac (struct eth_device *dev, const unsigned char *mac) |
|
|
|
|
writel (laddr, &ftmac100->mac_ladr); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static void ftmac100_set_mac_from_env (struct eth_device *dev) |
|
|
|
|
{ |
|
|
|
|
eth_getenv_enetaddr ("ethaddr", dev->enetaddr); |
|
|
|
|
|
|
|
|
|
ftmac100_set_mac (dev, dev->enetaddr); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* disable transmitter, receiver |
|
|
|
|
* Disable MAC |
|
|
|
|
*/ |
|
|
|
|
static void ftmac100_halt (struct eth_device *dev) |
|
|
|
|
static void _ftmac100_halt(struct ftmac100_data *priv) |
|
|
|
|
{ |
|
|
|
|
struct ftmac100 *ftmac100 = (struct ftmac100 *)dev->iobase; |
|
|
|
|
|
|
|
|
|
struct ftmac100 *ftmac100 = (struct ftmac100 *)priv->iobase; |
|
|
|
|
debug ("%s()\n", __func__); |
|
|
|
|
|
|
|
|
|
writel (0, &ftmac100->maccr); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static int ftmac100_init (struct eth_device *dev, bd_t *bd) |
|
|
|
|
/*
|
|
|
|
|
* Initialize MAC |
|
|
|
|
*/ |
|
|
|
|
static int _ftmac100_init(struct ftmac100_data *priv, unsigned char enetaddr[6]) |
|
|
|
|
{ |
|
|
|
|
struct ftmac100 *ftmac100 = (struct ftmac100 *)dev->iobase; |
|
|
|
|
struct ftmac100_data *priv = dev->priv; |
|
|
|
|
struct ftmac100 *ftmac100 = (struct ftmac100 *)priv->iobase; |
|
|
|
|
struct ftmac100_txdes *txdes = priv->txdes; |
|
|
|
|
struct ftmac100_rxdes *rxdes = priv->rxdes; |
|
|
|
|
unsigned int maccr; |
|
|
|
@ -83,11 +82,11 @@ static int ftmac100_init (struct eth_device *dev, bd_t *bd) |
|
|
|
|
|
|
|
|
|
debug ("%s()\n", __func__); |
|
|
|
|
|
|
|
|
|
ftmac100_reset (dev); |
|
|
|
|
ftmac100_reset(priv); |
|
|
|
|
|
|
|
|
|
/* set the ethernet address */ |
|
|
|
|
ftmac100_set_mac(priv, enetaddr); |
|
|
|
|
|
|
|
|
|
ftmac100_set_mac_from_env (dev); |
|
|
|
|
|
|
|
|
|
/* disable all interrupts */ |
|
|
|
|
|
|
|
|
@ -136,25 +135,37 @@ static int ftmac100_init (struct eth_device *dev, bd_t *bd) |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* Get a data block via Ethernet |
|
|
|
|
* Free receiving buffer |
|
|
|
|
*/ |
|
|
|
|
static int ftmac100_recv (struct eth_device *dev) |
|
|
|
|
static int _ftmac100_free_pkt(struct ftmac100_data *priv) |
|
|
|
|
{ |
|
|
|
|
struct ftmac100_rxdes *curr_des; |
|
|
|
|
curr_des = &priv->rxdes[priv->rx_index]; |
|
|
|
|
/* release buffer to DMA */ |
|
|
|
|
curr_des->rxdes0 |= FTMAC100_RXDES0_RXDMA_OWN; |
|
|
|
|
priv->rx_index = (priv->rx_index + 1) % PKTBUFSRX; |
|
|
|
|
return 0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* Receive a data block via Ethernet |
|
|
|
|
*/ |
|
|
|
|
static int __ftmac100_recv(struct ftmac100_data *priv) |
|
|
|
|
{ |
|
|
|
|
struct ftmac100_data *priv = dev->priv; |
|
|
|
|
struct ftmac100_rxdes *curr_des; |
|
|
|
|
unsigned short rxlen; |
|
|
|
|
|
|
|
|
|
curr_des = &priv->rxdes[priv->rx_index]; |
|
|
|
|
|
|
|
|
|
if (curr_des->rxdes0 & FTMAC100_RXDES0_RXDMA_OWN) |
|
|
|
|
return -1; |
|
|
|
|
return 0; |
|
|
|
|
|
|
|
|
|
if (curr_des->rxdes0 & (FTMAC100_RXDES0_RX_ERR | |
|
|
|
|
FTMAC100_RXDES0_CRC_ERR | |
|
|
|
|
FTMAC100_RXDES0_FTL | |
|
|
|
|
FTMAC100_RXDES0_RUNT | |
|
|
|
|
FTMAC100_RXDES0_RX_ODD_NB)) { |
|
|
|
|
return -1; |
|
|
|
|
return 0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
rxlen = FTMAC100_RXDES0_RFL (curr_des->rxdes0); |
|
|
|
@ -162,26 +173,15 @@ static int ftmac100_recv (struct eth_device *dev) |
|
|
|
|
debug ("%s(): RX buffer %d, %x received\n", |
|
|
|
|
__func__, priv->rx_index, rxlen); |
|
|
|
|
|
|
|
|
|
/* pass the packet up to the protocol layers. */ |
|
|
|
|
|
|
|
|
|
net_process_received_packet((void *)curr_des->rxdes2, rxlen); |
|
|
|
|
|
|
|
|
|
/* release buffer to DMA */ |
|
|
|
|
|
|
|
|
|
curr_des->rxdes0 |= FTMAC100_RXDES0_RXDMA_OWN; |
|
|
|
|
|
|
|
|
|
priv->rx_index = (priv->rx_index + 1) % PKTBUFSRX; |
|
|
|
|
|
|
|
|
|
return 0; |
|
|
|
|
return rxlen; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* Send a data block via Ethernet |
|
|
|
|
*/ |
|
|
|
|
static int ftmac100_send(struct eth_device *dev, void *packet, int length) |
|
|
|
|
static int _ftmac100_send(struct ftmac100_data *priv, void *packet, int length) |
|
|
|
|
{ |
|
|
|
|
struct ftmac100 *ftmac100 = (struct ftmac100 *)dev->iobase; |
|
|
|
|
struct ftmac100_data *priv = dev->priv; |
|
|
|
|
struct ftmac100 *ftmac100 = (struct ftmac100 *)priv->iobase; |
|
|
|
|
struct ftmac100_txdes *curr_des = priv->txdes; |
|
|
|
|
ulong start; |
|
|
|
|
|
|
|
|
@ -224,25 +224,69 @@ static int ftmac100_send(struct eth_device *dev, void *packet, int length) |
|
|
|
|
return 0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
#ifndef CONFIG_DM_ETH |
|
|
|
|
/*
|
|
|
|
|
* disable transmitter, receiver |
|
|
|
|
*/ |
|
|
|
|
static void ftmac100_halt(struct eth_device *dev) |
|
|
|
|
{ |
|
|
|
|
struct ftmac100_data *priv = dev->priv; |
|
|
|
|
return _ftmac100_halt(priv); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static int ftmac100_init(struct eth_device *dev, bd_t *bd) |
|
|
|
|
{ |
|
|
|
|
struct ftmac100_data *priv = dev->priv; |
|
|
|
|
return _ftmac100_init(priv , dev->enetaddr); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static int _ftmac100_recv(struct ftmac100_data *priv) |
|
|
|
|
{ |
|
|
|
|
struct ftmac100_rxdes *curr_des; |
|
|
|
|
unsigned short len; |
|
|
|
|
curr_des = &priv->rxdes[priv->rx_index]; |
|
|
|
|
len = __ftmac100_recv(priv); |
|
|
|
|
if (len) { |
|
|
|
|
/* pass the packet up to the protocol layers. */ |
|
|
|
|
net_process_received_packet((void *)curr_des->rxdes2, len); |
|
|
|
|
_ftmac100_free_pkt(priv); |
|
|
|
|
} |
|
|
|
|
return len ? 1 : 0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* Get a data block via Ethernet |
|
|
|
|
*/ |
|
|
|
|
static int ftmac100_recv(struct eth_device *dev) |
|
|
|
|
{ |
|
|
|
|
struct ftmac100_data *priv = dev->priv; |
|
|
|
|
return _ftmac100_recv(priv); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* Send a data block via Ethernet |
|
|
|
|
*/ |
|
|
|
|
static int ftmac100_send(struct eth_device *dev, void *packet, int length) |
|
|
|
|
{ |
|
|
|
|
struct ftmac100_data *priv = dev->priv; |
|
|
|
|
return _ftmac100_send(priv , packet , length); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
int ftmac100_initialize (bd_t *bd) |
|
|
|
|
{ |
|
|
|
|
struct eth_device *dev; |
|
|
|
|
struct ftmac100_data *priv; |
|
|
|
|
|
|
|
|
|
dev = malloc (sizeof *dev); |
|
|
|
|
if (!dev) { |
|
|
|
|
printf ("%s(): failed to allocate dev\n", __func__); |
|
|
|
|
goto out; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/* Transmit and receive descriptors should align to 16 bytes */ |
|
|
|
|
|
|
|
|
|
priv = memalign (16, sizeof (struct ftmac100_data)); |
|
|
|
|
if (!priv) { |
|
|
|
|
printf ("%s(): failed to allocate priv\n", __func__); |
|
|
|
|
goto free_dev; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
memset (dev, 0, sizeof (*dev)); |
|
|
|
|
memset (priv, 0, sizeof (*priv)); |
|
|
|
|
|
|
|
|
@ -253,7 +297,7 @@ int ftmac100_initialize (bd_t *bd) |
|
|
|
|
dev->send = ftmac100_send; |
|
|
|
|
dev->recv = ftmac100_recv; |
|
|
|
|
dev->priv = priv; |
|
|
|
|
|
|
|
|
|
priv->iobase = dev->iobase; |
|
|
|
|
eth_register (dev); |
|
|
|
|
|
|
|
|
|
return 1; |
|
|
|
@ -263,3 +307,135 @@ free_dev: |
|
|
|
|
out: |
|
|
|
|
return 0; |
|
|
|
|
} |
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
#ifdef CONFIG_DM_ETH |
|
|
|
|
static int ftmac100_start(struct udevice *dev) |
|
|
|
|
{ |
|
|
|
|
struct eth_pdata *plat = dev_get_platdata(dev); |
|
|
|
|
struct ftmac100_data *priv = dev_get_priv(dev); |
|
|
|
|
|
|
|
|
|
return _ftmac100_init(priv, plat->enetaddr); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static void ftmac100_stop(struct udevice *dev) |
|
|
|
|
{ |
|
|
|
|
struct ftmac100_data *priv = dev_get_priv(dev); |
|
|
|
|
_ftmac100_halt(priv); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static int ftmac100_send(struct udevice *dev, void *packet, int length) |
|
|
|
|
{ |
|
|
|
|
struct ftmac100_data *priv = dev_get_priv(dev); |
|
|
|
|
int ret; |
|
|
|
|
ret = _ftmac100_send(priv , packet , length); |
|
|
|
|
return ret ? 0 : -ETIMEDOUT; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static int ftmac100_recv(struct udevice *dev, int flags, uchar **packetp) |
|
|
|
|
{ |
|
|
|
|
struct ftmac100_data *priv = dev_get_priv(dev); |
|
|
|
|
struct ftmac100_rxdes *curr_des; |
|
|
|
|
curr_des = &priv->rxdes[priv->rx_index]; |
|
|
|
|
int len; |
|
|
|
|
len = __ftmac100_recv(priv); |
|
|
|
|
if (len) |
|
|
|
|
*packetp = (void *)curr_des->rxdes2; |
|
|
|
|
|
|
|
|
|
return len ? len : -EAGAIN; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static int ftmac100_free_pkt(struct udevice *dev, uchar *packet, int length) |
|
|
|
|
{ |
|
|
|
|
struct ftmac100_data *priv = dev_get_priv(dev); |
|
|
|
|
_ftmac100_free_pkt(priv); |
|
|
|
|
return 0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
int ftmac100_read_rom_hwaddr(struct udevice *dev) |
|
|
|
|
{ |
|
|
|
|
struct eth_pdata *pdata = dev_get_platdata(dev); |
|
|
|
|
eth_getenv_enetaddr("ethaddr", pdata->enetaddr); |
|
|
|
|
return 0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static const char *dtbmacaddr(u32 ifno) |
|
|
|
|
{ |
|
|
|
|
int node, len; |
|
|
|
|
char enet[16]; |
|
|
|
|
const char *mac; |
|
|
|
|
const char *path; |
|
|
|
|
if (gd->fdt_blob == NULL) { |
|
|
|
|
printf("%s: don't have a valid gd->fdt_blob!\n", __func__); |
|
|
|
|
return NULL; |
|
|
|
|
} |
|
|
|
|
node = fdt_path_offset(gd->fdt_blob, "/aliases"); |
|
|
|
|
if (node < 0) |
|
|
|
|
return NULL; |
|
|
|
|
|
|
|
|
|
sprintf(enet, "ethernet%d", ifno); |
|
|
|
|
path = fdt_getprop(gd->fdt_blob, node, enet, NULL); |
|
|
|
|
if (!path) { |
|
|
|
|
printf("no alias for %s\n", enet); |
|
|
|
|
return NULL; |
|
|
|
|
} |
|
|
|
|
node = fdt_path_offset(gd->fdt_blob, path); |
|
|
|
|
mac = fdt_getprop(gd->fdt_blob, node, "mac-address", &len); |
|
|
|
|
if (mac && is_valid_ethaddr((u8 *)mac)) |
|
|
|
|
return mac; |
|
|
|
|
|
|
|
|
|
return NULL; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static int ftmac100_ofdata_to_platdata(struct udevice *dev) |
|
|
|
|
{ |
|
|
|
|
struct ftmac100_data *priv = dev_get_priv(dev); |
|
|
|
|
struct eth_pdata *pdata = dev_get_platdata(dev); |
|
|
|
|
const char *mac; |
|
|
|
|
pdata->iobase = dev_get_addr(dev); |
|
|
|
|
priv->iobase = pdata->iobase; |
|
|
|
|
mac = dtbmacaddr(0); |
|
|
|
|
if (mac) |
|
|
|
|
memcpy(pdata->enetaddr , mac , 6); |
|
|
|
|
|
|
|
|
|
return 0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static int ftmac100_probe(struct udevice *dev) |
|
|
|
|
{ |
|
|
|
|
struct ftmac100_data *priv = dev_get_priv(dev); |
|
|
|
|
priv->name = dev->name; |
|
|
|
|
return 0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static int ftmac100_bind(struct udevice *dev) |
|
|
|
|
{ |
|
|
|
|
return device_set_name(dev, dev->name); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static const struct eth_ops ftmac100_ops = { |
|
|
|
|
.start = ftmac100_start, |
|
|
|
|
.send = ftmac100_send, |
|
|
|
|
.recv = ftmac100_recv, |
|
|
|
|
.stop = ftmac100_stop, |
|
|
|
|
.free_pkt = ftmac100_free_pkt, |
|
|
|
|
}; |
|
|
|
|
|
|
|
|
|
static const struct udevice_id ftmac100_ids[] = { |
|
|
|
|
{ .compatible = "andestech,atmac100" }, |
|
|
|
|
{ } |
|
|
|
|
}; |
|
|
|
|
|
|
|
|
|
U_BOOT_DRIVER(ftmac100) = { |
|
|
|
|
.name = "nds32_mac", |
|
|
|
|
.id = UCLASS_ETH, |
|
|
|
|
.of_match = ftmac100_ids, |
|
|
|
|
.bind = ftmac100_bind, |
|
|
|
|
.ofdata_to_platdata = ftmac100_ofdata_to_platdata, |
|
|
|
|
.probe = ftmac100_probe, |
|
|
|
|
.ops = &ftmac100_ops, |
|
|
|
|
.priv_auto_alloc_size = sizeof(struct ftmac100_data), |
|
|
|
|
.platdata_auto_alloc_size = sizeof(struct eth_pdata), |
|
|
|
|
.flags = DM_FLAG_ALLOC_PRIV_DMA, |
|
|
|
|
}; |
|
|
|
|
#endif |
|
|
|
|