Lines Matching refs: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_gbeth(struct net_device *ndev) in ravb_set_rate_gbeth() argument
87 struct ravb_private *priv = netdev_priv(ndev); in ravb_set_rate_gbeth()
91 ravb_write(ndev, GBETH_GECMR_SPEED_10, GECMR); in ravb_set_rate_gbeth()
94 ravb_write(ndev, GBETH_GECMR_SPEED_100, GECMR); in ravb_set_rate_gbeth()
97 ravb_write(ndev, GBETH_GECMR_SPEED_1000, GECMR); in ravb_set_rate_gbeth()
102 static void ravb_set_rate_rcar(struct net_device *ndev) in ravb_set_rate_rcar() argument
104 struct ravb_private *priv = netdev_priv(ndev); in ravb_set_rate_rcar()
108 ravb_write(ndev, GECMR_SPEED_100, GECMR); in ravb_set_rate_rcar()
111 ravb_write(ndev, GECMR_SPEED_1000, GECMR); in ravb_set_rate_rcar()
130 struct net_device *ndev) in ravb_read_mac_address() argument
134 ret = of_get_ethdev_address(np, ndev); in ravb_read_mac_address()
136 u32 mahr = ravb_read(ndev, MAHR); in ravb_read_mac_address()
137 u32 malr = ravb_read(ndev, MALR); in ravb_read_mac_address()
146 eth_hw_addr_set(ndev, addr); in ravb_read_mac_address()
155 ravb_modify(priv->ndev, PIR, mask, set ? mask : 0); in ravb_mdio_ctrl()
182 return (ravb_read(priv->ndev, PIR) & PIR_MDI) != 0; in ravb_get_mdio_data()
195 static int ravb_tx_free(struct net_device *ndev, int q, bool free_txed_only) in ravb_tx_free() argument
197 struct ravb_private *priv = netdev_priv(ndev); in ravb_tx_free()
219 dma_unmap_single(ndev->dev.parent, le32_to_cpu(desc->dptr), in ravb_tx_free()
238 static void ravb_rx_ring_free_gbeth(struct net_device *ndev, int q) in ravb_rx_ring_free_gbeth() argument
240 struct ravb_private *priv = netdev_priv(ndev); in ravb_rx_ring_free_gbeth()
250 if (!dma_mapping_error(ndev->dev.parent, in ravb_rx_ring_free_gbeth()
252 dma_unmap_single(ndev->dev.parent, in ravb_rx_ring_free_gbeth()
258 dma_free_coherent(ndev->dev.parent, ring_size, priv->gbeth_rx_ring, in ravb_rx_ring_free_gbeth()
263 static void ravb_rx_ring_free_rcar(struct net_device *ndev, int q) in ravb_rx_ring_free_rcar() argument
265 struct ravb_private *priv = netdev_priv(ndev); in ravb_rx_ring_free_rcar()
275 if (!dma_mapping_error(ndev->dev.parent, in ravb_rx_ring_free_rcar()
277 dma_unmap_single(ndev->dev.parent, in ravb_rx_ring_free_rcar()
284 dma_free_coherent(ndev->dev.parent, ring_size, priv->rx_ring[q], in ravb_rx_ring_free_rcar()
290 static void ravb_ring_free(struct net_device *ndev, int q) in ravb_ring_free() argument
292 struct ravb_private *priv = netdev_priv(ndev); in ravb_ring_free()
298 info->rx_ring_free(ndev, q); in ravb_ring_free()
301 ravb_tx_free(ndev, q, false); in ravb_ring_free()
305 dma_free_coherent(ndev->dev.parent, ring_size, priv->tx_ring[q], in ravb_ring_free()
329 static void ravb_rx_ring_format_gbeth(struct net_device *ndev, int q) in ravb_rx_ring_format_gbeth() argument
331 struct ravb_private *priv = netdev_priv(ndev); in ravb_rx_ring_format_gbeth()
344 dma_addr = dma_map_single(ndev->dev.parent, priv->rx_skb[q][i]->data, in ravb_rx_ring_format_gbeth()
350 if (dma_mapping_error(ndev->dev.parent, dma_addr)) in ravb_rx_ring_format_gbeth()
360 static void ravb_rx_ring_format_rcar(struct net_device *ndev, int q) in ravb_rx_ring_format_rcar() argument
362 struct ravb_private *priv = netdev_priv(ndev); in ravb_rx_ring_format_rcar()
374 dma_addr = dma_map_single(ndev->dev.parent, priv->rx_skb[q][i]->data, in ravb_rx_ring_format_rcar()
380 if (dma_mapping_error(ndev->dev.parent, dma_addr)) in ravb_rx_ring_format_rcar()
391 static void ravb_ring_format(struct net_device *ndev, int q) in ravb_ring_format() argument
393 struct ravb_private *priv = netdev_priv(ndev); in ravb_ring_format()
407 info->rx_ring_format(ndev, q); in ravb_ring_format()
433 static void *ravb_alloc_rx_desc_gbeth(struct net_device *ndev, int q) in ravb_alloc_rx_desc_gbeth() argument
435 struct ravb_private *priv = netdev_priv(ndev); in ravb_alloc_rx_desc_gbeth()
440 priv->gbeth_rx_ring = dma_alloc_coherent(ndev->dev.parent, ring_size, in ravb_alloc_rx_desc_gbeth()
446 static void *ravb_alloc_rx_desc_rcar(struct net_device *ndev, int q) in ravb_alloc_rx_desc_rcar() argument
448 struct ravb_private *priv = netdev_priv(ndev); in ravb_alloc_rx_desc_rcar()
453 priv->rx_ring[q] = dma_alloc_coherent(ndev->dev.parent, ring_size, in ravb_alloc_rx_desc_rcar()
460 static int ravb_ring_init(struct net_device *ndev, int q) in ravb_ring_init() argument
462 struct ravb_private *priv = netdev_priv(ndev); in ravb_ring_init()
478 skb = __netdev_alloc_skb(ndev, info->max_rx_len, GFP_KERNEL); in ravb_ring_init()
494 if (!info->alloc_rx_desc(ndev, q)) in ravb_ring_init()
502 priv->tx_ring[q] = dma_alloc_coherent(ndev->dev.parent, ring_size, in ravb_ring_init()
511 ravb_ring_free(ndev, q); in ravb_ring_init()
516 static void ravb_emac_init_gbeth(struct net_device *ndev) in ravb_emac_init_gbeth() argument
518 struct ravb_private *priv = netdev_priv(ndev); in ravb_emac_init_gbeth()
521 ravb_write(ndev, GBETH_RX_BUFF_MAX + ETH_FCS_LEN, RFLR); in ravb_emac_init_gbeth()
524 ravb_write(ndev, ECMR_ZPF | ((priv->duplex > 0) ? ECMR_DM : 0) | in ravb_emac_init_gbeth()
528 ravb_set_rate_gbeth(ndev); in ravb_emac_init_gbeth()
531 ravb_write(ndev, in ravb_emac_init_gbeth()
532 (ndev->dev_addr[0] << 24) | (ndev->dev_addr[1] << 16) | in ravb_emac_init_gbeth()
533 (ndev->dev_addr[2] << 8) | (ndev->dev_addr[3]), MAHR); in ravb_emac_init_gbeth()
534 ravb_write(ndev, (ndev->dev_addr[4] << 8) | (ndev->dev_addr[5]), MALR); in ravb_emac_init_gbeth()
537 ravb_write(ndev, ECSR_ICD | ECSR_LCHNG | ECSR_PFRI, ECSR); in ravb_emac_init_gbeth()
538 ravb_write(ndev, CSR0_TPE | CSR0_RPE, CSR0); in ravb_emac_init_gbeth()
541 ravb_write(ndev, ECSIPR_ICDIP, ECSIPR); in ravb_emac_init_gbeth()
544 ravb_modify(ndev, CXR31, CXR31_SEL_LINK0 | CXR31_SEL_LINK1, 0); in ravb_emac_init_gbeth()
545 ravb_write(ndev, (1000 << 16) | CXR35_SEL_XMII_MII, CXR35); in ravb_emac_init_gbeth()
547 ravb_modify(ndev, CXR31, CXR31_SEL_LINK0 | CXR31_SEL_LINK1, in ravb_emac_init_gbeth()
552 static void ravb_emac_init_rcar(struct net_device *ndev) in ravb_emac_init_rcar() argument
555 ravb_write(ndev, ndev->mtu + ETH_HLEN + VLAN_HLEN + ETH_FCS_LEN, RFLR); in ravb_emac_init_rcar()
558 ravb_write(ndev, ECMR_ZPF | ECMR_DM | in ravb_emac_init_rcar()
559 (ndev->features & NETIF_F_RXCSUM ? ECMR_RCSC : 0) | in ravb_emac_init_rcar()
562 ravb_set_rate_rcar(ndev); in ravb_emac_init_rcar()
565 ravb_write(ndev, in ravb_emac_init_rcar()
566 (ndev->dev_addr[0] << 24) | (ndev->dev_addr[1] << 16) | in ravb_emac_init_rcar()
567 (ndev->dev_addr[2] << 8) | (ndev->dev_addr[3]), MAHR); in ravb_emac_init_rcar()
568 ravb_write(ndev, in ravb_emac_init_rcar()
569 (ndev->dev_addr[4] << 8) | (ndev->dev_addr[5]), MALR); in ravb_emac_init_rcar()
572 ravb_write(ndev, ECSR_ICD | ECSR_MPD, ECSR); in ravb_emac_init_rcar()
575 ravb_write(ndev, ECSIPR_ICDIP | ECSIPR_MPDIP | ECSIPR_LCHNGIP, ECSIPR); in ravb_emac_init_rcar()
579 static void ravb_emac_init(struct net_device *ndev) in ravb_emac_init() argument
581 struct ravb_private *priv = netdev_priv(ndev); in ravb_emac_init()
584 info->emac_init(ndev); in ravb_emac_init()
587 static int ravb_dmac_init_gbeth(struct net_device *ndev) in ravb_dmac_init_gbeth() argument
591 error = ravb_ring_init(ndev, RAVB_BE); in ravb_dmac_init_gbeth()
596 ravb_ring_format(ndev, RAVB_BE); in ravb_dmac_init_gbeth()
599 ravb_write(ndev, 0x60000000, RCR); in ravb_dmac_init_gbeth()
602 ravb_write(ndev, 0x7ffc0000 | GBETH_RX_BUFF_MAX, RTC); in ravb_dmac_init_gbeth()
605 ravb_write(ndev, 0x00222200, TGC); in ravb_dmac_init_gbeth()
607 ravb_write(ndev, 0, TCCR); in ravb_dmac_init_gbeth()
610 ravb_write(ndev, RIC0_FRE0, RIC0); in ravb_dmac_init_gbeth()
612 ravb_write(ndev, 0x0, RIC1); in ravb_dmac_init_gbeth()
614 ravb_write(ndev, RIC2_QFE0 | RIC2_RFFE, RIC2); in ravb_dmac_init_gbeth()
616 ravb_write(ndev, TIC_FTE0, TIC); in ravb_dmac_init_gbeth()
621 static int ravb_dmac_init_rcar(struct net_device *ndev) in ravb_dmac_init_rcar() argument
623 struct ravb_private *priv = netdev_priv(ndev); in ravb_dmac_init_rcar()
627 error = ravb_ring_init(ndev, RAVB_BE); in ravb_dmac_init_rcar()
630 error = ravb_ring_init(ndev, RAVB_NC); in ravb_dmac_init_rcar()
632 ravb_ring_free(ndev, RAVB_BE); in ravb_dmac_init_rcar()
637 ravb_ring_format(ndev, RAVB_BE); in ravb_dmac_init_rcar()
638 ravb_ring_format(ndev, RAVB_NC); in ravb_dmac_init_rcar()
641 ravb_write(ndev, in ravb_dmac_init_rcar()
645 ravb_write(ndev, TGC_TQP_AVBMODE1 | 0x00112200, TGC); in ravb_dmac_init_rcar()
648 ravb_write(ndev, TCCR_TFEN, TCCR); in ravb_dmac_init_rcar()
653 ravb_write(ndev, 0, DIL); in ravb_dmac_init_rcar()
655 ravb_write(ndev, CIE_CRIE | CIE_CTIE | CIE_CL0M, CIE); in ravb_dmac_init_rcar()
658 ravb_write(ndev, RIC0_FRE0 | RIC0_FRE1, RIC0); in ravb_dmac_init_rcar()
660 ravb_write(ndev, 0, RIC1); in ravb_dmac_init_rcar()
662 ravb_write(ndev, RIC2_QFE0 | RIC2_QFE1 | RIC2_RFFE, RIC2); in ravb_dmac_init_rcar()
664 ravb_write(ndev, TIC_FTE0 | TIC_FTE1 | TIC_TFUE, TIC); in ravb_dmac_init_rcar()
670 static int ravb_dmac_init(struct net_device *ndev) in ravb_dmac_init() argument
672 struct ravb_private *priv = netdev_priv(ndev); in ravb_dmac_init()
677 error = ravb_config(ndev); in ravb_dmac_init()
681 error = info->dmac_init(ndev); in ravb_dmac_init()
686 ravb_modify(ndev, CCC, CCC_OPC, CCC_OPC_OPERATION); in ravb_dmac_init()
691 static void ravb_get_tx_tstamp(struct net_device *ndev) in ravb_get_tx_tstamp() argument
693 struct ravb_private *priv = netdev_priv(ndev); in ravb_get_tx_tstamp()
702 count = (ravb_read(ndev, TSR) & TSR_TFFL) >> 8; in ravb_get_tx_tstamp()
704 tfa2 = ravb_read(ndev, TFA2); in ravb_get_tx_tstamp()
706 ts.tv_nsec = (u64)ravb_read(ndev, TFA0); in ravb_get_tx_tstamp()
708 ravb_read(ndev, TFA1); in ravb_get_tx_tstamp()
725 ravb_modify(ndev, TCCR, TCCR_TFR, TCCR_TFR); in ravb_get_tx_tstamp()
744 static struct sk_buff *ravb_get_skb_gbeth(struct net_device *ndev, int entry, in ravb_get_skb_gbeth() argument
747 struct ravb_private *priv = netdev_priv(ndev); in ravb_get_skb_gbeth()
752 dma_unmap_single(ndev->dev.parent, le32_to_cpu(desc->dptr), in ravb_get_skb_gbeth()
759 static bool ravb_rx_gbeth(struct net_device *ndev, int *quota, int q) in ravb_rx_gbeth() argument
761 struct ravb_private *priv = netdev_priv(ndev); in ravb_rx_gbeth()
811 skb = ravb_get_skb_gbeth(ndev, entry, desc); in ravb_rx_gbeth()
813 skb->protocol = eth_type_trans(skb, ndev); in ravb_rx_gbeth()
819 priv->rx_1st_skb = ravb_get_skb_gbeth(ndev, entry, desc); in ravb_rx_gbeth()
823 skb = ravb_get_skb_gbeth(ndev, entry, desc); in ravb_rx_gbeth()
832 skb = ravb_get_skb_gbeth(ndev, entry, desc); in ravb_rx_gbeth()
840 eth_type_trans(priv->rx_1st_skb, ndev); in ravb_rx_gbeth()
860 skb = netdev_alloc_skb(ndev, info->max_rx_len); in ravb_rx_gbeth()
864 dma_addr = dma_map_single(ndev->dev.parent, in ravb_rx_gbeth()
872 if (dma_mapping_error(ndev->dev.parent, dma_addr)) in ravb_rx_gbeth()
888 static bool ravb_rx_rcar(struct net_device *ndev, int *quota, int q) in ravb_rx_rcar() argument
890 struct ravb_private *priv = netdev_priv(ndev); in ravb_rx_rcar()
939 dma_unmap_single(ndev->dev.parent, le32_to_cpu(desc->dptr), in ravb_rx_rcar()
957 skb->protocol = eth_type_trans(skb, ndev); in ravb_rx_rcar()
958 if (ndev->features & NETIF_F_RXCSUM) in ravb_rx_rcar()
976 skb = netdev_alloc_skb(ndev, info->max_rx_len); in ravb_rx_rcar()
980 dma_addr = dma_map_single(ndev->dev.parent, skb->data, in ravb_rx_rcar()
987 if (dma_mapping_error(ndev->dev.parent, dma_addr)) in ravb_rx_rcar()
1003 static bool ravb_rx(struct net_device *ndev, int *quota, int q) in ravb_rx() argument
1005 struct ravb_private *priv = netdev_priv(ndev); in ravb_rx()
1008 return info->receive(ndev, quota, q); in ravb_rx()
1011 static void ravb_rcv_snd_disable(struct net_device *ndev) in ravb_rcv_snd_disable() argument
1014 ravb_modify(ndev, ECMR, ECMR_RE | ECMR_TE, 0); in ravb_rcv_snd_disable()
1017 static void ravb_rcv_snd_enable(struct net_device *ndev) in ravb_rcv_snd_enable() argument
1020 ravb_modify(ndev, ECMR, ECMR_RE | ECMR_TE, ECMR_RE | ECMR_TE); in ravb_rcv_snd_enable()
1024 static int ravb_stop_dma(struct net_device *ndev) in ravb_stop_dma() argument
1026 struct ravb_private *priv = netdev_priv(ndev); in ravb_stop_dma()
1031 error = ravb_wait(ndev, TCCR, info->tccr_mask, 0); in ravb_stop_dma()
1036 error = ravb_wait(ndev, CSR, CSR_TPO0 | CSR_TPO1 | CSR_TPO2 | CSR_TPO3, in ravb_stop_dma()
1042 ravb_rcv_snd_disable(ndev); in ravb_stop_dma()
1045 error = ravb_wait(ndev, CSR, CSR_RPO, 0); in ravb_stop_dma()
1050 return ravb_config(ndev); in ravb_stop_dma()
1054 static void ravb_emac_interrupt_unlocked(struct net_device *ndev) in ravb_emac_interrupt_unlocked() argument
1056 struct ravb_private *priv = netdev_priv(ndev); in ravb_emac_interrupt_unlocked()
1059 ecsr = ravb_read(ndev, ECSR); in ravb_emac_interrupt_unlocked()
1060 ravb_write(ndev, ecsr, ECSR); /* clear interrupt */ in ravb_emac_interrupt_unlocked()
1065 ndev->stats.tx_carrier_errors++; in ravb_emac_interrupt_unlocked()
1070 psr = ravb_read(ndev, PSR); in ravb_emac_interrupt_unlocked()
1075 ravb_rcv_snd_disable(ndev); in ravb_emac_interrupt_unlocked()
1078 ravb_rcv_snd_enable(ndev); in ravb_emac_interrupt_unlocked()
1085 struct net_device *ndev = dev_id; in ravb_emac_interrupt() local
1086 struct ravb_private *priv = netdev_priv(ndev); in ravb_emac_interrupt()
1089 ravb_emac_interrupt_unlocked(ndev); in ravb_emac_interrupt()
1095 static void ravb_error_interrupt(struct net_device *ndev) in ravb_error_interrupt() argument
1097 struct ravb_private *priv = netdev_priv(ndev); in ravb_error_interrupt()
1100 eis = ravb_read(ndev, EIS); in ravb_error_interrupt()
1101 ravb_write(ndev, ~(EIS_QFS | EIS_RESERVED), EIS); in ravb_error_interrupt()
1103 ris2 = ravb_read(ndev, RIS2); in ravb_error_interrupt()
1104 ravb_write(ndev, ~(RIS2_QFF0 | RIS2_QFF1 | RIS2_RFFF | RIS2_RESERVED), in ravb_error_interrupt()
1121 static bool ravb_queue_interrupt(struct net_device *ndev, int q) in ravb_queue_interrupt() argument
1123 struct ravb_private *priv = netdev_priv(ndev); in ravb_queue_interrupt()
1125 u32 ris0 = ravb_read(ndev, RIS0); in ravb_queue_interrupt()
1126 u32 ric0 = ravb_read(ndev, RIC0); in ravb_queue_interrupt()
1127 u32 tis = ravb_read(ndev, TIS); in ravb_queue_interrupt()
1128 u32 tic = ravb_read(ndev, TIC); in ravb_queue_interrupt()
1134 ravb_write(ndev, ric0 & ~BIT(q), RIC0); in ravb_queue_interrupt()
1135 ravb_write(ndev, tic & ~BIT(q), TIC); in ravb_queue_interrupt()
1137 ravb_write(ndev, BIT(q), RID0); in ravb_queue_interrupt()
1138 ravb_write(ndev, BIT(q), TID); in ravb_queue_interrupt()
1142 netdev_warn(ndev, in ravb_queue_interrupt()
1145 netdev_warn(ndev, in ravb_queue_interrupt()
1154 static bool ravb_timestamp_interrupt(struct net_device *ndev) in ravb_timestamp_interrupt() argument
1156 u32 tis = ravb_read(ndev, TIS); in ravb_timestamp_interrupt()
1159 ravb_write(ndev, ~(TIS_TFUF | TIS_RESERVED), TIS); in ravb_timestamp_interrupt()
1160 ravb_get_tx_tstamp(ndev); in ravb_timestamp_interrupt()
1168 struct net_device *ndev = dev_id; in ravb_interrupt() local
1169 struct ravb_private *priv = netdev_priv(ndev); in ravb_interrupt()
1176 iss = ravb_read(ndev, ISS); in ravb_interrupt()
1183 if (ravb_timestamp_interrupt(ndev)) in ravb_interrupt()
1189 if (ravb_queue_interrupt(ndev, q)) in ravb_interrupt()
1193 if (ravb_queue_interrupt(ndev, RAVB_BE)) in ravb_interrupt()
1200 ravb_emac_interrupt_unlocked(ndev); in ravb_interrupt()
1206 ravb_error_interrupt(ndev); in ravb_interrupt()
1212 ravb_ptp_interrupt(ndev); in ravb_interrupt()
1223 struct net_device *ndev = dev_id; in ravb_multi_interrupt() local
1224 struct ravb_private *priv = netdev_priv(ndev); in ravb_multi_interrupt()
1230 iss = ravb_read(ndev, ISS); in ravb_multi_interrupt()
1233 if ((iss & ISS_TFUS) && ravb_timestamp_interrupt(ndev)) in ravb_multi_interrupt()
1238 ravb_error_interrupt(ndev); in ravb_multi_interrupt()
1244 ravb_ptp_interrupt(ndev); in ravb_multi_interrupt()
1254 struct net_device *ndev = dev_id; in ravb_dma_interrupt() local
1255 struct ravb_private *priv = netdev_priv(ndev); in ravb_dma_interrupt()
1261 if (ravb_queue_interrupt(ndev, q)) in ravb_dma_interrupt()
1280 struct net_device *ndev = napi->dev; in ravb_poll() local
1281 struct ravb_private *priv = netdev_priv(ndev); in ravb_poll()
1297 ravb_write(ndev, ~(mask | RIS0_RESERVED), RIS0); in ravb_poll()
1299 if (ravb_rx(ndev, &quota, q)) in ravb_poll()
1306 ravb_write(ndev, ~(mask | TIS_RESERVED), TIS); in ravb_poll()
1307 ravb_tx_free(ndev, q, true); in ravb_poll()
1308 netif_wake_subqueue(ndev, q); in ravb_poll()
1316 ravb_modify(ndev, RIC0, mask, mask); in ravb_poll()
1317 ravb_modify(ndev, TIC, mask, mask); in ravb_poll()
1319 ravb_write(ndev, mask, RIE0); in ravb_poll()
1320 ravb_write(ndev, mask, TIE); in ravb_poll()
1328 if (priv->rx_over_errors != ndev->stats.rx_over_errors) in ravb_poll()
1329 ndev->stats.rx_over_errors = priv->rx_over_errors; in ravb_poll()
1330 if (priv->rx_fifo_errors != ndev->stats.rx_fifo_errors) in ravb_poll()
1331 ndev->stats.rx_fifo_errors = priv->rx_fifo_errors; in ravb_poll()
1336 static void ravb_set_duplex_gbeth(struct net_device *ndev) in ravb_set_duplex_gbeth() argument
1338 struct ravb_private *priv = netdev_priv(ndev); in ravb_set_duplex_gbeth()
1340 ravb_modify(ndev, ECMR, ECMR_DM, priv->duplex > 0 ? ECMR_DM : 0); in ravb_set_duplex_gbeth()
1344 static void ravb_adjust_link(struct net_device *ndev) in ravb_adjust_link() argument
1346 struct ravb_private *priv = netdev_priv(ndev); in ravb_adjust_link()
1348 struct phy_device *phydev = ndev->phydev; in ravb_adjust_link()
1356 ravb_rcv_snd_disable(ndev); in ravb_adjust_link()
1362 ravb_set_duplex_gbeth(ndev); in ravb_adjust_link()
1368 info->set_rate(ndev); in ravb_adjust_link()
1371 ravb_modify(ndev, ECMR, ECMR_TXF, 0); in ravb_adjust_link()
1385 ravb_rcv_snd_enable(ndev); in ravb_adjust_link()
1399 static int ravb_phy_init(struct net_device *ndev) in ravb_phy_init() argument
1401 struct device_node *np = ndev->dev.parent->of_node; in ravb_phy_init()
1402 struct ravb_private *priv = netdev_priv(ndev); in ravb_phy_init()
1429 phydev = of_phy_connect(ndev, pn, ravb_adjust_link, 0, iface); in ravb_phy_init()
1432 netdev_err(ndev, "failed to connect PHY\n"); in ravb_phy_init()
1443 netdev_info(ndev, "limited PHY to 100Mbit/s\n"); in ravb_phy_init()
1472 static int ravb_phy_start(struct net_device *ndev) in ravb_phy_start() argument
1476 error = ravb_phy_init(ndev); in ravb_phy_start()
1480 phy_start(ndev->phydev); in ravb_phy_start()
1485 static u32 ravb_get_msglevel(struct net_device *ndev) in ravb_get_msglevel() argument
1487 struct ravb_private *priv = netdev_priv(ndev); in ravb_get_msglevel()
1492 static void ravb_set_msglevel(struct net_device *ndev, u32 value) in ravb_set_msglevel() argument
1494 struct ravb_private *priv = netdev_priv(ndev); in ravb_set_msglevel()
1564 static void ravb_get_ethtool_stats(struct net_device *ndev, in ravb_get_ethtool_stats() argument
1567 struct ravb_private *priv = netdev_priv(ndev); in ravb_get_ethtool_stats()
1596 static void ravb_get_strings(struct net_device *ndev, u32 stringset, u8 *data) in ravb_get_strings() argument
1598 struct ravb_private *priv = netdev_priv(ndev); in ravb_get_strings()
1608 static void ravb_get_ringparam(struct net_device *ndev, in ravb_get_ringparam() argument
1613 struct ravb_private *priv = netdev_priv(ndev); in ravb_get_ringparam()
1621 static int ravb_set_ringparam(struct net_device *ndev, in ravb_set_ringparam() argument
1626 struct ravb_private *priv = netdev_priv(ndev); in ravb_set_ringparam()
1638 if (netif_running(ndev)) { in ravb_set_ringparam()
1639 netif_device_detach(ndev); in ravb_set_ringparam()
1642 ravb_ptp_stop(ndev); in ravb_set_ringparam()
1644 error = ravb_stop_dma(ndev); in ravb_set_ringparam()
1646 netdev_err(ndev, in ravb_set_ringparam()
1650 synchronize_irq(ndev->irq); in ravb_set_ringparam()
1653 ravb_ring_free(ndev, RAVB_BE); in ravb_set_ringparam()
1655 ravb_ring_free(ndev, RAVB_NC); in ravb_set_ringparam()
1662 if (netif_running(ndev)) { in ravb_set_ringparam()
1663 error = ravb_dmac_init(ndev); in ravb_set_ringparam()
1665 netdev_err(ndev, in ravb_set_ringparam()
1671 ravb_emac_init(ndev); in ravb_set_ringparam()
1675 ravb_ptp_init(ndev, priv->pdev); in ravb_set_ringparam()
1677 netif_device_attach(ndev); in ravb_set_ringparam()
1683 static int ravb_get_ts_info(struct net_device *ndev, in ravb_get_ts_info() argument
1686 struct ravb_private *priv = netdev_priv(ndev); in ravb_get_ts_info()
1707 static void ravb_get_wol(struct net_device *ndev, struct ethtool_wolinfo *wol) in ravb_get_wol() argument
1709 struct ravb_private *priv = netdev_priv(ndev); in ravb_get_wol()
1715 static int ravb_set_wol(struct net_device *ndev, struct ethtool_wolinfo *wol) in ravb_set_wol() argument
1717 struct ravb_private *priv = netdev_priv(ndev); in ravb_set_wol()
1748 struct net_device *ndev, struct device *dev, in ravb_hook_irq() argument
1754 name = devm_kasprintf(dev, GFP_KERNEL, "%s:%s", ndev->name, ch); in ravb_hook_irq()
1757 error = request_irq(irq, handler, 0, name, ndev); in ravb_hook_irq()
1759 netdev_err(ndev, "cannot request IRQ %s\n", name); in ravb_hook_irq()
1765 static int ravb_open(struct net_device *ndev) in ravb_open() argument
1767 struct ravb_private *priv = netdev_priv(ndev); in ravb_open()
1778 error = request_irq(ndev->irq, ravb_interrupt, IRQF_SHARED, in ravb_open()
1779 ndev->name, ndev); in ravb_open()
1781 netdev_err(ndev, "cannot request IRQ\n"); in ravb_open()
1785 error = ravb_hook_irq(ndev->irq, ravb_multi_interrupt, ndev, in ravb_open()
1789 error = ravb_hook_irq(priv->emac_irq, ravb_emac_interrupt, ndev, in ravb_open()
1794 ndev, dev, "ch0:rx_be"); in ravb_open()
1798 ndev, dev, "ch18:tx_be"); in ravb_open()
1802 ndev, dev, "ch1:rx_nc"); in ravb_open()
1806 ndev, dev, "ch19:tx_nc"); in ravb_open()
1812 ndev, dev, "err_a"); in ravb_open()
1816 ndev, dev, "mgmt_a"); in ravb_open()
1823 error = ravb_dmac_init(ndev); in ravb_open()
1826 ravb_emac_init(ndev); in ravb_open()
1830 ravb_ptp_init(ndev, priv->pdev); in ravb_open()
1832 netif_tx_start_all_queues(ndev); in ravb_open()
1835 error = ravb_phy_start(ndev); in ravb_open()
1844 ravb_ptp_stop(ndev); in ravb_open()
1849 free_irq(priv->mgmta_irq, ndev); in ravb_open()
1852 free_irq(priv->erra_irq, ndev); in ravb_open()
1854 free_irq(priv->tx_irqs[RAVB_NC], ndev); in ravb_open()
1856 free_irq(priv->rx_irqs[RAVB_NC], ndev); in ravb_open()
1858 free_irq(priv->tx_irqs[RAVB_BE], ndev); in ravb_open()
1860 free_irq(priv->rx_irqs[RAVB_BE], ndev); in ravb_open()
1862 free_irq(priv->emac_irq, ndev); in ravb_open()
1864 free_irq(ndev->irq, ndev); in ravb_open()
1873 static void ravb_tx_timeout(struct net_device *ndev, unsigned int txqueue) in ravb_tx_timeout() argument
1875 struct ravb_private *priv = netdev_priv(ndev); in ravb_tx_timeout()
1877 netif_err(priv, tx_err, ndev, in ravb_tx_timeout()
1879 ravb_read(ndev, ISS)); in ravb_tx_timeout()
1882 ndev->stats.tx_errors++; in ravb_tx_timeout()
1892 struct net_device *ndev = priv->ndev; in ravb_tx_timeout_work() local
1895 netif_tx_stop_all_queues(ndev); in ravb_tx_timeout_work()
1899 ravb_ptp_stop(ndev); in ravb_tx_timeout_work()
1902 if (ravb_stop_dma(ndev)) { in ravb_tx_timeout_work()
1911 ravb_rcv_snd_enable(ndev); in ravb_tx_timeout_work()
1915 ravb_ring_free(ndev, RAVB_BE); in ravb_tx_timeout_work()
1917 ravb_ring_free(ndev, RAVB_NC); in ravb_tx_timeout_work()
1920 error = ravb_dmac_init(ndev); in ravb_tx_timeout_work()
1926 netdev_err(ndev, "%s: ravb_dmac_init() failed, error %d\n", in ravb_tx_timeout_work()
1930 ravb_emac_init(ndev); in ravb_tx_timeout_work()
1935 ravb_ptp_init(ndev, priv->pdev); in ravb_tx_timeout_work()
1937 netif_tx_start_all_queues(ndev); in ravb_tx_timeout_work()
1941 static netdev_tx_t ravb_start_xmit(struct sk_buff *skb, struct net_device *ndev) in ravb_start_xmit() argument
1943 struct ravb_private *priv = netdev_priv(ndev); in ravb_start_xmit()
1958 netif_err(priv, tx_queued, ndev, in ravb_start_xmit()
1960 netif_stop_subqueue(ndev, q); in ravb_start_xmit()
1992 dma_addr = dma_map_single(ndev->dev.parent, buffer, len, in ravb_start_xmit()
1994 if (dma_mapping_error(ndev->dev.parent, dma_addr)) in ravb_start_xmit()
2003 dma_addr = dma_map_single(ndev->dev.parent, buffer, len, in ravb_start_xmit()
2005 if (dma_mapping_error(ndev->dev.parent, dma_addr)) in ravb_start_xmit()
2012 dma_addr = dma_map_single(ndev->dev.parent, skb->data, skb->len, in ravb_start_xmit()
2014 if (dma_mapping_error(ndev->dev.parent, dma_addr)) in ravb_start_xmit()
2027 dma_unmap_single(ndev->dev.parent, dma_addr, in ravb_start_xmit()
2054 ravb_modify(ndev, TCCR, TCCR_TSRQ0 << q, TCCR_TSRQ0 << q); in ravb_start_xmit()
2059 !ravb_tx_free(ndev, q, true)) in ravb_start_xmit()
2060 netif_stop_subqueue(ndev, q); in ravb_start_xmit()
2067 dma_unmap_single(ndev->dev.parent, le32_to_cpu(desc->dptr), in ravb_start_xmit()
2075 static u16 ravb_select_queue(struct net_device *ndev, struct sk_buff *skb, in ravb_select_queue() argument
2084 static struct net_device_stats *ravb_get_stats(struct net_device *ndev) in ravb_get_stats() argument
2086 struct ravb_private *priv = netdev_priv(ndev); in ravb_get_stats()
2090 nstats = &ndev->stats; in ravb_get_stats()
2094 nstats->tx_dropped += ravb_read(ndev, TROCR); in ravb_get_stats()
2095 ravb_write(ndev, 0, TROCR); /* (write clear) */ in ravb_get_stats()
2099 nstats->collisions += ravb_read(ndev, CXR41); in ravb_get_stats()
2100 ravb_write(ndev, 0, CXR41); /* (write clear) */ in ravb_get_stats()
2101 nstats->tx_carrier_errors += ravb_read(ndev, CXR42); in ravb_get_stats()
2102 ravb_write(ndev, 0, CXR42); /* (write clear) */ in ravb_get_stats()
2136 static void ravb_set_rx_mode(struct net_device *ndev) in ravb_set_rx_mode() argument
2138 struct ravb_private *priv = netdev_priv(ndev); in ravb_set_rx_mode()
2142 ravb_modify(ndev, ECMR, ECMR_PRM, in ravb_set_rx_mode()
2143 ndev->flags & IFF_PROMISC ? ECMR_PRM : 0); in ravb_set_rx_mode()
2148 static int ravb_close(struct net_device *ndev) in ravb_close() argument
2150 struct device_node *np = ndev->dev.parent->of_node; in ravb_close()
2151 struct ravb_private *priv = netdev_priv(ndev); in ravb_close()
2155 netif_tx_stop_all_queues(ndev); in ravb_close()
2158 ravb_write(ndev, 0, RIC0); in ravb_close()
2159 ravb_write(ndev, 0, RIC2); in ravb_close()
2160 ravb_write(ndev, 0, TIC); in ravb_close()
2164 ravb_ptp_stop(ndev); in ravb_close()
2167 if (ravb_stop_dma(ndev) < 0) in ravb_close()
2168 netdev_err(ndev, in ravb_close()
2181 if (ndev->phydev) { in ravb_close()
2182 phy_stop(ndev->phydev); in ravb_close()
2183 phy_disconnect(ndev->phydev); in ravb_close()
2189 free_irq(priv->tx_irqs[RAVB_NC], ndev); in ravb_close()
2190 free_irq(priv->rx_irqs[RAVB_NC], ndev); in ravb_close()
2191 free_irq(priv->tx_irqs[RAVB_BE], ndev); in ravb_close()
2192 free_irq(priv->rx_irqs[RAVB_BE], ndev); in ravb_close()
2193 free_irq(priv->emac_irq, ndev); in ravb_close()
2195 free_irq(priv->erra_irq, ndev); in ravb_close()
2196 free_irq(priv->mgmta_irq, ndev); in ravb_close()
2199 free_irq(ndev->irq, ndev); in ravb_close()
2206 ravb_ring_free(ndev, RAVB_BE); in ravb_close()
2208 ravb_ring_free(ndev, RAVB_NC); in ravb_close()
2213 static int ravb_hwtstamp_get(struct net_device *ndev, struct ifreq *req) in ravb_hwtstamp_get() argument
2215 struct ravb_private *priv = netdev_priv(ndev); in ravb_hwtstamp_get()
2237 static int ravb_hwtstamp_set(struct net_device *ndev, struct ifreq *req) in ravb_hwtstamp_set() argument
2239 struct ravb_private *priv = netdev_priv(ndev); in ravb_hwtstamp_set()
2278 static int ravb_do_ioctl(struct net_device *ndev, struct ifreq *req, int cmd) in ravb_do_ioctl() argument
2280 struct phy_device *phydev = ndev->phydev; in ravb_do_ioctl()
2282 if (!netif_running(ndev)) in ravb_do_ioctl()
2290 return ravb_hwtstamp_get(ndev, req); in ravb_do_ioctl()
2292 return ravb_hwtstamp_set(ndev, req); in ravb_do_ioctl()
2298 static int ravb_change_mtu(struct net_device *ndev, int new_mtu) in ravb_change_mtu() argument
2300 struct ravb_private *priv = netdev_priv(ndev); in ravb_change_mtu()
2302 ndev->mtu = new_mtu; in ravb_change_mtu()
2304 if (netif_running(ndev)) { in ravb_change_mtu()
2306 ravb_emac_init(ndev); in ravb_change_mtu()
2309 netdev_update_features(ndev); in ravb_change_mtu()
2314 static void ravb_set_rx_csum(struct net_device *ndev, bool enable) in ravb_set_rx_csum() argument
2316 struct ravb_private *priv = netdev_priv(ndev); in ravb_set_rx_csum()
2322 ravb_rcv_snd_disable(ndev); in ravb_set_rx_csum()
2325 ravb_modify(ndev, ECMR, ECMR_RCSC, enable ? ECMR_RCSC : 0); in ravb_set_rx_csum()
2328 ravb_rcv_snd_enable(ndev); in ravb_set_rx_csum()
2333 static int ravb_set_features_gbeth(struct net_device *ndev, in ravb_set_features_gbeth() argument
2340 static int ravb_set_features_rcar(struct net_device *ndev, in ravb_set_features_rcar() argument
2343 netdev_features_t changed = ndev->features ^ features; in ravb_set_features_rcar()
2346 ravb_set_rx_csum(ndev, features & NETIF_F_RXCSUM); in ravb_set_features_rcar()
2348 ndev->features = features; in ravb_set_features_rcar()
2353 static int ravb_set_features(struct net_device *ndev, in ravb_set_features() argument
2356 struct ravb_private *priv = netdev_priv(ndev); in ravb_set_features()
2359 return info->set_feature(ndev, features); in ravb_set_features()
2530 static int ravb_set_gti(struct net_device *ndev) in ravb_set_gti() argument
2532 struct ravb_private *priv = netdev_priv(ndev); in ravb_set_gti()
2534 struct device *dev = ndev->dev.parent; in ravb_set_gti()
2553 ravb_write(ndev, inc, GTI); in ravb_set_gti()
2558 static void ravb_set_config_mode(struct net_device *ndev) in ravb_set_config_mode() argument
2560 struct ravb_private *priv = netdev_priv(ndev); in ravb_set_config_mode()
2564 ravb_modify(ndev, CCC, CCC_OPC, CCC_OPC_CONFIG); in ravb_set_config_mode()
2566 ravb_modify(ndev, CCC, CCC_CSEL, CCC_CSEL_HPB); in ravb_set_config_mode()
2568 ravb_modify(ndev, CCC, CCC_OPC, CCC_OPC_CONFIG | in ravb_set_config_mode()
2571 ravb_modify(ndev, CCC, CCC_OPC, CCC_OPC_CONFIG); in ravb_set_config_mode()
2576 static void ravb_parse_delay_mode(struct device_node *np, struct net_device *ndev) in ravb_parse_delay_mode() argument
2578 struct ravb_private *priv = netdev_priv(ndev); in ravb_parse_delay_mode()
2610 static void ravb_set_delay_mode(struct net_device *ndev) in ravb_set_delay_mode() argument
2612 struct ravb_private *priv = netdev_priv(ndev); in ravb_set_delay_mode()
2619 ravb_modify(ndev, APSR, APSR_RDM | APSR_TDM, set); in ravb_set_delay_mode()
2628 struct net_device *ndev; in ravb_probe() local
2644 ndev = alloc_etherdev_mqs(sizeof(struct ravb_private), in ravb_probe()
2646 if (!ndev) in ravb_probe()
2651 ndev->features = info->net_features; in ravb_probe()
2652 ndev->hw_features = info->net_hw_features; in ravb_probe()
2670 ndev->irq = irq; in ravb_probe()
2672 SET_NETDEV_DEV(ndev, &pdev->dev); in ravb_probe()
2674 priv = netdev_priv(ndev); in ravb_probe()
2677 priv->ndev = ndev; in ravb_probe()
2693 ndev->base_addr = res->start; in ravb_probe()
2772 ndev->max_mtu = info->rx_max_buf_size - (ETH_HLEN + VLAN_HLEN + ETH_FCS_LEN); in ravb_probe()
2773 ndev->min_mtu = ETH_MIN_MTU; in ravb_probe()
2783 ndev->netdev_ops = &ravb_netdev_ops; in ravb_probe()
2784 ndev->ethtool_ops = &ravb_ethtool_ops; in ravb_probe()
2787 ravb_set_config_mode(ndev); in ravb_probe()
2791 error = ravb_set_gti(ndev); in ravb_probe()
2796 ravb_modify(ndev, GCCR, GCCR_LTI, GCCR_LTI); in ravb_probe()
2800 ravb_parse_delay_mode(np, ndev); in ravb_probe()
2801 ravb_set_delay_mode(ndev); in ravb_probe()
2806 priv->desc_bat = dma_alloc_coherent(ndev->dev.parent, priv->desc_bat_size, in ravb_probe()
2817 ravb_write(ndev, priv->desc_bat_dma, DBAT); in ravb_probe()
2824 ravb_ptp_init(ndev, pdev); in ravb_probe()
2830 ravb_read_mac_address(np, ndev); in ravb_probe()
2831 if (!is_valid_ether_addr(ndev->dev_addr)) { in ravb_probe()
2834 eth_hw_addr_random(ndev); in ravb_probe()
2844 netif_napi_add(ndev, &priv->napi[RAVB_BE], ravb_poll); in ravb_probe()
2846 netif_napi_add(ndev, &priv->napi[RAVB_NC], ravb_poll); in ravb_probe()
2849 error = register_netdev(ndev); in ravb_probe()
2856 netdev_info(ndev, "Base address at %#x, %pM, IRQ %d.\n", in ravb_probe()
2857 (u32)ndev->base_addr, ndev->dev_addr, ndev->irq); in ravb_probe()
2859 platform_set_drvdata(pdev, ndev); in ravb_probe()
2870 dma_free_coherent(ndev->dev.parent, priv->desc_bat_size, priv->desc_bat, in ravb_probe()
2875 ravb_ptp_stop(ndev); in ravb_probe()
2881 free_netdev(ndev); in ravb_probe()
2891 struct net_device *ndev = platform_get_drvdata(pdev); in ravb_remove() local
2892 struct ravb_private *priv = netdev_priv(ndev); in ravb_remove()
2897 ravb_ptp_stop(ndev); in ravb_remove()
2902 dma_free_coherent(ndev->dev.parent, priv->desc_bat_size, priv->desc_bat, in ravb_remove()
2905 ravb_write(ndev, CCC_OPC_RESET, CCC); in ravb_remove()
2906 unregister_netdev(ndev); in ravb_remove()
2914 free_netdev(ndev); in ravb_remove()
2920 static int ravb_wol_setup(struct net_device *ndev) in ravb_wol_setup() argument
2922 struct ravb_private *priv = netdev_priv(ndev); in ravb_wol_setup()
2926 ravb_write(ndev, 0, RIC0); in ravb_wol_setup()
2927 ravb_write(ndev, 0, RIC2); in ravb_wol_setup()
2928 ravb_write(ndev, 0, TIC); in ravb_wol_setup()
2935 ravb_write(ndev, ECSIPR_MPDIP, ECSIPR); in ravb_wol_setup()
2938 ravb_modify(ndev, ECMR, ECMR_MPDE, ECMR_MPDE); in ravb_wol_setup()
2943 static int ravb_wol_restore(struct net_device *ndev) in ravb_wol_restore() argument
2945 struct ravb_private *priv = netdev_priv(ndev); in ravb_wol_restore()
2953 ravb_modify(ndev, ECMR, ECMR_MPDE, 0); in ravb_wol_restore()
2955 ravb_close(ndev); in ravb_wol_restore()
2962 struct net_device *ndev = dev_get_drvdata(dev); in ravb_suspend() local
2963 struct ravb_private *priv = netdev_priv(ndev); in ravb_suspend()
2966 if (!netif_running(ndev)) in ravb_suspend()
2969 netif_device_detach(ndev); in ravb_suspend()
2972 ret = ravb_wol_setup(ndev); in ravb_suspend()
2974 ret = ravb_close(ndev); in ravb_suspend()
2977 ravb_ptp_stop(ndev); in ravb_suspend()
2984 struct net_device *ndev = dev_get_drvdata(dev); in ravb_resume() local
2985 struct ravb_private *priv = netdev_priv(ndev); in ravb_resume()
2991 ravb_write(ndev, CCC_OPC_RESET, CCC); in ravb_resume()
2999 ravb_set_config_mode(ndev); in ravb_resume()
3003 ret = ravb_set_gti(ndev); in ravb_resume()
3008 ravb_modify(ndev, GCCR, GCCR_LTI, GCCR_LTI); in ravb_resume()
3012 ravb_set_delay_mode(ndev); in ravb_resume()
3015 ravb_write(ndev, priv->desc_bat_dma, DBAT); in ravb_resume()
3018 ravb_ptp_init(ndev, priv->pdev); in ravb_resume()
3020 if (netif_running(ndev)) { in ravb_resume()
3022 ret = ravb_wol_restore(ndev); in ravb_resume()
3026 ret = ravb_open(ndev); in ravb_resume()
3029 ravb_set_rx_mode(ndev); in ravb_resume()
3030 netif_device_attach(ndev); in ravb_resume()