root/drivers/net/ethernet/microchip/encx24j600.c
// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * Microchip ENCX24J600 ethernet driver
 *
 * Copyright (C) 2015 Gridpoint
 * Author: Jon Ringle <jringle@gridpoint.com>
 */

#include <linux/device.h>
#include <linux/errno.h>
#include <linux/etherdevice.h>
#include <linux/ethtool.h>
#include <linux/interrupt.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/netdevice.h>
#include <linux/regmap.h>
#include <linux/skbuff.h>
#include <linux/spi/spi.h>

#include "encx24j600_hw.h"

#define DRV_NAME        "encx24j600"
#define DRV_VERSION     "1.0"

#define DEFAULT_MSG_ENABLE (NETIF_MSG_DRV | NETIF_MSG_PROBE | NETIF_MSG_LINK)
static int debug = -1;
module_param(debug, int, 0000);
MODULE_PARM_DESC(debug, "Debug level (0=none,...,16=all)");

/* SRAM memory layout:
 *
 * 0x0000-0x05ff TX buffers  1.5KB  (1*1536) reside in the GP area in SRAM
 * 0x0600-0x5fff RX buffers 22.5KB (15*1536) reside in the RX area in SRAM
 */
#define ENC_TX_BUF_START 0x0000U
#define ENC_RX_BUF_START 0x0600U
#define ENC_RX_BUF_END   0x5fffU
#define ENC_SRAM_SIZE    0x6000U

enum {
        RXFILTER_NORMAL,
        RXFILTER_MULTI,
        RXFILTER_PROMISC
};

struct encx24j600_priv {
        struct net_device        *ndev;
        struct mutex              lock; /* device access lock */
        struct encx24j600_context ctx;
        struct sk_buff           *tx_skb;
        struct task_struct       *kworker_task;
        struct kthread_worker     kworker;
        struct kthread_work       tx_work;
        struct kthread_work       setrx_work;
        u16                       next_packet;
        bool                      hw_enabled;
        bool                      full_duplex;
        bool                      autoneg;
        u16                       speed;
        int                       rxfilter;
        u32                       msg_enable;
};

static void dump_packet(const char *msg, int len, const char *data)
{
        pr_debug(DRV_NAME ": %s - packet len:%d\n", msg, len);
        print_hex_dump_bytes("pk data: ", DUMP_PREFIX_OFFSET, data, len);
}

static void encx24j600_dump_rsv(struct encx24j600_priv *priv, const char *msg,
                                struct rsv *rsv)
{
        struct net_device *dev = priv->ndev;

        netdev_info(dev, "RX packet Len:%d\n", rsv->len);
        netdev_dbg(dev, "%s - NextPk: 0x%04x\n", msg,
                   rsv->next_packet);
        netdev_dbg(dev, "RxOK: %d, DribbleNibble: %d\n",
                   RSV_GETBIT(rsv->rxstat, RSV_RXOK),
                   RSV_GETBIT(rsv->rxstat, RSV_DRIBBLENIBBLE));
        netdev_dbg(dev, "CRCErr:%d, LenChkErr: %d, LenOutOfRange: %d\n",
                   RSV_GETBIT(rsv->rxstat, RSV_CRCERROR),
                   RSV_GETBIT(rsv->rxstat, RSV_LENCHECKERR),
                   RSV_GETBIT(rsv->rxstat, RSV_LENOUTOFRANGE));
        netdev_dbg(dev, "Multicast: %d, Broadcast: %d, LongDropEvent: %d, CarrierEvent: %d\n",
                   RSV_GETBIT(rsv->rxstat, RSV_RXMULTICAST),
                   RSV_GETBIT(rsv->rxstat, RSV_RXBROADCAST),
                   RSV_GETBIT(rsv->rxstat, RSV_RXLONGEVDROPEV),
                   RSV_GETBIT(rsv->rxstat, RSV_CARRIEREV));
        netdev_dbg(dev, "ControlFrame: %d, PauseFrame: %d, UnknownOp: %d, VLanTagFrame: %d\n",
                   RSV_GETBIT(rsv->rxstat, RSV_RXCONTROLFRAME),
                   RSV_GETBIT(rsv->rxstat, RSV_RXPAUSEFRAME),
                   RSV_GETBIT(rsv->rxstat, RSV_RXUNKNOWNOPCODE),
                   RSV_GETBIT(rsv->rxstat, RSV_RXTYPEVLAN));
}

static u16 encx24j600_read_reg(struct encx24j600_priv *priv, u8 reg)
{
        struct net_device *dev = priv->ndev;
        unsigned int val = 0;
        int ret = regmap_read(priv->ctx.regmap, reg, &val);

        if (unlikely(ret))
                netif_err(priv, drv, dev, "%s: error %d reading reg %02x\n",
                          __func__, ret, reg);
        return val;
}

static void encx24j600_write_reg(struct encx24j600_priv *priv, u8 reg, u16 val)
{
        struct net_device *dev = priv->ndev;
        int ret = regmap_write(priv->ctx.regmap, reg, val);

        if (unlikely(ret))
                netif_err(priv, drv, dev, "%s: error %d writing reg %02x=%04x\n",
                          __func__, ret, reg, val);
}

