[people/ms/u-boot.git] / drivers / net / ftmac100.c

/*
 * Faraday FTMAC100 Ethernet
 *
 * (C) Copyright 2009 Faraday Technology
 * Po-Yu Chuang <ratbert@faraday-tech.com>
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

#include <config.h>
#include <common.h>
#include <malloc.h>
#include <net.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 ftmac100_data *priv)
{
	struct ftmac100 *ftmac100 = (struct ftmac100 *)priv->iobase;

	debug ("%s()\n", __func__);

	writel (FTMAC100_MACCR_SW_RST, &ftmac100->maccr);

	while (readl (&ftmac100->maccr) & FTMAC100_MACCR_SW_RST)
		mdelay(1);
	/*
	 * When soft reset complete, write mac address immediately maybe fail somehow
	 *  Wait for a while can avoid this problem
	 */
	mdelay(1);
}

/*
 * Set MAC address
 */
static void ftmac100_set_mac(struct ftmac100_data *priv ,
	const unsigned char *mac)
{
	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];

	debug ("%s(%x %x)\n", __func__, maddr, laddr);

	writel (maddr, &ftmac100->mac_madr);
	writel (laddr, &ftmac100->mac_ladr);
}

/*
 * Disable MAC
 */
static void _ftmac100_halt(struct ftmac100_data *priv)
{
	struct ftmac100 *ftmac100 = (struct ftmac100 *)priv->iobase;
	debug ("%s()\n", __func__);
	writel (0, &ftmac100->maccr);
}

/*
 * Initialize MAC
 */
static int _ftmac100_init(struct ftmac100_data *priv, unsigned char enetaddr[6])
{
	struct ftmac100 *ftmac100 = (struct ftmac100 *)priv->iobase;
	struct ftmac100_txdes *txdes = priv->txdes;
	struct ftmac100_rxdes *rxdes = priv->rxdes;
	unsigned int maccr;
	int i;
	debug ("%s()\n", __func__);

	ftmac100_reset(priv);

	/* set the ethernet address */
	ftmac100_set_mac(priv, enetaddr);


	/* disable all interrupts */

	writel (0, &ftmac100->imr);

	/* initialize descriptors */

	priv->rx_index = 0;

	txdes[0].txdes1			= FTMAC100_TXDES1_EDOTR;
	rxdes[PKTBUFSRX - 1].rxdes1	= FTMAC100_RXDES1_EDORR;

	for (i = 0; i < PKTBUFSRX; i++) {
		/* RXBUF_BADR */
		rxdes[i].rxdes2 = (unsigned int)net_rx_packets[i];
		rxdes[i].rxdes1 |= FTMAC100_RXDES1_RXBUF_SIZE (PKTSIZE_ALIGN);
		rxdes[i].rxdes0 = FTMAC100_RXDES0_RXDMA_OWN;
	}

	/* transmit ring */

	writel ((unsigned int)txdes, &ftmac100->txr_badr);

	/* receive ring */

	writel ((unsigned int)rxdes, &ftmac100->rxr_badr);

	/* poll receive descriptor automatically */

	writel (FTMAC100_APTC_RXPOLL_CNT (1), &ftmac100->aptc);

	/* enable transmitter, receiver */

	maccr = FTMAC100_MACCR_XMT_EN |
		FTMAC100_MACCR_RCV_EN |
		FTMAC100_MACCR_XDMA_EN |
		FTMAC100_MACCR_RDMA_EN |
		FTMAC100_MACCR_CRC_APD |
		FTMAC100_MACCR_ENRX_IN_HALFTX |
		FTMAC100_MACCR_RX_RUNT |
		FTMAC100_MACCR_RX_BROADPKT;

	writel (maccr, &ftmac100->maccr);

	return 0;
}

/*
 * Free receiving buffer
 */
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_rxdes *curr_des;
	unsigned short rxlen;

	curr_des = &priv->rxdes[priv->rx_index];
	if (curr_des->rxdes0 & FTMAC100_RXDES0_RXDMA_OWN)
		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 0;
	}

	rxlen = FTMAC100_RXDES0_RFL (curr_des->rxdes0);
	invalidate_dcache_range(curr_des->rxdes2,curr_des->rxdes2+rxlen);
	debug ("%s(): RX buffer %d, %x received\n",
	       __func__, priv->rx_index, rxlen);

	return rxlen;
}

