src/drivers/net/dwmac.c

/*
 * Copyright (C) 2025 Michael Brown <mbrown@fensystems.co.uk>.
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation; either version 2 of the
 * License, or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
 * 02110-1301, USA.
 *
 * You can also choose to distribute this program under the terms of
 * the Unmodified Binary Distribution Licence (as given in the file
 * COPYING.UBDL), provided that you have satisfied its requirements.
 */

FILE_LICENCE ( GPL2_OR_LATER_OR_UBDL );

#include <stdint.h>
#include <string.h>
#include <errno.h>
#include <byteswap.h>
#include <ipxe/netdevice.h>
#include <ipxe/ethernet.h>
#include <ipxe/if_ether.h>
#include <ipxe/iobuf.h>
#include <ipxe/timer.h>
#include <ipxe/devtree.h>
#include <ipxe/fdt.h>
#include "dwmac.h"

/** @file
 *
 * Synopsys DesignWare MAC network driver
 *
 */

/******************************************************************************
 *
 * Debug
 *
 ******************************************************************************
 */

/**
 * Dump MAC registers (for debugging)
 *
 * @v dwmac		DesignWare MAC device
 */
static void dwmac_dump_mac ( struct dwmac *dwmac ) {

	/* Do nothing unless debugging is enabled */
	if ( ! DBG_LOG )
		return;

	/* Dump MAC registers */
	DBGC ( dwmac, "DWMAC %s ver %08x cfg %08x flt %08x flo %08x\n",
	       dwmac->name, readl ( dwmac->regs + DWMAC_VER ),
	       readl ( dwmac->regs + DWMAC_CFG ),
	       readl ( dwmac->regs + DWMAC_FILTER ),
	       readl ( dwmac->regs + DWMAC_FLOW ) );
	DBGC ( dwmac, "DWMAC %s isr %08x dbg %08x gmi %08x\n",
	       dwmac->name, readl ( dwmac->regs + DWMAC_ISR ),
	       readl ( dwmac->regs + DWMAC_DEBUG ),
	       readl ( dwmac->regs + DWMAC_GMII ) );
}

/**
 * Dump DMA registers (for debugging)
 *
 * @v dwmac		DesignWare MAC device
 */
static void dwmac_dump_dma ( struct dwmac *dwmac ) {
	uint32_t status;

	/* Do nothing unless debugging is enabled */
	if ( ! DBG_LOG )
		return;

	/* Dump DMA registers */
	status = readl ( dwmac->regs + DWMAC_STATUS );
	DBGC ( dwmac, "DWMAC %s bus %08x fea %08x axi %08x ahb %08x\n",
	       dwmac->name, readl ( dwmac->regs + DWMAC_BUS ),
	       readl ( dwmac->regs + DWMAC_FEATURE ),
	       readl ( dwmac->regs + DWMAC_AXI ),
	       readl ( dwmac->regs + DWMAC_AHB ) );
	DBGC ( dwmac, "DWMAC %s opm %08x sta %08x drp %08x\n",
	       dwmac->name, readl ( dwmac->regs + DWMAC_OP ),
	       status, readl ( dwmac->regs + DWMAC_DROP ) );
	DBGC ( dwmac, "DWMAC %s txb %08x txd %08x txb %08x\n",
	       dwmac->name, readl ( dwmac->regs + DWMAC_TXBASE ),
	       readl ( dwmac->regs + DWMAC_TXDESC ),
	       readl ( dwmac->regs + DWMAC_TXBUF ) );
	DBGC ( dwmac, "DWMAC %s rxb %08x rxd %08x rxb %08x\n",
	       dwmac->name, readl ( dwmac->regs + DWMAC_RXBASE ),
	       readl ( dwmac->regs + DWMAC_RXDESC ),
	       readl ( dwmac->regs + DWMAC_RXBUF ) );

	/* Clear sticky bits in status register, since nothing else will */
	writel ( status, ( dwmac->regs + DWMAC_STATUS ) );
}