static void encx24j600_update_reg(struct encx24j600_priv *priv, u8 reg,
                                  u16 mask, u16 val)
{
        struct net_device *dev = priv->ndev;
        int ret = regmap_update_bits(priv->ctx.regmap, reg, mask, val);

        if (unlikely(ret))
                netif_err(priv, drv, dev, "%s: error %d updating reg %02x=%04x~%04x\n",
                          __func__, ret, reg, val, mask);
}

static u16 encx24j600_read_phy(struct encx24j600_priv *priv, u8 reg)
{
        struct net_device *dev = priv->ndev;
        unsigned int val = 0;
        int ret = regmap_read(priv->ctx.phymap, reg, &val);

        if (unlikely(ret))
                netif_err(priv, drv, dev, "%s: error %d reading %02x\n",
                          __func__, ret, reg);
        return val;
}

static void encx24j600_write_phy(struct encx24j600_priv *priv, u8 reg, u16 val)
{
        struct net_device *dev = priv->ndev;
        int ret = regmap_write(priv->ctx.phymap, reg, val);

        if (unlikely(ret))
                netif_err(priv, drv, dev, "%s: error %d writing reg %02x=%04x\n",
                          __func__, ret, reg, val);
}

static void encx24j600_clr_bits(struct encx24j600_priv *priv, u8 reg, u16 mask)
{
        encx24j600_update_reg(priv, reg, mask, 0);
}

static void encx24j600_set_bits(struct encx24j600_priv *priv, u8 reg, u16 mask)
{
        encx24j600_update_reg(priv, reg, mask, mask);
}

static void encx24j600_cmd(struct encx24j600_priv *priv, u8 cmd)
{
        struct net_device *dev = priv->ndev;
        int ret = regmap_write(priv->ctx.regmap, cmd, 0);

        if (unlikely(ret))
                netif_err(priv, drv, dev, "%s: error %d with cmd %02x\n",
                          __func__, ret, cmd);
}

static int encx24j600_raw_read(struct encx24j600_priv *priv, u8 reg, u8 *data,
                               size_t count)
{
        int ret;

        mutex_lock(&priv->ctx.mutex);
        ret = regmap_encx24j600_spi_read(&priv->ctx, reg, data, count);
        mutex_unlock(&priv->ctx.mutex);

        return ret;
}

static int encx24j600_raw_write(struct encx24j600_priv *priv, u8 reg,
                                const u8 *data, size_t count)
{
        int ret;

        mutex_lock(&priv->ctx.mutex);
        ret = regmap_encx24j600_spi_write(&priv->ctx, reg, data, count);
        mutex_unlock(&priv->ctx.mutex);

        return ret;
}

static void encx24j600_update_phcon1(struct encx24j600_priv *priv)
{
        u16 phcon1 = encx24j600_read_phy(priv, PHCON1);

        if (priv->autoneg == AUTONEG_ENABLE) {
                phcon1 |= ANEN | RENEG;
        } else {
                phcon1 &= ~ANEN;
                if (priv->speed == SPEED_100)
                        phcon1 |= SPD100;
                else
                        phcon1 &= ~SPD100;

                if (priv->full_duplex)
                        phcon1 |= PFULDPX;
                else
                        phcon1 &= ~PFULDPX;
        }
        encx24j600_write_phy(priv, PHCON1, phcon1);
}

/* Waits for autonegotiation to complete. */
static int encx24j600_wait_for_autoneg(struct encx24j600_priv *priv)
{
        struct net_device *dev = priv->ndev;
        unsigned long timeout = jiffies + msecs_to_jiffies(2000);
        u16 phstat1;
        u16 estat;

        phstat1 = encx24j600_read_phy(priv, PHSTAT1);
        while ((phstat1 & ANDONE) == 0) {
                if (time_after(jiffies, timeout)) {
                        u16 phstat3;

                        netif_notice(priv, drv, dev, "timeout waiting for autoneg done\n");

                        priv->autoneg = AUTONEG_DISABLE;
                        phstat3 = encx24j600_read_phy(priv, PHSTAT3);
                        priv->speed = (phstat3 & PHY3SPD100)
                                      ? SPEED_100 : SPEED_10;
                        priv->full_duplex = (phstat3 & PHY3DPX) ? 1 : 0;
                        encx24j600_update_phcon1(priv);
                        netif_notice(priv, drv, dev, "Using parallel detection: %s/%s",
                                     priv->speed == SPEED_100 ? "100" : "10",
                                     priv->full_duplex ? "Full" : "Half");

                        return -ETIMEDOUT;
                }
                cpu_relax();
                phstat1 = encx24j600_read_phy(priv, PHSTAT1);
        }

        estat = encx24j600_read_reg(priv, ESTAT);
        if (estat & PHYDPX) {
                encx24j600_set_bits(priv, MACON2, FULDPX);
                encx24j600_write_reg(priv, MABBIPG, 0x15);
        } else {
                encx24j600_clr_bits(priv, MACON2, FULDPX);
                encx24j600_write_reg(priv, MABBIPG, 0x12);
                /* Max retransmittions attempt  */
                encx24j600_write_reg(priv, MACLCON, 0x370f);
        }

        return 0;
}