/*
 * Send a data block via Ethernet
 */
static int _ftmac100_send(struct ftmac100_data *priv, void *packet, int length)
{
	struct ftmac100 *ftmac100 = (struct ftmac100 *)priv->iobase;
	struct ftmac100_txdes *curr_des = priv->txdes;
	ulong start;

	if (curr_des->txdes0 & FTMAC100_TXDES0_TXDMA_OWN) {
		debug ("%s(): no TX descriptor available\n", __func__);
		return -1;
	}

	debug ("%s(%x, %x)\n", __func__, (int)packet, length);

	length = (length < ETH_ZLEN) ? ETH_ZLEN : length;

	/* initiate a transmit sequence */

	flush_dcache_range((u32)packet,(u32)packet+length);
	curr_des->txdes2 = (unsigned int)packet;	/* TXBUF_BADR */

	curr_des->txdes1 &= FTMAC100_TXDES1_EDOTR;
	curr_des->txdes1 |= FTMAC100_TXDES1_FTS |
			    FTMAC100_TXDES1_LTS |
			    FTMAC100_TXDES1_TXBUF_SIZE (length);

	curr_des->txdes0 = FTMAC100_TXDES0_TXDMA_OWN;

	/* start transmit */

	writel (1, &ftmac100->txpd);

	/* wait for transfer to succeed */

	start = get_timer(0);
	while (curr_des->txdes0 & FTMAC100_TXDES0_TXDMA_OWN) {
		if (get_timer(start) >= 5) {
			debug ("%s(): timed out\n", __func__);
			return -1;
		}
	}

	debug ("%s(): packet sent\n", __func__);

	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));

	strcpy(dev->name, "FTMAC100");
	dev->iobase	= CONFIG_FTMAC100_BASE;
	dev->init	= ftmac100_init;
	dev->halt	= ftmac100_halt;
	dev->send	= ftmac100_send;
	dev->recv	= ftmac100_recv;
	dev->priv	= priv;
	priv->iobase	= dev->iobase;
	eth_register (dev);

	return 1;

free_dev:
	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_env_get_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 = devfdt_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
Commit	Line	Data
750326e5 PYC	1	/*
	2	* Faraday FTMAC100 Ethernet
	3	*
	4	* (C) Copyright 2009 Faraday Technology
	5	* Po-Yu Chuang <ratbert@faraday-tech.com>
	6	*
1a459660	7	* SPDX-License-Identifier: GPL-2.0+
750326e5 PYC	8	*/
	9
	10	#include <config.h>
	11	#include <common.h>
	12	#include <malloc.h>
	13	#include <net.h>
be71a179	14	#include <linux/io.h>
750326e5 PYC	15
750326e5 PYC	16	#include "ftmac100.h"
be71a179	17	#ifdef CONFIG_DM_ETH
	18	#include <dm.h>
	19	DECLARE_GLOBAL_DATA_PTR;
	20	#endif
750326e5 PYC	21	#define ETH_ZLEN 60
	22
	23	struct ftmac100_data {
6f6e6e09 PYC	24	struct ftmac100_txdes txdes[1];
6f6e6e09 PYC	25	struct ftmac100_rxdes rxdes[PKTBUFSRX];
750326e5	26	int rx_index;
be71a179	27	const char *name;
be71a179	28	phys_addr_t iobase;
750326e5 PYC	29	};
	30
	31	/*
	32	* Reset MAC
	33	*/
be71a179	34	static void ftmac100_reset(struct ftmac100_data *priv)
750326e5	35	{
be71a179	36	struct ftmac100 ftmac100 = (struct ftmac100 )priv->iobase;
750326e5 PYC	37
	38	debug ("%s()\n", __func__);
	39
	40	writel (FTMAC100_MACCR_SW_RST, &ftmac100->maccr);
	41
	42	while (readl (&ftmac100->maccr) & FTMAC100_MACCR_SW_RST)
1341494c	43	mdelay(1);
	44	/*
	45	* When soft reset complete, write mac address immediately maybe fail somehow
	46	* Wait for a while can avoid this problem
	47	*/
	48	mdelay(1);
750326e5 PYC	49	}
	50
	51	/*
	52	* Set MAC address
	53	*/
