Lines Matching full:ndev
53 void ravb_modify(struct net_device *ndev, enum ravb_reg reg, u32 clear, in ravb_modify() argument
56 ravb_write(ndev, (ravb_read(ndev, reg) & ~clear) | set, reg); in ravb_modify()
59 int ravb_wait(struct net_device *ndev, enum ravb_reg reg, u32 mask, u32 value) in ravb_wait() argument
64 if ((ravb_read(ndev, reg) & mask) == value) in ravb_wait()
71 static int ravb_config(struct net_device *ndev) in ravb_config() argument
76 ravb_modify(ndev, CCC, CCC_OPC, CCC_OPC_CONFIG); in ravb_config()
78 error = ravb_wait(ndev, CSR, CSR_OPS, CSR_OPS_CONFIG); in ravb_config()
80 netdev_err(ndev, "failed to switch device to config mode\n"); in ravb_config()
85 static void ravb_set_rate(struct net_device *ndev) in ravb_set_rate() argument
87 struct ravb_private *priv = netdev_priv(ndev); in ravb_set_rate()
91 ravb_write(ndev, GECMR_SPEED_100, GECMR); in ravb_set_rate()
94 ravb_write(ndev, GECMR_SPEED_1000, GECMR); in ravb_set_rate()
112 static void ravb_read_mac_address(struct net_device *ndev, const u8 *mac) in ravb_read_mac_address() argument
115 ether_addr_copy(ndev->dev_addr, mac); in ravb_read_mac_address()
117 u32 mahr = ravb_read(ndev, MAHR); in ravb_read_mac_address()
118 u32 malr = ravb_read(ndev, MALR); in ravb_read_mac_address()
120 ndev->dev_addr[0] = (mahr >> 24) & 0xFF; in ravb_read_mac_address()
121 ndev->dev_addr[1] = (mahr >> 16) & 0xFF; in ravb_read_mac_address()
122 ndev->dev_addr[2] = (mahr >> 8) & 0xFF; in ravb_read_mac_address()
123 ndev->dev_addr[3] = (mahr >> 0) & 0xFF; in ravb_read_mac_address()
124 ndev->dev_addr[4] = (malr >> 8) & 0xFF; in ravb_read_mac_address()
125 ndev->dev_addr[5] = (malr >> 0) & 0xFF; in ravb_read_mac_address()
134 ravb_modify(priv->ndev, PIR, mask, set ? mask : 0); in ravb_mdio_ctrl()
161 return (ravb_read(priv->ndev, PIR) & PIR_MDI) != 0; in ravb_get_mdio_data()
174 static int ravb_tx_free(struct net_device *ndev, int q, bool free_txed_only) in ravb_tx_free() argument
176 struct ravb_private *priv = netdev_priv(ndev); in ravb_tx_free()
198 dma_unmap_single(ndev->dev.parent, le32_to_cpu(desc->dptr), in ravb_tx_free()
218 static void ravb_ring_free(struct net_device *ndev, int q) in ravb_ring_free() argument
220 struct ravb_private *priv = netdev_priv(ndev); in ravb_ring_free()
229 if (!dma_mapping_error(ndev->dev.parent, in ravb_ring_free()
231 dma_unmap_single(ndev->dev.parent, in ravb_ring_free()
238 dma_free_coherent(ndev->dev.parent, ring_size, priv->rx_ring[q], in ravb_ring_free()
244 ravb_tx_free(ndev, q, false); in ravb_ring_free()
248 dma_free_coherent(ndev->dev.parent, ring_size, priv->tx_ring[q], in ravb_ring_free()
273 static void ravb_ring_format(struct net_device *ndev, int q) in ravb_ring_format() argument
275 struct ravb_private *priv = netdev_priv(ndev); in ravb_ring_format()
297 dma_addr = dma_map_single(ndev->dev.parent, priv->rx_skb[q][i]->data, in ravb_ring_format()
303 if (dma_mapping_error(ndev->dev.parent, dma_addr)) in ravb_ring_format()
337 static int ravb_ring_init(struct net_device *ndev, int q) in ravb_ring_init() argument
339 struct ravb_private *priv = netdev_priv(ndev); in ravb_ring_init()
354 skb = netdev_alloc_skb(ndev, RX_BUF_SZ + RAVB_ALIGN - 1); in ravb_ring_init()
371 priv->rx_ring[q] = dma_alloc_coherent(ndev->dev.parent, ring_size, in ravb_ring_init()
382 priv->tx_ring[q] = dma_alloc_coherent(ndev->dev.parent, ring_size, in ravb_ring_init()
391 ravb_ring_free(ndev, q); in ravb_ring_init()
397 static void ravb_emac_init(struct net_device *ndev) in ravb_emac_init() argument
400 ravb_write(ndev, ndev->mtu + ETH_HLEN + VLAN_HLEN + ETH_FCS_LEN, RFLR); in ravb_emac_init()
403 ravb_write(ndev, ECMR_ZPF | ECMR_DM | in ravb_emac_init()
404 (ndev->features & NETIF_F_RXCSUM ? ECMR_RCSC : 0) | in ravb_emac_init()
407 ravb_set_rate(ndev); in ravb_emac_init()
410 ravb_write(ndev, in ravb_emac_init()
411 (ndev->dev_addr[0] << 24) | (ndev->dev_addr[1] << 16) | in ravb_emac_init()
412 (ndev->dev_addr[2] << 8) | (ndev->dev_addr[3]), MAHR); in ravb_emac_init()
413 ravb_write(ndev, in ravb_emac_init()
414 (ndev->dev_addr[4] << 8) | (ndev->dev_addr[5]), MALR); in ravb_emac_init()
417 ravb_write(ndev, ECSR_ICD | ECSR_MPD, ECSR); in ravb_emac_init()
420 ravb_write(ndev, ECSIPR_ICDIP | ECSIPR_MPDIP | ECSIPR_LCHNGIP, ECSIPR); in ravb_emac_init()
424 static int ravb_dmac_init(struct net_device *ndev) in ravb_dmac_init() argument
426 struct ravb_private *priv = netdev_priv(ndev); in ravb_dmac_init()
430 error = ravb_config(ndev); in ravb_dmac_init()
434 error = ravb_ring_init(ndev, RAVB_BE); in ravb_dmac_init()
437 error = ravb_ring_init(ndev, RAVB_NC); in ravb_dmac_init()
439 ravb_ring_free(ndev, RAVB_BE); in ravb_dmac_init()
444 ravb_ring_format(ndev, RAVB_BE); in ravb_dmac_init()
445 ravb_ring_format(ndev, RAVB_NC); in ravb_dmac_init()
448 ravb_write(ndev, in ravb_dmac_init()
452 ravb_write(ndev, TGC_TQP_AVBMODE1 | 0x00112200, TGC); in ravb_dmac_init()
455 ravb_write(ndev, TCCR_TFEN, TCCR); in ravb_dmac_init()
460 ravb_write(ndev, 0, DIL); in ravb_dmac_init()
462 ravb_write(ndev, CIE_CRIE | CIE_CTIE | CIE_CL0M, CIE); in ravb_dmac_init()
465 ravb_write(ndev, RIC0_FRE0 | RIC0_FRE1, RIC0); in ravb_dmac_init()
467 ravb_write(ndev, 0, RIC1); in ravb_dmac_init()
469 ravb_write(ndev, RIC2_QFE0 | RIC2_QFE1 | RIC2_RFFE, RIC2); in ravb_dmac_init()
471 ravb_write(ndev, TIC_FTE0 | TIC_FTE1 | TIC_TFUE, TIC); in ravb_dmac_init()
474 ravb_modify(ndev, CCC, CCC_OPC, CCC_OPC_OPERATION); in ravb_dmac_init()
479 static void ravb_get_tx_tstamp(struct net_device *ndev) in ravb_get_tx_tstamp() argument
481 struct ravb_private *priv = netdev_priv(ndev); in ravb_get_tx_tstamp()
490 count = (ravb_read(ndev, TSR) & TSR_TFFL) >> 8; in ravb_get_tx_tstamp()
492 tfa2 = ravb_read(ndev, TFA2); in ravb_get_tx_tstamp()
494 ts.tv_nsec = (u64)ravb_read(ndev, TFA0); in ravb_get_tx_tstamp()
496 ravb_read(ndev, TFA1); in ravb_get_tx_tstamp()
513 ravb_modify(ndev, TCCR, TCCR_TFR, TCCR_TFR); in ravb_get_tx_tstamp()
533 static bool ravb_rx(struct net_device *ndev, int *quota, int q) in ravb_rx() argument
535 struct ravb_private *priv = netdev_priv(ndev); in ravb_rx()
583 dma_unmap_single(ndev->dev.parent, le32_to_cpu(desc->dptr), in ravb_rx()
601 skb->protocol = eth_type_trans(skb, ndev); in ravb_rx()
602 if (ndev->features & NETIF_F_RXCSUM) in ravb_rx()
620 skb = netdev_alloc_skb(ndev, in ravb_rx()
626 dma_addr = dma_map_single(ndev->dev.parent, skb->data, in ravb_rx()
633 if (dma_mapping_error(ndev->dev.parent, dma_addr)) in ravb_rx()
648 static void ravb_rcv_snd_disable(struct net_device *ndev) in ravb_rcv_snd_disable() argument
651 ravb_modify(ndev, ECMR, ECMR_RE | ECMR_TE, 0); in ravb_rcv_snd_disable()
654 static void ravb_rcv_snd_enable(struct net_device *ndev) in ravb_rcv_snd_enable() argument
657 ravb_modify(ndev, ECMR, ECMR_RE | ECMR_TE, ECMR_RE | ECMR_TE); in ravb_rcv_snd_enable()
661 static int ravb_stop_dma(struct net_device *ndev) in ravb_stop_dma() argument
666 error = ravb_wait(ndev, TCCR, in ravb_stop_dma()
671 error = ravb_wait(ndev, CSR, CSR_TPO0 | CSR_TPO1 | CSR_TPO2 | CSR_TPO3, in ravb_stop_dma()
677 ravb_rcv_snd_disable(ndev); in ravb_stop_dma()
680 error = ravb_wait(ndev, CSR, CSR_RPO, 0); in ravb_stop_dma()
685 return ravb_config(ndev); in ravb_stop_dma()
689 static void ravb_emac_interrupt_unlocked(struct net_device *ndev) in ravb_emac_interrupt_unlocked() argument
691 struct ravb_private *priv = netdev_priv(ndev); in ravb_emac_interrupt_unlocked()
694 ecsr = ravb_read(ndev, ECSR); in ravb_emac_interrupt_unlocked()
695 ravb_write(ndev, ecsr, ECSR); /* clear interrupt */ in ravb_emac_interrupt_unlocked()
700 ndev->stats.tx_carrier_errors++; in ravb_emac_interrupt_unlocked()
705 psr = ravb_read(ndev, PSR); in ravb_emac_interrupt_unlocked()
710 ravb_rcv_snd_disable(ndev); in ravb_emac_interrupt_unlocked()
713 ravb_rcv_snd_enable(ndev); in ravb_emac_interrupt_unlocked()
720 struct net_device *ndev = dev_id; in ravb_emac_interrupt() local
721 struct ravb_private *priv = netdev_priv(ndev); in ravb_emac_interrupt()
724 ravb_emac_interrupt_unlocked(ndev); in ravb_emac_interrupt()
730 static void ravb_error_interrupt(struct net_device *ndev) in ravb_error_interrupt() argument
732 struct ravb_private *priv = netdev_priv(ndev); in ravb_error_interrupt()
735 eis = ravb_read(ndev, EIS); in ravb_error_interrupt()
736 ravb_write(ndev, ~(EIS_QFS | EIS_RESERVED), EIS); in ravb_error_interrupt()
738 ris2 = ravb_read(ndev, RIS2); in ravb_error_interrupt()
739 ravb_write(ndev, ~(RIS2_QFF0 | RIS2_QFF1 | RIS2_RFFF | RIS2_RESERVED), in ravb_error_interrupt()
756 static bool ravb_queue_interrupt(struct net_device *ndev, int q) in ravb_queue_interrupt() argument
758 struct ravb_private *priv = netdev_priv(ndev); in ravb_queue_interrupt()
759 u32 ris0 = ravb_read(ndev, RIS0); in ravb_queue_interrupt()
760 u32 ric0 = ravb_read(ndev, RIC0); in ravb_queue_interrupt()
761 u32 tis = ravb_read(ndev, TIS); in ravb_queue_interrupt()
762 u32 tic = ravb_read(ndev, TIC); in ravb_queue_interrupt()
768 ravb_write(ndev, ric0 & ~BIT(q), RIC0); in ravb_queue_interrupt()
769 ravb_write(ndev, tic & ~BIT(q), TIC); in ravb_queue_interrupt()
771 ravb_write(ndev, BIT(q), RID0); in ravb_queue_interrupt()
772 ravb_write(ndev, BIT(q), TID); in ravb_queue_interrupt()
776 netdev_warn(ndev, in ravb_queue_interrupt()
779 netdev_warn(ndev, in ravb_queue_interrupt()
788 static bool ravb_timestamp_interrupt(struct net_device *ndev) in ravb_timestamp_interrupt() argument
790 u32 tis = ravb_read(ndev, TIS); in ravb_timestamp_interrupt()
793 ravb_write(ndev, ~(TIS_TFUF | TIS_RESERVED), TIS); in ravb_timestamp_interrupt()
794 ravb_get_tx_tstamp(ndev); in ravb_timestamp_interrupt()
802 struct net_device *ndev = dev_id; in ravb_interrupt() local
803 struct ravb_private *priv = netdev_priv(ndev); in ravb_interrupt()
809 iss = ravb_read(ndev, ISS); in ravb_interrupt()
816 if (ravb_timestamp_interrupt(ndev)) in ravb_interrupt()
821 if (ravb_queue_interrupt(ndev, q)) in ravb_interrupt()
828 ravb_emac_interrupt_unlocked(ndev); in ravb_interrupt()
834 ravb_error_interrupt(ndev); in ravb_interrupt()
840 ravb_ptp_interrupt(ndev); in ravb_interrupt()
851 struct net_device *ndev = dev_id; in ravb_multi_interrupt() local
852 struct ravb_private *priv = netdev_priv(ndev); in ravb_multi_interrupt()
858 iss = ravb_read(ndev, ISS); in ravb_multi_interrupt()
861 if ((iss & ISS_TFUS) && ravb_timestamp_interrupt(ndev)) in ravb_multi_interrupt()
866 ravb_error_interrupt(ndev); in ravb_multi_interrupt()
872 ravb_ptp_interrupt(ndev); in ravb_multi_interrupt()
882 struct net_device *ndev = dev_id; in ravb_dma_interrupt() local
883 struct ravb_private *priv = netdev_priv(ndev); in ravb_dma_interrupt()
889 if (ravb_queue_interrupt(ndev, q)) in ravb_dma_interrupt()
908 struct net_device *ndev = napi->dev; in ravb_poll() local
909 struct ravb_private *priv = netdev_priv(ndev); in ravb_poll()
917 ravb_write(ndev, ~(mask | RIS0_RESERVED), RIS0); in ravb_poll()
918 if (ravb_rx(ndev, "a, q)) in ravb_poll()
924 ravb_write(ndev, ~(mask | TIS_RESERVED), TIS); in ravb_poll()
925 ravb_tx_free(ndev, q, true); in ravb_poll()
926 netif_wake_subqueue(ndev, q); in ravb_poll()
934 ravb_modify(ndev, RIC0, mask, mask); in ravb_poll()
935 ravb_modify(ndev, TIC, mask, mask); in ravb_poll()
937 ravb_write(ndev, mask, RIE0); in ravb_poll()
938 ravb_write(ndev, mask, TIE); in ravb_poll()
945 if (priv->rx_over_errors != ndev->stats.rx_over_errors) in ravb_poll()
946 ndev->stats.rx_over_errors = priv->rx_over_errors; in ravb_poll()
947 if (priv->rx_fifo_errors != ndev->stats.rx_fifo_errors) in ravb_poll()
948 ndev->stats.rx_fifo_errors = priv->rx_fifo_errors; in ravb_poll()
954 static void ravb_adjust_link(struct net_device *ndev) in ravb_adjust_link() argument
956 struct ravb_private *priv = netdev_priv(ndev); in ravb_adjust_link()
957 struct phy_device *phydev = ndev->phydev; in ravb_adjust_link()
965 ravb_rcv_snd_disable(ndev); in ravb_adjust_link()
971 ravb_set_rate(ndev); in ravb_adjust_link()
974 ravb_modify(ndev, ECMR, ECMR_TXF, 0); in ravb_adjust_link()
986 ravb_rcv_snd_enable(ndev); in ravb_adjust_link()
1000 static int ravb_phy_init(struct net_device *ndev) in ravb_phy_init() argument
1002 struct device_node *np = ndev->dev.parent->of_node; in ravb_phy_init()
1003 struct ravb_private *priv = netdev_priv(ndev); in ravb_phy_init()
1028 phydev = of_phy_connect(ndev, pn, ravb_adjust_link, 0, iface); in ravb_phy_init()
1031 netdev_err(ndev, "failed to connect PHY\n"); in ravb_phy_init()
1042 netdev_err(ndev, "failed to limit PHY to 100Mbit/s\n"); in ravb_phy_init()
1046 netdev_info(ndev, "limited PHY to 100Mbit/s\n"); in ravb_phy_init()
1073 static int ravb_phy_start(struct net_device *ndev) in ravb_phy_start() argument
1077 error = ravb_phy_init(ndev); in ravb_phy_start()
1081 phy_start(ndev->phydev); in ravb_phy_start()
1086 static u32 ravb_get_msglevel(struct net_device *ndev) in ravb_get_msglevel() argument
1088 struct ravb_private *priv = netdev_priv(ndev); in ravb_get_msglevel()
1093 static void ravb_set_msglevel(struct net_device *ndev, u32 value) in ravb_set_msglevel() argument
1095 struct ravb_private *priv = netdev_priv(ndev); in ravb_set_msglevel()
1146 static void ravb_get_ethtool_stats(struct net_device *ndev, in ravb_get_ethtool_stats() argument
1149 struct ravb_private *priv = netdev_priv(ndev); in ravb_get_ethtool_stats()
1175 static void ravb_get_strings(struct net_device *ndev, u32 stringset, u8 *data) in ravb_get_strings() argument
1184 static void ravb_get_ringparam(struct net_device *ndev, in ravb_get_ringparam() argument
1187 struct ravb_private *priv = netdev_priv(ndev); in ravb_get_ringparam()
1195 static int ravb_set_ringparam(struct net_device *ndev, in ravb_set_ringparam() argument
1198 struct ravb_private *priv = netdev_priv(ndev); in ravb_set_ringparam()
1209 if (netif_running(ndev)) { in ravb_set_ringparam()
1210 netif_device_detach(ndev); in ravb_set_ringparam()
1213 ravb_ptp_stop(ndev); in ravb_set_ringparam()
1215 error = ravb_stop_dma(ndev); in ravb_set_ringparam()
1217 netdev_err(ndev, in ravb_set_ringparam()
1221 synchronize_irq(ndev->irq); in ravb_set_ringparam()
1224 ravb_ring_free(ndev, RAVB_BE); in ravb_set_ringparam()
1225 ravb_ring_free(ndev, RAVB_NC); in ravb_set_ringparam()
1232 if (netif_running(ndev)) { in ravb_set_ringparam()
1233 error = ravb_dmac_init(ndev); in ravb_set_ringparam()
1235 netdev_err(ndev, in ravb_set_ringparam()
1241 ravb_emac_init(ndev); in ravb_set_ringparam()
1245 ravb_ptp_init(ndev, priv->pdev); in ravb_set_ringparam()
1247 netif_device_attach(ndev); in ravb_set_ringparam()
1253 static int ravb_get_ts_info(struct net_device *ndev, in ravb_get_ts_info() argument
1256 struct ravb_private *priv = netdev_priv(ndev); in ravb_get_ts_info()
1275 static void ravb_get_wol(struct net_device *ndev, struct ethtool_wolinfo *wol) in ravb_get_wol() argument
1277 struct ravb_private *priv = netdev_priv(ndev); in ravb_get_wol()
1283 static int ravb_set_wol(struct net_device *ndev, struct ethtool_wolinfo *wol) in ravb_set_wol() argument
1285 struct ravb_private *priv = netdev_priv(ndev); in ravb_set_wol()
1315 struct net_device *ndev, struct device *dev, in ravb_hook_irq() argument
1321 name = devm_kasprintf(dev, GFP_KERNEL, "%s:%s", ndev->name, ch); in ravb_hook_irq()
1324 error = request_irq(irq, handler, 0, name, ndev); in ravb_hook_irq()
1326 netdev_err(ndev, "cannot request IRQ %s\n", name); in ravb_hook_irq()
1332 static int ravb_open(struct net_device *ndev) in ravb_open() argument
1334 struct ravb_private *priv = netdev_priv(ndev); in ravb_open()
1343 error = request_irq(ndev->irq, ravb_interrupt, IRQF_SHARED, in ravb_open()
1344 ndev->name, ndev); in ravb_open()
1346 netdev_err(ndev, "cannot request IRQ\n"); in ravb_open()
1350 error = ravb_hook_irq(ndev->irq, ravb_multi_interrupt, ndev, in ravb_open()
1354 error = ravb_hook_irq(priv->emac_irq, ravb_emac_interrupt, ndev, in ravb_open()
1359 ndev, dev, "ch0:rx_be"); in ravb_open()
1363 ndev, dev, "ch18:tx_be"); in ravb_open()
1367 ndev, dev, "ch1:rx_nc"); in ravb_open()
1371 ndev, dev, "ch19:tx_nc"); in ravb_open()
1377 error = ravb_dmac_init(ndev); in ravb_open()
1380 ravb_emac_init(ndev); in ravb_open()
1384 ravb_ptp_init(ndev, priv->pdev); in ravb_open()
1387 error = ravb_phy_start(ndev); in ravb_open()
1391 netif_tx_start_all_queues(ndev); in ravb_open()
1398 ravb_ptp_stop(ndev); in ravb_open()
1402 free_irq(priv->tx_irqs[RAVB_NC], ndev); in ravb_open()
1404 free_irq(priv->rx_irqs[RAVB_NC], ndev); in ravb_open()
1406 free_irq(priv->tx_irqs[RAVB_BE], ndev); in ravb_open()
1408 free_irq(priv->rx_irqs[RAVB_BE], ndev); in ravb_open()
1410 free_irq(priv->emac_irq, ndev); in ravb_open()
1412 free_irq(ndev->irq, ndev); in ravb_open()
1420 static void ravb_tx_timeout(struct net_device *ndev, unsigned int txqueue) in ravb_tx_timeout() argument
1422 struct ravb_private *priv = netdev_priv(ndev); in ravb_tx_timeout()
1424 netif_err(priv, tx_err, ndev, in ravb_tx_timeout()
1426 ravb_read(ndev, ISS)); in ravb_tx_timeout()
1429 ndev->stats.tx_errors++; in ravb_tx_timeout()
1438 struct net_device *ndev = priv->ndev; in ravb_tx_timeout_work() local
1447 netif_tx_stop_all_queues(ndev); in ravb_tx_timeout_work()
1451 ravb_ptp_stop(ndev); in ravb_tx_timeout_work()
1454 if (ravb_stop_dma(ndev)) { in ravb_tx_timeout_work()
1463 ravb_rcv_snd_enable(ndev); in ravb_tx_timeout_work()
1467 ravb_ring_free(ndev, RAVB_BE); in ravb_tx_timeout_work()
1468 ravb_ring_free(ndev, RAVB_NC); in ravb_tx_timeout_work()
1471 error = ravb_dmac_init(ndev); in ravb_tx_timeout_work()
1477 netdev_err(ndev, "%s: ravb_dmac_init() failed, error %d\n", in ravb_tx_timeout_work()
1481 ravb_emac_init(ndev); in ravb_tx_timeout_work()
1486 ravb_ptp_init(ndev, priv->pdev); in ravb_tx_timeout_work()
1488 netif_tx_start_all_queues(ndev); in ravb_tx_timeout_work()
1495 static netdev_tx_t ravb_start_xmit(struct sk_buff *skb, struct net_device *ndev) in ravb_start_xmit() argument
1497 struct ravb_private *priv = netdev_priv(ndev); in ravb_start_xmit()
1511 netif_err(priv, tx_queued, ndev, in ravb_start_xmit()
1513 netif_stop_subqueue(ndev, q); in ravb_start_xmit()
1545 dma_addr = dma_map_single(ndev->dev.parent, buffer, len, in ravb_start_xmit()
1547 if (dma_mapping_error(ndev->dev.parent, dma_addr)) in ravb_start_xmit()
1556 dma_addr = dma_map_single(ndev->dev.parent, buffer, len, in ravb_start_xmit()
1558 if (dma_mapping_error(ndev->dev.parent, dma_addr)) in ravb_start_xmit()
1565 dma_addr = dma_map_single(ndev->dev.parent, skb->data, skb->len, in ravb_start_xmit()
1567 if (dma_mapping_error(ndev->dev.parent, dma_addr)) in ravb_start_xmit()
1579 dma_unmap_single(ndev->dev.parent, dma_addr, in ravb_start_xmit()
1605 ravb_modify(ndev, TCCR, TCCR_TSRQ0 << q, TCCR_TSRQ0 << q); in ravb_start_xmit()
1610 !ravb_tx_free(ndev, q, true)) in ravb_start_xmit()
1611 netif_stop_subqueue(ndev, q); in ravb_start_xmit()
1618 dma_unmap_single(ndev->dev.parent, le32_to_cpu(desc->dptr), in ravb_start_xmit()
1626 static u16 ravb_select_queue(struct net_device *ndev, struct sk_buff *skb, in ravb_select_queue() argument
1635 static struct net_device_stats *ravb_get_stats(struct net_device *ndev) in ravb_get_stats() argument
1637 struct ravb_private *priv = netdev_priv(ndev); in ravb_get_stats()
1640 nstats = &ndev->stats; in ravb_get_stats()
1645 nstats->tx_dropped += ravb_read(ndev, TROCR); in ravb_get_stats()
1646 ravb_write(ndev, 0, TROCR); /* (write clear) */ in ravb_get_stats()
1669 static void ravb_set_rx_mode(struct net_device *ndev) in ravb_set_rx_mode() argument
1671 struct ravb_private *priv = netdev_priv(ndev); in ravb_set_rx_mode()
1675 ravb_modify(ndev, ECMR, ECMR_PRM, in ravb_set_rx_mode()
1676 ndev->flags & IFF_PROMISC ? ECMR_PRM : 0); in ravb_set_rx_mode()
1681 static int ravb_close(struct net_device *ndev) in ravb_close() argument
1683 struct device_node *np = ndev->dev.parent->of_node; in ravb_close()
1684 struct ravb_private *priv = netdev_priv(ndev); in ravb_close()
1687 netif_tx_stop_all_queues(ndev); in ravb_close()
1690 ravb_write(ndev, 0, RIC0); in ravb_close()
1691 ravb_write(ndev, 0, RIC2); in ravb_close()
1692 ravb_write(ndev, 0, TIC); in ravb_close()
1696 ravb_ptp_stop(ndev); in ravb_close()
1699 if (ravb_stop_dma(ndev) < 0) in ravb_close()
1700 netdev_err(ndev, in ravb_close()
1711 if (ndev->phydev) { in ravb_close()
1712 phy_stop(ndev->phydev); in ravb_close()
1713 phy_disconnect(ndev->phydev); in ravb_close()
1721 free_irq(priv->tx_irqs[RAVB_NC], ndev); in ravb_close()
1722 free_irq(priv->rx_irqs[RAVB_NC], ndev); in ravb_close()
1723 free_irq(priv->tx_irqs[RAVB_BE], ndev); in ravb_close()
1724 free_irq(priv->rx_irqs[RAVB_BE], ndev); in ravb_close()
1725 free_irq(priv->emac_irq, ndev); in ravb_close()
1727 free_irq(ndev->irq, ndev); in ravb_close()
1733 ravb_ring_free(ndev, RAVB_BE); in ravb_close()
1734 ravb_ring_free(ndev, RAVB_NC); in ravb_close()
1739 static int ravb_hwtstamp_get(struct net_device *ndev, struct ifreq *req) in ravb_hwtstamp_get() argument
1741 struct ravb_private *priv = netdev_priv(ndev); in ravb_hwtstamp_get()
1763 static int ravb_hwtstamp_set(struct net_device *ndev, struct ifreq *req) in ravb_hwtstamp_set() argument
1765 struct ravb_private *priv = netdev_priv(ndev); in ravb_hwtstamp_set()
1808 static int ravb_do_ioctl(struct net_device *ndev, struct ifreq *req, int cmd) in ravb_do_ioctl() argument
1810 struct phy_device *phydev = ndev->phydev; in ravb_do_ioctl()
1812 if (!netif_running(ndev)) in ravb_do_ioctl()
1820 return ravb_hwtstamp_get(ndev, req); in ravb_do_ioctl()
1822 return ravb_hwtstamp_set(ndev, req); in ravb_do_ioctl()
1828 static int ravb_change_mtu(struct net_device *ndev, int new_mtu) in ravb_change_mtu() argument
1830 struct ravb_private *priv = netdev_priv(ndev); in ravb_change_mtu()
1832 ndev->mtu = new_mtu; in ravb_change_mtu()
1834 if (netif_running(ndev)) { in ravb_change_mtu()
1836 ravb_emac_init(ndev); in ravb_change_mtu()
1839 netdev_update_features(ndev); in ravb_change_mtu()
1844 static void ravb_set_rx_csum(struct net_device *ndev, bool enable) in ravb_set_rx_csum() argument
1846 struct ravb_private *priv = netdev_priv(ndev); in ravb_set_rx_csum()
1852 ravb_rcv_snd_disable(ndev); in ravb_set_rx_csum()
1855 ravb_modify(ndev, ECMR, ECMR_RCSC, enable ? ECMR_RCSC : 0); in ravb_set_rx_csum()
1858 ravb_rcv_snd_enable(ndev); in ravb_set_rx_csum()
1863 static int ravb_set_features(struct net_device *ndev, in ravb_set_features() argument
1866 netdev_features_t changed = ndev->features ^ features; in ravb_set_features()
1869 ravb_set_rx_csum(ndev, features & NETIF_F_RXCSUM); in ravb_set_features()
1871 ndev->features = features; in ravb_set_features()
1946 static int ravb_set_gti(struct net_device *ndev) in ravb_set_gti() argument
1948 struct ravb_private *priv = netdev_priv(ndev); in ravb_set_gti()
1949 struct device *dev = ndev->dev.parent; in ravb_set_gti()
1966 ravb_write(ndev, inc, GTI); in ravb_set_gti()
1971 static void ravb_set_config_mode(struct net_device *ndev) in ravb_set_config_mode() argument
1973 struct ravb_private *priv = netdev_priv(ndev); in ravb_set_config_mode()
1976 ravb_modify(ndev, CCC, CCC_OPC, CCC_OPC_CONFIG); in ravb_set_config_mode()
1978 ravb_modify(ndev, CCC, CCC_CSEL, CCC_CSEL_HPB); in ravb_set_config_mode()
1980 ravb_modify(ndev, CCC, CCC_OPC, CCC_OPC_CONFIG | in ravb_set_config_mode()
1993 static void ravb_parse_delay_mode(struct device_node *np, struct net_device *ndev) in ravb_parse_delay_mode() argument
1995 struct ravb_private *priv = netdev_priv(ndev); in ravb_parse_delay_mode()
2031 static void ravb_set_delay_mode(struct net_device *ndev) in ravb_set_delay_mode() argument
2033 struct ravb_private *priv = netdev_priv(ndev); in ravb_set_delay_mode()
2040 ravb_modify(ndev, APSR, APSR_DM, set); in ravb_set_delay_mode()
2048 struct net_device *ndev; in ravb_probe() local
2066 ndev = alloc_etherdev_mqs(sizeof(struct ravb_private), in ravb_probe()
2068 if (!ndev) in ravb_probe()
2071 ndev->features = NETIF_F_RXCSUM; in ravb_probe()
2072 ndev->hw_features = NETIF_F_RXCSUM; in ravb_probe()
2080 ndev->base_addr = res->start; in ravb_probe()
2092 ndev->irq = irq; in ravb_probe()
2094 SET_NETDEV_DEV(ndev, &pdev->dev); in ravb_probe()
2096 priv = netdev_priv(ndev); in ravb_probe()
2097 priv->ndev = ndev; in ravb_probe()
2153 ndev->max_mtu = 2048 - (ETH_HLEN + VLAN_HLEN + ETH_FCS_LEN); in ravb_probe()
2154 ndev->min_mtu = ETH_MIN_MTU; in ravb_probe()
2160 ndev->netdev_ops = &ravb_netdev_ops; in ravb_probe()
2161 ndev->ethtool_ops = &ravb_ethtool_ops; in ravb_probe()
2164 ravb_set_config_mode(ndev); in ravb_probe()
2167 error = ravb_set_gti(ndev); in ravb_probe()
2172 ravb_modify(ndev, GCCR, GCCR_LTI, GCCR_LTI); in ravb_probe()
2175 ravb_parse_delay_mode(np, ndev); in ravb_probe()
2176 ravb_set_delay_mode(ndev); in ravb_probe()
2181 priv->desc_bat = dma_alloc_coherent(ndev->dev.parent, priv->desc_bat_size, in ravb_probe()
2192 ravb_write(ndev, priv->desc_bat_dma, DBAT); in ravb_probe()
2199 ravb_ptp_init(ndev, pdev); in ravb_probe()
2205 ravb_read_mac_address(ndev, of_get_mac_address(np)); in ravb_probe()
2206 if (!is_valid_ether_addr(ndev->dev_addr)) { in ravb_probe()
2209 eth_hw_addr_random(ndev); in ravb_probe()
2219 netif_napi_add(ndev, &priv->napi[RAVB_BE], ravb_poll, 64); in ravb_probe()
2220 netif_napi_add(ndev, &priv->napi[RAVB_NC], ravb_poll, 64); in ravb_probe()
2223 error = register_netdev(ndev); in ravb_probe()
2230 netdev_info(ndev, "Base address at %#x, %pM, IRQ %d.\n", in ravb_probe()
2231 (u32)ndev->base_addr, ndev->dev_addr, ndev->irq); in ravb_probe()
2233 platform_set_drvdata(pdev, ndev); in ravb_probe()
2242 dma_free_coherent(ndev->dev.parent, priv->desc_bat_size, priv->desc_bat, in ravb_probe()
2247 ravb_ptp_stop(ndev); in ravb_probe()
2249 free_netdev(ndev); in ravb_probe()
2259 struct net_device *ndev = platform_get_drvdata(pdev); in ravb_remove() local
2260 struct ravb_private *priv = netdev_priv(ndev); in ravb_remove()
2264 ravb_ptp_stop(ndev); in ravb_remove()
2267 ravb_write(ndev, CCC_OPC_RESET, CCC); in ravb_remove()
2268 unregister_netdev(ndev); in ravb_remove()
2272 dma_free_coherent(ndev->dev.parent, priv->desc_bat_size, priv->desc_bat, in ravb_remove()
2276 free_netdev(ndev); in ravb_remove()
2282 static int ravb_wol_setup(struct net_device *ndev) in ravb_wol_setup() argument
2284 struct ravb_private *priv = netdev_priv(ndev); in ravb_wol_setup()
2287 ravb_write(ndev, 0, RIC0); in ravb_wol_setup()
2288 ravb_write(ndev, 0, RIC2); in ravb_wol_setup()
2289 ravb_write(ndev, 0, TIC); in ravb_wol_setup()
2295 ravb_write(ndev, ECSIPR_MPDIP, ECSIPR); in ravb_wol_setup()
2298 ravb_modify(ndev, ECMR, ECMR_MPDE, ECMR_MPDE); in ravb_wol_setup()
2303 static int ravb_wol_restore(struct net_device *ndev) in ravb_wol_restore() argument
2305 struct ravb_private *priv = netdev_priv(ndev); in ravb_wol_restore()
2312 ravb_modify(ndev, ECMR, ECMR_MPDE, 0); in ravb_wol_restore()
2314 ret = ravb_close(ndev); in ravb_wol_restore()
2323 struct net_device *ndev = dev_get_drvdata(dev); in ravb_suspend() local
2324 struct ravb_private *priv = netdev_priv(ndev); in ravb_suspend()
2327 if (!netif_running(ndev)) in ravb_suspend()
2330 netif_device_detach(ndev); in ravb_suspend()
2333 ret = ravb_wol_setup(ndev); in ravb_suspend()
2335 ret = ravb_close(ndev); in ravb_suspend()
2342 struct net_device *ndev = dev_get_drvdata(dev); in ravb_resume() local
2343 struct ravb_private *priv = netdev_priv(ndev); in ravb_resume()
2348 ravb_write(ndev, CCC_OPC_RESET, CCC); in ravb_resume()
2356 ravb_set_config_mode(ndev); in ravb_resume()
2359 ret = ravb_set_gti(ndev); in ravb_resume()
2364 ravb_modify(ndev, GCCR, GCCR_LTI, GCCR_LTI); in ravb_resume()
2367 ravb_set_delay_mode(ndev); in ravb_resume()
2370 ravb_write(ndev, priv->desc_bat_dma, DBAT); in ravb_resume()
2372 if (netif_running(ndev)) { in ravb_resume()
2374 ret = ravb_wol_restore(ndev); in ravb_resume()
2378 ret = ravb_open(ndev); in ravb_resume()
2381 ravb_set_rx_mode(ndev); in ravb_resume()
2382 netif_device_attach(ndev); in ravb_resume()