/* Access the PHY to determine link status */
static void encx24j600_check_link_status(struct encx24j600_priv *priv)
{
        struct net_device *dev = priv->ndev;
        u16 estat;

        estat = encx24j600_read_reg(priv, ESTAT);

        if (estat & PHYLNK) {
                if (priv->autoneg == AUTONEG_ENABLE)
                        encx24j600_wait_for_autoneg(priv);

                netif_carrier_on(dev);
                netif_info(priv, ifup, dev, "link up\n");
        } else {
                netif_info(priv, ifdown, dev, "link down\n");

                /* Re-enable autoneg since we won't know what we might be
                 * connected to when the link is brought back up again.
                 */
                priv->autoneg  = AUTONEG_ENABLE;
                priv->full_duplex = true;
                priv->speed = SPEED_100;
                netif_carrier_off(dev);
        }
}

static void encx24j600_int_link_handler(struct encx24j600_priv *priv)
{
        struct net_device *dev = priv->ndev;

        netif_dbg(priv, intr, dev, "%s", __func__);
        encx24j600_check_link_status(priv);
        encx24j600_clr_bits(priv, EIR, LINKIF);
}

static void encx24j600_tx_complete(struct encx24j600_priv *priv, bool err)
{
        struct net_device *dev = priv->ndev;

        if (!priv->tx_skb) {
                BUG();
                return;
        }

        mutex_lock(&priv->lock);

        if (err)
                dev->stats.tx_errors++;
        else
                dev->stats.tx_packets++;

        dev->stats.tx_bytes += priv->tx_skb->len;

        encx24j600_clr_bits(priv, EIR, TXIF | TXABTIF);

        netif_dbg(priv, tx_done, dev, "TX Done%s\n", err ? ": Err" : "");

        dev_kfree_skb(priv->tx_skb);
        priv->tx_skb = NULL;

        netif_wake_queue(dev);

        mutex_unlock(&priv->lock);
}

static int encx24j600_receive_packet(struct encx24j600_priv *priv,
                                     struct rsv *rsv)
{
        struct net_device *dev = priv->ndev;
        struct sk_buff *skb = netdev_alloc_skb(dev, rsv->len + NET_IP_ALIGN);

        if (!skb) {
                pr_err_ratelimited("RX: OOM: packet dropped\n");
                dev->stats.rx_dropped++;
                return -ENOMEM;
        }
        skb_reserve(skb, NET_IP_ALIGN);
        encx24j600_raw_read(priv, RRXDATA, skb_put(skb, rsv->len), rsv->len);

        if (netif_msg_pktdata(priv))
                dump_packet("RX", skb->len, skb->data);

        skb->dev = dev;
        skb->protocol = eth_type_trans(skb, dev);
        skb->ip_summed = CHECKSUM_COMPLETE;

        /* Maintain stats */
        dev->stats.rx_packets++;
        dev->stats.rx_bytes += rsv->len;

        netif_rx(skb);

        return 0;
}

static void encx24j600_rx_packets(struct encx24j600_priv *priv, u8 packet_count)
{
        struct net_device *dev = priv->ndev;

        while (packet_count--) {
                struct rsv rsv;
                u16 newrxtail;

                encx24j600_write_reg(priv, ERXRDPT, priv->next_packet);
                encx24j600_raw_read(priv, RRXDATA, (u8 *)&rsv, sizeof(rsv));

                if (netif_msg_rx_status(priv))
                        encx24j600_dump_rsv(priv, __func__, &rsv);

                if (!RSV_GETBIT(rsv.rxstat, RSV_RXOK) ||
                    (rsv.len > MAX_FRAMELEN)) {
                        netif_err(priv, rx_err, dev, "RX Error %04x\n",
                                  rsv.rxstat);
                        dev->stats.rx_errors++;

                        if (RSV_GETBIT(rsv.rxstat, RSV_CRCERROR))
                                dev->stats.rx_crc_errors++;
                        if (RSV_GETBIT(rsv.rxstat, RSV_LENCHECKERR))
                                dev->stats.rx_frame_errors++;
                        if (rsv.len > MAX_FRAMELEN)
                                dev->stats.rx_over_errors++;
                } else {
                        encx24j600_receive_packet(priv, &rsv);
                }

                priv->next_packet = rsv.next_packet;

                newrxtail = priv->next_packet - 2;
                if (newrxtail == ENC_RX_BUF_START)
                        newrxtail = SRAM_SIZE - 2;

                encx24j600_cmd(priv, SETPKTDEC);
                encx24j600_write_reg(priv, ERXTAIL, newrxtail);
        }
}