be71a179	54	static void ftmac100_set_mac(struct ftmac100_data *priv ,
be71a179	55	const unsigned char *mac)
750326e5	56	{
be71a179	57	struct ftmac100 ftmac100 = (struct ftmac100 )priv->iobase;
750326e5 PYC	58	unsigned int maddr = mac[0] << 8 \| mac[1];
	59	unsigned int laddr = mac[2] << 24 \| mac[3] << 16 \| mac[4] << 8 \| mac[5];
	60
	61	debug ("%s(%x %x)\n", __func__, maddr, laddr);
	62
	63	writel (maddr, &ftmac100->mac_madr);
	64	writel (laddr, &ftmac100->mac_ladr);
	65	}
	66
750326e5	67	/*
be71a179	68	* Disable MAC
750326e5	69	*/
be71a179	70	static void _ftmac100_halt(struct ftmac100_data *priv)
750326e5	71	{
be71a179	72	struct ftmac100 ftmac100 = (struct ftmac100 )priv->iobase;
750326e5	73	debug ("%s()\n", __func__);
750326e5 PYC	74	writel (0, &ftmac100->maccr);
	75	}
	76
be71a179	77	/*
	78	* Initialize MAC
	79	*/
	80	static int _ftmac100_init(struct ftmac100_data *priv, unsigned char enetaddr[6])
750326e5	81	{
be71a179	82	struct ftmac100 ftmac100 = (struct ftmac100 )priv->iobase;
6f6e6e09 PYC	83	struct ftmac100_txdes *txdes = priv->txdes;
6f6e6e09 PYC	84	struct ftmac100_rxdes *rxdes = priv->rxdes;
750326e5 PYC	85	unsigned int maccr;
750326e5 PYC	86	int i;
750326e5 PYC	87	debug ("%s()\n", __func__);
750326e5 PYC	88
be71a179	89	ftmac100_reset(priv);
750326e5 PYC	90
750326e5 PYC	91	/* set the ethernet address */
be71a179	92	ftmac100_set_mac(priv, enetaddr);
750326e5	93
750326e5 PYC	94
	95	/* disable all interrupts */
	96
	97	writel (0, &ftmac100->imr);
	98
	99	/* initialize descriptors */
	100
	101	priv->rx_index = 0;
	102
	103	txdes[0].txdes1 = FTMAC100_TXDES1_EDOTR;
	104	rxdes[PKTBUFSRX - 1].rxdes1 = FTMAC100_RXDES1_EDORR;
	105
	106	for (i = 0; i < PKTBUFSRX; i++) {
	107	/* RXBUF_BADR */
1fd92db8	108	rxdes[i].rxdes2 = (unsigned int)net_rx_packets[i];
750326e5 PYC	109	rxdes[i].rxdes1 \|= FTMAC100_RXDES1_RXBUF_SIZE (PKTSIZE_ALIGN);
	110	rxdes[i].rxdes0 = FTMAC100_RXDES0_RXDMA_OWN;
	111	}
	112
	113	/* transmit ring */
	114
	115	writel ((unsigned int)txdes, &ftmac100->txr_badr);
	116
	117	/* receive ring */
	118
	119	writel ((unsigned int)rxdes, &ftmac100->rxr_badr);
	120
	121	/* poll receive descriptor automatically */
	122
	123	writel (FTMAC100_APTC_RXPOLL_CNT (1), &ftmac100->aptc);
	124
	125	/* enable transmitter, receiver */
	126
	127	maccr = FTMAC100_MACCR_XMT_EN \|
	128	FTMAC100_MACCR_RCV_EN \|
	129	FTMAC100_MACCR_XDMA_EN \|
	130	FTMAC100_MACCR_RDMA_EN \|
	131	FTMAC100_MACCR_CRC_APD \|
	132	FTMAC100_MACCR_ENRX_IN_HALFTX \|
	133	FTMAC100_MACCR_RX_RUNT \|
	134	FTMAC100_MACCR_RX_BROADPKT;
	135
	136	writel (maccr, &ftmac100->maccr);
	137
	138	return 0;
	139	}
	140
	141	/*
be71a179	142	* Free receiving buffer
750326e5	143	*/
be71a179	144	static int _ftmac100_free_pkt(struct ftmac100_data *priv)
	145	{
	146	struct ftmac100_rxdes *curr_des;
	147	curr_des = &priv->rxdes[priv->rx_index];
	148	/* release buffer to DMA */
	149	curr_des->rxdes0 \|= FTMAC100_RXDES0_RXDMA_OWN;
	150	priv->rx_index = (priv->rx_index + 1) % PKTBUFSRX;
	151	return 0;
	152	}
	153
	154	/*
	155	* Receive a data block via Ethernet
	156	*/
	157	static int __ftmac100_recv(struct ftmac100_data *priv)
