|
@@ -11,24 +11,29 @@
|
|
#include <common.h>
|
|
#include <common.h>
|
|
#include <malloc.h>
|
|
#include <malloc.h>
|
|
#include <net.h>
|
|
#include <net.h>
|
|
-#include <asm/io.h>
|
|
|
|
|
|
+#include <linux/io.h>
|
|
|
|
|
|
#include "ftmac100.h"
|
|
#include "ftmac100.h"
|
|
-
|
|
|
|
|
|
+#ifdef CONFIG_DM_ETH
|
|
|
|
+#include <dm.h>
|
|
|
|
+DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
+#endif
|
|
#define ETH_ZLEN 60
|
|
#define ETH_ZLEN 60
|
|
|
|
|
|
struct ftmac100_data {
|
|
struct ftmac100_data {
|
|
struct ftmac100_txdes txdes[1];
|
|
struct ftmac100_txdes txdes[1];
|
|
struct ftmac100_rxdes rxdes[PKTBUFSRX];
|
|
struct ftmac100_rxdes rxdes[PKTBUFSRX];
|
|
int rx_index;
|
|
int rx_index;
|
|
|
|
+ const char *name;
|
|
|
|
+ phys_addr_t iobase;
|
|
};
|
|
};
|
|
|
|
|
|
/*
|
|
/*
|
|
* Reset MAC
|
|
* 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__);
|
|
debug ("%s()\n", __func__);
|
|
|
|
|
|
@@ -41,9 +46,10 @@ static void ftmac100_reset (struct eth_device *dev)
|
|
/*
|
|
/*
|
|
* Set MAC address
|
|
* 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 maddr = mac[0] << 8 | mac[1];
|
|
unsigned int laddr = mac[2] << 24 | mac[3] << 16 | mac[4] << 8 | mac[5];
|
|
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);
|
|
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__);
|
|
debug ("%s()\n", __func__);
|
|
-
|
|
|
|
writel (0, &ftmac100->maccr);
|
|
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_txdes *txdes = priv->txdes;
|
|
struct ftmac100_rxdes *rxdes = priv->rxdes;
|
|
struct ftmac100_rxdes *rxdes = priv->rxdes;
|
|
unsigned int maccr;
|
|
unsigned int maccr;
|
|
@@ -83,11 +82,11 @@ static int ftmac100_init (struct eth_device *dev, bd_t *bd)
|
|
|
|
|
|
debug ("%s()\n", __func__);
|
|
debug ("%s()\n", __func__);
|
|
|
|
|
|
- ftmac100_reset (dev);
|
|
|
|
|
|
+ ftmac100_reset(priv);
|
|
|
|
|
|
/* set the ethernet address */
|
|
/* set the ethernet address */
|
|
|
|
+ ftmac100_set_mac(priv, enetaddr);
|
|
|
|
|
|
- ftmac100_set_mac_from_env (dev);
|
|
|
|
|
|
|
|
/* disable all interrupts */
|
|
/* 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;
|
|
struct ftmac100_rxdes *curr_des;
|
|
unsigned short rxlen;
|
|
unsigned short rxlen;
|
|
|
|
|
|
curr_des = &priv->rxdes[priv->rx_index];
|
|
curr_des = &priv->rxdes[priv->rx_index];
|
|
|
|
|
|
if (curr_des->rxdes0 & FTMAC100_RXDES0_RXDMA_OWN)
|
|
if (curr_des->rxdes0 & FTMAC100_RXDES0_RXDMA_OWN)
|
|
- return -1;
|
|
|
|
|
|
+ return 0;
|
|
|
|
|
|
if (curr_des->rxdes0 & (FTMAC100_RXDES0_RX_ERR |
|
|
if (curr_des->rxdes0 & (FTMAC100_RXDES0_RX_ERR |
|
|
FTMAC100_RXDES0_CRC_ERR |
|
|
FTMAC100_RXDES0_CRC_ERR |
|
|
FTMAC100_RXDES0_FTL |
|
|
FTMAC100_RXDES0_FTL |
|
|
FTMAC100_RXDES0_RUNT |
|
|
FTMAC100_RXDES0_RUNT |
|
|
FTMAC100_RXDES0_RX_ODD_NB)) {
|
|
FTMAC100_RXDES0_RX_ODD_NB)) {
|
|
- return -1;
|
|
|
|
|
|
+ return 0;
|
|
}
|
|
}
|
|
|
|
|
|
rxlen = FTMAC100_RXDES0_RFL (curr_des->rxdes0);
|
|
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",
|
|
debug ("%s(): RX buffer %d, %x received\n",
|
|
__func__, priv->rx_index, rxlen);
|
|
__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
|
|
* 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;
|
|
struct ftmac100_txdes *curr_des = priv->txdes;
|
|
ulong start;
|
|
ulong start;
|
|
|
|
|
|
@@ -224,25 +224,69 @@ static int ftmac100_send(struct eth_device *dev, void *packet, int length)
|
|
return 0;
|
|
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)
|
|
int ftmac100_initialize (bd_t *bd)
|
|
{
|
|
{
|
|
struct eth_device *dev;
|
|
struct eth_device *dev;
|
|
struct ftmac100_data *priv;
|
|
struct ftmac100_data *priv;
|
|
-
|
|
|
|
dev = malloc (sizeof *dev);
|
|
dev = malloc (sizeof *dev);
|
|
if (!dev) {
|
|
if (!dev) {
|
|
printf ("%s(): failed to allocate dev\n", __func__);
|
|
printf ("%s(): failed to allocate dev\n", __func__);
|
|
goto out;
|
|
goto out;
|
|
}
|
|
}
|
|
-
|
|
|
|
/* Transmit and receive descriptors should align to 16 bytes */
|
|
/* Transmit and receive descriptors should align to 16 bytes */
|
|
-
|
|
|
|
priv = memalign (16, sizeof (struct ftmac100_data));
|
|
priv = memalign (16, sizeof (struct ftmac100_data));
|
|
if (!priv) {
|
|
if (!priv) {
|
|
printf ("%s(): failed to allocate priv\n", __func__);
|
|
printf ("%s(): failed to allocate priv\n", __func__);
|
|
goto free_dev;
|
|
goto free_dev;
|
|
}
|
|
}
|
|
-
|
|
|
|
memset (dev, 0, sizeof (*dev));
|
|
memset (dev, 0, sizeof (*dev));
|
|
memset (priv, 0, sizeof (*priv));
|
|
memset (priv, 0, sizeof (*priv));
|
|
|
|
|
|
@@ -253,7 +297,7 @@ int ftmac100_initialize (bd_t *bd)
|
|
dev->send = ftmac100_send;
|
|
dev->send = ftmac100_send;
|
|
dev->recv = ftmac100_recv;
|
|
dev->recv = ftmac100_recv;
|
|
dev->priv = priv;
|
|
dev->priv = priv;
|
|
-
|
|
|
|
|
|
+ priv->iobase = dev->iobase;
|
|
eth_register (dev);
|
|
eth_register (dev);
|
|
|
|
|
|
return 1;
|
|
return 1;
|
|
@@ -263,3 +307,135 @@ free_dev:
|
|
out:
|
|
out:
|
|
return 0;
|
|
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
|