static irqreturn_t encx24j600_isr(int irq, void *dev_id)
{
        struct encx24j600_priv *priv = dev_id;
        struct net_device *dev = priv->ndev;
        int eir;

        /* Clear interrupts */
        encx24j600_cmd(priv, CLREIE);

        eir = encx24j600_read_reg(priv, EIR);

        if (eir & LINKIF)
                encx24j600_int_link_handler(priv);

        if (eir & TXIF)
                encx24j600_tx_complete(priv, false);

        if (eir & TXABTIF)
                encx24j600_tx_complete(priv, true);

        if (eir & RXABTIF) {
                if (eir & PCFULIF) {
                        /* Packet counter is full */
                        netif_err(priv, rx_err, dev, "Packet counter full\n");
                }
                dev->stats.rx_dropped++;
                encx24j600_clr_bits(priv, EIR, RXABTIF);
        }

        if (eir & PKTIF) {
                u8 packet_count;

                mutex_lock(&priv->lock);

                packet_count = encx24j600_read_reg(priv, ESTAT) & 0xff;
                while (packet_count) {
                        encx24j600_rx_packets(priv, packet_count);
                        packet_count = encx24j600_read_reg(priv, ESTAT) & 0xff;
                }

                mutex_unlock(&priv->lock);
        }

        /* Enable interrupts */
        encx24j600_cmd(priv, SETEIE);

        return IRQ_HANDLED;
}

static int encx24j600_soft_reset(struct encx24j600_priv *priv)
{
        int ret = 0;
        int timeout;
        u16 eudast;

        /* Write and verify a test value to EUDAST */
        regcache_cache_bypass(priv->ctx.regmap, true);
        timeout = 10;
        do {
                encx24j600_write_reg(priv, EUDAST, EUDAST_TEST_VAL);
                eudast = encx24j600_read_reg(priv, EUDAST);
                usleep_range(25, 100);
        } while ((eudast != EUDAST_TEST_VAL) && --timeout);
        regcache_cache_bypass(priv->ctx.regmap, false);

        if (timeout == 0) {
                ret = -ETIMEDOUT;
                goto err_out;
        }

        /* Wait for CLKRDY to become set */
        timeout = 10;
        while (!(encx24j600_read_reg(priv, ESTAT) & CLKRDY) && --timeout)
                usleep_range(25, 100);

        if (timeout == 0) {
                ret = -ETIMEDOUT;
                goto err_out;
        }

        /* Issue a System Reset command */
        encx24j600_cmd(priv, SETETHRST);
        usleep_range(25, 100);

        /* Confirm that EUDAST has 0000h after system reset */
        if (encx24j600_read_reg(priv, EUDAST) != 0) {
                ret = -EINVAL;
                goto err_out;
        }

        /* Wait for PHY register and status bits to become available */
        usleep_range(256, 1000);

err_out:
        return ret;
}

static int encx24j600_hw_reset(struct encx24j600_priv *priv)
{
        int ret;

        mutex_lock(&priv->lock);
        ret = encx24j600_soft_reset(priv);
        mutex_unlock(&priv->lock);

        return ret;
}

static void encx24j600_reset_hw_tx(struct encx24j600_priv *priv)
{
        encx24j600_set_bits(priv, ECON2, TXRST);
        encx24j600_clr_bits(priv, ECON2, TXRST);
}

static void encx24j600_hw_init_tx(struct encx24j600_priv *priv)
{
        /* Reset TX */
        encx24j600_reset_hw_tx(priv);

        /* Clear the TXIF flag if were previously set */
        encx24j600_clr_bits(priv, EIR, TXIF | TXABTIF);

        /* Write the Tx Buffer pointer */
        encx24j600_write_reg(priv, EGPWRPT, ENC_TX_BUF_START);
}

static void encx24j600_hw_init_rx(struct encx24j600_priv *priv)
{
        encx24j600_cmd(priv, DISABLERX);

        /* Set up RX packet start address in the SRAM */
        encx24j600_write_reg(priv, ERXST, ENC_RX_BUF_START);

        /* Preload the RX Data pointer to the beginning of the RX area */
        encx24j600_write_reg(priv, ERXRDPT, ENC_RX_BUF_START);

        priv->next_packet = ENC_RX_BUF_START;

        /* Set up RX end address in the SRAM */
        encx24j600_write_reg(priv, ERXTAIL, ENC_SRAM_SIZE - 2);

        /* Reset the  user data pointers    */
        encx24j600_write_reg(priv, EUDAST, ENC_SRAM_SIZE);
        encx24j600_write_reg(priv, EUDAND, ENC_SRAM_SIZE + 1);

        /* Set Max Frame length */
        encx24j600_write_reg(priv, MAMXFL, MAX_FRAMELEN);
}

