Lines Matching +full:etheravb +full:- +full:r8a7795
1 // SPDX-License-Identifier: GPL-2.0
4 * Copyright (C) 2014-2019 Renesas Electronics Corporation
6 * Copyright (C) 2015-2016 Cogent Embedded, Inc. <source@cogentembedded.com>
14 #include <linux/dma-mapping.h>
66 return -ETIMEDOUT; in ravb_wait()
98 switch (priv->speed) { in ravb_set_rate_gbeth()
115 switch (priv->speed) { in ravb_set_rate_rcar()
127 u32 reserve = (unsigned long)skb->data & (RAVB_ALIGN - 1); in ravb_set_buffer_align()
130 skb_reserve(skb, RAVB_ALIGN - reserve); in ravb_set_buffer_align()
164 ravb_modify(priv->ndev, PIR, mask, set ? mask : 0); in ravb_mdio_ctrl()
191 return (ravb_read(priv->ndev, PIR) & PIR_MDI) != 0; in ravb_get_mdio_data()
203 /* Free TX skb function for AVB-IP */
207 struct net_device_stats *stats = &priv->stats[q]; in ravb_tx_free()
208 unsigned int num_tx_desc = priv->num_tx_desc; in ravb_tx_free()
214 for (; priv->cur_tx[q] - priv->dirty_tx[q] > 0; priv->dirty_tx[q]++) { in ravb_tx_free()
217 entry = priv->dirty_tx[q] % (priv->num_tx_ring[q] * in ravb_tx_free()
219 desc = &priv->tx_ring[q][entry]; in ravb_tx_free()
220 txed = desc->die_dt == DT_FEMPTY; in ravb_tx_free()
225 size = le16_to_cpu(desc->ds_tagl) & TX_DS; in ravb_tx_free()
227 if (priv->tx_skb[q][entry / num_tx_desc]) { in ravb_tx_free()
228 dma_unmap_single(ndev->dev.parent, le32_to_cpu(desc->dptr), in ravb_tx_free()
231 if (entry % num_tx_desc == num_tx_desc - 1) { in ravb_tx_free()
233 dev_kfree_skb_any(priv->tx_skb[q][entry]); in ravb_tx_free()
234 priv->tx_skb[q][entry] = NULL; in ravb_tx_free()
236 stats->tx_packets++; in ravb_tx_free()
241 stats->tx_bytes += size; in ravb_tx_free()
242 desc->die_dt = DT_EEMPTY; in ravb_tx_free()
253 if (!priv->gbeth_rx_ring) in ravb_rx_ring_free_gbeth()
256 for (i = 0; i < priv->num_rx_ring[q]; i++) { in ravb_rx_ring_free_gbeth()
257 struct ravb_rx_desc *desc = &priv->gbeth_rx_ring[i]; in ravb_rx_ring_free_gbeth()
259 if (!dma_mapping_error(ndev->dev.parent, in ravb_rx_ring_free_gbeth()
260 le32_to_cpu(desc->dptr))) in ravb_rx_ring_free_gbeth()
261 dma_unmap_single(ndev->dev.parent, in ravb_rx_ring_free_gbeth()
262 le32_to_cpu(desc->dptr), in ravb_rx_ring_free_gbeth()
266 ring_size = sizeof(struct ravb_rx_desc) * (priv->num_rx_ring[q] + 1); in ravb_rx_ring_free_gbeth()
267 dma_free_coherent(ndev->dev.parent, ring_size, priv->gbeth_rx_ring, in ravb_rx_ring_free_gbeth()
268 priv->rx_desc_dma[q]); in ravb_rx_ring_free_gbeth()
269 priv->gbeth_rx_ring = NULL; in ravb_rx_ring_free_gbeth()
278 if (!priv->rx_ring[q]) in ravb_rx_ring_free_rcar()
281 for (i = 0; i < priv->num_rx_ring[q]; i++) { in ravb_rx_ring_free_rcar()
282 struct ravb_ex_rx_desc *desc = &priv->rx_ring[q][i]; in ravb_rx_ring_free_rcar()
284 if (!dma_mapping_error(ndev->dev.parent, in ravb_rx_ring_free_rcar()
285 le32_to_cpu(desc->dptr))) in ravb_rx_ring_free_rcar()
286 dma_unmap_single(ndev->dev.parent, in ravb_rx_ring_free_rcar()
287 le32_to_cpu(desc->dptr), in ravb_rx_ring_free_rcar()
292 (priv->num_rx_ring[q] + 1); in ravb_rx_ring_free_rcar()
293 dma_free_coherent(ndev->dev.parent, ring_size, priv->rx_ring[q], in ravb_rx_ring_free_rcar()
294 priv->rx_desc_dma[q]); in ravb_rx_ring_free_rcar()
295 priv->rx_ring[q] = NULL; in ravb_rx_ring_free_rcar()
302 const struct ravb_hw_info *info = priv->info; in ravb_ring_free()
303 unsigned int num_tx_desc = priv->num_tx_desc; in ravb_ring_free()
307 info->rx_ring_free(ndev, q); in ravb_ring_free()
309 if (priv->tx_ring[q]) { in ravb_ring_free()
313 (priv->num_tx_ring[q] * num_tx_desc + 1); in ravb_ring_free()
314 dma_free_coherent(ndev->dev.parent, ring_size, priv->tx_ring[q], in ravb_ring_free()
315 priv->tx_desc_dma[q]); in ravb_ring_free()
316 priv->tx_ring[q] = NULL; in ravb_ring_free()
320 if (priv->rx_skb[q]) { in ravb_ring_free()
321 for (i = 0; i < priv->num_rx_ring[q]; i++) in ravb_ring_free()
322 dev_kfree_skb(priv->rx_skb[q][i]); in ravb_ring_free()
324 kfree(priv->rx_skb[q]); in ravb_ring_free()
325 priv->rx_skb[q] = NULL; in ravb_ring_free()
328 kfree(priv->tx_align[q]); in ravb_ring_free()
329 priv->tx_align[q] = NULL; in ravb_ring_free()
334 kfree(priv->tx_skb[q]); in ravb_ring_free()
335 priv->tx_skb[q] = NULL; in ravb_ring_free()
346 rx_ring_size = sizeof(*rx_desc) * priv->num_rx_ring[q]; in ravb_rx_ring_format_gbeth()
347 memset(priv->gbeth_rx_ring, 0, rx_ring_size); in ravb_rx_ring_format_gbeth()
349 for (i = 0; i < priv->num_rx_ring[q]; i++) { in ravb_rx_ring_format_gbeth()
351 rx_desc = &priv->gbeth_rx_ring[i]; in ravb_rx_ring_format_gbeth()
352 rx_desc->ds_cc = cpu_to_le16(GBETH_RX_DESC_DATA_SIZE); in ravb_rx_ring_format_gbeth()
353 dma_addr = dma_map_single(ndev->dev.parent, priv->rx_skb[q][i]->data, in ravb_rx_ring_format_gbeth()
359 if (dma_mapping_error(ndev->dev.parent, dma_addr)) in ravb_rx_ring_format_gbeth()
360 rx_desc->ds_cc = cpu_to_le16(0); in ravb_rx_ring_format_gbeth()
361 rx_desc->dptr = cpu_to_le32(dma_addr); in ravb_rx_ring_format_gbeth()
362 rx_desc->die_dt = DT_FEMPTY; in ravb_rx_ring_format_gbeth()
364 rx_desc = &priv->gbeth_rx_ring[i]; in ravb_rx_ring_format_gbeth()
365 rx_desc->dptr = cpu_to_le32((u32)priv->rx_desc_dma[q]); in ravb_rx_ring_format_gbeth()
366 rx_desc->die_dt = DT_LINKFIX; /* type */ in ravb_rx_ring_format_gbeth()
373 unsigned int rx_ring_size = sizeof(*rx_desc) * priv->num_rx_ring[q]; in ravb_rx_ring_format_rcar()
377 memset(priv->rx_ring[q], 0, rx_ring_size); in ravb_rx_ring_format_rcar()
379 for (i = 0; i < priv->num_rx_ring[q]; i++) { in ravb_rx_ring_format_rcar()
381 rx_desc = &priv->rx_ring[q][i]; in ravb_rx_ring_format_rcar()
382 rx_desc->ds_cc = cpu_to_le16(RX_BUF_SZ); in ravb_rx_ring_format_rcar()
383 dma_addr = dma_map_single(ndev->dev.parent, priv->rx_skb[q][i]->data, in ravb_rx_ring_format_rcar()
389 if (dma_mapping_error(ndev->dev.parent, dma_addr)) in ravb_rx_ring_format_rcar()
390 rx_desc->ds_cc = cpu_to_le16(0); in ravb_rx_ring_format_rcar()
391 rx_desc->dptr = cpu_to_le32(dma_addr); in ravb_rx_ring_format_rcar()
392 rx_desc->die_dt = DT_FEMPTY; in ravb_rx_ring_format_rcar()
394 rx_desc = &priv->rx_ring[q][i]; in ravb_rx_ring_format_rcar()
395 rx_desc->dptr = cpu_to_le32((u32)priv->rx_desc_dma[q]); in ravb_rx_ring_format_rcar()
396 rx_desc->die_dt = DT_LINKFIX; /* type */ in ravb_rx_ring_format_rcar()
403 const struct ravb_hw_info *info = priv->info; in ravb_ring_format()
404 unsigned int num_tx_desc = priv->num_tx_desc; in ravb_ring_format()
407 unsigned int tx_ring_size = sizeof(*tx_desc) * priv->num_tx_ring[q] * in ravb_ring_format()
411 priv->cur_rx[q] = 0; in ravb_ring_format()
412 priv->cur_tx[q] = 0; in ravb_ring_format()
413 priv->dirty_rx[q] = 0; in ravb_ring_format()
414 priv->dirty_tx[q] = 0; in ravb_ring_format()
416 info->rx_ring_format(ndev, q); in ravb_ring_format()
418 memset(priv->tx_ring[q], 0, tx_ring_size); in ravb_ring_format()
420 for (i = 0, tx_desc = priv->tx_ring[q]; i < priv->num_tx_ring[q]; in ravb_ring_format()
422 tx_desc->die_dt = DT_EEMPTY; in ravb_ring_format()
425 tx_desc->die_dt = DT_EEMPTY; in ravb_ring_format()
428 tx_desc->dptr = cpu_to_le32((u32)priv->tx_desc_dma[q]); in ravb_ring_format()
429 tx_desc->die_dt = DT_LINKFIX; /* type */ in ravb_ring_format()
432 desc = &priv->desc_bat[RX_QUEUE_OFFSET + q]; in ravb_ring_format()
433 desc->die_dt = DT_LINKFIX; /* type */ in ravb_ring_format()
434 desc->dptr = cpu_to_le32((u32)priv->rx_desc_dma[q]); in ravb_ring_format()
437 desc = &priv->desc_bat[q]; in ravb_ring_format()
438 desc->die_dt = DT_LINKFIX; /* type */ in ravb_ring_format()
439 desc->dptr = cpu_to_le32((u32)priv->tx_desc_dma[q]); in ravb_ring_format()
447 ring_size = sizeof(struct ravb_rx_desc) * (priv->num_rx_ring[q] + 1); in ravb_alloc_rx_desc_gbeth()
449 priv->gbeth_rx_ring = dma_alloc_coherent(ndev->dev.parent, ring_size, in ravb_alloc_rx_desc_gbeth()
450 &priv->rx_desc_dma[q], in ravb_alloc_rx_desc_gbeth()
452 return priv->gbeth_rx_ring; in ravb_alloc_rx_desc_gbeth()
460 ring_size = sizeof(struct ravb_ex_rx_desc) * (priv->num_rx_ring[q] + 1); in ravb_alloc_rx_desc_rcar()
462 priv->rx_ring[q] = dma_alloc_coherent(ndev->dev.parent, ring_size, in ravb_alloc_rx_desc_rcar()
463 &priv->rx_desc_dma[q], in ravb_alloc_rx_desc_rcar()
465 return priv->rx_ring[q]; in ravb_alloc_rx_desc_rcar()
472 const struct ravb_hw_info *info = priv->info; in ravb_ring_init()
473 unsigned int num_tx_desc = priv->num_tx_desc; in ravb_ring_init()
479 priv->rx_skb[q] = kcalloc(priv->num_rx_ring[q], in ravb_ring_init()
480 sizeof(*priv->rx_skb[q]), GFP_KERNEL); in ravb_ring_init()
481 priv->tx_skb[q] = kcalloc(priv->num_tx_ring[q], in ravb_ring_init()
482 sizeof(*priv->tx_skb[q]), GFP_KERNEL); in ravb_ring_init()
483 if (!priv->rx_skb[q] || !priv->tx_skb[q]) in ravb_ring_init()
486 for (i = 0; i < priv->num_rx_ring[q]; i++) { in ravb_ring_init()
487 skb = __netdev_alloc_skb(ndev, info->max_rx_len, GFP_KERNEL); in ravb_ring_init()
491 priv->rx_skb[q][i] = skb; in ravb_ring_init()
496 priv->tx_align[q] = kmalloc(DPTR_ALIGN * priv->num_tx_ring[q] + in ravb_ring_init()
497 DPTR_ALIGN - 1, GFP_KERNEL); in ravb_ring_init()
498 if (!priv->tx_align[q]) in ravb_ring_init()
503 if (!info->alloc_rx_desc(ndev, q)) in ravb_ring_init()
506 priv->dirty_rx[q] = 0; in ravb_ring_init()
510 (priv->num_tx_ring[q] * num_tx_desc + 1); in ravb_ring_init()
511 priv->tx_ring[q] = dma_alloc_coherent(ndev->dev.parent, ring_size, in ravb_ring_init()
512 &priv->tx_desc_dma[q], in ravb_ring_init()
514 if (!priv->tx_ring[q]) in ravb_ring_init()
522 return -ENOMEM; in ravb_ring_init()
529 if (priv->phy_interface == PHY_INTERFACE_MODE_MII) { in ravb_emac_init_gbeth()
542 ravb_write(ndev, ECMR_ZPF | ((priv->duplex > 0) ? ECMR_DM : 0) | in ravb_emac_init_gbeth()
550 (ndev->dev_addr[0] << 24) | (ndev->dev_addr[1] << 16) | in ravb_emac_init_gbeth()
551 (ndev->dev_addr[2] << 8) | (ndev->dev_addr[3]), MAHR); in ravb_emac_init_gbeth()
552 ravb_write(ndev, (ndev->dev_addr[4] << 8) | (ndev->dev_addr[5]), MALR); in ravb_emac_init_gbeth()
554 /* E-MAC status register clear */ in ravb_emac_init_gbeth()
558 /* E-MAC interrupt enable register */ in ravb_emac_init_gbeth()
565 ravb_write(ndev, ndev->mtu + ETH_HLEN + VLAN_HLEN + ETH_FCS_LEN, RFLR); in ravb_emac_init_rcar()
569 (ndev->features & NETIF_F_RXCSUM ? ECMR_RCSC : 0) | in ravb_emac_init_rcar()
576 (ndev->dev_addr[0] << 24) | (ndev->dev_addr[1] << 16) | in ravb_emac_init_rcar()
577 (ndev->dev_addr[2] << 8) | (ndev->dev_addr[3]), MAHR); in ravb_emac_init_rcar()
579 (ndev->dev_addr[4] << 8) | (ndev->dev_addr[5]), MALR); in ravb_emac_init_rcar()
581 /* E-MAC status register clear */ in ravb_emac_init_rcar()
584 /* E-MAC interrupt enable register */ in ravb_emac_init_rcar()
588 /* E-MAC init function */
592 const struct ravb_hw_info *info = priv->info; in ravb_emac_init()
594 info->emac_init(ndev); in ravb_emac_init()
634 const struct ravb_hw_info *info = priv->info; in ravb_dmac_init_rcar()
661 if (info->multi_irqs) { in ravb_dmac_init_rcar()
683 const struct ravb_hw_info *info = priv->info; in ravb_dmac_init()
691 error = info->dmac_init(ndev); in ravb_dmac_init()
695 /* Setting the control will start the AVB-DMAC process. */ in ravb_dmac_init()
711 while (count--) { in ravb_get_tx_tstamp()
719 list_for_each_entry_safe(ts_skb, ts_skb2, &priv->ts_skb_list, in ravb_get_tx_tstamp()
721 skb = ts_skb->skb; in ravb_get_tx_tstamp()
722 tag = ts_skb->tag; in ravb_get_tx_tstamp()
723 list_del(&ts_skb->list); in ravb_get_tx_tstamp()
744 if (unlikely(skb->len < sizeof(__sum16))) in ravb_rx_csum()
746 hw_csum = skb_tail_pointer(skb) - sizeof(__sum16); in ravb_rx_csum()
747 skb->csum = csum_unfold((__force __sum16)get_unaligned_le16(hw_csum)); in ravb_rx_csum()
748 skb->ip_summed = CHECKSUM_COMPLETE; in ravb_rx_csum()
749 skb_trim(skb, skb->len - sizeof(__sum16)); in ravb_rx_csum()
758 skb = priv->rx_skb[RAVB_BE][entry]; in ravb_get_skb_gbeth()
759 priv->rx_skb[RAVB_BE][entry] = NULL; in ravb_get_skb_gbeth()
760 dma_unmap_single(ndev->dev.parent, le32_to_cpu(desc->dptr), in ravb_get_skb_gbeth()
770 const struct ravb_hw_info *info = priv->info; in ravb_rx_gbeth()
782 entry = priv->cur_rx[q] % priv->num_rx_ring[q]; in ravb_rx_gbeth()
783 boguscnt = priv->dirty_rx[q] + priv->num_rx_ring[q] - priv->cur_rx[q]; in ravb_rx_gbeth()
784 stats = &priv->stats[q]; in ravb_rx_gbeth()
788 desc = &priv->gbeth_rx_ring[entry]; in ravb_rx_gbeth()
789 while (desc->die_dt != DT_FEMPTY) { in ravb_rx_gbeth()
792 desc_status = desc->msc; in ravb_rx_gbeth()
793 pkt_len = le16_to_cpu(desc->ds_cc) & RX_DS; in ravb_rx_gbeth()
795 if (--boguscnt < 0) in ravb_rx_gbeth()
798 /* We use 0-byte descriptors to mark the DMA mapping errors */ in ravb_rx_gbeth()
803 stats->multicast++; in ravb_rx_gbeth()
806 stats->rx_errors++; in ravb_rx_gbeth()
808 stats->rx_crc_errors++; in ravb_rx_gbeth()
810 stats->rx_frame_errors++; in ravb_rx_gbeth()
812 stats->rx_length_errors++; in ravb_rx_gbeth()
814 stats->rx_missed_errors++; in ravb_rx_gbeth()
816 die_dt = desc->die_dt & 0xF0; in ravb_rx_gbeth()
821 skb->protocol = eth_type_trans(skb, ndev); in ravb_rx_gbeth()
822 napi_gro_receive(&priv->napi[q], skb); in ravb_rx_gbeth()
823 stats->rx_packets++; in ravb_rx_gbeth()
824 stats->rx_bytes += pkt_len; in ravb_rx_gbeth()
827 priv->rx_1st_skb = ravb_get_skb_gbeth(ndev, entry, desc); in ravb_rx_gbeth()
828 skb_put(priv->rx_1st_skb, pkt_len); in ravb_rx_gbeth()
832 skb_copy_to_linear_data_offset(priv->rx_1st_skb, in ravb_rx_gbeth()
833 priv->rx_1st_skb->len, in ravb_rx_gbeth()
834 skb->data, in ravb_rx_gbeth()
836 skb_put(priv->rx_1st_skb, pkt_len); in ravb_rx_gbeth()
841 skb_copy_to_linear_data_offset(priv->rx_1st_skb, in ravb_rx_gbeth()
842 priv->rx_1st_skb->len, in ravb_rx_gbeth()
843 skb->data, in ravb_rx_gbeth()
845 skb_put(priv->rx_1st_skb, pkt_len); in ravb_rx_gbeth()
847 priv->rx_1st_skb->protocol = in ravb_rx_gbeth()
848 eth_type_trans(priv->rx_1st_skb, ndev); in ravb_rx_gbeth()
849 napi_gro_receive(&priv->napi[q], in ravb_rx_gbeth()
850 priv->rx_1st_skb); in ravb_rx_gbeth()
851 stats->rx_packets++; in ravb_rx_gbeth()
852 stats->rx_bytes += pkt_len; in ravb_rx_gbeth()
857 entry = (++priv->cur_rx[q]) % priv->num_rx_ring[q]; in ravb_rx_gbeth()
858 desc = &priv->gbeth_rx_ring[entry]; in ravb_rx_gbeth()
862 for (; priv->cur_rx[q] - priv->dirty_rx[q] > 0; priv->dirty_rx[q]++) { in ravb_rx_gbeth()
863 entry = priv->dirty_rx[q] % priv->num_rx_ring[q]; in ravb_rx_gbeth()
864 desc = &priv->gbeth_rx_ring[entry]; in ravb_rx_gbeth()
865 desc->ds_cc = cpu_to_le16(GBETH_RX_DESC_DATA_SIZE); in ravb_rx_gbeth()
867 if (!priv->rx_skb[q][entry]) { in ravb_rx_gbeth()
868 skb = netdev_alloc_skb(ndev, info->max_rx_len); in ravb_rx_gbeth()
872 dma_addr = dma_map_single(ndev->dev.parent, in ravb_rx_gbeth()
873 skb->data, in ravb_rx_gbeth()
880 if (dma_mapping_error(ndev->dev.parent, dma_addr)) in ravb_rx_gbeth()
881 desc->ds_cc = cpu_to_le16(0); in ravb_rx_gbeth()
882 desc->dptr = cpu_to_le32(dma_addr); in ravb_rx_gbeth()
883 priv->rx_skb[q][entry] = skb; in ravb_rx_gbeth()
887 desc->die_dt = DT_FEMPTY; in ravb_rx_gbeth()
890 *quota -= limit - (++boguscnt); in ravb_rx_gbeth()
899 const struct ravb_hw_info *info = priv->info; in ravb_rx_rcar()
900 int entry = priv->cur_rx[q] % priv->num_rx_ring[q]; in ravb_rx_rcar()
901 int boguscnt = (priv->dirty_rx[q] + priv->num_rx_ring[q]) - in ravb_rx_rcar()
902 priv->cur_rx[q]; in ravb_rx_rcar()
903 struct net_device_stats *stats = &priv->stats[q]; in ravb_rx_rcar()
914 desc = &priv->rx_ring[q][entry]; in ravb_rx_rcar()
915 while (desc->die_dt != DT_FEMPTY) { in ravb_rx_rcar()
918 desc_status = desc->msc; in ravb_rx_rcar()
919 pkt_len = le16_to_cpu(desc->ds_cc) & RX_DS; in ravb_rx_rcar()
921 if (--boguscnt < 0) in ravb_rx_rcar()
924 /* We use 0-byte descriptors to mark the DMA mapping errors */ in ravb_rx_rcar()
929 stats->multicast++; in ravb_rx_rcar()
933 stats->rx_errors++; in ravb_rx_rcar()
935 stats->rx_crc_errors++; in ravb_rx_rcar()
937 stats->rx_frame_errors++; in ravb_rx_rcar()
939 stats->rx_length_errors++; in ravb_rx_rcar()
941 stats->rx_missed_errors++; in ravb_rx_rcar()
943 u32 get_ts = priv->tstamp_rx_ctrl & RAVB_RXTSTAMP_TYPE; in ravb_rx_rcar()
945 skb = priv->rx_skb[q][entry]; in ravb_rx_rcar()
946 priv->rx_skb[q][entry] = NULL; in ravb_rx_rcar()
947 dma_unmap_single(ndev->dev.parent, le32_to_cpu(desc->dptr), in ravb_rx_rcar()
958 ts.tv_sec = ((u64) le16_to_cpu(desc->ts_sh) << in ravb_rx_rcar()
959 32) | le32_to_cpu(desc->ts_sl); in ravb_rx_rcar()
960 ts.tv_nsec = le32_to_cpu(desc->ts_n); in ravb_rx_rcar()
961 shhwtstamps->hwtstamp = timespec64_to_ktime(ts); in ravb_rx_rcar()
965 skb->protocol = eth_type_trans(skb, ndev); in ravb_rx_rcar()
966 if (ndev->features & NETIF_F_RXCSUM) in ravb_rx_rcar()
968 napi_gro_receive(&priv->napi[q], skb); in ravb_rx_rcar()
969 stats->rx_packets++; in ravb_rx_rcar()
970 stats->rx_bytes += pkt_len; in ravb_rx_rcar()
973 entry = (++priv->cur_rx[q]) % priv->num_rx_ring[q]; in ravb_rx_rcar()
974 desc = &priv->rx_ring[q][entry]; in ravb_rx_rcar()
978 for (; priv->cur_rx[q] - priv->dirty_rx[q] > 0; priv->dirty_rx[q]++) { in ravb_rx_rcar()
979 entry = priv->dirty_rx[q] % priv->num_rx_ring[q]; in ravb_rx_rcar()
980 desc = &priv->rx_ring[q][entry]; in ravb_rx_rcar()
981 desc->ds_cc = cpu_to_le16(RX_BUF_SZ); in ravb_rx_rcar()
983 if (!priv->rx_skb[q][entry]) { in ravb_rx_rcar()
984 skb = netdev_alloc_skb(ndev, info->max_rx_len); in ravb_rx_rcar()
988 dma_addr = dma_map_single(ndev->dev.parent, skb->data, in ravb_rx_rcar()
989 le16_to_cpu(desc->ds_cc), in ravb_rx_rcar()
995 if (dma_mapping_error(ndev->dev.parent, dma_addr)) in ravb_rx_rcar()
996 desc->ds_cc = cpu_to_le16(0); in ravb_rx_rcar()
997 desc->dptr = cpu_to_le32(dma_addr); in ravb_rx_rcar()
998 priv->rx_skb[q][entry] = skb; in ravb_rx_rcar()
1002 desc->die_dt = DT_FEMPTY; in ravb_rx_rcar()
1005 *quota -= limit - (++boguscnt); in ravb_rx_rcar()
1014 const struct ravb_hw_info *info = priv->info; in ravb_rx()
1016 return info->receive(ndev, quota, q); in ravb_rx()
1035 const struct ravb_hw_info *info = priv->info; in ravb_stop_dma()
1039 error = ravb_wait(ndev, TCCR, info->tccr_mask, 0); in ravb_stop_dma()
1049 /* Stop the E-MAC's RX/TX processes. */ in ravb_stop_dma()
1057 /* Stop AVB-DMAC process */ in ravb_stop_dma()
1061 /* E-MAC interrupt handler */
1071 pm_wakeup_event(&priv->pdev->dev, 0); in ravb_emac_interrupt_unlocked()
1073 ndev->stats.tx_carrier_errors++; in ravb_emac_interrupt_unlocked()
1076 if (priv->no_avb_link) in ravb_emac_interrupt_unlocked()
1079 if (priv->avb_link_active_low) in ravb_emac_interrupt_unlocked()
1096 spin_lock(&priv->lock); in ravb_emac_interrupt()
1098 spin_unlock(&priv->lock); in ravb_emac_interrupt()
1117 priv->stats[RAVB_BE].rx_over_errors++; in ravb_error_interrupt()
1121 priv->stats[RAVB_NC].rx_over_errors++; in ravb_error_interrupt()
1125 priv->rx_fifo_errors++; in ravb_error_interrupt()
1132 const struct ravb_hw_info *info = priv->info; in ravb_queue_interrupt()
1139 if (napi_schedule_prep(&priv->napi[q])) { in ravb_queue_interrupt()
1141 if (!info->irq_en_dis) { in ravb_queue_interrupt()
1148 __napi_schedule(&priv->napi[q]); in ravb_queue_interrupt()
1178 const struct ravb_hw_info *info = priv->info; in ravb_interrupt()
1182 spin_lock(&priv->lock); in ravb_interrupt()
1195 if (info->nc_queues) { in ravb_interrupt()
1196 for (q = RAVB_NC; q >= RAVB_BE; q--) { in ravb_interrupt()
1206 /* E-MAC status summary */ in ravb_interrupt()
1224 spin_unlock(&priv->lock); in ravb_interrupt()
1236 spin_lock(&priv->lock); in ravb_multi_interrupt()
1256 spin_unlock(&priv->lock); in ravb_multi_interrupt()
1266 spin_lock(&priv->lock); in ravb_dma_interrupt()
1272 spin_unlock(&priv->lock); in ravb_dma_interrupt()
1288 struct net_device *ndev = napi->dev; in ravb_poll()
1290 const struct ravb_hw_info *info = priv->info; in ravb_poll()
1292 int q = napi - priv->napi; in ravb_poll()
1303 spin_lock_irqsave(&priv->lock, flags); in ravb_poll()
1308 spin_unlock_irqrestore(&priv->lock, flags); in ravb_poll()
1311 priv->rx_over_errors = priv->stats[RAVB_BE].rx_over_errors; in ravb_poll()
1312 if (info->nc_queues) in ravb_poll()
1313 priv->rx_over_errors += priv->stats[RAVB_NC].rx_over_errors; in ravb_poll()
1314 if (priv->rx_over_errors != ndev->stats.rx_over_errors) in ravb_poll()
1315 ndev->stats.rx_over_errors = priv->rx_over_errors; in ravb_poll()
1316 if (priv->rx_fifo_errors != ndev->stats.rx_fifo_errors) in ravb_poll()
1317 ndev->stats.rx_fifo_errors = priv->rx_fifo_errors; in ravb_poll()
1324 /* Re-enable RX/TX interrupts */ in ravb_poll()
1325 spin_lock_irqsave(&priv->lock, flags); in ravb_poll()
1326 if (!info->irq_en_dis) { in ravb_poll()
1333 spin_unlock_irqrestore(&priv->lock, flags); in ravb_poll()
1336 return budget - quota; in ravb_poll()
1343 ravb_modify(ndev, ECMR, ECMR_DM, priv->duplex > 0 ? ECMR_DM : 0); in ravb_set_duplex_gbeth()
1350 const struct ravb_hw_info *info = priv->info; in ravb_adjust_link()
1351 struct phy_device *phydev = ndev->phydev; in ravb_adjust_link()
1355 spin_lock_irqsave(&priv->lock, flags); in ravb_adjust_link()
1357 /* Disable TX and RX right over here, if E-MAC change is ignored */ in ravb_adjust_link()
1358 if (priv->no_avb_link) in ravb_adjust_link()
1361 if (phydev->link) { in ravb_adjust_link()
1362 if (info->half_duplex && phydev->duplex != priv->duplex) { in ravb_adjust_link()
1364 priv->duplex = phydev->duplex; in ravb_adjust_link()
1368 if (phydev->speed != priv->speed) { in ravb_adjust_link()
1370 priv->speed = phydev->speed; in ravb_adjust_link()
1371 info->set_rate(ndev); in ravb_adjust_link()
1373 if (!priv->link) { in ravb_adjust_link()
1376 priv->link = phydev->link; in ravb_adjust_link()
1378 } else if (priv->link) { in ravb_adjust_link()
1380 priv->link = 0; in ravb_adjust_link()
1381 priv->speed = 0; in ravb_adjust_link()
1382 if (info->half_duplex) in ravb_adjust_link()
1383 priv->duplex = -1; in ravb_adjust_link()
1386 /* Enable TX and RX right over here, if E-MAC change is ignored */ in ravb_adjust_link()
1387 if (priv->no_avb_link && phydev->link) in ravb_adjust_link()
1390 spin_unlock_irqrestore(&priv->lock, flags); in ravb_adjust_link()
1399 struct device_node *np = ndev->dev.parent->of_node; in ravb_phy_init()
1401 const struct ravb_hw_info *info = priv->info; in ravb_phy_init()
1407 priv->link = 0; in ravb_phy_init()
1408 priv->speed = 0; in ravb_phy_init()
1409 priv->duplex = -1; in ravb_phy_init()
1412 pn = of_parse_phandle(np, "phy-handle", 0); in ravb_phy_init()
1425 iface = priv->rgmii_override ? PHY_INTERFACE_MODE_RGMII in ravb_phy_init()
1426 : priv->phy_interface; in ravb_phy_init()
1431 err = -ENOENT; in ravb_phy_init()
1435 if (!info->half_duplex) { in ravb_phy_init()
1467 phy_start(ndev->phydev); in ravb_phy_start()
1476 return priv->msg_enable; in ravb_get_msglevel()
1483 priv->msg_enable = value; in ravb_set_msglevel()
1541 const struct ravb_hw_info *info = priv->info; in ravb_get_sset_count()
1545 return info->stats_len; in ravb_get_sset_count()
1547 return -EOPNOTSUPP; in ravb_get_sset_count()
1555 const struct ravb_hw_info *info = priv->info; in ravb_get_ethtool_stats()
1560 num_rx_q = info->nc_queues ? NUM_RX_QUEUE : 1; in ravb_get_ethtool_stats()
1561 /* Device-specific stats */ in ravb_get_ethtool_stats()
1563 struct net_device_stats *stats = &priv->stats[q]; in ravb_get_ethtool_stats()
1565 data[i++] = priv->cur_rx[q]; in ravb_get_ethtool_stats()
1566 data[i++] = priv->cur_tx[q]; in ravb_get_ethtool_stats()
1567 data[i++] = priv->dirty_rx[q]; in ravb_get_ethtool_stats()
1568 data[i++] = priv->dirty_tx[q]; in ravb_get_ethtool_stats()
1569 data[i++] = stats->rx_packets; in ravb_get_ethtool_stats()
1570 data[i++] = stats->tx_packets; in ravb_get_ethtool_stats()
1571 data[i++] = stats->rx_bytes; in ravb_get_ethtool_stats()
1572 data[i++] = stats->tx_bytes; in ravb_get_ethtool_stats()
1573 data[i++] = stats->multicast; in ravb_get_ethtool_stats()
1574 data[i++] = stats->rx_errors; in ravb_get_ethtool_stats()
1575 data[i++] = stats->rx_crc_errors; in ravb_get_ethtool_stats()
1576 data[i++] = stats->rx_frame_errors; in ravb_get_ethtool_stats()
1577 data[i++] = stats->rx_length_errors; in ravb_get_ethtool_stats()
1578 data[i++] = stats->rx_missed_errors; in ravb_get_ethtool_stats()
1579 data[i++] = stats->rx_over_errors; in ravb_get_ethtool_stats()
1586 const struct ravb_hw_info *info = priv->info; in ravb_get_strings()
1590 memcpy(data, info->gstrings_stats, info->gstrings_size); in ravb_get_strings()
1602 ring->rx_max_pending = BE_RX_RING_MAX; in ravb_get_ringparam()
1603 ring->tx_max_pending = BE_TX_RING_MAX; in ravb_get_ringparam()
1604 ring->rx_pending = priv->num_rx_ring[RAVB_BE]; in ravb_get_ringparam()
1605 ring->tx_pending = priv->num_tx_ring[RAVB_BE]; in ravb_get_ringparam()
1614 const struct ravb_hw_info *info = priv->info; in ravb_set_ringparam()
1617 if (ring->tx_pending > BE_TX_RING_MAX || in ravb_set_ringparam()
1618 ring->rx_pending > BE_RX_RING_MAX || in ravb_set_ringparam()
1619 ring->tx_pending < BE_TX_RING_MIN || in ravb_set_ringparam()
1620 ring->rx_pending < BE_RX_RING_MIN) in ravb_set_ringparam()
1621 return -EINVAL; in ravb_set_ringparam()
1622 if (ring->rx_mini_pending || ring->rx_jumbo_pending) in ravb_set_ringparam()
1623 return -EINVAL; in ravb_set_ringparam()
1628 if (info->gptp) in ravb_set_ringparam()
1637 synchronize_irq(ndev->irq); in ravb_set_ringparam()
1641 if (info->nc_queues) in ravb_set_ringparam()
1646 priv->num_rx_ring[RAVB_BE] = ring->rx_pending; in ravb_set_ringparam()
1647 priv->num_tx_ring[RAVB_BE] = ring->tx_pending; in ravb_set_ringparam()
1661 if (info->gptp) in ravb_set_ringparam()
1662 ravb_ptp_init(ndev, priv->pdev); in ravb_set_ringparam()
1674 const struct ravb_hw_info *hw_info = priv->info; in ravb_get_ts_info()
1676 if (hw_info->gptp || hw_info->ccc_gac) { in ravb_get_ts_info()
1677 info->so_timestamping = in ravb_get_ts_info()
1682 info->tx_types = (1 << HWTSTAMP_TX_OFF) | (1 << HWTSTAMP_TX_ON); in ravb_get_ts_info()
1683 info->rx_filters = in ravb_get_ts_info()
1687 info->phc_index = ptp_clock_index(priv->ptp.clock); in ravb_get_ts_info()
1697 wol->supported = WAKE_MAGIC; in ravb_get_wol()
1698 wol->wolopts = priv->wol_enabled ? WAKE_MAGIC : 0; in ravb_get_wol()
1704 const struct ravb_hw_info *info = priv->info; in ravb_set_wol()
1706 if (!info->magic_pkt || (wol->wolopts & ~WAKE_MAGIC)) in ravb_set_wol()
1707 return -EOPNOTSUPP; in ravb_set_wol()
1709 priv->wol_enabled = !!(wol->wolopts & WAKE_MAGIC); in ravb_set_wol()
1711 device_set_wakeup_enable(&priv->pdev->dev, priv->wol_enabled); in ravb_set_wol()
1740 name = devm_kasprintf(dev, GFP_KERNEL, "%s:%s", ndev->name, ch); in ravb_hook_irq()
1742 return -ENOMEM; in ravb_hook_irq()
1754 const struct ravb_hw_info *info = priv->info; in ravb_open()
1755 struct platform_device *pdev = priv->pdev; in ravb_open()
1756 struct device *dev = &pdev->dev; in ravb_open()
1759 napi_enable(&priv->napi[RAVB_BE]); in ravb_open()
1760 if (info->nc_queues) in ravb_open()
1761 napi_enable(&priv->napi[RAVB_NC]); in ravb_open()
1763 if (!info->multi_irqs) { in ravb_open()
1764 error = request_irq(ndev->irq, ravb_interrupt, IRQF_SHARED, in ravb_open()
1765 ndev->name, ndev); in ravb_open()
1771 error = ravb_hook_irq(ndev->irq, ravb_multi_interrupt, ndev, in ravb_open()
1775 error = ravb_hook_irq(priv->emac_irq, ravb_emac_interrupt, ndev, in ravb_open()
1779 error = ravb_hook_irq(priv->rx_irqs[RAVB_BE], ravb_be_interrupt, in ravb_open()
1783 error = ravb_hook_irq(priv->tx_irqs[RAVB_BE], ravb_be_interrupt, in ravb_open()
1787 error = ravb_hook_irq(priv->rx_irqs[RAVB_NC], ravb_nc_interrupt, in ravb_open()
1791 error = ravb_hook_irq(priv->tx_irqs[RAVB_NC], ravb_nc_interrupt, in ravb_open()
1796 if (info->err_mgmt_irqs) { in ravb_open()
1797 error = ravb_hook_irq(priv->erra_irq, ravb_multi_interrupt, in ravb_open()
1801 error = ravb_hook_irq(priv->mgmta_irq, ravb_multi_interrupt, in ravb_open()
1815 if (info->gptp) in ravb_open()
1816 ravb_ptp_init(ndev, priv->pdev); in ravb_open()
1829 if (info->gptp) in ravb_open()
1833 if (!info->multi_irqs) in ravb_open()
1835 if (info->err_mgmt_irqs) in ravb_open()
1836 free_irq(priv->mgmta_irq, ndev); in ravb_open()
1838 if (info->err_mgmt_irqs) in ravb_open()
1839 free_irq(priv->erra_irq, ndev); in ravb_open()
1841 free_irq(priv->tx_irqs[RAVB_NC], ndev); in ravb_open()
1843 free_irq(priv->rx_irqs[RAVB_NC], ndev); in ravb_open()
1845 free_irq(priv->tx_irqs[RAVB_BE], ndev); in ravb_open()
1847 free_irq(priv->rx_irqs[RAVB_BE], ndev); in ravb_open()
1849 free_irq(priv->emac_irq, ndev); in ravb_open()
1851 free_irq(ndev->irq, ndev); in ravb_open()
1853 if (info->nc_queues) in ravb_open()
1854 napi_disable(&priv->napi[RAVB_NC]); in ravb_open()
1855 napi_disable(&priv->napi[RAVB_BE]); in ravb_open()
1869 ndev->stats.tx_errors++; in ravb_tx_timeout()
1871 schedule_work(&priv->work); in ravb_tx_timeout()
1878 const struct ravb_hw_info *info = priv->info; in ravb_tx_timeout_work()
1879 struct net_device *ndev = priv->ndev; in ravb_tx_timeout_work()
1884 schedule_work(&priv->work); in ravb_tx_timeout_work()
1891 if (info->gptp) in ravb_tx_timeout_work()
1901 * re-enables the TX and RX and skip the following in ravb_tx_timeout_work()
1902 * re-initialization procedure. in ravb_tx_timeout_work()
1909 if (info->nc_queues) in ravb_tx_timeout_work()
1916 * should return here to avoid re-enabling the TX and RX in in ravb_tx_timeout_work()
1927 if (info->gptp) in ravb_tx_timeout_work()
1928 ravb_ptp_init(ndev, priv->pdev); in ravb_tx_timeout_work()
1940 const struct ravb_hw_info *info = priv->info; in ravb_start_xmit()
1941 unsigned int num_tx_desc = priv->num_tx_desc; in ravb_start_xmit()
1951 spin_lock_irqsave(&priv->lock, flags); in ravb_start_xmit()
1952 if (priv->cur_tx[q] - priv->dirty_tx[q] > (priv->num_tx_ring[q] - 1) * in ravb_start_xmit()
1957 spin_unlock_irqrestore(&priv->lock, flags); in ravb_start_xmit()
1964 entry = priv->cur_tx[q] % (priv->num_tx_ring[q] * num_tx_desc); in ravb_start_xmit()
1965 priv->tx_skb[q][entry / num_tx_desc] = skb; in ravb_start_xmit()
1968 buffer = PTR_ALIGN(priv->tx_align[q], DPTR_ALIGN) + in ravb_start_xmit()
1970 len = PTR_ALIGN(skb->data, DPTR_ALIGN) - skb->data; in ravb_start_xmit()
1981 * length of the second DMA descriptor (skb->len - len) in ravb_start_xmit()
1987 memcpy(buffer, skb->data, len); in ravb_start_xmit()
1988 dma_addr = dma_map_single(ndev->dev.parent, buffer, len, in ravb_start_xmit()
1990 if (dma_mapping_error(ndev->dev.parent, dma_addr)) in ravb_start_xmit()
1993 desc = &priv->tx_ring[q][entry]; in ravb_start_xmit()
1994 desc->ds_tagl = cpu_to_le16(len); in ravb_start_xmit()
1995 desc->dptr = cpu_to_le32(dma_addr); in ravb_start_xmit()
1997 buffer = skb->data + len; in ravb_start_xmit()
1998 len = skb->len - len; in ravb_start_xmit()
1999 dma_addr = dma_map_single(ndev->dev.parent, buffer, len, in ravb_start_xmit()
2001 if (dma_mapping_error(ndev->dev.parent, dma_addr)) in ravb_start_xmit()
2006 desc = &priv->tx_ring[q][entry]; in ravb_start_xmit()
2007 len = skb->len; in ravb_start_xmit()
2008 dma_addr = dma_map_single(ndev->dev.parent, skb->data, skb->len, in ravb_start_xmit()
2010 if (dma_mapping_error(ndev->dev.parent, dma_addr)) in ravb_start_xmit()
2013 desc->ds_tagl = cpu_to_le16(len); in ravb_start_xmit()
2014 desc->dptr = cpu_to_le32(dma_addr); in ravb_start_xmit()
2017 if (info->gptp || info->ccc_gac) { in ravb_start_xmit()
2022 desc--; in ravb_start_xmit()
2023 dma_unmap_single(ndev->dev.parent, dma_addr, in ravb_start_xmit()
2028 ts_skb->skb = skb_get(skb); in ravb_start_xmit()
2029 ts_skb->tag = priv->ts_skb_tag++; in ravb_start_xmit()
2030 priv->ts_skb_tag &= 0x3ff; in ravb_start_xmit()
2031 list_add_tail(&ts_skb->list, &priv->ts_skb_list); in ravb_start_xmit()
2034 skb_shinfo(skb)->tx_flags |= SKBTX_IN_PROGRESS; in ravb_start_xmit()
2035 desc->tagh_tsr = (ts_skb->tag >> 4) | TX_TSR; in ravb_start_xmit()
2036 desc->ds_tagl |= cpu_to_le16(ts_skb->tag << 12); in ravb_start_xmit()
2044 desc->die_dt = DT_FEND; in ravb_start_xmit()
2045 desc--; in ravb_start_xmit()
2046 desc->die_dt = DT_FSTART; in ravb_start_xmit()
2048 desc->die_dt = DT_FSINGLE; in ravb_start_xmit()
2052 priv->cur_tx[q] += num_tx_desc; in ravb_start_xmit()
2053 if (priv->cur_tx[q] - priv->dirty_tx[q] > in ravb_start_xmit()
2054 (priv->num_tx_ring[q] - 1) * num_tx_desc && in ravb_start_xmit()
2059 spin_unlock_irqrestore(&priv->lock, flags); in ravb_start_xmit()
2063 dma_unmap_single(ndev->dev.parent, le32_to_cpu(desc->dptr), in ravb_start_xmit()
2064 le16_to_cpu(desc->ds_tagl), DMA_TO_DEVICE); in ravb_start_xmit()
2067 priv->tx_skb[q][entry / num_tx_desc] = NULL; in ravb_start_xmit()
2075 return (skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP) ? RAVB_NC : in ravb_select_queue()
2083 const struct ravb_hw_info *info = priv->info; in ravb_get_stats()
2086 nstats = &ndev->stats; in ravb_get_stats()
2087 stats0 = &priv->stats[RAVB_BE]; in ravb_get_stats()
2089 if (info->tx_counters) { in ravb_get_stats()
2090 nstats->tx_dropped += ravb_read(ndev, TROCR); in ravb_get_stats()
2094 if (info->carrier_counters) { in ravb_get_stats()
2095 nstats->collisions += ravb_read(ndev, CXR41); in ravb_get_stats()
2097 nstats->tx_carrier_errors += ravb_read(ndev, CXR42); in ravb_get_stats()
2101 nstats->rx_packets = stats0->rx_packets; in ravb_get_stats()
2102 nstats->tx_packets = stats0->tx_packets; in ravb_get_stats()
2103 nstats->rx_bytes = stats0->rx_bytes; in ravb_get_stats()
2104 nstats->tx_bytes = stats0->tx_bytes; in ravb_get_stats()
2105 nstats->multicast = stats0->multicast; in ravb_get_stats()
2106 nstats->rx_errors = stats0->rx_errors; in ravb_get_stats()
2107 nstats->rx_crc_errors = stats0->rx_crc_errors; in ravb_get_stats()
2108 nstats->rx_frame_errors = stats0->rx_frame_errors; in ravb_get_stats()
2109 nstats->rx_length_errors = stats0->rx_length_errors; in ravb_get_stats()
2110 nstats->rx_missed_errors = stats0->rx_missed_errors; in ravb_get_stats()
2111 nstats->rx_over_errors = stats0->rx_over_errors; in ravb_get_stats()
2112 if (info->nc_queues) { in ravb_get_stats()
2113 stats1 = &priv->stats[RAVB_NC]; in ravb_get_stats()
2115 nstats->rx_packets += stats1->rx_packets; in ravb_get_stats()
2116 nstats->tx_packets += stats1->tx_packets; in ravb_get_stats()
2117 nstats->rx_bytes += stats1->rx_bytes; in ravb_get_stats()
2118 nstats->tx_bytes += stats1->tx_bytes; in ravb_get_stats()
2119 nstats->multicast += stats1->multicast; in ravb_get_stats()
2120 nstats->rx_errors += stats1->rx_errors; in ravb_get_stats()
2121 nstats->rx_crc_errors += stats1->rx_crc_errors; in ravb_get_stats()
2122 nstats->rx_frame_errors += stats1->rx_frame_errors; in ravb_get_stats()
2123 nstats->rx_length_errors += stats1->rx_length_errors; in ravb_get_stats()
2124 nstats->rx_missed_errors += stats1->rx_missed_errors; in ravb_get_stats()
2125 nstats->rx_over_errors += stats1->rx_over_errors; in ravb_get_stats()
2137 spin_lock_irqsave(&priv->lock, flags); in ravb_set_rx_mode()
2139 ndev->flags & IFF_PROMISC ? ECMR_PRM : 0); in ravb_set_rx_mode()
2140 spin_unlock_irqrestore(&priv->lock, flags); in ravb_set_rx_mode()
2146 struct device_node *np = ndev->dev.parent->of_node; in ravb_close()
2148 const struct ravb_hw_info *info = priv->info; in ravb_close()
2159 if (info->gptp) in ravb_close()
2162 /* Set the config mode to stop the AVB-DMAC's processes */ in ravb_close()
2168 if (info->gptp || info->ccc_gac) { in ravb_close()
2169 list_for_each_entry_safe(ts_skb, ts_skb2, &priv->ts_skb_list, list) { in ravb_close()
2170 list_del(&ts_skb->list); in ravb_close()
2171 kfree_skb(ts_skb->skb); in ravb_close()
2177 if (ndev->phydev) { in ravb_close()
2178 phy_stop(ndev->phydev); in ravb_close()
2179 phy_disconnect(ndev->phydev); in ravb_close()
2184 cancel_work_sync(&priv->work); in ravb_close()
2186 if (info->multi_irqs) { in ravb_close()
2187 free_irq(priv->tx_irqs[RAVB_NC], ndev); in ravb_close()
2188 free_irq(priv->rx_irqs[RAVB_NC], ndev); in ravb_close()
2189 free_irq(priv->tx_irqs[RAVB_BE], ndev); in ravb_close()
2190 free_irq(priv->rx_irqs[RAVB_BE], ndev); in ravb_close()
2191 free_irq(priv->emac_irq, ndev); in ravb_close()
2192 if (info->err_mgmt_irqs) { in ravb_close()
2193 free_irq(priv->erra_irq, ndev); in ravb_close()
2194 free_irq(priv->mgmta_irq, ndev); in ravb_close()
2197 free_irq(ndev->irq, ndev); in ravb_close()
2199 if (info->nc_queues) in ravb_close()
2200 napi_disable(&priv->napi[RAVB_NC]); in ravb_close()
2201 napi_disable(&priv->napi[RAVB_BE]); in ravb_close()
2205 if (info->nc_queues) in ravb_close()
2217 config.tx_type = priv->tstamp_tx_ctrl ? HWTSTAMP_TX_ON : in ravb_hwtstamp_get()
2219 switch (priv->tstamp_rx_ctrl & RAVB_RXTSTAMP_TYPE) { in ravb_hwtstamp_get()
2230 return copy_to_user(req->ifr_data, &config, sizeof(config)) ? in ravb_hwtstamp_get()
2231 -EFAULT : 0; in ravb_hwtstamp_get()
2242 if (copy_from_user(&config, req->ifr_data, sizeof(config))) in ravb_hwtstamp_set()
2243 return -EFAULT; in ravb_hwtstamp_set()
2253 return -ERANGE; in ravb_hwtstamp_set()
2268 priv->tstamp_tx_ctrl = tstamp_tx_ctrl; in ravb_hwtstamp_set()
2269 priv->tstamp_rx_ctrl = tstamp_rx_ctrl; in ravb_hwtstamp_set()
2271 return copy_to_user(req->ifr_data, &config, sizeof(config)) ? in ravb_hwtstamp_set()
2272 -EFAULT : 0; in ravb_hwtstamp_set()
2278 struct phy_device *phydev = ndev->phydev; in ravb_do_ioctl()
2281 return -EINVAL; in ravb_do_ioctl()
2284 return -ENODEV; in ravb_do_ioctl()
2300 ndev->mtu = new_mtu; in ravb_change_mtu()
2303 synchronize_irq(priv->emac_irq); in ravb_change_mtu()
2317 spin_lock_irqsave(&priv->lock, flags); in ravb_set_rx_csum()
2328 spin_unlock_irqrestore(&priv->lock, flags); in ravb_set_rx_csum()
2341 netdev_features_t changed = ndev->features ^ features; in ravb_set_features_rcar()
2346 ndev->features = features; in ravb_set_features_rcar()
2355 const struct ravb_hw_info *info = priv->info; in ravb_set_features()
2357 return info->set_feature(ndev, features); in ravb_set_features()
2378 struct platform_device *pdev = priv->pdev; in ravb_mdio_init()
2379 struct device *dev = &pdev->dev; in ravb_mdio_init()
2385 priv->mdiobb.ops = &bb_ops; in ravb_mdio_init()
2388 priv->mii_bus = alloc_mdio_bitbang(&priv->mdiobb); in ravb_mdio_init()
2389 if (!priv->mii_bus) in ravb_mdio_init()
2390 return -ENOMEM; in ravb_mdio_init()
2393 priv->mii_bus->name = "ravb_mii"; in ravb_mdio_init()
2394 priv->mii_bus->parent = dev; in ravb_mdio_init()
2395 snprintf(priv->mii_bus->id, MII_BUS_ID_SIZE, "%s-%x", in ravb_mdio_init()
2396 pdev->name, pdev->id); in ravb_mdio_init()
2399 error = of_mdiobus_register(priv->mii_bus, dev->of_node); in ravb_mdio_init()
2403 pn = of_parse_phandle(dev->of_node, "phy-handle", 0); in ravb_mdio_init()
2406 phydev->mac_managed_pm = true; in ravb_mdio_init()
2407 put_device(&phydev->mdio.dev); in ravb_mdio_init()
2414 free_mdio_bitbang(priv->mii_bus); in ravb_mdio_init()
2422 mdiobus_unregister(priv->mii_bus); in ravb_mdio_release()
2425 free_mdio_bitbang(priv->mii_bus); in ravb_mdio_release()
2444 .max_rx_len = RX_BUF_SZ + RAVB_ALIGN - 1,
2470 .max_rx_len = RX_BUF_SZ + RAVB_ALIGN - 1,
2493 .max_rx_len = RX_BUF_SZ + RAVB_ALIGN - 1,
2526 { .compatible = "renesas,etheravb-r8a7790", .data = &ravb_gen2_hw_info },
2527 { .compatible = "renesas,etheravb-r8a7794", .data = &ravb_gen2_hw_info },
2528 { .compatible = "renesas,etheravb-rcar-gen2", .data = &ravb_gen2_hw_info },
2529 { .compatible = "renesas,etheravb-r8a7795", .data = &ravb_gen3_hw_info },
2530 { .compatible = "renesas,etheravb-rcar-gen3", .data = &ravb_gen3_hw_info },
2531 { .compatible = "renesas,etheravb-rcar-gen4", .data = &ravb_gen3_hw_info },
2532 { .compatible = "renesas,etheravb-rzv2m", .data = &ravb_rzv2m_hw_info },
2533 { .compatible = "renesas,rzg2l-gbeth", .data = &gbeth_hw_info },
2541 const struct ravb_hw_info *info = priv->info; in ravb_set_gti()
2542 struct device *dev = ndev->dev.parent; in ravb_set_gti()
2546 if (info->gptp_ref_clk) in ravb_set_gti()
2547 rate = clk_get_rate(priv->gptp_clk); in ravb_set_gti()
2549 rate = clk_get_rate(priv->clk); in ravb_set_gti()
2551 return -EINVAL; in ravb_set_gti()
2556 dev_err(dev, "gti.tiv increment 0x%llx is outside the range 0x%x - 0x%x\n", in ravb_set_gti()
2558 return -EINVAL; in ravb_set_gti()
2569 const struct ravb_hw_info *info = priv->info; in ravb_set_config_mode()
2572 if (info->gptp) { in ravb_set_config_mode()
2578 } else if (info->ccc_gac) { in ravb_set_config_mode()
2594 if (!of_property_read_u32(np, "rx-internal-delay-ps", &delay)) { in ravb_parse_delay_mode()
2596 priv->rxcidm = !!delay; in ravb_parse_delay_mode()
2599 if (!of_property_read_u32(np, "tx-internal-delay-ps", &delay)) { in ravb_parse_delay_mode()
2601 priv->txcidm = !!delay; in ravb_parse_delay_mode()
2608 /* Fall back to legacy rgmii-*id behavior */ in ravb_parse_delay_mode()
2609 if (priv->phy_interface == PHY_INTERFACE_MODE_RGMII_ID || in ravb_parse_delay_mode()
2610 priv->phy_interface == PHY_INTERFACE_MODE_RGMII_RXID) { in ravb_parse_delay_mode()
2611 priv->rxcidm = 1; in ravb_parse_delay_mode()
2612 priv->rgmii_override = 1; in ravb_parse_delay_mode()
2615 if (priv->phy_interface == PHY_INTERFACE_MODE_RGMII_ID || in ravb_parse_delay_mode()
2616 priv->phy_interface == PHY_INTERFACE_MODE_RGMII_TXID) { in ravb_parse_delay_mode()
2617 priv->txcidm = 1; in ravb_parse_delay_mode()
2618 priv->rgmii_override = 1; in ravb_parse_delay_mode()
2627 if (priv->rxcidm) in ravb_set_delay_mode()
2629 if (priv->txcidm) in ravb_set_delay_mode()
2636 struct device_node *np = pdev->dev.of_node; in ravb_probe()
2646 dev_err(&pdev->dev, in ravb_probe()
2648 return -EINVAL; in ravb_probe()
2651 rstc = devm_reset_control_get_optional_exclusive(&pdev->dev, NULL); in ravb_probe()
2653 return dev_err_probe(&pdev->dev, PTR_ERR(rstc), in ravb_probe()
2659 return -ENOMEM; in ravb_probe()
2661 info = of_device_get_match_data(&pdev->dev); in ravb_probe()
2663 ndev->features = info->net_features; in ravb_probe()
2664 ndev->hw_features = info->net_hw_features; in ravb_probe()
2670 pm_runtime_enable(&pdev->dev); in ravb_probe()
2671 error = pm_runtime_resume_and_get(&pdev->dev); in ravb_probe()
2675 if (info->multi_irqs) { in ravb_probe()
2676 if (info->err_mgmt_irqs) in ravb_probe()
2687 ndev->irq = irq; in ravb_probe()
2689 SET_NETDEV_DEV(ndev, &pdev->dev); in ravb_probe()
2692 priv->info = info; in ravb_probe()
2693 priv->rstc = rstc; in ravb_probe()
2694 priv->ndev = ndev; in ravb_probe()
2695 priv->pdev = pdev; in ravb_probe()
2696 priv->num_tx_ring[RAVB_BE] = BE_TX_RING_SIZE; in ravb_probe()
2697 priv->num_rx_ring[RAVB_BE] = BE_RX_RING_SIZE; in ravb_probe()
2698 if (info->nc_queues) { in ravb_probe()
2699 priv->num_tx_ring[RAVB_NC] = NC_TX_RING_SIZE; in ravb_probe()
2700 priv->num_rx_ring[RAVB_NC] = NC_RX_RING_SIZE; in ravb_probe()
2703 priv->addr = devm_platform_get_and_ioremap_resource(pdev, 0, &res); in ravb_probe()
2704 if (IS_ERR(priv->addr)) { in ravb_probe()
2705 error = PTR_ERR(priv->addr); in ravb_probe()
2709 /* The Ether-specific entries in the device structure. */ in ravb_probe()
2710 ndev->base_addr = res->start; in ravb_probe()
2712 spin_lock_init(&priv->lock); in ravb_probe()
2713 INIT_WORK(&priv->work, ravb_tx_timeout_work); in ravb_probe()
2715 error = of_get_phy_mode(np, &priv->phy_interface); in ravb_probe()
2716 if (error && error != -ENODEV) in ravb_probe()
2719 priv->no_avb_link = of_property_read_bool(np, "renesas,no-ether-link"); in ravb_probe()
2720 priv->avb_link_active_low = in ravb_probe()
2721 of_property_read_bool(np, "renesas,ether-link-active-low"); in ravb_probe()
2723 if (info->multi_irqs) { in ravb_probe()
2724 if (info->err_mgmt_irqs) in ravb_probe()
2732 priv->emac_irq = irq; in ravb_probe()
2739 priv->rx_irqs[i] = irq; in ravb_probe()
2747 priv->tx_irqs[i] = irq; in ravb_probe()
2750 if (info->err_mgmt_irqs) { in ravb_probe()
2756 priv->erra_irq = irq; in ravb_probe()
2763 priv->mgmta_irq = irq; in ravb_probe()
2767 priv->clk = devm_clk_get(&pdev->dev, NULL); in ravb_probe()
2768 if (IS_ERR(priv->clk)) { in ravb_probe()
2769 error = PTR_ERR(priv->clk); in ravb_probe()
2773 priv->refclk = devm_clk_get_optional(&pdev->dev, "refclk"); in ravb_probe()
2774 if (IS_ERR(priv->refclk)) { in ravb_probe()
2775 error = PTR_ERR(priv->refclk); in ravb_probe()
2778 clk_prepare_enable(priv->refclk); in ravb_probe()
2780 if (info->gptp_ref_clk) { in ravb_probe()
2781 priv->gptp_clk = devm_clk_get(&pdev->dev, "gptp"); in ravb_probe()
2782 if (IS_ERR(priv->gptp_clk)) { in ravb_probe()
2783 error = PTR_ERR(priv->gptp_clk); in ravb_probe()
2786 clk_prepare_enable(priv->gptp_clk); in ravb_probe()
2789 ndev->max_mtu = info->rx_max_buf_size - (ETH_HLEN + VLAN_HLEN + ETH_FCS_LEN); in ravb_probe()
2790 ndev->min_mtu = ETH_MIN_MTU; in ravb_probe()
2792 /* FIXME: R-Car Gen2 has 4byte alignment restriction for tx buffer in ravb_probe()
2797 priv->num_tx_desc = info->aligned_tx ? 2 : 1; in ravb_probe()
2800 ndev->netdev_ops = &ravb_netdev_ops; in ravb_probe()
2801 ndev->ethtool_ops = &ravb_ethtool_ops; in ravb_probe()
2808 if (info->gptp || info->ccc_gac) { in ravb_probe()
2818 if (info->internal_delay) { in ravb_probe()
2824 priv->desc_bat_size = sizeof(struct ravb_desc) * DBAT_ENTRY_NUM; in ravb_probe()
2825 priv->desc_bat = dma_alloc_coherent(ndev->dev.parent, priv->desc_bat_size, in ravb_probe()
2826 &priv->desc_bat_dma, GFP_KERNEL); in ravb_probe()
2827 if (!priv->desc_bat) { in ravb_probe()
2828 dev_err(&pdev->dev, in ravb_probe()
2830 priv->desc_bat_size); in ravb_probe()
2831 error = -ENOMEM; in ravb_probe()
2835 priv->desc_bat[q].die_dt = DT_EOS; in ravb_probe()
2836 ravb_write(ndev, priv->desc_bat_dma, DBAT); in ravb_probe()
2839 INIT_LIST_HEAD(&priv->ts_skb_list); in ravb_probe()
2842 if (info->ccc_gac) in ravb_probe()
2846 priv->msg_enable = RAVB_DEF_MSG_ENABLE; in ravb_probe()
2850 if (!is_valid_ether_addr(ndev->dev_addr)) { in ravb_probe()
2851 dev_warn(&pdev->dev, in ravb_probe()
2859 dev_err(&pdev->dev, "failed to initialize MDIO\n"); in ravb_probe()
2863 netif_napi_add(ndev, &priv->napi[RAVB_BE], ravb_poll); in ravb_probe()
2864 if (info->nc_queues) in ravb_probe()
2865 netif_napi_add(ndev, &priv->napi[RAVB_NC], ravb_poll); in ravb_probe()
2872 device_set_wakeup_capable(&pdev->dev, 1); in ravb_probe()
2876 (u32)ndev->base_addr, ndev->dev_addr, ndev->irq); in ravb_probe()
2883 if (info->nc_queues) in ravb_probe()
2884 netif_napi_del(&priv->napi[RAVB_NC]); in ravb_probe()
2886 netif_napi_del(&priv->napi[RAVB_BE]); in ravb_probe()
2889 dma_free_coherent(ndev->dev.parent, priv->desc_bat_size, priv->desc_bat, in ravb_probe()
2890 priv->desc_bat_dma); in ravb_probe()
2893 if (info->ccc_gac) in ravb_probe()
2896 clk_disable_unprepare(priv->gptp_clk); in ravb_probe()
2898 clk_disable_unprepare(priv->refclk); in ravb_probe()
2900 pm_runtime_put(&pdev->dev); in ravb_probe()
2902 pm_runtime_disable(&pdev->dev); in ravb_probe()
2913 const struct ravb_hw_info *info = priv->info; in ravb_remove()
2916 if (info->nc_queues) in ravb_remove()
2917 netif_napi_del(&priv->napi[RAVB_NC]); in ravb_remove()
2918 netif_napi_del(&priv->napi[RAVB_BE]); in ravb_remove()
2923 if (info->ccc_gac) in ravb_remove()
2926 dma_free_coherent(ndev->dev.parent, priv->desc_bat_size, priv->desc_bat, in ravb_remove()
2927 priv->desc_bat_dma); in ravb_remove()
2931 clk_disable_unprepare(priv->gptp_clk); in ravb_remove()
2932 clk_disable_unprepare(priv->refclk); in ravb_remove()
2934 pm_runtime_put_sync(&pdev->dev); in ravb_remove()
2935 pm_runtime_disable(&pdev->dev); in ravb_remove()
2936 reset_control_assert(priv->rstc); in ravb_remove()
2946 const struct ravb_hw_info *info = priv->info; in ravb_wol_setup()
2954 synchronize_irq(priv->emac_irq); in ravb_wol_setup()
2955 if (info->nc_queues) in ravb_wol_setup()
2956 napi_disable(&priv->napi[RAVB_NC]); in ravb_wol_setup()
2957 napi_disable(&priv->napi[RAVB_BE]); in ravb_wol_setup()
2963 return enable_irq_wake(priv->emac_irq); in ravb_wol_setup()
2969 const struct ravb_hw_info *info = priv->info; in ravb_wol_restore()
2971 if (info->nc_queues) in ravb_wol_restore()
2972 napi_enable(&priv->napi[RAVB_NC]); in ravb_wol_restore()
2973 napi_enable(&priv->napi[RAVB_BE]); in ravb_wol_restore()
2980 return disable_irq_wake(priv->emac_irq); in ravb_wol_restore()
2994 if (priv->wol_enabled) in ravb_suspend()
2999 if (priv->info->ccc_gac) in ravb_suspend()
3009 const struct ravb_hw_info *info = priv->info; in ravb_resume()
3013 if (priv->wol_enabled) { in ravb_resume()
3029 if (info->gptp || info->ccc_gac) { in ravb_resume()
3039 if (info->internal_delay) in ravb_resume()
3043 ravb_write(ndev, priv->desc_bat_dma, DBAT); in ravb_resume()
3045 if (priv->info->ccc_gac) in ravb_resume()
3046 ravb_ptp_init(ndev, priv->pdev); in ravb_resume()
3049 if (priv->wol_enabled) { in ravb_resume()
3066 /* Runtime PM callback shared between ->runtime_suspend() in ravb_runtime_nop()
3067 * and ->runtime_resume(). Simply returns success. in ravb_runtime_nop()
3069 * This driver re-initializes all registers after in ravb_runtime_nop()