750326e5	158	{
6f6e6e09	159	struct ftmac100_rxdes *curr_des;
750326e5 PYC	160	unsigned short rxlen;
	161
	162	curr_des = &priv->rxdes[priv->rx_index];
750326e5	163	if (curr_des->rxdes0 & FTMAC100_RXDES0_RXDMA_OWN)
be71a179	164	return 0;
750326e5 PYC	165
	166	if (curr_des->rxdes0 & (FTMAC100_RXDES0_RX_ERR \|
	167	FTMAC100_RXDES0_CRC_ERR \|
	168	FTMAC100_RXDES0_FTL \|
	169	FTMAC100_RXDES0_RUNT \|
	170	FTMAC100_RXDES0_RX_ODD_NB)) {
be71a179	171	return 0;
750326e5 PYC	172	}
	173
	174	rxlen = FTMAC100_RXDES0_RFL (curr_des->rxdes0);
ce4e2370	175	invalidate_dcache_range(curr_des->rxdes2,curr_des->rxdes2+rxlen);
750326e5 PYC	176	debug ("%s(): RX buffer %d, %x received\n",
	177	__func__, priv->rx_index, rxlen);
	178
be71a179	179	return rxlen;
750326e5 PYC	180	}
	181
	182	/*
	183	* Send a data block via Ethernet
	184	*/
be71a179	185	static int _ftmac100_send(struct ftmac100_data priv, void packet, int length)
750326e5	186	{
be71a179	187	struct ftmac100 ftmac100 = (struct ftmac100 )priv->iobase;
6f6e6e09	188	struct ftmac100_txdes *curr_des = priv->txdes;
8d8fd5b6	189	ulong start;
750326e5 PYC	190
	191	if (curr_des->txdes0 & FTMAC100_TXDES0_TXDMA_OWN) {
	192	debug ("%s(): no TX descriptor available\n", __func__);
	193	return -1;
	194	}
	195
	196	debug ("%s(%x, %x)\n", __func__, (int)packet, length);
	197
	198	length = (length < ETH_ZLEN) ? ETH_ZLEN : length;
	199
	200	/* initiate a transmit sequence */
	201
ce4e2370	202	flush_dcache_range((u32)packet,(u32)packet+length);
750326e5 PYC	203	curr_des->txdes2 = (unsigned int)packet; /* TXBUF_BADR */
	204
	205	curr_des->txdes1 &= FTMAC100_TXDES1_EDOTR;
	206	curr_des->txdes1 \|= FTMAC100_TXDES1_FTS \|
	207	FTMAC100_TXDES1_LTS \|
	208	FTMAC100_TXDES1_TXBUF_SIZE (length);
	209
	210	curr_des->txdes0 = FTMAC100_TXDES0_TXDMA_OWN;
	211
	212	/* start transmit */
	213
	214	writel (1, &ftmac100->txpd);
	215
	216	/* wait for transfer to succeed */
	217
8d8fd5b6	218	start = get_timer(0);
750326e5	219	while (curr_des->txdes0 & FTMAC100_TXDES0_TXDMA_OWN) {
8d8fd5b6	220	if (get_timer(start) >= 5) {
750326e5 PYC	221	debug ("%s(): timed out\n", __func__);
	222	return -1;
	223	}
	224	}
	225
	226	debug ("%s(): packet sent\n", __func__);
	227
	228	return 0;
	229	}
	230