static void encx24j600_dump_config(struct encx24j600_priv *priv,
                                   const char *msg)
{
        pr_info(DRV_NAME ": %s\n", msg);

        /* CHIP configuration */
        pr_info(DRV_NAME " ECON1:   %04X\n", encx24j600_read_reg(priv, ECON1));
        pr_info(DRV_NAME " ECON2:   %04X\n", encx24j600_read_reg(priv, ECON2));
        pr_info(DRV_NAME " ERXFCON: %04X\n", encx24j600_read_reg(priv,
                                                                 ERXFCON));
        pr_info(DRV_NAME " ESTAT:   %04X\n", encx24j600_read_reg(priv, ESTAT));
        pr_info(DRV_NAME " EIR:     %04X\n", encx24j600_read_reg(priv, EIR));
        pr_info(DRV_NAME " EIDLED:  %04X\n", encx24j600_read_reg(priv, EIDLED));

        /* MAC layer configuration */
        pr_info(DRV_NAME " MACON1:  %04X\n", encx24j600_read_reg(priv, MACON1));
        pr_info(DRV_NAME " MACON2:  %04X\n", encx24j600_read_reg(priv, MACON2));
        pr_info(DRV_NAME " MAIPG:   %04X\n", encx24j600_read_reg(priv, MAIPG));
        pr_info(DRV_NAME " MACLCON: %04X\n", encx24j600_read_reg(priv,
                                                                 MACLCON));
        pr_info(DRV_NAME " MABBIPG: %04X\n", encx24j600_read_reg(priv,
                                                                 MABBIPG));

        /* PHY configuration */
        pr_info(DRV_NAME " PHCON1:  %04X\n", encx24j600_read_phy(priv, PHCON1));
        pr_info(DRV_NAME " PHCON2:  %04X\n", encx24j600_read_phy(priv, PHCON2));
        pr_info(DRV_NAME " PHANA:   %04X\n", encx24j600_read_phy(priv, PHANA));
        pr_info(DRV_NAME " PHANLPA: %04X\n", encx24j600_read_phy(priv,
                                                                 PHANLPA));
        pr_info(DRV_NAME " PHANE:   %04X\n", encx24j600_read_phy(priv, PHANE));
        pr_info(DRV_NAME " PHSTAT1: %04X\n", encx24j600_read_phy(priv,
                                                                 PHSTAT1));
        pr_info(DRV_NAME " PHSTAT2: %04X\n", encx24j600_read_phy(priv,
                                                                 PHSTAT2));
        pr_info(DRV_NAME " PHSTAT3: %04X\n", encx24j600_read_phy(priv,
                                                                 PHSTAT3));
}

static void encx24j600_set_rxfilter_mode(struct encx24j600_priv *priv)
{
        switch (priv->rxfilter) {
        case RXFILTER_PROMISC:
                encx24j600_set_bits(priv, MACON1, PASSALL);
                encx24j600_write_reg(priv, ERXFCON, UCEN | MCEN | NOTMEEN);
                break;
        case RXFILTER_MULTI:
                encx24j600_clr_bits(priv, MACON1, PASSALL);
                encx24j600_write_reg(priv, ERXFCON, UCEN | CRCEN | BCEN | MCEN);
                break;
        case RXFILTER_NORMAL:
        default:
                encx24j600_clr_bits(priv, MACON1, PASSALL);
                encx24j600_write_reg(priv, ERXFCON, UCEN | CRCEN | BCEN);
                break;
        }
}

static void encx24j600_hw_init(struct encx24j600_priv *priv)
{
        u16 macon2;

        priv->hw_enabled = false;

        /* PHY Leds: link status,
         * LEDA: Link State + collision events
         * LEDB: Link State + transmit/receive events
         */
        encx24j600_update_reg(priv, EIDLED, 0xff00, 0xcb00);

        /* Loopback disabled */
        encx24j600_write_reg(priv, MACON1, 0x9);

        /* interpacket gap value */
        encx24j600_write_reg(priv, MAIPG, 0x0c12);

        /* Write the auto negotiation pattern */
        encx24j600_write_phy(priv, PHANA, PHANA_DEFAULT);

        encx24j600_update_phcon1(priv);
        encx24j600_check_link_status(priv);

        macon2 = MACON2_RSV1 | TXCRCEN | PADCFG0 | PADCFG2 | MACON2_DEFER;
        if ((priv->autoneg == AUTONEG_DISABLE) && priv->full_duplex)
                macon2 |= FULDPX;

        encx24j600_set_bits(priv, MACON2, macon2);

        priv->rxfilter = RXFILTER_NORMAL;
        encx24j600_set_rxfilter_mode(priv);

        /* Program the Maximum frame length */
        encx24j600_write_reg(priv, MAMXFL, MAX_FRAMELEN);

        /* Init Tx pointers */
        encx24j600_hw_init_tx(priv);

        /* Init Rx pointers */
        encx24j600_hw_init_rx(priv);

        if (netif_msg_hw(priv))
                encx24j600_dump_config(priv, "Hw is initialized");
}

static void encx24j600_hw_enable(struct encx24j600_priv *priv)
{
        /* Clear the interrupt flags in case was set */
        encx24j600_clr_bits(priv, EIR, (PCFULIF | RXABTIF | TXABTIF | TXIF |
                                        PKTIF | LINKIF));

        /* Enable the interrupts */
        encx24j600_write_reg(priv, EIE, (PCFULIE | RXABTIE | TXABTIE | TXIE |
                                         PKTIE | LINKIE | INTIE));

        /* Enable RX */
        encx24j600_cmd(priv, ENABLERX);

        priv->hw_enabled = true;
}

static void encx24j600_hw_disable(struct encx24j600_priv *priv)
{
        /* Disable all interrupts */
        encx24j600_write_reg(priv, EIE, 0);

        /* Disable RX */
        encx24j600_cmd(priv, DISABLERX);

        priv->hw_enabled = false;
}

