From patchwork Fri Aug 6 05:49:03 2021 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Joel Stanley X-Patchwork-Id: 12422749 X-Patchwork-Delegate: kuba@kernel.org Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-21.8 required=3.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,HEADER_FROM_DIFFERENT_DOMAINS,INCLUDES_CR_TRAILER,INCLUDES_PATCH, MAILING_LIST_MULTI,MENTIONS_GIT_HOSTING,SPF_HELO_NONE,SPF_PASS,URIBL_BLOCKED, USER_AGENT_GIT autolearn=unavailable autolearn_force=no version=3.4.0 Received: from mail.kernel.org (mail.kernel.org [198.145.29.99]) by smtp.lore.kernel.org (Postfix) with ESMTP id EA73DC4338F for ; Fri, 6 Aug 2021 05:49:50 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by mail.kernel.org (Postfix) with ESMTP id CB12B61104 for ; Fri, 6 Aug 2021 05:49:50 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S243327AbhHFFuE (ORCPT ); Fri, 6 Aug 2021 01:50:04 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:51994 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S243079AbhHFFtu (ORCPT ); Fri, 6 Aug 2021 01:49:50 -0400 Received: from mail-pj1-x102a.google.com (mail-pj1-x102a.google.com [IPv6:2607:f8b0:4864:20::102a]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 8B3D8C06179B; Thu, 5 Aug 2021 22:49:34 -0700 (PDT) Received: by mail-pj1-x102a.google.com with SMTP id m10-20020a17090a34cab0290176b52c60ddso15449818pjf.4; Thu, 05 Aug 2021 22:49:34 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20161025; h=sender:from:to:cc:subject:date:message-id:in-reply-to:references :mime-version:content-transfer-encoding; bh=hD8la+uQht470Z79A1A0VyiqMXVtxSlHKEsCD9ytGxY=; b=g8CYSTwEJigiAEwta2YaRM2kHqI7Qsz8dmHhg97XYpevCmoOTzJeHfS9Nw6+7i3lQK pccMDuIt9413IfkhYTDPkzKCfYpTNoXyChdrqb4bWfd0ElBuefTuuND73w+/8JWNGISi 7eYW3q7AtuC4fKP/bzxoirIR0EpD+vz4hxujgb/ubjysPLzS5DBVXvScki0bZ/LQKJJA ZpoQ9KWCLf98xLUKZe8PaFuWqlXZLBxix2v+fTtC9y29aBT0gOg12FXLc4qsqMUgU1aB TkhvC4ivxiLIF+XGgEoKZ0gveTuaNj6d/wqSb2TjWMN3Zlz+KOsjR8MmIg8Lh8+w7FH5 Rz8w== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:sender:from:to:cc:subject:date:message-id :in-reply-to:references:mime-version:content-transfer-encoding; bh=hD8la+uQht470Z79A1A0VyiqMXVtxSlHKEsCD9ytGxY=; b=NUz0HXMqMPbvKjMmsfZYYw7pQrWyGwVKSDNNigcqkOaYZZ80BtKXAoGSEg4AGu1Pww Lhi9o3mdTn5aVU4qXIx4xZnfjaBweT7MeFTx7oD8JU8duDL8EdSuG748foz8Un8VpnY6 uxPo8LWU51oecRlivzHE1VwTg6HC5rtZVHmKpFmotWFoabRGTwaB+crqEwjfXAKlnAXS UM+vt94jgNr/9ia1MY5zJA0DBxkKAcxq8UhcHk2aqrWk73BRavx+5u0wJSd8/J2OdmZ/ s1Qpd2a+GtLOOApkvWkF5gHTdH1dwzqUh3Hc5zrIhSIcWQpvXzQRtvvjSvr89QpWHmq8 CiBg== X-Gm-Message-State: AOAM5332BXVw0a2S0Lj6avvxOJg7ilRcq3LfebCkTkQVpM9lFaqwGllP qjS6O8fDziGIunA8wPwugdA= X-Google-Smtp-Source: ABdhPJxDSrKuont5VakZtWdqOVBFXK3oiVuU0xp4fJdTlKlcnsB1vTfgxwiv36/MFxr83F+lk6FybA== X-Received: by 2002:a17:90a:a103:: with SMTP id s3mr8522363pjp.121.1628228974137; Thu, 05 Aug 2021 22:49:34 -0700 (PDT) Received: from voyager.lan ([45.124.203.15]) by smtp.gmail.com with ESMTPSA id z2sm10902205pgz.43.2021.08.05.22.49.28 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Thu, 05 Aug 2021 22:49:33 -0700 (PDT) Sender: "joel.stan@gmail.com" From: Joel Stanley To: "David S . Miller" , Jakub Kicinski , Rob Herring Cc: Stafford Horne , Benjamin Herrenschmidt , Anton Blanchard , Gabriel Somlo , David Shah , Karol Gugala , Mateusz Holenko , devicetree@vger.kernel.org, netdev@vger.kernel.org, linux-kernel@vger.kernel.org Subject: [PATCH 1/2] dt-bindings: net: Add bindings for LiteETH Date: Fri, 6 Aug 2021 15:19:03 +0930 Message-Id: <20210806054904.534315-2-joel@jms.id.au> X-Mailer: git-send-email 2.32.0 In-Reply-To: <20210806054904.534315-1-joel@jms.id.au> References: <20210806054904.534315-1-joel@jms.id.au> MIME-Version: 1.0 Precedence: bulk List-ID: X-Mailing-List: netdev@vger.kernel.org X-Patchwork-Delegate: kuba@kernel.org LiteETH is a small footprint and configurable Ethernet core for FPGA based system on chips. Signed-off-by: Joel Stanley --- .../bindings/net/litex,liteeth.yaml | 62 +++++++++++++++++++ 1 file changed, 62 insertions(+) create mode 100644 Documentation/devicetree/bindings/net/litex,liteeth.yaml diff --git a/Documentation/devicetree/bindings/net/litex,liteeth.yaml b/Documentation/devicetree/bindings/net/litex,liteeth.yaml new file mode 100644 index 000000000000..e2a837dbfdaa --- /dev/null +++ b/Documentation/devicetree/bindings/net/litex,liteeth.yaml @@ -0,0 +1,62 @@ +# SPDX-License-Identifier: GPL-2.0-or-later OR BSD-2-Clause +%YAML 1.2 +--- +$id: http://devicetree.org/schemas/net/litex,liteeth.yaml# +$schema: http://devicetree.org/meta-schemas/core.yaml# + +title: LiteX LiteETH ethernet device + +maintainers: + - Joel Stanley + +description: | + LiteETH is a small footprint and configurable Ethernet core for FPGA based + system on chips. + + The hardware source is Open Source and can be found on at + https://github.com/enjoy-digital/liteeth/. + +properties: + compatible: + const: litex,liteeth + + reg: + minItems: 3 + items: + - description: MAC registers + - description: MDIO registers + - description: Packet buffer + + interrupts: + maxItems: 1 + + rx-fifo-depth: + description: Receive FIFO size, in units of 2048 bytes + + tx-fifo-depth: + description: Transmit FIFO size, in units of 2048 bytes + + mac-address: + description: MAC address to use + +required: + - compatible + - reg + - interrupts + +additionalProperties: false + +examples: + - | + mac: ethernet@8020000 { + compatible = "litex,liteeth"; + reg = <0x8021000 0x100 + 0x8020800 0x100 + 0x8030000 0x2000>; + rx-fifo-depth = <2>; + tx-fifo-depth = <2>; + interrupts = <0x11 0x1>; + }; +... + +# vim: set ts=2 sw=2 sts=2 tw=80 et cc=80 ft=yaml : From patchwork Fri Aug 6 05:49:04 2021 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Joel Stanley X-Patchwork-Id: 12422751 X-Patchwork-Delegate: kuba@kernel.org Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-16.8 required=3.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,HEADER_FROM_DIFFERENT_DOMAINS,INCLUDES_CR_TRAILER,INCLUDES_PATCH, MAILING_LIST_MULTI,SPF_HELO_NONE,SPF_PASS,URIBL_BLOCKED,USER_AGENT_GIT autolearn=unavailable autolearn_force=no version=3.4.0 Received: from mail.kernel.org (mail.kernel.org [198.145.29.99]) by smtp.lore.kernel.org (Postfix) with ESMTP id 82116C4338F for ; Fri, 6 Aug 2021 05:49:54 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by mail.kernel.org (Postfix) with ESMTP id 6923661102 for ; Fri, 6 Aug 2021 05:49:54 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S243323AbhHFFuH (ORCPT ); Fri, 6 Aug 2021 01:50:07 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:52048 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S243227AbhHFFuA (ORCPT ); Fri, 6 Aug 2021 01:50:00 -0400 Received: from mail-pj1-x1029.google.com (mail-pj1-x1029.google.com [IPv6:2607:f8b0:4864:20::1029]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 45D51C06179E; Thu, 5 Aug 2021 22:49:40 -0700 (PDT) Received: by mail-pj1-x1029.google.com with SMTP id j1so14623626pjv.3; Thu, 05 Aug 2021 22:49:40 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20161025; h=sender:from:to:cc:subject:date:message-id:in-reply-to:references :mime-version:content-transfer-encoding; bh=OkrfNB9h/J9+0BXrxgRDOIiNgRkRsAVZIbL21KfTL9s=; b=mpJLB9teQnahUuigytlfkJMVdsmQsz2E02PtUWE0JxtOeg7X+5KtZMZHO7vNhEPe0s raxKW8ek1ONlWAYdsdqQYXH2yLogqCAhKG8LZYUebIjS4gEyKgmhsiiOUAO/zVTAAYoR +q/5jmJGmRtLZqZ2tHV2jl4xvROX2x70GPIcQkY8J2cvWVeomg2TMLt7wa2iFl+ZLOnr ow1Y90a14MH+bArpdhUdiQMN2DRJk+s2m2ekjkj+ECmOqX1i65EWWWWIIYIWzCvt8lmX nCF0J1rJLqr25D5aUo3rarQ796IQzCSDQv3tECgfnnG3QYfUU71JLEoN8wAppFjPpLsK maug== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:sender:from:to:cc:subject:date:message-id :in-reply-to:references:mime-version:content-transfer-encoding; bh=OkrfNB9h/J9+0BXrxgRDOIiNgRkRsAVZIbL21KfTL9s=; b=ZR5aw4pNE/0CL8j0qLBrxQY5op61qFeMqL/lbwZAf9u2JbVoJo+bmaEgsOIAvSww7D ftAw+c4w3PXY8REDZpti0uCWmp67pFtJD0SyG16EHucK5+1qD5IOKJ3fcu2vjNN3BWCZ WJWjcb0RfHPmi/7a07YYzwW4aSpXcLg0x+Sf2Wdxy2mYyWIVcyezTbEkqiU9BvbbGzU4 g37+plOMLGu9Y54p2NXK96fqpJujW5tttunTOSY3XrPHNau75TiIIPxu3baXqb6Xrzgn QXULDphw1Mz68jAMYvKB80ZJ8XNT99NwCOH7xZsaDUVGhOprOS2uhLB76D2B1cUNVBVq G20w== X-Gm-Message-State: AOAM532KpHC1v72D9iVWcXYTlVyNwyJVv9w7FmcIawnkrpQoaagf3Mty +LVH1pekV0OnFTugK+mW42I= X-Google-Smtp-Source: ABdhPJwL7TxwJAJjspPSkZrYuPBEJ3ViixnljlX6zsTQN7wmgdupkMwk3Pp8uZcdqb1C/Wg/bhm/Rw== X-Received: by 2002:a17:90a:bb89:: with SMTP id v9mr19497756pjr.54.1628228979787; Thu, 05 Aug 2021 22:49:39 -0700 (PDT) Received: from voyager.lan ([45.124.203.15]) by smtp.gmail.com with ESMTPSA id z2sm10902205pgz.43.2021.08.05.22.49.34 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Thu, 05 Aug 2021 22:49:39 -0700 (PDT) Sender: "joel.stan@gmail.com" From: Joel Stanley To: "David S . Miller" , Jakub Kicinski , Rob Herring Cc: Stafford Horne , Benjamin Herrenschmidt , Anton Blanchard , Gabriel Somlo , David Shah , Karol Gugala , Mateusz Holenko , devicetree@vger.kernel.org, netdev@vger.kernel.org, linux-kernel@vger.kernel.org Subject: [PATCH 2/2] net: Add driver for LiteX's LiteETH network interface Date: Fri, 6 Aug 2021 15:19:04 +0930 Message-Id: <20210806054904.534315-3-joel@jms.id.au> X-Mailer: git-send-email 2.32.0 In-Reply-To: <20210806054904.534315-1-joel@jms.id.au> References: <20210806054904.534315-1-joel@jms.id.au> MIME-Version: 1.0 Precedence: bulk List-ID: X-Mailing-List: netdev@vger.kernel.org X-Patchwork-Delegate: kuba@kernel.org LiteX is a soft system-on-chip that targets FPGAs. LiteETH is a basic network device that is commonly used in LiteX designs. The driver was first written in 2017 and has been maintained by the LiteX community in various trees. Thank you to all who have contributed. Co-developed-by: Gabriel Somlo Co-developed-by: David Shah Co-developed-by: Stafford Horne Signed-off-by: Joel Stanley --- drivers/net/ethernet/Kconfig | 1 + drivers/net/ethernet/Makefile | 1 + drivers/net/ethernet/litex/Kconfig | 24 ++ drivers/net/ethernet/litex/Makefile | 5 + drivers/net/ethernet/litex/litex_liteeth.c | 340 +++++++++++++++++++++ 5 files changed, 371 insertions(+) create mode 100644 drivers/net/ethernet/litex/Kconfig create mode 100644 drivers/net/ethernet/litex/Makefile create mode 100644 drivers/net/ethernet/litex/litex_liteeth.c diff --git a/drivers/net/ethernet/Kconfig b/drivers/net/ethernet/Kconfig index 1cdff1dca790..d796684ec9ca 100644 --- a/drivers/net/ethernet/Kconfig +++ b/drivers/net/ethernet/Kconfig @@ -118,6 +118,7 @@ config LANTIQ_XRX200 Support for the PMAC of the Gigabit switch (GSWIP) inside the Lantiq / Intel VRX200 VDSL SoC +source "drivers/net/ethernet/litex/Kconfig" source "drivers/net/ethernet/marvell/Kconfig" source "drivers/net/ethernet/mediatek/Kconfig" source "drivers/net/ethernet/mellanox/Kconfig" diff --git a/drivers/net/ethernet/Makefile b/drivers/net/ethernet/Makefile index cb3f9084a21b..aaa5078cd7d1 100644 --- a/drivers/net/ethernet/Makefile +++ b/drivers/net/ethernet/Makefile @@ -51,6 +51,7 @@ obj-$(CONFIG_JME) += jme.o obj-$(CONFIG_KORINA) += korina.o obj-$(CONFIG_LANTIQ_ETOP) += lantiq_etop.o obj-$(CONFIG_LANTIQ_XRX200) += lantiq_xrx200.o +obj-$(CONFIG_NET_VENDOR_LITEX) += litex/ obj-$(CONFIG_NET_VENDOR_MARVELL) += marvell/ obj-$(CONFIG_NET_VENDOR_MEDIATEK) += mediatek/ obj-$(CONFIG_NET_VENDOR_MELLANOX) += mellanox/ diff --git a/drivers/net/ethernet/litex/Kconfig b/drivers/net/ethernet/litex/Kconfig new file mode 100644 index 000000000000..0a863e3ff7bf --- /dev/null +++ b/drivers/net/ethernet/litex/Kconfig @@ -0,0 +1,24 @@ +# +# LiteX device configuration +# + +config NET_VENDOR_LITEX + bool "LiteX devices" + default y + help + If you have a network (Ethernet) card belonging to this class, say Y. + + Note that the answer to this question doesn't directly affect the + kernel: saying N will just cause the configurator to skip all + the questions about LiteX devices. If you say Y, you will be asked + for your specific card in the following questions. + +if NET_VENDOR_LITEX + +config LITEX_LITEETH + tristate "LiteX Ethernet support" + help + If you wish to compile a kernel for hardware with a LiteX LiteEth + device then you should answer Y to this. + +endif # NET_VENDOR_LITEX diff --git a/drivers/net/ethernet/litex/Makefile b/drivers/net/ethernet/litex/Makefile new file mode 100644 index 000000000000..9343b73b8e49 --- /dev/null +++ b/drivers/net/ethernet/litex/Makefile @@ -0,0 +1,5 @@ +# +# Makefile for the LiteX network device drivers. +# + +obj-$(CONFIG_LITEX_LITEETH) += litex_liteeth.o diff --git a/drivers/net/ethernet/litex/litex_liteeth.c b/drivers/net/ethernet/litex/litex_liteeth.c new file mode 100644 index 000000000000..48b551e6d97b --- /dev/null +++ b/drivers/net/ethernet/litex/litex_liteeth.c @@ -0,0 +1,340 @@ +// SPDX-License-Identifier: GPL-2.0-or-later +/* + * LiteX Liteeth Ethernet + * + * Copyright 2017 Joel Stanley + * + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define LITEETH_WRITER_SLOT 0x00 +#define LITEETH_WRITER_LENGTH 0x04 +#define LITEETH_WRITER_ERRORS 0x08 +#define LITEETH_WRITER_EV_STATUS 0x0C +#define LITEETH_WRITER_EV_PENDING 0x10 +#define LITEETH_WRITER_EV_ENABLE 0x14 +#define LITEETH_READER_START 0x18 +#define LITEETH_READER_READY 0x1C +#define LITEETH_READER_LEVEL 0x20 +#define LITEETH_READER_SLOT 0x24 +#define LITEETH_READER_LENGTH 0x28 +#define LITEETH_READER_EV_STATUS 0x2C +#define LITEETH_READER_EV_PENDING 0x30 +#define LITEETH_READER_EV_ENABLE 0x34 +#define LITEETH_PREAMBLE_CRC 0x38 +#define LITEETH_PREAMBLE_ERRORS 0x3C +#define LITEETH_CRC_ERRORS 0x40 + +#define LITEETH_PHY_CRG_RESET 0x00 +#define LITEETH_MDIO_W 0x04 +#define LITEETH_MDIO_R 0x0C + +#define DRV_NAME "liteeth" + +#define LITEETH_BUFFER_SIZE 0x800 +#define MAX_PKT_SIZE LITEETH_BUFFER_SIZE + +struct liteeth { + void __iomem *base; + void __iomem *mdio_base; + struct net_device *netdev; + struct device *dev; + struct mii_bus *mii_bus; + + /* Link management */ + int cur_duplex; + int cur_speed; + + /* Tx */ + int tx_slot; + int num_tx_slots; + void __iomem *tx_base; + + /* Rx */ + int rx_slot; + int num_rx_slots; + void __iomem *rx_base; +}; + + +static int liteeth_rx(struct net_device *netdev) +{ + struct liteeth *priv = netdev_priv(netdev); + struct sk_buff *skb; + unsigned char *data; + u8 rx_slot; + int len; + + rx_slot = readb(priv->base + LITEETH_WRITER_SLOT); + len = readl(priv->base + LITEETH_WRITER_LENGTH); + + skb = netdev_alloc_skb(netdev, len + NET_IP_ALIGN); + if (!skb) { + netdev_err(netdev, "couldn't get memory"); + netdev->stats.rx_dropped++; + return NET_RX_DROP; + } + + /* Ensure alignemnt of the ip header within the skb */ + skb_reserve(skb, NET_IP_ALIGN); + if (len == 0 || len > 2048) + return NET_RX_DROP; + data = skb_put(skb, len); + memcpy_fromio(data, priv->rx_base + rx_slot * LITEETH_BUFFER_SIZE, len); + skb->protocol = eth_type_trans(skb, netdev); + + netdev->stats.rx_packets++; + netdev->stats.rx_bytes += len; + + return netif_rx(skb); +} + +static irqreturn_t liteeth_interrupt(int irq, void *dev_id) +{ + struct net_device *netdev = dev_id; + struct liteeth *priv = netdev_priv(netdev); + u8 reg; + + reg = readb(priv->base + LITEETH_READER_EV_PENDING); + if (reg) { + netdev->stats.tx_packets++; + writeb(reg, priv->base + LITEETH_READER_EV_PENDING); + } + + reg = readb(priv->base + LITEETH_WRITER_EV_PENDING); + if (reg) { + liteeth_rx(netdev); + writeb(reg, priv->base + LITEETH_WRITER_EV_PENDING); + } + + return IRQ_HANDLED; +} + +static int liteeth_open(struct net_device *netdev) +{ + struct liteeth *priv = netdev_priv(netdev); + int err; + + /* Clear pending events */ + writeb(1, priv->base + LITEETH_WRITER_EV_PENDING); + writeb(1, priv->base + LITEETH_READER_EV_PENDING); + + err = request_irq(netdev->irq, liteeth_interrupt, 0, netdev->name, netdev); + if (err) { + netdev_err(netdev, "failed to request irq %d\n", netdev->irq); + return err; + } + + /* Enable IRQs */ + writeb(1, priv->base + LITEETH_WRITER_EV_ENABLE); + writeb(1, priv->base + LITEETH_READER_EV_ENABLE); + + /* TODO: Remove these once we have working mdio support */ + priv->cur_duplex = DUPLEX_FULL; + priv->cur_speed = SPEED_100; + netif_carrier_on(netdev); + + netif_start_queue(netdev); + + return 0; +} + +static int liteeth_stop(struct net_device *netdev) +{ + struct liteeth *priv = netdev_priv(netdev); + + netif_stop_queue(netdev); + + writeb(0, priv->base + LITEETH_WRITER_EV_ENABLE); + writeb(0, priv->base + LITEETH_READER_EV_ENABLE); + + free_irq(netdev->irq, netdev); + + return 0; +} + +static int liteeth_start_xmit(struct sk_buff *skb, struct net_device *netdev) +{ + struct liteeth *priv = netdev_priv(netdev); + void __iomem *txbuffer; + int ret; + u8 val; + + /* Reject oversize packets */ + if (unlikely(skb->len > MAX_PKT_SIZE)) { + if (net_ratelimit()) + netdev_dbg(netdev, "tx packet too big\n"); + goto drop; + } + + txbuffer = priv->tx_base + priv->tx_slot * LITEETH_BUFFER_SIZE; + memcpy_toio(txbuffer, skb->data, skb->len); + writeb(priv->tx_slot, priv->base + LITEETH_READER_SLOT); + writew(skb->len, priv->base + LITEETH_READER_LENGTH); + + ret = readl_poll_timeout_atomic(priv->base + LITEETH_READER_READY, val, val, 5, 1000); + if (ret == -ETIMEDOUT) { + netdev_err(netdev, "LITEETH_READER_READY timed out\n"); + goto drop; + } + + writeb(1, priv->base + LITEETH_READER_START); + + netdev->stats.tx_bytes += skb->len; + + priv->tx_slot = (priv->tx_slot + 1) % priv->num_tx_slots; + dev_kfree_skb_any(skb); + return NETDEV_TX_OK; +drop: + /* Drop the packet */ + dev_kfree_skb_any(skb); + netdev->stats.tx_dropped++; + + return NETDEV_TX_OK; +} + +static const struct net_device_ops liteeth_netdev_ops = { + .ndo_open = liteeth_open, + .ndo_stop = liteeth_stop, + .ndo_start_xmit = liteeth_start_xmit, +}; + +static void liteeth_reset_hw(struct liteeth *priv) +{ + /* Reset, twice */ + writeb(0, priv->base + LITEETH_PHY_CRG_RESET); + udelay(10); + writeb(1, priv->base + LITEETH_PHY_CRG_RESET); + udelay(10); + writeb(0, priv->base + LITEETH_PHY_CRG_RESET); + udelay(10); +} + +static int liteeth_probe(struct platform_device *pdev) +{ + struct net_device *netdev; + void __iomem *buf_base; + struct resource *res; + struct liteeth *priv; + int irq, err; + + netdev = alloc_etherdev(sizeof(*priv)); + if (!netdev) + return -ENOMEM; + + priv = netdev_priv(netdev); + priv->netdev = netdev; + priv->dev = &pdev->dev; + + irq = platform_get_irq(pdev, 0); + if (irq < 0) { + dev_err(&pdev->dev, "Failed to get IRQ\n"); + goto err; + } + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + priv->base = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(priv->base)) { + err = PTR_ERR(priv->base); + goto err; + } + + res = platform_get_resource(pdev, IORESOURCE_MEM, 1); + priv->mdio_base = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(priv->mdio_base)) { + err = PTR_ERR(priv->mdio_base); + goto err; + } + + res = platform_get_resource(pdev, IORESOURCE_MEM, 2); + buf_base = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(buf_base)) { + err = PTR_ERR(buf_base); + goto err; + } + + err = of_property_read_u32(pdev->dev.of_node, "rx-fifo-depth", + &priv->num_rx_slots); + if (err) { + dev_err(&pdev->dev, "unable to get rx-fifo-depth\n"); + goto err; + } + + err = of_property_read_u32(pdev->dev.of_node, "tx-fifo-depth", + &priv->num_tx_slots); + if (err) { + dev_err(&pdev->dev, "unable to get tx-fifo-depth\n"); + goto err; + } + + /* Rx slots */ + priv->rx_base = buf_base; + priv->rx_slot = 0; + + /* Tx slots come after Rx slots */ + priv->tx_base = buf_base + priv->num_rx_slots * LITEETH_BUFFER_SIZE; + priv->tx_slot = 0; + + err = of_get_mac_address(pdev->dev.of_node, netdev->dev_addr); + if (err) + eth_hw_addr_random(netdev); + + SET_NETDEV_DEV(netdev, &pdev->dev); + platform_set_drvdata(pdev, netdev); + + netdev->netdev_ops = &liteeth_netdev_ops; + netdev->irq = irq; + + liteeth_reset_hw(priv); + + err = register_netdev(netdev); + if (err) { + dev_err(&pdev->dev, "Failed to register netdev\n"); + goto err; + } + + netdev_info(netdev, "irq %d, mapped at %px\n", netdev->irq, priv->base); + + return 0; +err: + free_netdev(netdev); + return err; +} + +static int liteeth_remove(struct platform_device *pdev) +{ + struct net_device *netdev = platform_get_drvdata(pdev); + + unregister_netdev(netdev); + free_netdev(netdev); + + return 0; +} + +static const struct of_device_id liteeth_of_match[] = { + { .compatible = "litex,liteeth" }, + { } +}; +MODULE_DEVICE_TABLE(of, liteeth_of_match); + +static struct platform_driver liteeth_driver = { + .probe = liteeth_probe, + .remove = liteeth_remove, + .driver = { + .name = DRV_NAME, + .of_match_table = liteeth_of_match, + }, +}; +module_platform_driver(liteeth_driver); + +MODULE_AUTHOR("Joel Stanley "); +MODULE_LICENSE("GPL");