be71a179	231	#ifndef CONFIG_DM_ETH
	232	/*
	233	* disable transmitter, receiver
	234	*/
	235	static void ftmac100_halt(struct eth_device *dev)
	236	{
	237	struct ftmac100_data *priv = dev->priv;
	238	return _ftmac100_halt(priv);
	239	}
	240
	241	static int ftmac100_init(struct eth_device dev, bd_t bd)
	242	{
	243	struct ftmac100_data *priv = dev->priv;
	244	return _ftmac100_init(priv , dev->enetaddr);
	245	}
	246
	247	static int _ftmac100_recv(struct ftmac100_data *priv)
	248	{
	249	struct ftmac100_rxdes *curr_des;
	250	unsigned short len;
	251	curr_des = &priv->rxdes[priv->rx_index];
	252	len = __ftmac100_recv(priv);
	253	if (len) {
	254	/* pass the packet up to the protocol layers. */
	255	net_process_received_packet((void *)curr_des->rxdes2, len);
	256	_ftmac100_free_pkt(priv);
	257	}
	258	return len ? 1 : 0;
	259	}
	260
	261	/*
	262	* Get a data block via Ethernet
	263	*/
	264	static int ftmac100_recv(struct eth_device *dev)
	265	{
	266	struct ftmac100_data *priv = dev->priv;
	267	return _ftmac100_recv(priv);
	268	}
	269
	270	/*
	271	* Send a data block via Ethernet
	272	*/
	273	static int ftmac100_send(struct eth_device dev, void packet, int length)
	274	{
	275	struct ftmac100_data *priv = dev->priv;
	276	return _ftmac100_send(priv , packet , length);
	277	}
	278
750326e5 PYC	279	int ftmac100_initialize (bd_t *bd)
	280	{
	281	struct eth_device *dev;
	282	struct ftmac100_data *priv;
750326e5 PYC	283	dev = malloc (sizeof *dev);
	284	if (!dev) {
	285	printf ("%s(): failed to allocate dev\n", __func__);
	286	goto out;
	287	}
750326e5	288	/* Transmit and receive descriptors should align to 16 bytes */
750326e5 PYC	289	priv = memalign (16, sizeof (struct ftmac100_data));
	290	if (!priv) {
	291	printf ("%s(): failed to allocate priv\n", __func__);
	292	goto free_dev;
	293	}
750326e5 PYC	294	memset (dev, 0, sizeof (*dev));
	295	memset (priv, 0, sizeof (*priv));
	296
192bc694	297	strcpy(dev->name, "FTMAC100");
750326e5 PYC	298	dev->iobase = CONFIG_FTMAC100_BASE;
	299	dev->init = ftmac100_init;
	300	dev->halt = ftmac100_halt;
	301	dev->send = ftmac100_send;
	302	dev->recv = ftmac100_recv;
	303	dev->priv = priv;
be71a179	304	priv->iobase = dev->iobase;
750326e5 PYC	305	eth_register (dev);
	306
	307	return 1;
	308
	309	free_dev:
	310	free (dev);
	311	out:
	312	return 0;
	313	}