static int encx24j600_setlink(struct net_device *dev, u8 autoneg, u16 speed,
                              u8 duplex)
{
        struct encx24j600_priv *priv = netdev_priv(dev);
        int ret = 0;

        if (!priv->hw_enabled) {
                /* link is in low power mode now; duplex setting
                 * will take effect on next encx24j600_hw_init()
                 */
                if (speed == SPEED_10 || speed == SPEED_100) {
                        priv->autoneg = (autoneg == AUTONEG_ENABLE);
                        priv->full_duplex = (duplex == DUPLEX_FULL);
                        priv->speed = (speed == SPEED_100);
                } else {
                        netif_warn(priv, link, dev, "unsupported link speed setting\n");
                        /*speeds other than SPEED_10 and SPEED_100 */
                        /*are not supported by chip */
                        ret = -EOPNOTSUPP;
                }
        } else {
                netif_warn(priv, link, dev, "Warning: hw must be disabled to set link mode\n");
                ret = -EBUSY;
        }
        return ret;
}

static void encx24j600_hw_get_macaddr(struct encx24j600_priv *priv,
                                      unsigned char *ethaddr)
{
        unsigned short val;

        val = encx24j600_read_reg(priv, MAADR1);

        ethaddr[0] = val & 0x00ff;
        ethaddr[1] = (val & 0xff00) >> 8;

        val = encx24j600_read_reg(priv, MAADR2);

        ethaddr[2] = val & 0x00ffU;
        ethaddr[3] = (val & 0xff00U) >> 8;

        val = encx24j600_read_reg(priv, MAADR3);

        ethaddr[4] = val & 0x00ffU;
        ethaddr[5] = (val & 0xff00U) >> 8;
}

/* Program the hardware MAC address from dev->dev_addr.*/
static int encx24j600_set_hw_macaddr(struct net_device *dev)
{
        struct encx24j600_priv *priv = netdev_priv(dev);

        if (priv->hw_enabled) {
                netif_info(priv, drv, dev, "Hardware must be disabled to set Mac address\n");
                return -EBUSY;
        }

        mutex_lock(&priv->lock);

        netif_info(priv, drv, dev, "%s: Setting MAC address to %pM\n",
                   dev->name, dev->dev_addr);

        encx24j600_write_reg(priv, MAADR3, (dev->dev_addr[4] |
                             dev->dev_addr[5] << 8));
        encx24j600_write_reg(priv, MAADR2, (dev->dev_addr[2] |
                             dev->dev_addr[3] << 8));
        encx24j600_write_reg(priv, MAADR1, (dev->dev_addr[0] |
                             dev->dev_addr[1] << 8));

        mutex_unlock(&priv->lock);

        return 0;
}

/* Store the new hardware address in dev->dev_addr, and update the MAC.*/
static int encx24j600_set_mac_address(struct net_device *dev, void *addr)
{
        struct sockaddr *address = addr;

        if (netif_running(dev))
                return -EBUSY;
        if (!is_valid_ether_addr(address->sa_data))
                return -EADDRNOTAVAIL;

        eth_hw_addr_set(dev, address->sa_data);
        return encx24j600_set_hw_macaddr(dev);
}

static int encx24j600_open(struct net_device *dev)
{
        struct encx24j600_priv *priv = netdev_priv(dev);

        int ret = request_threaded_irq(priv->ctx.spi->irq, NULL, encx24j600_isr,
                                       IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
                                       DRV_NAME, priv);
        if (unlikely(ret < 0)) {
                netdev_err(dev, "request irq %d failed (ret = %d)\n",
                           priv->ctx.spi->irq, ret);
                return ret;
        }

        encx24j600_hw_disable(priv);
        encx24j600_hw_init(priv);
        encx24j600_hw_enable(priv);
        netif_start_queue(dev);

        return 0;
}

static int encx24j600_stop(struct net_device *dev)
{
        struct encx24j600_priv *priv = netdev_priv(dev);

        netif_stop_queue(dev);
        free_irq(priv->ctx.spi->irq, priv);
        return 0;
}

static void encx24j600_setrx_proc(struct kthread_work *ws)
{
        struct encx24j600_priv *priv =
                        container_of(ws, struct encx24j600_priv, setrx_work);

        mutex_lock(&priv->lock);
        encx24j600_set_rxfilter_mode(priv);
        mutex_unlock(&priv->lock);
}

static void encx24j600_set_multicast_list(struct net_device *dev)
{
        struct encx24j600_priv *priv = netdev_priv(dev);
        int oldfilter = priv->rxfilter;

        if (dev->flags & IFF_PROMISC) {
                netif_dbg(priv, link, dev, "promiscuous mode\n");
                priv->rxfilter = RXFILTER_PROMISC;
        } else if ((dev->flags & IFF_ALLMULTI) || !netdev_mc_empty(dev)) {
                netif_dbg(priv, link, dev, "%smulticast mode\n",
                          (dev->flags & IFF_ALLMULTI) ? "all-" : "");
                priv->rxfilter = RXFILTER_MULTI;
        } else {
                netif_dbg(priv, link, dev, "normal mode\n");
                priv->rxfilter = RXFILTER_NORMAL;
        }

        if (oldfilter != priv->rxfilter)
                kthread_queue_work(&priv->kworker, &priv->setrx_work);
}