/**
 * Dump all registers (for debugging)
 *
 * @v dwmac		DesignWare MAC device
 */
static void __attribute__ (( unused )) dwmac_dump ( struct dwmac *dwmac ) {

	/* Dump MAC and DMA registers */
	dwmac_dump_mac ( dwmac );
	dwmac_dump_dma ( dwmac );
}

/******************************************************************************
 *
 * Device reset
 *
 ******************************************************************************
 */

/**
 * Reset hardware
 *
 * @v dwmac		DesignWare MAC device
 * @ret rc		Return status code
 */
static int dwmac_reset ( struct dwmac *dwmac ) {
	unsigned int i;
	uint32_t bus;

	/* Trigger software reset */
	writel ( DWMAC_BUS_SWR, ( dwmac->regs + DWMAC_BUS ) );

	/* Wait for reset to complete */
	for ( i = 0 ; i < DWMAC_RESET_MAX_WAIT_MS ; i++ ) {

		/* Delay */
		mdelay ( 1 );

		/* Check for reset completion */
		bus = readl ( dwmac->regs + DWMAC_BUS );
		if ( ! ( bus & DWMAC_BUS_SWR ) )
			return 0;
	}

	DBGC ( dwmac, "DWMAC %s timed out waiting for reset\n",
	       dwmac->name );
	return -ETIMEDOUT;
}

/******************************************************************************
 *
 * Link state
 *
 ******************************************************************************
 */

/**
 * Check link state
 *
 * @v netdev		Network device
 */
static void dwmac_check_link ( struct net_device *netdev ) {
	struct dwmac *dwmac = netdev->priv;
	uint32_t gmii;

	/* Read SGMII/RGMII link status */
	gmii = readl ( dwmac->regs + DWMAC_GMII );
	DBGC ( dwmac, "DWMAC %s GMII link status %#08x\n", dwmac->name, gmii );

	/* Update network device */
	if ( gmii & DWMAC_GMII_LINK ) {
		netdev_link_up ( netdev );
	} else {
		netdev_link_down ( netdev );
	}
}

/******************************************************************************
 *
 * Network device interface
 *
 ******************************************************************************
 */

/**
 * Create descriptor ring
 *
 * @v dwmac		DesignWare MAC device
 * @v ring		Descriptor ring
 * @ret rc		Return status code
 */
static int dwmac_create_ring ( struct dwmac *dwmac, struct dwmac_ring *ring ) {
	struct dwmac_descriptor *desc;
	struct dwmac_descriptor *next;
	physaddr_t base;
	unsigned int i;

	/* Allocate descriptor ring (on its own size) */
	ring->desc = dma_alloc ( dwmac->dma, &ring->map, ring->len, ring->len );
	if ( ! ring->desc )
		return -ENOMEM;

	/* Initialise descriptor ring */
	memset ( ring->desc, 0, ring->len );
	for ( i = 0 ; i < ring->count ; i++ ) {
		desc = &ring->desc[i];
		desc->size = cpu_to_le16 ( DWMAC_RX_LEN |
					   DWMAC_SIZE_RX_CHAIN );
		desc->ctrl = ring->ctrl;
		assert ( desc->ctrl & DWMAC_CTRL_CHAIN );
		next = &ring->desc[ ( i + 1 ) & ( ring->count - 1 ) ];
		desc->next = dma ( &ring->map, next );
	}
	wmb();

	/* Program ring address */
	base = dma ( &ring->map, ring->desc );
	assert ( base == ( ( uint32_t ) base ) );
	writel ( base, ( dwmac->regs + DWMAC_DMA + ring->qbase ) );

	DBGC ( dwmac, "DWMAC %s ring %02x is at [%08lx,%08lx)\n",
	       dwmac->name, ring->qbase, virt_to_phys ( ring->desc ),
	       ( virt_to_phys ( ring->desc ) + ring->len ) );
	return 0;
}