be71a179	314	#endif
	315
	316	#ifdef CONFIG_DM_ETH
	317	static int ftmac100_start(struct udevice *dev)
	318	{
	319	struct eth_pdata *plat = dev_get_platdata(dev);
	320	struct ftmac100_data *priv = dev_get_priv(dev);
	321
	322	return _ftmac100_init(priv, plat->enetaddr);
	323	}
	324
	325	static void ftmac100_stop(struct udevice *dev)
	326	{
	327	struct ftmac100_data *priv = dev_get_priv(dev);
	328	_ftmac100_halt(priv);
	329	}
	330
	331	static int ftmac100_send(struct udevice dev, void packet, int length)
	332	{
	333	struct ftmac100_data *priv = dev_get_priv(dev);
	334	int ret;
	335	ret = _ftmac100_send(priv , packet , length);
	336	return ret ? 0 : -ETIMEDOUT;
	337	}
	338
	339	static int ftmac100_recv(struct udevice dev, int flags, uchar *packetp)
	340	{
	341	struct ftmac100_data *priv = dev_get_priv(dev);
	342	struct ftmac100_rxdes *curr_des;
	343	curr_des = &priv->rxdes[priv->rx_index];
	344	int len;
	345	len = __ftmac100_recv(priv);
	346	if (len)
	347	packetp = (void )curr_des->rxdes2;
	348
	349	return len ? len : -EAGAIN;
	350	}
	351
	352	static int ftmac100_free_pkt(struct udevice dev, uchar packet, int length)
	353	{
	354	struct ftmac100_data *priv = dev_get_priv(dev);
	355	_ftmac100_free_pkt(priv);
	356	return 0;
	357	}
	358
	359	int ftmac100_read_rom_hwaddr(struct udevice *dev)
	360	{
	361	struct eth_pdata *pdata = dev_get_platdata(dev);
35affd7a	362	eth_env_get_enetaddr("ethaddr", pdata->enetaddr);
be71a179	363	return 0;
	364	}
	365
	366	static const char *dtbmacaddr(u32 ifno)
	367	{
	368	int node, len;
	369	char enet[16];
	370	const char *mac;
	371	const char *path;
	372	if (gd->fdt_blob == NULL) {
	373	printf("%s: don't have a valid gd->fdt_blob!\n", __func__);
	374	return NULL;
	375	}
	376	node = fdt_path_offset(gd->fdt_blob, "/aliases");
	377	if (node < 0)
	378	return NULL;
	379
	380	sprintf(enet, "ethernet%d", ifno);
	381	path = fdt_getprop(gd->fdt_blob, node, enet, NULL);
	382	if (!path) {
	383	printf("no alias for %s\n", enet);
	384	return NULL;
	385	}
	386	node = fdt_path_offset(gd->fdt_blob, path);
	387	mac = fdt_getprop(gd->fdt_blob, node, "mac-address", &len);
	388	if (mac && is_valid_ethaddr((u8 *)mac))
	389	return mac;
	390
	391	return NULL;
	392	}
	393
	394	static int ftmac100_ofdata_to_platdata(struct udevice *dev)
	395	{
	396	struct ftmac100_data *priv = dev_get_priv(dev);
	397	struct eth_pdata *pdata = dev_get_platdata(dev);
	398	const char *mac;
a821c4af	399	pdata->iobase = devfdt_get_addr(dev);
be71a179	400	priv->iobase = pdata->iobase;
	401	mac = dtbmacaddr(0);
	402	if (mac)
	403	memcpy(pdata->enetaddr , mac , 6);
	404
	405	return 0;
	406	}
	407
	408	static int ftmac100_probe(struct udevice *dev)
	409	{
	410	struct ftmac100_data *priv = dev_get_priv(dev);
	411	priv->name = dev->name;
	412	return 0;
	413	}
	414
	415	static int ftmac100_bind(struct udevice *dev)
	416	{
	417	return device_set_name(dev, dev->name);
	418	}
	419
	420	static const struct eth_ops ftmac100_ops = {
	421	.start = ftmac100_start,
	422	.send = ftmac100_send,
	423	.recv = ftmac100_recv,
	424	.stop = ftmac100_stop,
	425	.free_pkt = ftmac100_free_pkt,
	426	};
	427
	428	static const struct udevice_id ftmac100_ids[] = {
	429	{ .compatible = "andestech,atmac100" },
	430	{ }
	431	};
	432
	433	U_BOOT_DRIVER(ftmac100) = {
	434	.name = "nds32_mac",
	435	.id = UCLASS_ETH,
	436	.of_match = ftmac100_ids,
	437	.bind = ftmac100_bind,
	438	.ofdata_to_platdata = ftmac100_ofdata_to_platdata,
	439	.probe = ftmac100_probe,
	440	.ops = &ftmac100_ops,
	441	.priv_auto_alloc_size = sizeof(struct ftmac100_data),
	442	.platdata_auto_alloc_size = sizeof(struct eth_pdata),
	443	.flags = DM_FLAG_ALLOC_PRIV_DMA,
	444	};
	445	#endif