static void encx24j600_hw_tx(struct encx24j600_priv *priv)
{
        struct net_device *dev = priv->ndev;

        netif_info(priv, tx_queued, dev, "TX Packet Len:%d\n",
                   priv->tx_skb->len);

        if (netif_msg_pktdata(priv))
                dump_packet("TX", priv->tx_skb->len, priv->tx_skb->data);

        if (encx24j600_read_reg(priv, EIR) & TXABTIF)
                /* Last transmission aborted due to error.
                 * Reset TX interface
                 */
                encx24j600_reset_hw_tx(priv);

        /* Clear the TXIF flag if were previously set */
        encx24j600_clr_bits(priv, EIR, TXIF);

        /* Set the data pointer to the TX buffer address in the SRAM */
        encx24j600_write_reg(priv, EGPWRPT, ENC_TX_BUF_START);

        /* Copy the packet into the SRAM */
        encx24j600_raw_write(priv, WGPDATA, (u8 *)priv->tx_skb->data,
                             priv->tx_skb->len);

        /* Program the Tx buffer start pointer */
        encx24j600_write_reg(priv, ETXST, ENC_TX_BUF_START);

        /* Program the packet length */
        encx24j600_write_reg(priv, ETXLEN, priv->tx_skb->len);

        /* Start the transmission */
        encx24j600_cmd(priv, SETTXRTS);
}

static void encx24j600_tx_proc(struct kthread_work *ws)
{
        struct encx24j600_priv *priv =
                        container_of(ws, struct encx24j600_priv, tx_work);

        mutex_lock(&priv->lock);
        encx24j600_hw_tx(priv);
        mutex_unlock(&priv->lock);
}

static netdev_tx_t encx24j600_tx(struct sk_buff *skb, struct net_device *dev)
{
        struct encx24j600_priv *priv = netdev_priv(dev);

        netif_stop_queue(dev);

        /* save the timestamp */
        netif_trans_update(dev);

        /* Remember the skb for deferred processing */
        priv->tx_skb = skb;

        kthread_queue_work(&priv->kworker, &priv->tx_work);

        return NETDEV_TX_OK;
}

/* Deal with a transmit timeout */
static void encx24j600_tx_timeout(struct net_device *dev, unsigned int txqueue)
{
        struct encx24j600_priv *priv = netdev_priv(dev);

        netif_err(priv, tx_err, dev, "TX timeout at %ld, latency %ld\n",
                  jiffies, jiffies - dev_trans_start(dev));

        dev->stats.tx_errors++;
        netif_wake_queue(dev);
}

static int encx24j600_get_regs_len(struct net_device *dev)
{
        return SFR_REG_COUNT;
}

static void encx24j600_get_regs(struct net_device *dev,
                                struct ethtool_regs *regs, void *p)
{
        struct encx24j600_priv *priv = netdev_priv(dev);
        u16 *buff = p;
        u8 reg;

        regs->version = 1;
        mutex_lock(&priv->lock);
        for (reg = 0; reg < SFR_REG_COUNT; reg += 2) {
                unsigned int val = 0;
                /* ignore errors for unreadable registers */
                regmap_read(priv->ctx.regmap, reg, &val);
                buff[reg] = val & 0xffff;
        }
        mutex_unlock(&priv->lock);
}

static void encx24j600_get_drvinfo(struct net_device *dev,
                                   struct ethtool_drvinfo *info)
{
        strscpy(info->driver, DRV_NAME, sizeof(info->driver));
        strscpy(info->version, DRV_VERSION, sizeof(info->version));
        strscpy(info->bus_info, dev_name(dev->dev.parent),
                sizeof(info->bus_info));
}

static int encx24j600_get_link_ksettings(struct net_device *dev,
                                         struct ethtool_link_ksettings *cmd)
{
        struct encx24j600_priv *priv = netdev_priv(dev);
        u32 supported;

        supported = SUPPORTED_10baseT_Half | SUPPORTED_10baseT_Full |
                         SUPPORTED_100baseT_Half | SUPPORTED_100baseT_Full |
                         SUPPORTED_Autoneg | SUPPORTED_TP;

        ethtool_convert_legacy_u32_to_link_mode(cmd->link_modes.supported,
                                                supported);

        cmd->base.speed = priv->speed;
        cmd->base.duplex = priv->full_duplex ? DUPLEX_FULL : DUPLEX_HALF;
        cmd->base.port = PORT_TP;
        cmd->base.autoneg = priv->autoneg ? AUTONEG_ENABLE : AUTONEG_DISABLE;

        return 0;
}

static int
encx24j600_set_link_ksettings(struct net_device *dev,
                              const struct ethtool_link_ksettings *cmd)
{
        return encx24j600_setlink(dev, cmd->base.autoneg,
                                  cmd->base.speed, cmd->base.duplex);
}

static u32 encx24j600_get_msglevel(struct net_device *dev)
{
        struct encx24j600_priv *priv = netdev_priv(dev);

        return priv->msg_enable;
}

static void encx24j600_set_msglevel(struct net_device *dev, u32 val)
{
        struct encx24j600_priv *priv = netdev_priv(dev);

        priv->msg_enable = val;
}