/**
 * Destroy descriptor ring
 *
 * @v dwmac		DesignWare MAC device
 * @v ring		Descriptor ring
 */
static void dwmac_destroy_ring ( struct dwmac *dwmac,
				 struct dwmac_ring *ring ) {

	/* Clear ring address */
	writel ( 0, ( dwmac->regs + DWMAC_DMA + ring->qbase ) );

	/* Free descriptor ring */
	dma_free ( &ring->map, ring->desc, ring->len );
	ring->desc = NULL;
	ring->prod = 0;
	ring->cons = 0;
}

/**
 * Refill receive descriptor ring
 *
 * @v dwmac		DesignWare MAC device
 */
static void dwmac_refill_rx ( struct dwmac *dwmac ) {
	struct dwmac_descriptor *rx;
	struct io_buffer *iobuf;
	unsigned int rx_idx;
	unsigned int refilled = 0;

	/* Refill ring */
	while ( ( dwmac->rx.prod - dwmac->rx.cons ) != DWMAC_NUM_RX_DESC ) {

		/* Allocate I/O buffer */
		iobuf = alloc_rx_iob ( DWMAC_RX_LEN, dwmac->dma );
		if ( ! iobuf ) {
			/* Wait for next refill */
			break;
		}

		/* Get next receive descriptor */
		rx_idx = ( dwmac->rx.prod++ % DWMAC_NUM_RX_DESC );
		rx = &dwmac->rx.desc[rx_idx];

		/* Populate receive descriptor */
		rx->addr = cpu_to_le32 ( iob_dma ( iobuf ) );
		wmb();
		rx->stat = cpu_to_le32 ( DWMAC_STAT_OWN );

		/* Record I/O buffer */
		assert ( dwmac->rx_iobuf[rx_idx] == NULL );
		dwmac->rx_iobuf[rx_idx] = iobuf;

		DBGC2 ( dwmac, "DWMAC %s RX %d is [%08lx,%08lx)\n",
			dwmac->name, rx_idx, virt_to_phys ( iobuf->data ),
			( virt_to_phys ( iobuf->data ) + DWMAC_RX_LEN ) );
		refilled++;
	}

	/* Trigger poll */
	if ( refilled ) {
		wmb();
		writel ( 0, ( dwmac->regs + DWMAC_RXPOLL ) );
	}
}

/**
 * Open network device
 *
 * @v netdev		Network device
 * @ret rc		Return status code
 */
static int dwmac_open ( struct net_device *netdev ) {
	struct dwmac *dwmac = netdev->priv;
	union dwmac_mac mac;
	int rc;

	/* Create transmit descriptor ring */
	if ( ( rc = dwmac_create_ring ( dwmac, &dwmac->tx ) ) != 0 )
		goto err_create_tx;

	/* Create receive descriptor ring */
	if ( ( rc = dwmac_create_ring ( dwmac, &dwmac->rx ) ) != 0 )
		goto err_create_rx;

	/* Set MAC address */
	memcpy ( mac.raw, netdev->ll_addr, ETH_ALEN );
	writel ( mac.reg.addrl, ( dwmac->regs + DWMAC_ADDRL ) );
	writel ( mac.reg.addrh, ( dwmac->regs + DWMAC_ADDRH ) );

	/* Enable promiscuous mode */
	writel ( DWMAC_FILTER_PR, ( dwmac->regs + DWMAC_FILTER ) );

	/* Enable transmit and receive */
	writel ( ( DWMAC_OP_TXSF | DWMAC_OP_RXSF |
		   DWMAC_OP_TXEN | DWMAC_OP_RXEN ),
		 ( dwmac->regs + DWMAC_OP ) );
	writel ( ( DWMAC_CFG_DO | DWMAC_CFG_FD |
		   DWMAC_CFG_TXEN | DWMAC_CFG_RXEN ),
		 ( dwmac->regs + DWMAC_CFG ) );

	/* Refill receive descriptor ring */
	dwmac_refill_rx ( dwmac );

	/* Update link state */
	dwmac_check_link ( netdev );

	return 0;

	dwmac_destroy_ring ( dwmac, &dwmac->rx );
 err_create_rx:
	dwmac_destroy_ring ( dwmac, &dwmac->tx );
 err_create_tx:
	return rc;
}

