1 // SPDX-License-Identifier: GPL-2.0-or-later
3 * Actions Semi Owl SoCs Ethernet MAC driver
5 * Copyright (c) 2012 Actions Semi Inc.
6 * Copyright (c) 2021 Cristian Ciocaltea <cristian.ciocaltea@gmail.com>
9 #include <linux/circ_buf.h>
10 #include <linux/clk.h>
11 #include <linux/dma-mapping.h>
12 #include <linux/etherdevice.h>
13 #include <linux/of_mdio.h>
14 #include <linux/of_net.h>
15 #include <linux/platform_device.h>
17 #include <linux/reset.h>
21 #define OWL_EMAC_DEFAULT_MSG_ENABLE (NETIF_MSG_DRV | \
25 static u32 owl_emac_reg_read(struct owl_emac_priv *priv, u32 reg)
27 return readl(priv->base + reg);
30 static void owl_emac_reg_write(struct owl_emac_priv *priv, u32 reg, u32 data)
32 writel(data, priv->base + reg);
35 static u32 owl_emac_reg_update(struct owl_emac_priv *priv,
36 u32 reg, u32 mask, u32 val)
40 data = owl_emac_reg_read(priv, reg);
41 old_val = data & mask;
46 owl_emac_reg_write(priv, reg, data);
51 static void owl_emac_reg_set(struct owl_emac_priv *priv, u32 reg, u32 bits)
53 owl_emac_reg_update(priv, reg, bits, bits);
56 static void owl_emac_reg_clear(struct owl_emac_priv *priv, u32 reg, u32 bits)
58 owl_emac_reg_update(priv, reg, bits, 0);
61 static struct device *owl_emac_get_dev(struct owl_emac_priv *priv)
63 return priv->netdev->dev.parent;
66 static void owl_emac_irq_enable(struct owl_emac_priv *priv)
68 /* Enable all interrupts except TU.
70 * Note the NIE and AIE bits shall also be set in order to actually
71 * enable the selected interrupts.
73 owl_emac_reg_write(priv, OWL_EMAC_REG_MAC_CSR7,
74 OWL_EMAC_BIT_MAC_CSR7_NIE |
75 OWL_EMAC_BIT_MAC_CSR7_AIE |
76 OWL_EMAC_BIT_MAC_CSR7_ALL_NOT_TUE);
79 static void owl_emac_irq_disable(struct owl_emac_priv *priv)
81 /* Disable all interrupts.
83 * WARNING: Unset only the NIE and AIE bits in CSR7 to workaround an
84 * unexpected side effect (MAC hardware bug?!) where some bits in the
85 * status register (CSR5) are cleared automatically before being able
86 * to read them via owl_emac_irq_clear().
88 owl_emac_reg_write(priv, OWL_EMAC_REG_MAC_CSR7,
89 OWL_EMAC_BIT_MAC_CSR7_ALL_NOT_TUE);
92 static u32 owl_emac_irq_status(struct owl_emac_priv *priv)
94 return owl_emac_reg_read(priv, OWL_EMAC_REG_MAC_CSR5);
97 static u32 owl_emac_irq_clear(struct owl_emac_priv *priv)
99 u32 val = owl_emac_irq_status(priv);
101 owl_emac_reg_write(priv, OWL_EMAC_REG_MAC_CSR5, val);
106 static dma_addr_t owl_emac_dma_map_rx(struct owl_emac_priv *priv,
109 struct device *dev = owl_emac_get_dev(priv);
111 /* Buffer pointer for the RX DMA descriptor must be word aligned. */
112 return dma_map_single(dev, skb_tail_pointer(skb),
113 skb_tailroom(skb), DMA_FROM_DEVICE);
116 static void owl_emac_dma_unmap_rx(struct owl_emac_priv *priv,
117 struct sk_buff *skb, dma_addr_t dma_addr)
119 struct device *dev = owl_emac_get_dev(priv);
121 dma_unmap_single(dev, dma_addr, skb_tailroom(skb), DMA_FROM_DEVICE);
124 static dma_addr_t owl_emac_dma_map_tx(struct owl_emac_priv *priv,
127 struct device *dev = owl_emac_get_dev(priv);
129 return dma_map_single(dev, skb->data, skb_headlen(skb), DMA_TO_DEVICE);
132 static void owl_emac_dma_unmap_tx(struct owl_emac_priv *priv,
133 struct sk_buff *skb, dma_addr_t dma_addr)
135 struct device *dev = owl_emac_get_dev(priv);
137 dma_unmap_single(dev, dma_addr, skb_headlen(skb), DMA_TO_DEVICE);
140 static unsigned int owl_emac_ring_num_unused(struct owl_emac_ring *ring)
142 return CIRC_SPACE(ring->head, ring->tail, ring->size);
145 static unsigned int owl_emac_ring_get_next(struct owl_emac_ring *ring,
148 return (cur + 1) & (ring->size - 1);
151 static void owl_emac_ring_push_head(struct owl_emac_ring *ring)
153 ring->head = owl_emac_ring_get_next(ring, ring->head);
156 static void owl_emac_ring_pop_tail(struct owl_emac_ring *ring)
158 ring->tail = owl_emac_ring_get_next(ring, ring->tail);
161 static struct sk_buff *owl_emac_alloc_skb(struct net_device *netdev)
166 skb = netdev_alloc_skb(netdev, OWL_EMAC_RX_FRAME_MAX_LEN +
167 OWL_EMAC_SKB_RESERVE);
171 /* Ensure 4 bytes DMA alignment. */
172 offset = ((uintptr_t)skb->data) & (OWL_EMAC_SKB_ALIGN - 1);
173 if (unlikely(offset))
174 skb_reserve(skb, OWL_EMAC_SKB_ALIGN - offset);
179 static int owl_emac_ring_prepare_rx(struct owl_emac_priv *priv)
181 struct owl_emac_ring *ring = &priv->rx_ring;
182 struct device *dev = owl_emac_get_dev(priv);
183 struct net_device *netdev = priv->netdev;
184 struct owl_emac_ring_desc *desc;
189 for (i = 0; i < ring->size; i++) {
190 skb = owl_emac_alloc_skb(netdev);
194 dma_addr = owl_emac_dma_map_rx(priv, skb);
195 if (dma_mapping_error(dev, dma_addr)) {
200 desc = &ring->descs[i];
201 desc->status = OWL_EMAC_BIT_RDES0_OWN;
202 desc->control = skb_tailroom(skb) & OWL_EMAC_MSK_RDES1_RBS1;
203 desc->buf_addr = dma_addr;
207 ring->skbs_dma[i] = dma_addr;
210 desc->control |= OWL_EMAC_BIT_RDES1_RER;
218 static void owl_emac_ring_prepare_tx(struct owl_emac_priv *priv)
220 struct owl_emac_ring *ring = &priv->tx_ring;
221 struct owl_emac_ring_desc *desc;
224 for (i = 0; i < ring->size; i++) {
225 desc = &ring->descs[i];
228 desc->control = OWL_EMAC_BIT_TDES1_IC;
233 desc->control |= OWL_EMAC_BIT_TDES1_TER;
235 memset(ring->skbs_dma, 0, sizeof(dma_addr_t) * ring->size);
241 static void owl_emac_ring_unprepare_rx(struct owl_emac_priv *priv)
243 struct owl_emac_ring *ring = &priv->rx_ring;
246 for (i = 0; i < ring->size; i++) {
247 ring->descs[i].status = 0;
249 if (!ring->skbs_dma[i])
252 owl_emac_dma_unmap_rx(priv, ring->skbs[i], ring->skbs_dma[i]);
253 ring->skbs_dma[i] = 0;
255 dev_kfree_skb(ring->skbs[i]);
256 ring->skbs[i] = NULL;
260 static void owl_emac_ring_unprepare_tx(struct owl_emac_priv *priv)
262 struct owl_emac_ring *ring = &priv->tx_ring;
265 for (i = 0; i < ring->size; i++) {
266 ring->descs[i].status = 0;
268 if (!ring->skbs_dma[i])
271 owl_emac_dma_unmap_tx(priv, ring->skbs[i], ring->skbs_dma[i]);
272 ring->skbs_dma[i] = 0;
274 dev_kfree_skb(ring->skbs[i]);
275 ring->skbs[i] = NULL;
279 static int owl_emac_ring_alloc(struct device *dev, struct owl_emac_ring *ring,
282 ring->descs = dmam_alloc_coherent(dev,
283 sizeof(struct owl_emac_ring_desc) * size,
284 &ring->descs_dma, GFP_KERNEL);
288 ring->skbs = devm_kcalloc(dev, size, sizeof(struct sk_buff *),
293 ring->skbs_dma = devm_kcalloc(dev, size, sizeof(dma_addr_t),
303 static void owl_emac_dma_cmd_resume_rx(struct owl_emac_priv *priv)
305 owl_emac_reg_write(priv, OWL_EMAC_REG_MAC_CSR2,
306 OWL_EMAC_VAL_MAC_CSR2_RPD);
309 static void owl_emac_dma_cmd_resume_tx(struct owl_emac_priv *priv)
311 owl_emac_reg_write(priv, OWL_EMAC_REG_MAC_CSR1,
312 OWL_EMAC_VAL_MAC_CSR1_TPD);
315 static u32 owl_emac_dma_cmd_set_tx(struct owl_emac_priv *priv, u32 status)
317 return owl_emac_reg_update(priv, OWL_EMAC_REG_MAC_CSR6,
318 OWL_EMAC_BIT_MAC_CSR6_ST, status);
321 static u32 owl_emac_dma_cmd_start_tx(struct owl_emac_priv *priv)
323 return owl_emac_dma_cmd_set_tx(priv, ~0);
326 static u32 owl_emac_dma_cmd_set(struct owl_emac_priv *priv, u32 status)
328 return owl_emac_reg_update(priv, OWL_EMAC_REG_MAC_CSR6,
329 OWL_EMAC_MSK_MAC_CSR6_STSR, status);
332 static u32 owl_emac_dma_cmd_start(struct owl_emac_priv *priv)
334 return owl_emac_dma_cmd_set(priv, ~0);
337 static u32 owl_emac_dma_cmd_stop(struct owl_emac_priv *priv)
339 return owl_emac_dma_cmd_set(priv, 0);
342 static void owl_emac_set_hw_mac_addr(struct net_device *netdev)
344 struct owl_emac_priv *priv = netdev_priv(netdev);
345 const u8 *mac_addr = netdev->dev_addr;
346 u32 addr_high, addr_low;
348 addr_high = mac_addr[0] << 8 | mac_addr[1];
349 addr_low = mac_addr[2] << 24 | mac_addr[3] << 16 |
350 mac_addr[4] << 8 | mac_addr[5];
352 owl_emac_reg_write(priv, OWL_EMAC_REG_MAC_CSR17, addr_high);
353 owl_emac_reg_write(priv, OWL_EMAC_REG_MAC_CSR16, addr_low);
356 static void owl_emac_update_link_state(struct owl_emac_priv *priv)
361 val = OWL_EMAC_BIT_MAC_CSR20_FCE | OWL_EMAC_BIT_MAC_CSR20_TUE;
362 val |= OWL_EMAC_BIT_MAC_CSR20_TPE | OWL_EMAC_BIT_MAC_CSR20_RPE;
363 val |= OWL_EMAC_BIT_MAC_CSR20_BPE;
368 /* Update flow control. */
369 owl_emac_reg_write(priv, OWL_EMAC_REG_MAC_CSR20, val);
371 val = (priv->speed == SPEED_100) ? OWL_EMAC_VAL_MAC_CSR6_SPEED_100M :
372 OWL_EMAC_VAL_MAC_CSR6_SPEED_10M;
373 val <<= OWL_EMAC_OFF_MAC_CSR6_SPEED;
375 if (priv->duplex == DUPLEX_FULL)
376 val |= OWL_EMAC_BIT_MAC_CSR6_FD;
378 spin_lock_bh(&priv->lock);
380 /* Temporarily stop DMA TX & RX. */
381 status = owl_emac_dma_cmd_stop(priv);
383 /* Update operation modes. */
384 owl_emac_reg_update(priv, OWL_EMAC_REG_MAC_CSR6,
385 OWL_EMAC_MSK_MAC_CSR6_SPEED |
386 OWL_EMAC_BIT_MAC_CSR6_FD, val);
388 /* Restore DMA TX & RX status. */
389 owl_emac_dma_cmd_set(priv, status);
391 spin_unlock_bh(&priv->lock);
394 static void owl_emac_adjust_link(struct net_device *netdev)
396 struct owl_emac_priv *priv = netdev_priv(netdev);
397 struct phy_device *phydev = netdev->phydev;
398 bool state_changed = false;
402 priv->link = phydev->link;
403 state_changed = true;
406 if (priv->speed != phydev->speed) {
407 priv->speed = phydev->speed;
408 state_changed = true;
411 if (priv->duplex != phydev->duplex) {
412 priv->duplex = phydev->duplex;
413 state_changed = true;
416 if (priv->pause != phydev->pause) {
417 priv->pause = phydev->pause;
418 state_changed = true;
422 priv->link = phydev->link;
423 state_changed = true;
429 owl_emac_update_link_state(priv);
431 if (netif_msg_link(priv))
432 phy_print_status(phydev);
436 static irqreturn_t owl_emac_handle_irq(int irq, void *data)
438 struct net_device *netdev = data;
439 struct owl_emac_priv *priv = netdev_priv(netdev);
441 if (netif_running(netdev)) {
442 owl_emac_irq_disable(priv);
443 napi_schedule(&priv->napi);
449 static void owl_emac_ether_addr_push(u8 **dst, const u8 *src)
451 u32 *a = (u32 *)(*dst);
452 const u16 *b = (const u16 *)src;
462 owl_emac_setup_frame_prepare(struct owl_emac_priv *priv, struct sk_buff *skb)
464 const u8 bcast_addr[] = { 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF };
465 const u8 *mac_addr = priv->netdev->dev_addr;
469 skb_put(skb, OWL_EMAC_SETUP_FRAME_LEN);
472 memset(frame, 0, skb->len);
474 owl_emac_ether_addr_push(&frame, mac_addr);
475 owl_emac_ether_addr_push(&frame, bcast_addr);
477 /* Fill multicast addresses. */
478 WARN_ON(priv->mcaddr_list.count >= OWL_EMAC_MAX_MULTICAST_ADDRS);
479 for (i = 0; i < priv->mcaddr_list.count; i++) {
480 mac_addr = priv->mcaddr_list.addrs[i];
481 owl_emac_ether_addr_push(&frame, mac_addr);
485 /* The setup frame is a special descriptor which is used to provide physical
486 * addresses (i.e. mac, broadcast and multicast) to the MAC hardware for
487 * filtering purposes. To be recognized as a setup frame, the TDES1_SET bit
488 * must be set in the TX descriptor control field.
490 static int owl_emac_setup_frame_xmit(struct owl_emac_priv *priv)
492 struct owl_emac_ring *ring = &priv->tx_ring;
493 struct net_device *netdev = priv->netdev;
494 struct owl_emac_ring_desc *desc;
496 unsigned int tx_head;
501 skb = owl_emac_alloc_skb(netdev);
505 owl_emac_setup_frame_prepare(priv, skb);
507 dma_addr = owl_emac_dma_map_tx(priv, skb);
508 if (dma_mapping_error(owl_emac_get_dev(priv), dma_addr)) {
513 spin_lock_bh(&priv->lock);
515 tx_head = ring->head;
516 desc = &ring->descs[tx_head];
518 status = READ_ONCE(desc->status);
519 control = READ_ONCE(desc->control);
520 dma_rmb(); /* Ensure data has been read before used. */
522 if (unlikely(status & OWL_EMAC_BIT_TDES0_OWN) ||
523 !owl_emac_ring_num_unused(ring)) {
524 spin_unlock_bh(&priv->lock);
525 owl_emac_dma_unmap_tx(priv, skb, dma_addr);
530 ring->skbs[tx_head] = skb;
531 ring->skbs_dma[tx_head] = dma_addr;
533 control &= OWL_EMAC_BIT_TDES1_IC | OWL_EMAC_BIT_TDES1_TER; /* Maintain bits */
534 control |= OWL_EMAC_BIT_TDES1_SET;
535 control |= OWL_EMAC_MSK_TDES1_TBS1 & skb->len;
537 WRITE_ONCE(desc->control, control);
538 WRITE_ONCE(desc->buf_addr, dma_addr);
539 dma_wmb(); /* Flush descriptor before changing ownership. */
540 WRITE_ONCE(desc->status, OWL_EMAC_BIT_TDES0_OWN);
542 owl_emac_ring_push_head(ring);
544 /* Temporarily enable DMA TX. */
545 status = owl_emac_dma_cmd_start_tx(priv);
547 /* Trigger setup frame processing. */
548 owl_emac_dma_cmd_resume_tx(priv);
550 /* Restore DMA TX status. */
551 owl_emac_dma_cmd_set_tx(priv, status);
553 /* Stop regular TX until setup frame is processed. */
554 netif_stop_queue(netdev);
556 spin_unlock_bh(&priv->lock);
565 static netdev_tx_t owl_emac_ndo_start_xmit(struct sk_buff *skb,
566 struct net_device *netdev)
568 struct owl_emac_priv *priv = netdev_priv(netdev);
569 struct device *dev = owl_emac_get_dev(priv);
570 struct owl_emac_ring *ring = &priv->tx_ring;
571 struct owl_emac_ring_desc *desc;
572 unsigned int tx_head;
576 dma_addr = owl_emac_dma_map_tx(priv, skb);
577 if (dma_mapping_error(dev, dma_addr)) {
578 dev_err_ratelimited(&netdev->dev, "TX DMA mapping failed\n");
580 netdev->stats.tx_dropped++;
584 spin_lock_bh(&priv->lock);
586 tx_head = ring->head;
587 desc = &ring->descs[tx_head];
589 status = READ_ONCE(desc->status);
590 control = READ_ONCE(desc->control);
591 dma_rmb(); /* Ensure data has been read before used. */
593 if (!owl_emac_ring_num_unused(ring) ||
594 unlikely(status & OWL_EMAC_BIT_TDES0_OWN)) {
595 netif_stop_queue(netdev);
596 spin_unlock_bh(&priv->lock);
598 dev_dbg_ratelimited(&netdev->dev, "TX buffer full, status=0x%08x\n",
599 owl_emac_irq_status(priv));
600 owl_emac_dma_unmap_tx(priv, skb, dma_addr);
601 netdev->stats.tx_dropped++;
602 return NETDEV_TX_BUSY;
605 ring->skbs[tx_head] = skb;
606 ring->skbs_dma[tx_head] = dma_addr;
608 control &= OWL_EMAC_BIT_TDES1_IC | OWL_EMAC_BIT_TDES1_TER; /* Maintain bits */
609 control |= OWL_EMAC_BIT_TDES1_FS | OWL_EMAC_BIT_TDES1_LS;
610 control |= OWL_EMAC_MSK_TDES1_TBS1 & skb->len;
612 WRITE_ONCE(desc->control, control);
613 WRITE_ONCE(desc->buf_addr, dma_addr);
614 dma_wmb(); /* Flush descriptor before changing ownership. */
615 WRITE_ONCE(desc->status, OWL_EMAC_BIT_TDES0_OWN);
617 owl_emac_dma_cmd_resume_tx(priv);
618 owl_emac_ring_push_head(ring);
620 /* FIXME: The transmission is currently restricted to a single frame
621 * at a time as a workaround for a MAC hardware bug that causes random
622 * freeze of the TX queue processor.
624 netif_stop_queue(netdev);
626 spin_unlock_bh(&priv->lock);
631 static bool owl_emac_tx_complete_tail(struct owl_emac_priv *priv)
633 struct owl_emac_ring *ring = &priv->tx_ring;
634 struct net_device *netdev = priv->netdev;
635 struct owl_emac_ring_desc *desc;
637 unsigned int tx_tail;
640 tx_tail = ring->tail;
641 desc = &ring->descs[tx_tail];
643 status = READ_ONCE(desc->status);
644 dma_rmb(); /* Ensure data has been read before used. */
646 if (status & OWL_EMAC_BIT_TDES0_OWN)
649 /* Check for errors. */
650 if (status & OWL_EMAC_BIT_TDES0_ES) {
651 dev_dbg_ratelimited(&netdev->dev,
652 "TX complete error status: 0x%08x\n",
655 netdev->stats.tx_errors++;
657 if (status & OWL_EMAC_BIT_TDES0_UF)
658 netdev->stats.tx_fifo_errors++;
660 if (status & OWL_EMAC_BIT_TDES0_EC)
661 netdev->stats.tx_aborted_errors++;
663 if (status & OWL_EMAC_BIT_TDES0_LC)
664 netdev->stats.tx_window_errors++;
666 if (status & OWL_EMAC_BIT_TDES0_NC)
667 netdev->stats.tx_heartbeat_errors++;
669 if (status & OWL_EMAC_BIT_TDES0_LO)
670 netdev->stats.tx_carrier_errors++;
672 netdev->stats.tx_packets++;
673 netdev->stats.tx_bytes += ring->skbs[tx_tail]->len;
676 /* Some collisions occurred, but pkt has been transmitted. */
677 if (status & OWL_EMAC_BIT_TDES0_DE)
678 netdev->stats.collisions++;
680 skb = ring->skbs[tx_tail];
681 owl_emac_dma_unmap_tx(priv, skb, ring->skbs_dma[tx_tail]);
684 ring->skbs[tx_tail] = NULL;
685 ring->skbs_dma[tx_tail] = 0;
687 owl_emac_ring_pop_tail(ring);
689 if (unlikely(netif_queue_stopped(netdev)))
690 netif_wake_queue(netdev);
695 static void owl_emac_tx_complete(struct owl_emac_priv *priv)
697 struct owl_emac_ring *ring = &priv->tx_ring;
698 struct net_device *netdev = priv->netdev;
699 unsigned int tx_next;
702 spin_lock(&priv->lock);
704 while (ring->tail != ring->head) {
705 if (!owl_emac_tx_complete_tail(priv))
709 /* FIXME: This is a workaround for a MAC hardware bug not clearing
710 * (sometimes) the OWN bit for a transmitted frame descriptor.
712 * At this point, when TX queue is full, the tail descriptor has the
713 * OWN bit set, which normally means the frame has not been processed
714 * or transmitted yet. But if there is at least one descriptor in the
715 * queue having the OWN bit cleared, we can safely assume the tail
716 * frame has been also processed by the MAC hardware.
718 * If that's the case, let's force the frame completion by manually
719 * clearing the OWN bit.
721 if (unlikely(!owl_emac_ring_num_unused(ring))) {
722 tx_next = ring->tail;
724 while ((tx_next = owl_emac_ring_get_next(ring, tx_next)) != ring->head) {
725 status = READ_ONCE(ring->descs[tx_next].status);
726 dma_rmb(); /* Ensure data has been read before used. */
728 if (status & OWL_EMAC_BIT_TDES0_OWN)
731 netdev_dbg(netdev, "Found uncleared TX desc OWN bit\n");
733 status = READ_ONCE(ring->descs[ring->tail].status);
734 dma_rmb(); /* Ensure data has been read before used. */
735 status &= ~OWL_EMAC_BIT_TDES0_OWN;
736 WRITE_ONCE(ring->descs[ring->tail].status, status);
738 owl_emac_tx_complete_tail(priv);
743 spin_unlock(&priv->lock);
746 static int owl_emac_rx_process(struct owl_emac_priv *priv, int budget)
748 struct owl_emac_ring *ring = &priv->rx_ring;
749 struct device *dev = owl_emac_get_dev(priv);
750 struct net_device *netdev = priv->netdev;
751 struct owl_emac_ring_desc *desc;
752 struct sk_buff *curr_skb, *new_skb;
753 dma_addr_t curr_dma, new_dma;
754 unsigned int rx_tail, len;
758 while (recv < budget) {
759 spin_lock(&priv->lock);
761 rx_tail = ring->tail;
762 desc = &ring->descs[rx_tail];
764 status = READ_ONCE(desc->status);
765 dma_rmb(); /* Ensure data has been read before used. */
767 if (status & OWL_EMAC_BIT_RDES0_OWN) {
768 spin_unlock(&priv->lock);
772 curr_skb = ring->skbs[rx_tail];
773 curr_dma = ring->skbs_dma[rx_tail];
774 owl_emac_ring_pop_tail(ring);
776 spin_unlock(&priv->lock);
778 if (status & (OWL_EMAC_BIT_RDES0_DE | OWL_EMAC_BIT_RDES0_RF |
779 OWL_EMAC_BIT_RDES0_TL | OWL_EMAC_BIT_RDES0_CS |
780 OWL_EMAC_BIT_RDES0_DB | OWL_EMAC_BIT_RDES0_CE |
781 OWL_EMAC_BIT_RDES0_ZERO)) {
782 dev_dbg_ratelimited(&netdev->dev,
783 "RX desc error status: 0x%08x\n",
786 if (status & OWL_EMAC_BIT_RDES0_DE)
787 netdev->stats.rx_over_errors++;
789 if (status & (OWL_EMAC_BIT_RDES0_RF | OWL_EMAC_BIT_RDES0_DB))
790 netdev->stats.rx_frame_errors++;
792 if (status & OWL_EMAC_BIT_RDES0_TL)
793 netdev->stats.rx_length_errors++;
795 if (status & OWL_EMAC_BIT_RDES0_CS)
796 netdev->stats.collisions++;
798 if (status & OWL_EMAC_BIT_RDES0_CE)
799 netdev->stats.rx_crc_errors++;
801 if (status & OWL_EMAC_BIT_RDES0_ZERO)
802 netdev->stats.rx_fifo_errors++;
807 len = (status & OWL_EMAC_MSK_RDES0_FL) >> OWL_EMAC_OFF_RDES0_FL;
808 if (unlikely(len > OWL_EMAC_RX_FRAME_MAX_LEN)) {
809 netdev->stats.rx_length_errors++;
810 netdev_err(netdev, "invalid RX frame len: %u\n", len);
814 /* Prepare new skb before receiving the current one. */
815 new_skb = owl_emac_alloc_skb(netdev);
816 if (unlikely(!new_skb))
819 new_dma = owl_emac_dma_map_rx(priv, new_skb);
820 if (dma_mapping_error(dev, new_dma)) {
821 dev_kfree_skb(new_skb);
822 netdev_err(netdev, "RX DMA mapping failed\n");
826 owl_emac_dma_unmap_rx(priv, curr_skb, curr_dma);
828 skb_put(curr_skb, len - ETH_FCS_LEN);
829 curr_skb->ip_summed = CHECKSUM_NONE;
830 curr_skb->protocol = eth_type_trans(curr_skb, netdev);
831 curr_skb->dev = netdev;
833 netif_receive_skb(curr_skb);
835 netdev->stats.rx_packets++;
836 netdev->stats.rx_bytes += len;
841 netdev->stats.rx_dropped++;
842 netdev->stats.rx_errors++;
843 /* Reuse the current skb. */
848 spin_lock(&priv->lock);
850 ring->skbs[ring->head] = new_skb;
851 ring->skbs_dma[ring->head] = new_dma;
853 WRITE_ONCE(desc->buf_addr, new_dma);
854 dma_wmb(); /* Flush descriptor before changing ownership. */
855 WRITE_ONCE(desc->status, OWL_EMAC_BIT_RDES0_OWN);
857 owl_emac_ring_push_head(ring);
859 spin_unlock(&priv->lock);
865 static int owl_emac_poll(struct napi_struct *napi, int budget)
867 int work_done = 0, ru_cnt = 0, recv;
868 static int tx_err_cnt, rx_err_cnt;
869 struct owl_emac_priv *priv;
870 u32 status, proc_status;
872 priv = container_of(napi, struct owl_emac_priv, napi);
874 while ((status = owl_emac_irq_clear(priv)) &
875 (OWL_EMAC_BIT_MAC_CSR5_NIS | OWL_EMAC_BIT_MAC_CSR5_AIS)) {
878 /* TX setup frame raises ETI instead of TI. */
879 if (status & (OWL_EMAC_BIT_MAC_CSR5_TI | OWL_EMAC_BIT_MAC_CSR5_ETI)) {
880 owl_emac_tx_complete(priv);
883 /* Count MAC internal RX errors. */
884 proc_status = status & OWL_EMAC_MSK_MAC_CSR5_RS;
885 proc_status >>= OWL_EMAC_OFF_MAC_CSR5_RS;
886 if (proc_status == OWL_EMAC_VAL_MAC_CSR5_RS_DATA ||
887 proc_status == OWL_EMAC_VAL_MAC_CSR5_RS_CDES ||
888 proc_status == OWL_EMAC_VAL_MAC_CSR5_RS_FDES)
892 if (status & OWL_EMAC_BIT_MAC_CSR5_RI) {
893 recv = owl_emac_rx_process(priv, budget - work_done);
896 /* Count MAC internal TX errors. */
897 proc_status = status & OWL_EMAC_MSK_MAC_CSR5_TS;
898 proc_status >>= OWL_EMAC_OFF_MAC_CSR5_TS;
899 if (proc_status == OWL_EMAC_VAL_MAC_CSR5_TS_DATA ||
900 proc_status == OWL_EMAC_VAL_MAC_CSR5_TS_CDES)
902 } else if (status & OWL_EMAC_BIT_MAC_CSR5_RU) {
903 /* MAC AHB is in suspended state, will return to RX
904 * descriptor processing when the host changes ownership
905 * of the descriptor and either an RX poll demand CMD is
906 * issued or a new frame is recognized by the MAC AHB.
909 owl_emac_dma_cmd_resume_rx(priv);
911 recv = owl_emac_rx_process(priv, budget - work_done);
913 /* Guard against too many RU interrupts. */
919 if (work_done >= budget)
923 if (work_done < budget) {
924 napi_complete_done(napi, work_done);
925 owl_emac_irq_enable(priv);
928 /* Reset MAC when getting too many internal TX or RX errors. */
929 if (tx_err_cnt > 10 || rx_err_cnt > 10) {
930 netdev_dbg(priv->netdev, "%s error status: 0x%08x\n",
931 tx_err_cnt > 10 ? "TX" : "RX", status);
934 schedule_work(&priv->mac_reset_task);
940 static void owl_emac_mdio_clock_enable(struct owl_emac_priv *priv)
944 /* Enable MDC clock generation by adjusting CLKDIV according to
945 * the vendor implementation of the original driver.
947 val = owl_emac_reg_read(priv, OWL_EMAC_REG_MAC_CSR10);
948 val &= OWL_EMAC_MSK_MAC_CSR10_CLKDIV;
949 val |= OWL_EMAC_VAL_MAC_CSR10_CLKDIV_128 << OWL_EMAC_OFF_MAC_CSR10_CLKDIV;
951 val |= OWL_EMAC_BIT_MAC_CSR10_SB;
952 val |= OWL_EMAC_VAL_MAC_CSR10_OPCODE_CDS << OWL_EMAC_OFF_MAC_CSR10_OPCODE;
953 owl_emac_reg_write(priv, OWL_EMAC_REG_MAC_CSR10, val);
956 static void owl_emac_core_hw_reset(struct owl_emac_priv *priv)
958 /* Trigger hardware reset. */
959 reset_control_assert(priv->reset);
960 usleep_range(10, 20);
961 reset_control_deassert(priv->reset);
962 usleep_range(100, 200);
965 static int owl_emac_core_sw_reset(struct owl_emac_priv *priv)
970 /* Trigger software reset. */
971 owl_emac_reg_set(priv, OWL_EMAC_REG_MAC_CSR0, OWL_EMAC_BIT_MAC_CSR0_SWR);
972 ret = readl_poll_timeout(priv->base + OWL_EMAC_REG_MAC_CSR0,
973 val, !(val & OWL_EMAC_BIT_MAC_CSR0_SWR),
974 OWL_EMAC_POLL_DELAY_USEC,
975 OWL_EMAC_RESET_POLL_TIMEOUT_USEC);
979 if (priv->phy_mode == PHY_INTERFACE_MODE_RMII) {
980 /* Enable RMII and use the 50MHz rmii clk as output to PHY. */
983 /* Enable SMII and use the 125MHz rmii clk as output to PHY.
984 * Additionally set SMII SYNC delay to 4 half cycle.
986 val = 0x04 << OWL_EMAC_OFF_MAC_CTRL_SSDC;
987 val |= OWL_EMAC_BIT_MAC_CTRL_RSIS;
989 owl_emac_reg_write(priv, OWL_EMAC_REG_MAC_CTRL, val);
991 /* MDC is disabled after reset. */
992 owl_emac_mdio_clock_enable(priv);
994 /* Set FIFO pause & restart threshold levels. */
995 val = 0x40 << OWL_EMAC_OFF_MAC_CSR19_FPTL;
996 val |= 0x10 << OWL_EMAC_OFF_MAC_CSR19_FRTL;
997 owl_emac_reg_write(priv, OWL_EMAC_REG_MAC_CSR19, val);
999 /* Set flow control pause quanta time to ~100 ms. */
1000 val = 0x4FFF << OWL_EMAC_OFF_MAC_CSR18_PQT;
1001 owl_emac_reg_write(priv, OWL_EMAC_REG_MAC_CSR18, val);
1003 /* Setup interrupt mitigation. */
1004 val = 7 << OWL_EMAC_OFF_MAC_CSR11_NRP;
1005 val |= 4 << OWL_EMAC_OFF_MAC_CSR11_RT;
1006 owl_emac_reg_write(priv, OWL_EMAC_REG_MAC_CSR11, val);
1008 /* Set RX/TX rings base addresses. */
1009 owl_emac_reg_write(priv, OWL_EMAC_REG_MAC_CSR3,
1010 (u32)(priv->rx_ring.descs_dma));
1011 owl_emac_reg_write(priv, OWL_EMAC_REG_MAC_CSR4,
1012 (u32)(priv->tx_ring.descs_dma));
1014 /* Setup initial operation mode. */
1015 val = OWL_EMAC_VAL_MAC_CSR6_SPEED_100M << OWL_EMAC_OFF_MAC_CSR6_SPEED;
1016 val |= OWL_EMAC_BIT_MAC_CSR6_FD;
1017 owl_emac_reg_update(priv, OWL_EMAC_REG_MAC_CSR6,
1018 OWL_EMAC_MSK_MAC_CSR6_SPEED |
1019 OWL_EMAC_BIT_MAC_CSR6_FD, val);
1020 owl_emac_reg_clear(priv, OWL_EMAC_REG_MAC_CSR6,
1021 OWL_EMAC_BIT_MAC_CSR6_PR | OWL_EMAC_BIT_MAC_CSR6_PM);
1024 priv->speed = SPEED_UNKNOWN;
1025 priv->duplex = DUPLEX_UNKNOWN;
1027 priv->mcaddr_list.count = 0;
1032 static int owl_emac_enable(struct net_device *netdev, bool start_phy)
1034 struct owl_emac_priv *priv = netdev_priv(netdev);
1037 owl_emac_dma_cmd_stop(priv);
1038 owl_emac_irq_disable(priv);
1039 owl_emac_irq_clear(priv);
1041 owl_emac_ring_prepare_tx(priv);
1042 ret = owl_emac_ring_prepare_rx(priv);
1046 ret = owl_emac_core_sw_reset(priv);
1048 netdev_err(netdev, "failed to soft reset MAC core: %d\n", ret);
1052 owl_emac_set_hw_mac_addr(netdev);
1053 owl_emac_setup_frame_xmit(priv);
1055 netdev_reset_queue(netdev);
1056 napi_enable(&priv->napi);
1058 owl_emac_irq_enable(priv);
1059 owl_emac_dma_cmd_start(priv);
1062 phy_start(netdev->phydev);
1064 netif_start_queue(netdev);
1069 owl_emac_ring_unprepare_rx(priv);
1070 owl_emac_ring_unprepare_tx(priv);
1075 static void owl_emac_disable(struct net_device *netdev, bool stop_phy)
1077 struct owl_emac_priv *priv = netdev_priv(netdev);
1079 owl_emac_dma_cmd_stop(priv);
1080 owl_emac_irq_disable(priv);
1082 netif_stop_queue(netdev);
1083 napi_disable(&priv->napi);
1086 phy_stop(netdev->phydev);
1088 owl_emac_ring_unprepare_rx(priv);
1089 owl_emac_ring_unprepare_tx(priv);
1092 static int owl_emac_ndo_open(struct net_device *netdev)
1094 return owl_emac_enable(netdev, true);
1097 static int owl_emac_ndo_stop(struct net_device *netdev)
1099 owl_emac_disable(netdev, true);
1104 static void owl_emac_set_multicast(struct net_device *netdev, int count)
1106 struct owl_emac_priv *priv = netdev_priv(netdev);
1107 struct netdev_hw_addr *ha;
1111 priv->mcaddr_list.count = 0;
1115 netdev_for_each_mc_addr(ha, netdev) {
1116 if (!is_multicast_ether_addr(ha->addr))
1119 WARN_ON(index >= OWL_EMAC_MAX_MULTICAST_ADDRS);
1120 ether_addr_copy(priv->mcaddr_list.addrs[index++], ha->addr);
1123 priv->mcaddr_list.count = index;
1125 owl_emac_setup_frame_xmit(priv);
1128 static void owl_emac_ndo_set_rx_mode(struct net_device *netdev)
1130 struct owl_emac_priv *priv = netdev_priv(netdev);
1131 u32 status, val = 0;
1132 int mcast_count = 0;
1134 if (netdev->flags & IFF_PROMISC) {
1135 val = OWL_EMAC_BIT_MAC_CSR6_PR;
1136 } else if (netdev->flags & IFF_ALLMULTI) {
1137 val = OWL_EMAC_BIT_MAC_CSR6_PM;
1138 } else if (netdev->flags & IFF_MULTICAST) {
1139 mcast_count = netdev_mc_count(netdev);
1141 if (mcast_count > OWL_EMAC_MAX_MULTICAST_ADDRS) {
1142 val = OWL_EMAC_BIT_MAC_CSR6_PM;
1147 spin_lock_bh(&priv->lock);
1149 /* Temporarily stop DMA TX & RX. */
1150 status = owl_emac_dma_cmd_stop(priv);
1152 /* Update operation modes. */
1153 owl_emac_reg_update(priv, OWL_EMAC_REG_MAC_CSR6,
1154 OWL_EMAC_BIT_MAC_CSR6_PR | OWL_EMAC_BIT_MAC_CSR6_PM,
1157 /* Restore DMA TX & RX status. */
1158 owl_emac_dma_cmd_set(priv, status);
1160 spin_unlock_bh(&priv->lock);
1162 /* Set/reset multicast addr list. */
1163 owl_emac_set_multicast(netdev, mcast_count);
1166 static int owl_emac_ndo_set_mac_addr(struct net_device *netdev, void *addr)
1168 struct sockaddr *skaddr = addr;
1170 if (!is_valid_ether_addr(skaddr->sa_data))
1171 return -EADDRNOTAVAIL;
1173 if (netif_running(netdev))
1176 eth_hw_addr_set(netdev, skaddr->sa_data);
1177 owl_emac_set_hw_mac_addr(netdev);
1179 return owl_emac_setup_frame_xmit(netdev_priv(netdev));
1182 static int owl_emac_ndo_eth_ioctl(struct net_device *netdev,
1183 struct ifreq *req, int cmd)
1185 if (!netif_running(netdev))
1188 return phy_mii_ioctl(netdev->phydev, req, cmd);
1191 static void owl_emac_ndo_tx_timeout(struct net_device *netdev,
1192 unsigned int txqueue)
1194 struct owl_emac_priv *priv = netdev_priv(netdev);
1196 schedule_work(&priv->mac_reset_task);
1199 static void owl_emac_reset_task(struct work_struct *work)
1201 struct owl_emac_priv *priv;
1203 priv = container_of(work, struct owl_emac_priv, mac_reset_task);
1205 netdev_dbg(priv->netdev, "resetting MAC\n");
1206 owl_emac_disable(priv->netdev, false);
1207 owl_emac_enable(priv->netdev, false);
1210 static struct net_device_stats *
1211 owl_emac_ndo_get_stats(struct net_device *netdev)
1213 /* FIXME: If possible, try to get stats from MAC hardware registers
1214 * instead of tracking them manually in the driver.
1217 return &netdev->stats;
1220 static const struct net_device_ops owl_emac_netdev_ops = {
1221 .ndo_open = owl_emac_ndo_open,
1222 .ndo_stop = owl_emac_ndo_stop,
1223 .ndo_start_xmit = owl_emac_ndo_start_xmit,
1224 .ndo_set_rx_mode = owl_emac_ndo_set_rx_mode,
1225 .ndo_set_mac_address = owl_emac_ndo_set_mac_addr,
1226 .ndo_validate_addr = eth_validate_addr,
1227 .ndo_eth_ioctl = owl_emac_ndo_eth_ioctl,
1228 .ndo_tx_timeout = owl_emac_ndo_tx_timeout,
1229 .ndo_get_stats = owl_emac_ndo_get_stats,
1232 static void owl_emac_ethtool_get_drvinfo(struct net_device *dev,
1233 struct ethtool_drvinfo *info)
1235 strscpy(info->driver, OWL_EMAC_DRVNAME, sizeof(info->driver));
1238 static u32 owl_emac_ethtool_get_msglevel(struct net_device *netdev)
1240 struct owl_emac_priv *priv = netdev_priv(netdev);
1242 return priv->msg_enable;
1245 static void owl_emac_ethtool_set_msglevel(struct net_device *ndev, u32 val)
1247 struct owl_emac_priv *priv = netdev_priv(ndev);
1249 priv->msg_enable = val;
1252 static const struct ethtool_ops owl_emac_ethtool_ops = {
1253 .get_drvinfo = owl_emac_ethtool_get_drvinfo,
1254 .get_link = ethtool_op_get_link,
1255 .get_link_ksettings = phy_ethtool_get_link_ksettings,
1256 .set_link_ksettings = phy_ethtool_set_link_ksettings,
1257 .get_msglevel = owl_emac_ethtool_get_msglevel,
1258 .set_msglevel = owl_emac_ethtool_set_msglevel,
1261 static int owl_emac_mdio_wait(struct owl_emac_priv *priv)
1265 /* Wait while data transfer is in progress. */
1266 return readl_poll_timeout(priv->base + OWL_EMAC_REG_MAC_CSR10,
1267 val, !(val & OWL_EMAC_BIT_MAC_CSR10_SB),
1268 OWL_EMAC_POLL_DELAY_USEC,
1269 OWL_EMAC_MDIO_POLL_TIMEOUT_USEC);
1272 static int owl_emac_mdio_read(struct mii_bus *bus, int addr, int regnum)
1274 struct owl_emac_priv *priv = bus->priv;
1278 if (regnum & MII_ADDR_C45)
1281 data = OWL_EMAC_BIT_MAC_CSR10_SB;
1282 data |= OWL_EMAC_VAL_MAC_CSR10_OPCODE_RD << OWL_EMAC_OFF_MAC_CSR10_OPCODE;
1284 tmp = addr << OWL_EMAC_OFF_MAC_CSR10_PHYADD;
1285 data |= tmp & OWL_EMAC_MSK_MAC_CSR10_PHYADD;
1287 tmp = regnum << OWL_EMAC_OFF_MAC_CSR10_REGADD;
1288 data |= tmp & OWL_EMAC_MSK_MAC_CSR10_REGADD;
1290 owl_emac_reg_write(priv, OWL_EMAC_REG_MAC_CSR10, data);
1292 ret = owl_emac_mdio_wait(priv);
1296 data = owl_emac_reg_read(priv, OWL_EMAC_REG_MAC_CSR10);
1297 data &= OWL_EMAC_MSK_MAC_CSR10_DATA;
1303 owl_emac_mdio_write(struct mii_bus *bus, int addr, int regnum, u16 val)
1305 struct owl_emac_priv *priv = bus->priv;
1308 if (regnum & MII_ADDR_C45)
1311 data = OWL_EMAC_BIT_MAC_CSR10_SB;
1312 data |= OWL_EMAC_VAL_MAC_CSR10_OPCODE_WR << OWL_EMAC_OFF_MAC_CSR10_OPCODE;
1314 tmp = addr << OWL_EMAC_OFF_MAC_CSR10_PHYADD;
1315 data |= tmp & OWL_EMAC_MSK_MAC_CSR10_PHYADD;
1317 tmp = regnum << OWL_EMAC_OFF_MAC_CSR10_REGADD;
1318 data |= tmp & OWL_EMAC_MSK_MAC_CSR10_REGADD;
1320 data |= val & OWL_EMAC_MSK_MAC_CSR10_DATA;
1322 owl_emac_reg_write(priv, OWL_EMAC_REG_MAC_CSR10, data);
1324 return owl_emac_mdio_wait(priv);
1327 static int owl_emac_mdio_init(struct net_device *netdev)
1329 struct owl_emac_priv *priv = netdev_priv(netdev);
1330 struct device *dev = owl_emac_get_dev(priv);
1331 struct device_node *mdio_node;
1334 mdio_node = of_get_child_by_name(dev->of_node, "mdio");
1338 if (!of_device_is_available(mdio_node)) {
1343 priv->mii = devm_mdiobus_alloc(dev);
1349 snprintf(priv->mii->id, MII_BUS_ID_SIZE, "%s", dev_name(dev));
1350 priv->mii->name = "owl-emac-mdio";
1351 priv->mii->parent = dev;
1352 priv->mii->read = owl_emac_mdio_read;
1353 priv->mii->write = owl_emac_mdio_write;
1354 priv->mii->phy_mask = ~0; /* Mask out all PHYs from auto probing. */
1355 priv->mii->priv = priv;
1357 ret = devm_of_mdiobus_register(dev, priv->mii, mdio_node);
1360 of_node_put(mdio_node);
1364 static int owl_emac_phy_init(struct net_device *netdev)
1366 struct owl_emac_priv *priv = netdev_priv(netdev);
1367 struct device *dev = owl_emac_get_dev(priv);
1368 struct phy_device *phy;
1370 phy = of_phy_get_and_connect(netdev, dev->of_node,
1371 owl_emac_adjust_link);
1375 phy_set_sym_pause(phy, true, true, true);
1377 if (netif_msg_link(priv))
1378 phy_attached_info(phy);
1383 static void owl_emac_get_mac_addr(struct net_device *netdev)
1385 struct device *dev = netdev->dev.parent;
1388 ret = platform_get_ethdev_address(dev, netdev);
1389 if (!ret && is_valid_ether_addr(netdev->dev_addr))
1392 eth_hw_addr_random(netdev);
1393 dev_warn(dev, "using random MAC address %pM\n", netdev->dev_addr);
1396 static __maybe_unused int owl_emac_suspend(struct device *dev)
1398 struct net_device *netdev = dev_get_drvdata(dev);
1399 struct owl_emac_priv *priv = netdev_priv(netdev);
1401 disable_irq(netdev->irq);
1403 if (netif_running(netdev)) {
1404 owl_emac_disable(netdev, true);
1405 netif_device_detach(netdev);
1408 clk_bulk_disable_unprepare(OWL_EMAC_NCLKS, priv->clks);
1413 static __maybe_unused int owl_emac_resume(struct device *dev)
1415 struct net_device *netdev = dev_get_drvdata(dev);
1416 struct owl_emac_priv *priv = netdev_priv(netdev);
1419 ret = clk_bulk_prepare_enable(OWL_EMAC_NCLKS, priv->clks);
1423 if (netif_running(netdev)) {
1424 owl_emac_core_hw_reset(priv);
1425 owl_emac_core_sw_reset(priv);
1427 ret = owl_emac_enable(netdev, true);
1429 clk_bulk_disable_unprepare(OWL_EMAC_NCLKS, priv->clks);
1433 netif_device_attach(netdev);
1436 enable_irq(netdev->irq);
1441 static void owl_emac_clk_disable_unprepare(void *data)
1443 struct owl_emac_priv *priv = data;
1445 clk_bulk_disable_unprepare(OWL_EMAC_NCLKS, priv->clks);
1448 static int owl_emac_clk_set_rate(struct owl_emac_priv *priv)
1450 struct device *dev = owl_emac_get_dev(priv);
1454 switch (priv->phy_mode) {
1455 case PHY_INTERFACE_MODE_RMII:
1459 case PHY_INTERFACE_MODE_SMII:
1464 dev_err(dev, "unsupported phy interface mode %d\n",
1469 ret = clk_set_rate(priv->clks[OWL_EMAC_CLK_RMII].clk, rate);
1471 dev_err(dev, "failed to set RMII clock rate: %d\n", ret);
1476 static int owl_emac_probe(struct platform_device *pdev)
1478 struct device *dev = &pdev->dev;
1479 struct net_device *netdev;
1480 struct owl_emac_priv *priv;
1483 netdev = devm_alloc_etherdev(dev, sizeof(*priv));
1487 platform_set_drvdata(pdev, netdev);
1488 SET_NETDEV_DEV(netdev, dev);
1490 priv = netdev_priv(netdev);
1491 priv->netdev = netdev;
1492 priv->msg_enable = netif_msg_init(-1, OWL_EMAC_DEFAULT_MSG_ENABLE);
1494 ret = of_get_phy_mode(dev->of_node, &priv->phy_mode);
1496 dev_err(dev, "failed to get phy mode: %d\n", ret);
1500 spin_lock_init(&priv->lock);
1502 ret = dma_set_mask_and_coherent(dev, DMA_BIT_MASK(32));
1504 dev_err(dev, "unsupported DMA mask\n");
1508 ret = owl_emac_ring_alloc(dev, &priv->rx_ring, OWL_EMAC_RX_RING_SIZE);
1512 ret = owl_emac_ring_alloc(dev, &priv->tx_ring, OWL_EMAC_TX_RING_SIZE);
1516 priv->base = devm_platform_ioremap_resource(pdev, 0);
1517 if (IS_ERR(priv->base))
1518 return PTR_ERR(priv->base);
1520 netdev->irq = platform_get_irq(pdev, 0);
1521 if (netdev->irq < 0)
1524 ret = devm_request_irq(dev, netdev->irq, owl_emac_handle_irq,
1525 IRQF_SHARED, netdev->name, netdev);
1527 dev_err(dev, "failed to request irq: %d\n", netdev->irq);
1531 for (i = 0; i < OWL_EMAC_NCLKS; i++)
1532 priv->clks[i].id = owl_emac_clk_names[i];
1534 ret = devm_clk_bulk_get(dev, OWL_EMAC_NCLKS, priv->clks);
1538 ret = clk_bulk_prepare_enable(OWL_EMAC_NCLKS, priv->clks);
1542 ret = devm_add_action_or_reset(dev, owl_emac_clk_disable_unprepare, priv);
1546 ret = owl_emac_clk_set_rate(priv);
1550 priv->reset = devm_reset_control_get_exclusive(dev, NULL);
1551 if (IS_ERR(priv->reset))
1552 return dev_err_probe(dev, PTR_ERR(priv->reset),
1553 "failed to get reset control");
1555 owl_emac_get_mac_addr(netdev);
1557 owl_emac_core_hw_reset(priv);
1558 owl_emac_mdio_clock_enable(priv);
1560 ret = owl_emac_mdio_init(netdev);
1562 dev_err(dev, "failed to initialize MDIO bus\n");
1566 ret = owl_emac_phy_init(netdev);
1568 dev_err(dev, "failed to initialize PHY\n");
1572 INIT_WORK(&priv->mac_reset_task, owl_emac_reset_task);
1574 netdev->min_mtu = OWL_EMAC_MTU_MIN;
1575 netdev->max_mtu = OWL_EMAC_MTU_MAX;
1576 netdev->watchdog_timeo = OWL_EMAC_TX_TIMEOUT;
1577 netdev->netdev_ops = &owl_emac_netdev_ops;
1578 netdev->ethtool_ops = &owl_emac_ethtool_ops;
1579 netif_napi_add(netdev, &priv->napi, owl_emac_poll, NAPI_POLL_WEIGHT);
1581 ret = devm_register_netdev(dev, netdev);
1583 netif_napi_del(&priv->napi);
1584 phy_disconnect(netdev->phydev);
1591 static int owl_emac_remove(struct platform_device *pdev)
1593 struct owl_emac_priv *priv = platform_get_drvdata(pdev);
1595 netif_napi_del(&priv->napi);
1596 phy_disconnect(priv->netdev->phydev);
1597 cancel_work_sync(&priv->mac_reset_task);
1602 static const struct of_device_id owl_emac_of_match[] = {
1603 { .compatible = "actions,owl-emac", },
1606 MODULE_DEVICE_TABLE(of, owl_emac_of_match);
1608 static SIMPLE_DEV_PM_OPS(owl_emac_pm_ops,
1609 owl_emac_suspend, owl_emac_resume);
1611 static struct platform_driver owl_emac_driver = {
1613 .name = OWL_EMAC_DRVNAME,
1614 .of_match_table = owl_emac_of_match,
1615 .pm = &owl_emac_pm_ops,
1617 .probe = owl_emac_probe,
1618 .remove = owl_emac_remove,
1620 module_platform_driver(owl_emac_driver);
1622 MODULE_DESCRIPTION("Actions Semi Owl SoCs Ethernet MAC Driver");
1623 MODULE_AUTHOR("Actions Semi Inc.");
1624 MODULE_AUTHOR("Cristian Ciocaltea <cristian.ciocaltea@gmail.com>");
1625 MODULE_LICENSE("GPL");