static const struct ethtool_ops encx24j600_ethtool_ops = {
        .get_drvinfo = encx24j600_get_drvinfo,
        .get_msglevel = encx24j600_get_msglevel,
        .set_msglevel = encx24j600_set_msglevel,
        .get_regs_len = encx24j600_get_regs_len,
        .get_regs = encx24j600_get_regs,
        .get_link_ksettings = encx24j600_get_link_ksettings,
        .set_link_ksettings = encx24j600_set_link_ksettings,
};

static const struct net_device_ops encx24j600_netdev_ops = {
        .ndo_open = encx24j600_open,
        .ndo_stop = encx24j600_stop,
        .ndo_start_xmit = encx24j600_tx,
        .ndo_set_rx_mode = encx24j600_set_multicast_list,
        .ndo_set_mac_address = encx24j600_set_mac_address,
        .ndo_tx_timeout = encx24j600_tx_timeout,
        .ndo_validate_addr = eth_validate_addr,
};

static int encx24j600_spi_probe(struct spi_device *spi)
{
        int ret;

        struct net_device *ndev;
        struct encx24j600_priv *priv;
        u16 eidled;
        u8 addr[ETH_ALEN];

        ndev = alloc_etherdev(sizeof(struct encx24j600_priv));

        if (!ndev) {
                ret = -ENOMEM;
                goto error_out;
        }

        priv = netdev_priv(ndev);
        spi_set_drvdata(spi, priv);
        dev_set_drvdata(&spi->dev, priv);
        SET_NETDEV_DEV(ndev, &spi->dev);

        priv->msg_enable = netif_msg_init(debug, DEFAULT_MSG_ENABLE);
        priv->ndev = ndev;

        /* Default configuration PHY configuration */
        priv->full_duplex = true;
        priv->autoneg = AUTONEG_ENABLE;
        priv->speed = SPEED_100;

        priv->ctx.spi = spi;
        ndev->irq = spi->irq;
        ndev->netdev_ops = &encx24j600_netdev_ops;

        ret = devm_regmap_init_encx24j600(&spi->dev, &priv->ctx);
        if (ret)
                goto out_free;

        mutex_init(&priv->lock);

        /* Reset device and check if it is connected */
        if (encx24j600_hw_reset(priv)) {
                netif_err(priv, probe, ndev,
                          DRV_NAME ": Chip is not detected\n");
                ret = -EIO;
                goto out_free;
        }

        /* Initialize the device HW to the consistent state */
        encx24j600_hw_init(priv);

        kthread_init_worker(&priv->kworker);
        kthread_init_work(&priv->tx_work, encx24j600_tx_proc);
        kthread_init_work(&priv->setrx_work, encx24j600_setrx_proc);

        priv->kworker_task = kthread_run(kthread_worker_fn, &priv->kworker,
                                         "encx24j600");

        if (IS_ERR(priv->kworker_task)) {
                ret = PTR_ERR(priv->kworker_task);
                goto out_free;
        }

        /* Get the MAC address from the chip */
        encx24j600_hw_get_macaddr(priv, addr);
        eth_hw_addr_set(ndev, addr);

        ndev->ethtool_ops = &encx24j600_ethtool_ops;

        ret = register_netdev(ndev);
        if (unlikely(ret)) {
                netif_err(priv, probe, ndev, "Error %d initializing card encx24j600 card\n",
                          ret);
                goto out_stop;
        }

        eidled = encx24j600_read_reg(priv, EIDLED);
        if (((eidled & DEVID_MASK) >> DEVID_SHIFT) != ENCX24J600_DEV_ID) {
                ret = -EINVAL;
                goto out_unregister;
        }

        netif_info(priv, probe, ndev, "Silicon rev ID: 0x%02x\n",
                   (eidled & REVID_MASK) >> REVID_SHIFT);

        netif_info(priv, drv, priv->ndev, "MAC address %pM\n", ndev->dev_addr);

        return ret;

out_unregister:
        unregister_netdev(priv->ndev);
out_stop:
        kthread_stop(priv->kworker_task);
out_free:
        free_netdev(ndev);

error_out:
        return ret;
}

static void encx24j600_spi_remove(struct spi_device *spi)
{
        struct encx24j600_priv *priv = dev_get_drvdata(&spi->dev);

        unregister_netdev(priv->ndev);
        kthread_stop(priv->kworker_task);

        free_netdev(priv->ndev);
}

static const struct spi_device_id encx24j600_spi_id_table[] = {
        { .name = "encx24j600" },
        { /* sentinel */ }
};
MODULE_DEVICE_TABLE(spi, encx24j600_spi_id_table);

static struct spi_driver encx24j600_spi_net_driver = {
        .driver = {
                .name   = DRV_NAME,
                .bus    = &spi_bus_type,
        },
        .probe          = encx24j600_spi_probe,
        .remove         = encx24j600_spi_remove,
        .id_table       = encx24j600_spi_id_table,
};

module_spi_driver(encx24j600_spi_net_driver);

MODULE_DESCRIPTION(DRV_NAME " ethernet driver");
MODULE_AUTHOR("Jon Ringle <jringle@gridpoint.com>");
MODULE_LICENSE("GPL");