/**
 * Close network device
 *
 * @v netdev		Network device
 */
static void dwmac_close ( struct net_device *netdev ) {
	struct dwmac *dwmac = netdev->priv;
	unsigned int i;

	/* Reset NIC */
	dwmac_reset ( dwmac );

	/* Discard unused receive buffers */
	for ( i = 0 ; i < DWMAC_NUM_RX_DESC ; i++ ) {
		if ( dwmac->rx_iobuf[i] )
			free_rx_iob ( dwmac->rx_iobuf[i] );
		dwmac->rx_iobuf[i] = NULL;
	}

	/* Destroy receive descriptor ring */
	dwmac_destroy_ring ( dwmac, &dwmac->rx );

	/* Destroy transmit descriptor ring */
	dwmac_destroy_ring ( dwmac, &dwmac->tx );
}

/**
 * Transmit packet
 *
 * @v netdev		Network device
 * @v iobuf		I/O buffer
 * @ret rc		Return status code
 */
static int dwmac_transmit ( struct net_device *netdev,
			    struct io_buffer *iobuf ) {
	struct dwmac *dwmac = netdev->priv;
	struct dwmac_descriptor *tx;
	unsigned int tx_idx;

	/* Get next transmit descriptor */
	if ( ( dwmac->tx.prod - dwmac->tx.cons ) >= DWMAC_NUM_TX_DESC ) {
		DBGC ( dwmac, "DWMAC %s out of transmit descriptors\n",
		       dwmac->name );
		return -ENOBUFS;
	}
	tx_idx = ( dwmac->tx.prod % DWMAC_NUM_TX_DESC );
	tx = &dwmac->tx.desc[tx_idx];

	/* Update producer index */
	dwmac->tx.prod++;

	/* Populate transmit descriptor */
	tx->size = cpu_to_le16 ( iob_len ( iobuf ) );
	tx->addr = cpu_to_le32 ( iob_dma ( iobuf ) );
	wmb();
	tx->stat = cpu_to_le32 ( DWMAC_STAT_OWN | DWMAC_STAT_TX_LAST |
				 DWMAC_STAT_TX_FIRST | DWMAC_STAT_TX_CHAIN );
	wmb();

	/* Initiate transmission */
	writel ( 0, ( dwmac->regs + DWMAC_TXPOLL ) );

	DBGC2 ( dwmac, "DWMAC %s TX %d is [%08lx,%08lx)\n",
		dwmac->name, tx_idx, virt_to_phys ( iobuf->data ),
		( virt_to_phys ( iobuf->data ) + iob_len ( iobuf ) ) );
	return 0;
}

/**
 * Poll for completed packets
 *
 * @V netdev		Network device
 */
static void dwmac_poll_tx ( struct net_device *netdev ) {
	struct dwmac *dwmac = netdev->priv;
	struct dwmac_descriptor *tx;
	unsigned int tx_idx;

	/* Check for completed packets */
	while ( dwmac->tx.cons != dwmac->tx.prod ) {

		/* Get next transmit descriptor */
		tx_idx = ( dwmac->tx.cons % DWMAC_NUM_TX_DESC );
		tx = &dwmac->tx.desc[tx_idx];

		/* Stop if descriptor is still owned by hardware */
		if ( tx->stat & cpu_to_le32 ( DWMAC_STAT_OWN ) )
			return;
		dwmac->tx.cons++;

		/* Report completion */
		if ( tx->stat & cpu_to_le32 ( DWMAC_STAT_ERR ) ) {
			DBGC ( dwmac, "DWMAC %s TX %d error %#08x\n",
			       dwmac->name, tx_idx, le32_to_cpu ( tx->stat ) );
			dwmac_dump ( dwmac );
			netdev_tx_complete_next_err ( netdev, -EIO );
		} else {
			DBGC2 ( dwmac, "DWMAC %s TX %d complete\n",
				dwmac->name, tx_idx );
			netdev_tx_complete_next ( netdev );
		}
	}
}

/**
 * Poll for received packets
 *
 * @v netdev		Network device
 */
static void dwmac_poll_rx ( struct net_device *netdev ) {
	struct dwmac *dwmac = netdev->priv;
	struct dwmac_descriptor *rx;
	struct io_buffer *iobuf;
	unsigned int rx_idx;
	uint32_t stat;
	size_t len;

	/* Check for received packets */
	while ( dwmac->rx.cons != dwmac->rx.prod ) {

		/* Get next receive descriptor */
		rx_idx = ( dwmac->rx.cons % DWMAC_NUM_RX_DESC );
		rx = &dwmac->rx.desc[rx_idx];

		/* Stop if descriptor is still in use */
		if ( rx->stat & cpu_to_le32 ( DWMAC_STAT_OWN ) )
			return;
		dwmac->rx.cons++;

		/* Consume I/O buffer */
		iobuf = dwmac->rx_iobuf[rx_idx];
		assert ( iobuf != NULL );
		dwmac->rx_iobuf[rx_idx] = NULL;

		/* Hand off to network stack */
		stat = le32_to_cpu ( rx->stat );
		assert ( stat & DWMAC_STAT_RX_FIRST );
		assert ( stat & DWMAC_STAT_RX_LAST );
		if ( stat & DWMAC_STAT_ERR ) {
			DBGC ( dwmac, "DWMAC %s RX %d error %#08x\n",
			       dwmac->name, rx_idx, stat );
			dwmac_dump ( dwmac );
			netdev_rx_err ( netdev, iobuf, -EIO );
		} else {
			len = ( DWMAC_STAT_RX_LEN ( stat ) - 4 /* CRC */ );
			iob_put ( iobuf, len );
			DBGC2 ( dwmac, "DWMAC %s RX %d complete (length "
				"%zd)\n", dwmac->name, rx_idx, len );
			netdev_rx ( netdev, iobuf );
		}
	}
}

/**
 * Poll for completed and received packets
 *
 * @v netdev		Network device
 */
static void dwmac_poll ( struct net_device *netdev ) {
	struct dwmac *dwmac = netdev->priv;
	uint32_t status;

	/* Check for link status changes */
	status = readl ( dwmac->regs + DWMAC_STATUS );
	if ( status & DWMAC_STATUS_LINK )
		dwmac_check_link ( netdev );

	/* Poll for TX competions, if applicable */
	dwmac_poll_tx ( netdev );

	/* Poll for RX completions */
	dwmac_poll_rx ( netdev );

	/* Refill RX ring */
	dwmac_refill_rx ( dwmac );
}

/** DesignWare MAC network device operations */
static struct net_device_operations dwmac_operations = {
	.open		= dwmac_open,
	.close		= dwmac_close,
	.transmit	= dwmac_transmit,
	.poll		= dwmac_poll,
};

/******************************************************************************
 *
 * Devicetree interface
 *
 ******************************************************************************
 */

/**
 * Probe devicetree device
 *
 * @v dt		Devicetree device
 * @v offset		Starting node offset
 * @ret rc		Return status code
 */
static int dwmac_probe ( struct dt_device *dt, unsigned int offset ) {
	struct net_device *netdev;
	struct dwmac *dwmac;
	union dwmac_mac mac;
	uint32_t version;
	int rc;

	/* Allocate and initialise net device */
	netdev = alloc_etherdev ( sizeof ( *dwmac ) );
	if ( ! netdev ) {
		rc = -ENOMEM;
		goto err_alloc;
	}
	netdev_init ( netdev, &dwmac_operations );
	dwmac = netdev->priv;
	dt_set_drvdata ( dt, netdev );
	netdev->dev = &dt->dev;
	netdev->dma = &dt->dma;
	memset ( dwmac, 0, sizeof ( *dwmac ) );
	dwmac->dma = &dt->dma;
	dwmac->name = netdev->dev->name;
	dwmac_init_ring ( &dwmac->tx, DWMAC_NUM_TX_DESC, DWMAC_TXBASE,
			  ( DWMAC_CTRL_TX_FIRST | DWMAC_CTRL_TX_LAST |
			    DWMAC_CTRL_CHAIN ) );
	dwmac_init_ring ( &dwmac->rx, DWMAC_NUM_RX_DESC, DWMAC_RXBASE,
			  DWMAC_CTRL_CHAIN );

	/* Map registers */
	dwmac->regs = dt_ioremap ( dt, offset, DWMAC_REG_IDX, DWMAC_REG_LEN );
	if ( ! dwmac->regs ) {
		rc = -ENODEV;
		goto err_ioremap;
	}
	version = readl ( dwmac->regs + DWMAC_VER );
	DBGC ( dwmac, "DWMAC %s version %x.%x (user %x.%x)\n", dwmac->name,
	       DWMAC_VER_CORE_MAJOR ( version ),
	       DWMAC_VER_CORE_MINOR ( version ),
	       DWMAC_VER_USER_MAJOR ( version ),
	       DWMAC_VER_USER_MINOR ( version ) );

	/* Fetch devicetree MAC address */
	if ( ( rc = fdt_mac ( &sysfdt, offset, netdev ) ) != 0 ) {
		DBGC ( dwmac, "DWMAC %s could not fetch MAC: %s\n",
		       dwmac->name, strerror ( rc ) );
		goto err_mac;
	}

	/* Fetch current MAC address, if set */
	mac.reg.addrl = readl ( dwmac->regs + DWMAC_ADDRL );
	mac.reg.addrh = readl ( dwmac->regs + DWMAC_ADDRH );
	memcpy ( netdev->ll_addr, mac.raw, ETH_ALEN );

	/* Reset the NIC */
	if ( ( rc = dwmac_reset ( dwmac ) ) != 0 )
		goto err_reset;

	/* Register network device */
	if ( ( rc = register_netdev ( netdev ) ) != 0 )
		goto err_register_netdev;

	/* Update link state */
	dwmac_check_link ( netdev );

	return 0;

	unregister_netdev ( netdev );
 err_register_netdev:
	dwmac_reset ( dwmac );
 err_reset:
 err_mac:
	iounmap ( dwmac->regs );
 err_ioremap:
	netdev_nullify ( netdev );
	netdev_put ( netdev );
 err_alloc:
	return rc;
}

/**
 * Remove devicetree device
 *
 * @v dt		Devicetree device
 */
static void dwmac_remove ( struct dt_device *dt ) {
	struct net_device *netdev = dt_get_drvdata ( dt );
	struct dwmac *dwmac = netdev->priv;

	/* Unregister network device */
	unregister_netdev ( netdev );

	/* Reset card */
	dwmac_reset ( dwmac );

	/* Free network device */
	iounmap ( dwmac->regs );
	netdev_nullify ( netdev );
	netdev_put ( netdev );
}

/** DesignWare MAC compatible model identifiers */
static const char * dwmac_ids[] = {
	DT_ROM ( "thead,light-dwmac", "T-Head MAC" ),
	DT_ROM ( "snps,dwmac", "DesignWare MAC" ),
};

/** DesignWare MAC devicetree driver */
struct dt_driver dwmac_driver __dt_driver = {
	.name = "dwmac",
	.ids = dwmac_ids,
	.id_count = ( sizeof ( dwmac_ids ) / sizeof ( dwmac_ids[0] ) ),
	.probe = dwmac_probe,
	.remove = dwmac_remove,
};