Lines Matching +full:rx +full:- +full:tx
1 /* SPDX-License-Identifier: GPL-2.0+ */
39 netif_err(adapter, drv, adapter->netdev, in pci11x1x_strap_get_status()
52 adapter->is_sgmii_en = true; in pci11x1x_strap_get_status()
54 adapter->is_sgmii_en = false; in pci11x1x_strap_get_status()
59 adapter->is_sgmii_en = true; in pci11x1x_strap_get_status()
61 adapter->is_sgmii_en = false; in pci11x1x_strap_get_status()
63 adapter->is_sgmii_en = false; in pci11x1x_strap_get_status()
66 netif_dbg(adapter, drv, adapter->netdev, in pci11x1x_strap_get_status()
67 "SGMII I/F %sable\n", adapter->is_sgmii_en ? "En" : "Dis"); in pci11x1x_strap_get_status()
72 struct lan743x_csr *csr = &adapter->csr; in is_pci11x1x_chip()
73 u32 id_rev = csr->id_rev; in is_pci11x1x_chip()
84 pci_release_selected_regions(adapter->pdev, in lan743x_pci_cleanup()
85 pci_select_bars(adapter->pdev, in lan743x_pci_cleanup()
87 pci_disable_device(adapter->pdev); in lan743x_pci_cleanup()
96 adapter->pdev = pdev; in lan743x_pci_init()
101 netif_info(adapter, probe, adapter->netdev, in lan743x_pci_init()
103 pdev->vendor, pdev->device); in lan743x_pci_init()
116 pci_disable_device(adapter->pdev); in lan743x_pci_init()
124 return ioread32(&adapter->csr.csr_address[offset]); in lan743x_csr_read()
130 iowrite32(data, &adapter->csr.csr_address[offset]); in lan743x_csr_write()
161 struct lan743x_csr *csr = &adapter->csr; in lan743x_csr_init()
165 bar_start = pci_resource_start(adapter->pdev, 0); in lan743x_csr_init()
166 bar_length = pci_resource_len(adapter->pdev, 0); in lan743x_csr_init()
167 csr->csr_address = devm_ioremap(&adapter->pdev->dev, in lan743x_csr_init()
169 if (!csr->csr_address) { in lan743x_csr_init()
170 result = -ENOMEM; in lan743x_csr_init()
174 csr->id_rev = lan743x_csr_read(adapter, ID_REV); in lan743x_csr_init()
175 csr->fpga_rev = lan743x_csr_read(adapter, FPGA_REV); in lan743x_csr_init()
176 netif_info(adapter, probe, adapter->netdev, in lan743x_csr_init()
178 csr->id_rev, FPGA_REV_GET_MAJOR_(csr->fpga_rev), in lan743x_csr_init()
179 FPGA_REV_GET_MINOR_(csr->fpga_rev)); in lan743x_csr_init()
180 if (!ID_REV_IS_VALID_CHIP_ID_(csr->id_rev)) { in lan743x_csr_init()
181 result = -ENODEV; in lan743x_csr_init()
185 csr->flags = LAN743X_CSR_FLAG_SUPPORTS_INTR_AUTO_SET_CLR; in lan743x_csr_init()
186 switch (csr->id_rev & ID_REV_CHIP_REV_MASK_) { in lan743x_csr_init()
188 csr->flags |= LAN743X_CSR_FLAG_IS_A0; in lan743x_csr_init()
189 csr->flags &= ~LAN743X_CSR_FLAG_SUPPORTS_INTR_AUTO_SET_CLR; in lan743x_csr_init()
192 csr->flags |= LAN743X_CSR_FLAG_IS_B0; in lan743x_csr_init()
206 struct lan743x_intr *intr = &adapter->intr; in lan743x_intr_software_isr()
208 /* disable the interrupt to prevent repeated re-triggering */ in lan743x_intr_software_isr()
210 intr->software_isr_flag = true; in lan743x_intr_software_isr()
211 wake_up(&intr->software_isr_wq); in lan743x_intr_software_isr()
216 struct lan743x_tx *tx = context; in lan743x_tx_isr() local
217 struct lan743x_adapter *adapter = tx->adapter; in lan743x_tx_isr()
223 INT_BIT_DMA_TX_(tx->channel_number)); in lan743x_tx_isr()
226 if (int_sts & INT_BIT_DMA_TX_(tx->channel_number)) { in lan743x_tx_isr()
227 u32 ioc_bit = DMAC_INT_BIT_TX_IOC_(tx->channel_number); in lan743x_tx_isr()
244 napi_schedule(&tx->napi); in lan743x_tx_isr()
252 INT_BIT_DMA_TX_(tx->channel_number)); in lan743x_tx_isr()
257 struct lan743x_rx *rx = context; in lan743x_rx_isr() local
258 struct lan743x_adapter *adapter = rx->adapter; in lan743x_rx_isr()
263 INT_BIT_DMA_RX_(rx->channel_number)); in lan743x_rx_isr()
266 if (int_sts & INT_BIT_DMA_RX_(rx->channel_number)) { in lan743x_rx_isr()
267 u32 rx_frame_bit = DMAC_INT_BIT_RXFRM_(rx->channel_number); in lan743x_rx_isr()
284 napi_schedule(&rx->napi); in lan743x_rx_isr()
292 INT_BIT_DMA_RX_(rx->channel_number)); in lan743x_rx_isr()
307 lan743x_rx_isr(&adapter->rx[channel], in lan743x_intr_shared_isr()
314 for (channel = 0; channel < adapter->used_tx_channels; in lan743x_intr_shared_isr()
319 lan743x_tx_isr(&adapter->tx[channel], in lan743x_intr_shared_isr()
342 struct lan743x_adapter *adapter = vector->adapter; in lan743x_intr_entry_isr()
347 if (vector->flags & LAN743X_VECTOR_FLAG_SOURCE_STATUS_READ) { in lan743x_intr_entry_isr()
349 } else if (vector->flags & in lan743x_intr_entry_isr()
355 int_sts = vector->int_mask | INT_BIT_MAS_; in lan743x_intr_entry_isr()
361 if (vector->flags & LAN743X_VECTOR_FLAG_VECTOR_ENABLE_ISR_CLEAR) in lan743x_intr_entry_isr()
365 INT_VEC_EN_(vector->vector_index)); in lan743x_intr_entry_isr()
367 if (vector->flags & LAN743X_VECTOR_FLAG_MASTER_ENABLE_CLEAR) in lan743x_intr_entry_isr()
371 if (vector->flags & LAN743X_VECTOR_FLAG_SOURCE_ENABLE_CHECK) { in lan743x_intr_entry_isr()
375 int_enables = vector->int_mask; in lan743x_intr_entry_isr()
379 int_sts &= vector->int_mask; in lan743x_intr_entry_isr()
381 if (vector->handler) { in lan743x_intr_entry_isr()
382 vector->handler(vector->context, in lan743x_intr_entry_isr()
383 int_sts, vector->flags); in lan743x_intr_entry_isr()
387 vector->int_mask); in lan743x_intr_entry_isr()
392 if (vector->flags & LAN743X_VECTOR_FLAG_MASTER_ENABLE_SET) in lan743x_intr_entry_isr()
396 if (vector->flags & LAN743X_VECTOR_FLAG_VECTOR_ENABLE_ISR_SET) in lan743x_intr_entry_isr()
400 INT_VEC_EN_(vector->vector_index)); in lan743x_intr_entry_isr()
407 struct lan743x_intr *intr = &adapter->intr; in lan743x_intr_test_isr()
410 intr->software_isr_flag = false; in lan743x_intr_test_isr()
416 ret = wait_event_timeout(intr->software_isr_wq, in lan743x_intr_test_isr()
417 intr->software_isr_flag, in lan743x_intr_test_isr()
423 return ret > 0 ? 0 : -ENODEV; in lan743x_intr_test_isr()
432 struct lan743x_vector *vector = &adapter->intr.vector_list in lan743x_intr_register_isr()
436 vector->adapter = adapter; in lan743x_intr_register_isr()
437 vector->flags = flags; in lan743x_intr_register_isr()
438 vector->vector_index = vector_index; in lan743x_intr_register_isr()
439 vector->int_mask = int_mask; in lan743x_intr_register_isr()
440 vector->handler = handler; in lan743x_intr_register_isr()
441 vector->context = context; in lan743x_intr_register_isr()
443 ret = request_irq(vector->irq, in lan743x_intr_register_isr()
448 vector->handler = NULL; in lan743x_intr_register_isr()
449 vector->context = NULL; in lan743x_intr_register_isr()
450 vector->int_mask = 0; in lan743x_intr_register_isr()
451 vector->flags = 0; in lan743x_intr_register_isr()
459 struct lan743x_vector *vector = &adapter->intr.vector_list in lan743x_intr_unregister_isr()
462 free_irq(vector->irq, vector); in lan743x_intr_unregister_isr()
463 vector->handler = NULL; in lan743x_intr_unregister_isr()
464 vector->context = NULL; in lan743x_intr_unregister_isr()
465 vector->int_mask = 0; in lan743x_intr_unregister_isr()
466 vector->flags = 0; in lan743x_intr_unregister_isr()
474 for (index = 0; index < adapter->max_vector_count; index++) { in lan743x_intr_get_vector_flags()
475 if (adapter->intr.vector_list[index].int_mask & int_mask) in lan743x_intr_get_vector_flags()
476 return adapter->intr.vector_list[index].flags; in lan743x_intr_get_vector_flags()
483 struct lan743x_intr *intr = &adapter->intr; in lan743x_intr_close()
487 if (adapter->is_pci11x1x) in lan743x_intr_close()
492 for (index = 0; index < intr->number_of_vectors; index++) { in lan743x_intr_close()
493 if (intr->flags & INTR_FLAG_IRQ_REQUESTED(index)) { in lan743x_intr_close()
495 intr->flags &= ~INTR_FLAG_IRQ_REQUESTED(index); in lan743x_intr_close()
499 if (intr->flags & INTR_FLAG_MSI_ENABLED) { in lan743x_intr_close()
500 pci_disable_msi(adapter->pdev); in lan743x_intr_close()
501 intr->flags &= ~INTR_FLAG_MSI_ENABLED; in lan743x_intr_close()
504 if (intr->flags & INTR_FLAG_MSIX_ENABLED) { in lan743x_intr_close()
505 pci_disable_msix(adapter->pdev); in lan743x_intr_close()
506 intr->flags &= ~INTR_FLAG_MSIX_ENABLED; in lan743x_intr_close()
513 struct lan743x_intr *intr = &adapter->intr; in lan743x_intr_open()
519 int ret = -ENODEV; in lan743x_intr_open()
523 intr->number_of_vectors = 0; in lan743x_intr_open()
526 max_vector_count = adapter->max_vector_count; in lan743x_intr_open()
531 used_tx_channels = adapter->used_tx_channels; in lan743x_intr_open()
532 ret = pci_enable_msix_range(adapter->pdev, in lan743x_intr_open()
538 intr->flags |= INTR_FLAG_MSIX_ENABLED; in lan743x_intr_open()
539 intr->number_of_vectors = ret; in lan743x_intr_open()
540 intr->using_vectors = true; in lan743x_intr_open()
541 for (index = 0; index < intr->number_of_vectors; index++) in lan743x_intr_open()
542 intr->vector_list[index].irq = msix_entries in lan743x_intr_open()
544 netif_info(adapter, ifup, adapter->netdev, in lan743x_intr_open()
546 intr->number_of_vectors); in lan743x_intr_open()
550 if (!intr->number_of_vectors) { in lan743x_intr_open()
551 if (!(adapter->csr.flags & LAN743X_CSR_FLAG_IS_A0)) { in lan743x_intr_open()
552 if (!pci_enable_msi(adapter->pdev)) { in lan743x_intr_open()
553 intr->flags |= INTR_FLAG_MSI_ENABLED; in lan743x_intr_open()
554 intr->number_of_vectors = 1; in lan743x_intr_open()
555 intr->using_vectors = true; in lan743x_intr_open()
556 intr->vector_list[0].irq = in lan743x_intr_open()
557 adapter->pdev->irq; in lan743x_intr_open()
558 netif_info(adapter, ifup, adapter->netdev, in lan743x_intr_open()
560 intr->number_of_vectors); in lan743x_intr_open()
566 if (!intr->number_of_vectors) { in lan743x_intr_open()
567 intr->number_of_vectors = 1; in lan743x_intr_open()
568 intr->using_vectors = false; in lan743x_intr_open()
569 intr->vector_list[0].irq = intr->irq; in lan743x_intr_open()
570 netif_info(adapter, ifup, adapter->netdev, in lan743x_intr_open()
586 if (intr->using_vectors) { in lan743x_intr_open()
595 if (adapter->csr.flags & LAN743X_CSR_FLAG_SUPPORTS_INTR_AUTO_SET_CLR) { in lan743x_intr_open()
604 init_waitqueue_head(&intr->software_isr_wq); in lan743x_intr_open()
612 intr->flags |= INTR_FLAG_IRQ_REQUESTED(0); in lan743x_intr_open()
614 if (intr->using_vectors) in lan743x_intr_open()
618 if (!(adapter->csr.flags & LAN743X_CSR_FLAG_IS_A0)) { in lan743x_intr_open()
627 if (adapter->is_pci11x1x) { in lan743x_intr_open()
645 if (intr->number_of_vectors > 1) { in lan743x_intr_open()
646 int number_of_tx_vectors = intr->number_of_vectors - 1; in lan743x_intr_open()
657 if (adapter->csr.flags & in lan743x_intr_open()
669 /* map TX interrupt to vector */ in lan743x_intr_open()
673 /* Remove TX interrupt from shared mask */ in lan743x_intr_open()
674 intr->vector_list[0].int_mask &= ~int_bit; in lan743x_intr_open()
677 &adapter->tx[index]); in lan743x_intr_open()
680 intr->flags |= INTR_FLAG_IRQ_REQUESTED(vector); in lan743x_intr_open()
687 if ((intr->number_of_vectors - used_tx_channels) > 1) { in lan743x_intr_open()
688 int number_of_rx_vectors = intr->number_of_vectors - in lan743x_intr_open()
689 used_tx_channels - 1; in lan743x_intr_open()
701 if (adapter->csr.flags & in lan743x_intr_open()
713 /* map RX interrupt to vector */ in lan743x_intr_open()
723 /* Remove RX interrupt from shared mask */ in lan743x_intr_open()
724 intr->vector_list[0].int_mask &= ~int_bit; in lan743x_intr_open()
727 &adapter->rx[index]); in lan743x_intr_open()
730 intr->flags |= INTR_FLAG_IRQ_REQUESTED(vector); in lan743x_intr_open()
751 return -EIO; in lan743x_dp_write()
763 return -EIO; in lan743x_dp_write()
797 struct lan743x_adapter *adapter = bus->priv; in lan743x_mdiobus_read()
820 struct lan743x_adapter *adapter = bus->priv; in lan743x_mdiobus_write()
863 struct lan743x_adapter *adapter = bus->priv; in lan743x_mdiobus_c45_read()
898 struct lan743x_adapter *adapter = bus->priv; in lan743x_mdiobus_c45_write()
936 netif_err(adapter, drv, adapter->netdev, in lan743x_sgmii_wait_till_not_busy()
949 netif_err(adapter, probe, adapter->netdev, in lan743x_sgmii_read()
951 return -EINVAL; in lan743x_sgmii_read()
954 mutex_lock(&adapter->sgmii_rw_lock); in lan743x_sgmii_read()
967 mutex_unlock(&adapter->sgmii_rw_lock); in lan743x_sgmii_read()
979 netif_err(adapter, probe, adapter->netdev, in lan743x_sgmii_write()
981 return -EINVAL; in lan743x_sgmii_write()
983 mutex_lock(&adapter->sgmii_rw_lock); in lan743x_sgmii_write()
991 mutex_unlock(&adapter->sgmii_rw_lock); in lan743x_sgmii_write()
1066 enum lan743x_sgmii_lsd lsd = adapter->sgmii_lsd; in lan743x_sgmii_aneg_update()
1100 /* In order for Auto-Negotiation to operate properly at in lan743x_sgmii_aneg_update()
1146 return -ETIMEDOUT; in lan743x_pcs_seq_state()
1153 struct net_device *netdev = adapter->netdev; in lan743x_sgmii_config()
1154 struct phy_device *phydev = netdev->phydev; in lan743x_sgmii_config()
1160 switch (phydev->speed) { in lan743x_sgmii_config()
1162 if (phydev->master_slave_state == MASTER_SLAVE_STATE_MASTER) in lan743x_sgmii_config()
1168 if (phydev->master_slave_state == MASTER_SLAVE_STATE_MASTER) in lan743x_sgmii_config()
1174 if (phydev->duplex) in lan743x_sgmii_config()
1180 if (phydev->duplex) in lan743x_sgmii_config()
1186 netif_err(adapter, drv, adapter->netdev, in lan743x_sgmii_config()
1187 "Invalid speed %d\n", phydev->speed); in lan743x_sgmii_config()
1188 return -EINVAL; in lan743x_sgmii_config()
1191 adapter->sgmii_lsd = lsd; in lan743x_sgmii_config()
1194 netif_err(adapter, drv, adapter->netdev, in lan743x_sgmii_config()
1201 netif_err(adapter, drv, adapter->netdev, in lan743x_sgmii_config()
1207 netif_dbg(adapter, drv, adapter->netdev, in lan743x_sgmii_config()
1210 netif_dbg(adapter, drv, adapter->netdev, in lan743x_sgmii_config()
1213 /* SGMII/1000/2500BASE-X PCS power down */ in lan743x_sgmii_config()
1227 /* SGMII/1000/2500BASE-X PCS power up */ in lan743x_sgmii_config()
1254 ether_addr_copy(adapter->mac_address, addr); in lan743x_mac_set_address()
1255 netif_info(adapter, drv, adapter->netdev, in lan743x_mac_set_address()
1267 netdev = adapter->netdev; in lan743x_mac_init()
1275 if (!is_valid_ether_addr(adapter->mac_address)) { in lan743x_mac_init()
1278 adapter->mac_address[0] = mac_addr_lo & 0xFF; in lan743x_mac_init()
1279 adapter->mac_address[1] = (mac_addr_lo >> 8) & 0xFF; in lan743x_mac_init()
1280 adapter->mac_address[2] = (mac_addr_lo >> 16) & 0xFF; in lan743x_mac_init()
1281 adapter->mac_address[3] = (mac_addr_lo >> 24) & 0xFF; in lan743x_mac_init()
1282 adapter->mac_address[4] = mac_addr_hi & 0xFF; in lan743x_mac_init()
1283 adapter->mac_address[5] = (mac_addr_hi >> 8) & 0xFF; in lan743x_mac_init()
1288 } else if (!is_valid_ether_addr(adapter->mac_address)) { in lan743x_mac_init()
1293 eth_random_addr(adapter->mac_address); in lan743x_mac_init()
1295 lan743x_mac_set_address(adapter, adapter->mac_address); in lan743x_mac_init()
1296 eth_hw_addr_set(netdev, adapter->mac_address); in lan743x_mac_init()
1396 struct lan743x_phy *phy = &adapter->phy; in lan743x_phy_update_flowcontrol()
1399 if (phy->fc_autoneg) in lan743x_phy_update_flowcontrol()
1402 cap = phy->fc_request_control; in lan743x_phy_update_flowcontrol()
1417 struct phy_device *phydev = netdev->phydev; in lan743x_phy_link_status_change()
1421 if (phydev->state == PHY_RUNNING) { in lan743x_phy_link_status_change()
1436 if (phydev->duplex) in lan743x_phy_link_status_change()
1442 switch (phydev->speed) { in lan743x_phy_link_status_change()
1463 linkmode_adv_to_mii_adv_t(phydev->advertising); in lan743x_phy_link_status_change()
1465 linkmode_adv_to_mii_adv_t(phydev->lp_advertising); in lan743x_phy_link_status_change()
1469 lan743x_ptp_update_latency(adapter, phydev->speed); in lan743x_phy_link_status_change()
1470 if (phydev->interface == PHY_INTERFACE_MODE_SGMII || in lan743x_phy_link_status_change()
1471 phydev->interface == PHY_INTERFACE_MODE_1000BASEX || in lan743x_phy_link_status_change()
1472 phydev->interface == PHY_INTERFACE_MODE_2500BASEX) in lan743x_phy_link_status_change()
1479 struct net_device *netdev = adapter->netdev; in lan743x_phy_close()
1481 phy_stop(netdev->phydev); in lan743x_phy_close()
1482 phy_disconnect(netdev->phydev); in lan743x_phy_close()
1483 netdev->phydev = NULL; in lan743x_phy_close()
1488 struct net_device *netdev = adapter->netdev; in lan743x_phy_open()
1489 struct lan743x_phy *phy = &adapter->phy; in lan743x_phy_open()
1491 int ret = -EIO; in lan743x_phy_open()
1494 phydev = of_phy_get_and_connect(netdev, adapter->pdev->dev.of_node, in lan743x_phy_open()
1499 phydev = phy_find_first(adapter->mdiobus); in lan743x_phy_open()
1503 if (adapter->is_pci11x1x) in lan743x_phy_open()
1520 phy->fc_request_control = (FLOW_CTRL_RX | FLOW_CTRL_TX); in lan743x_phy_open()
1521 phy->fc_autoneg = phydev->autoneg; in lan743x_phy_open()
1557 mac_addr = adapter->mac_address; in lan743x_rfe_update_mac_address()
1572 struct net_device *netdev = adapter->netdev; in lan743x_rfe_set_multicast()
1581 if (netdev->flags & IFF_PROMISC) { in lan743x_rfe_set_multicast()
1584 if (netdev->flags & IFF_ALLMULTI) in lan743x_rfe_set_multicast()
1588 if (netdev->features & NETIF_F_RXCSUM) in lan743x_rfe_set_multicast()
1603 data = ha->addr[3]; in lan743x_rfe_set_multicast()
1604 data = ha->addr[2] | (data << 8); in lan743x_rfe_set_multicast()
1605 data = ha->addr[1] | (data << 8); in lan743x_rfe_set_multicast()
1606 data = ha->addr[0] | (data << 8); in lan743x_rfe_set_multicast()
1609 data = ha->addr[5]; in lan743x_rfe_set_multicast()
1610 data = ha->addr[4] | (data << 8); in lan743x_rfe_set_multicast()
1615 u32 bitnum = (ether_crc(ETH_ALEN, ha->addr) >> in lan743x_rfe_set_multicast()
1651 return -EPERM; in lan743x_dmac_init()
1653 if (!(adapter->csr.flags & LAN743X_CSR_FLAG_IS_A0)) in lan743x_dmac_init()
1694 timeout--; in lan743x_dmac_tx_wait_till_stopped()
1697 result = -ENODEV; in lan743x_dmac_tx_wait_till_stopped()
1723 timeout--; in lan743x_dmac_rx_wait_till_stopped()
1726 result = -ENODEV; in lan743x_dmac_rx_wait_till_stopped()
1730 static void lan743x_tx_release_desc(struct lan743x_tx *tx, in lan743x_tx_release_desc() argument
1738 descriptor = &tx->ring_cpu_ptr[descriptor_index]; in lan743x_tx_release_desc()
1739 buffer_info = &tx->buffer_info[descriptor_index]; in lan743x_tx_release_desc()
1740 if (!(buffer_info->flags & TX_BUFFER_INFO_FLAG_ACTIVE)) in lan743x_tx_release_desc()
1743 descriptor_type = le32_to_cpu(descriptor->data0) & in lan743x_tx_release_desc()
1751 if (buffer_info->dma_ptr) { in lan743x_tx_release_desc()
1752 if (buffer_info->flags & in lan743x_tx_release_desc()
1754 dma_unmap_page(&tx->adapter->pdev->dev, in lan743x_tx_release_desc()
1755 buffer_info->dma_ptr, in lan743x_tx_release_desc()
1756 buffer_info->buffer_length, in lan743x_tx_release_desc()
1759 dma_unmap_single(&tx->adapter->pdev->dev, in lan743x_tx_release_desc()
1760 buffer_info->dma_ptr, in lan743x_tx_release_desc()
1761 buffer_info->buffer_length, in lan743x_tx_release_desc()
1764 buffer_info->dma_ptr = 0; in lan743x_tx_release_desc()
1765 buffer_info->buffer_length = 0; in lan743x_tx_release_desc()
1767 if (!buffer_info->skb) in lan743x_tx_release_desc()
1770 if (!(buffer_info->flags & TX_BUFFER_INFO_FLAG_TIMESTAMP_REQUESTED)) { in lan743x_tx_release_desc()
1771 dev_kfree_skb_any(buffer_info->skb); in lan743x_tx_release_desc()
1776 lan743x_ptp_unrequest_tx_timestamp(tx->adapter); in lan743x_tx_release_desc()
1777 dev_kfree_skb_any(buffer_info->skb); in lan743x_tx_release_desc()
1779 ignore_sync = (buffer_info->flags & in lan743x_tx_release_desc()
1781 lan743x_ptp_tx_timestamp_skb(tx->adapter, in lan743x_tx_release_desc()
1782 buffer_info->skb, ignore_sync); in lan743x_tx_release_desc()
1786 buffer_info->skb = NULL; in lan743x_tx_release_desc()
1789 buffer_info->flags &= ~TX_BUFFER_INFO_FLAG_ACTIVE; in lan743x_tx_release_desc()
1796 static int lan743x_tx_next_index(struct lan743x_tx *tx, int index) in lan743x_tx_next_index() argument
1798 return ((++index) % tx->ring_size); in lan743x_tx_next_index()
1801 static void lan743x_tx_release_completed_descriptors(struct lan743x_tx *tx) in lan743x_tx_release_completed_descriptors() argument
1803 while (le32_to_cpu(*tx->head_cpu_ptr) != (tx->last_head)) { in lan743x_tx_release_completed_descriptors()
1804 lan743x_tx_release_desc(tx, tx->last_head, false); in lan743x_tx_release_completed_descriptors()
1805 tx->last_head = lan743x_tx_next_index(tx, tx->last_head); in lan743x_tx_release_completed_descriptors()
1809 static void lan743x_tx_release_all_descriptors(struct lan743x_tx *tx) in lan743x_tx_release_all_descriptors() argument
1813 original_head = tx->last_head; in lan743x_tx_release_all_descriptors()
1815 lan743x_tx_release_desc(tx, tx->last_head, true); in lan743x_tx_release_all_descriptors()
1816 tx->last_head = lan743x_tx_next_index(tx, tx->last_head); in lan743x_tx_release_all_descriptors()
1817 } while (tx->last_head != original_head); in lan743x_tx_release_all_descriptors()
1818 memset(tx->ring_cpu_ptr, 0, in lan743x_tx_release_all_descriptors()
1819 sizeof(*tx->ring_cpu_ptr) * (tx->ring_size)); in lan743x_tx_release_all_descriptors()
1820 memset(tx->buffer_info, 0, in lan743x_tx_release_all_descriptors()
1821 sizeof(*tx->buffer_info) * (tx->ring_size)); in lan743x_tx_release_all_descriptors()
1824 static int lan743x_tx_get_desc_cnt(struct lan743x_tx *tx, in lan743x_tx_get_desc_cnt() argument
1832 nr_frags = skb_shinfo(skb)->nr_frags; in lan743x_tx_get_desc_cnt()
1837 static int lan743x_tx_get_avail_desc(struct lan743x_tx *tx) in lan743x_tx_get_avail_desc() argument
1839 int last_head = tx->last_head; in lan743x_tx_get_avail_desc()
1840 int last_tail = tx->last_tail; in lan743x_tx_get_avail_desc()
1843 return tx->ring_size - last_tail + last_head - 1; in lan743x_tx_get_avail_desc()
1845 return last_head - last_tail - 1; in lan743x_tx_get_avail_desc()
1848 void lan743x_tx_set_timestamping_mode(struct lan743x_tx *tx, in lan743x_tx_set_timestamping_mode() argument
1853 tx->ts_flags |= TX_TS_FLAG_TIMESTAMPING_ENABLED; in lan743x_tx_set_timestamping_mode()
1855 tx->ts_flags &= ~TX_TS_FLAG_TIMESTAMPING_ENABLED; in lan743x_tx_set_timestamping_mode()
1857 tx->ts_flags |= TX_TS_FLAG_ONE_STEP_SYNC; in lan743x_tx_set_timestamping_mode()
1859 tx->ts_flags &= ~TX_TS_FLAG_ONE_STEP_SYNC; in lan743x_tx_set_timestamping_mode()
1862 static int lan743x_tx_frame_start(struct lan743x_tx *tx, in lan743x_tx_frame_start() argument
1870 * assuming tx->ring_lock has already been acquired. in lan743x_tx_frame_start()
1874 struct lan743x_adapter *adapter = tx->adapter; in lan743x_tx_frame_start()
1875 struct device *dev = &adapter->pdev->dev; in lan743x_tx_frame_start()
1878 tx->frame_flags |= TX_FRAME_FLAG_IN_PROGRESS; in lan743x_tx_frame_start()
1879 tx->frame_first = tx->last_tail; in lan743x_tx_frame_start()
1880 tx->frame_tail = tx->frame_first; in lan743x_tx_frame_start()
1882 tx_descriptor = &tx->ring_cpu_ptr[tx->frame_tail]; in lan743x_tx_frame_start()
1883 buffer_info = &tx->buffer_info[tx->frame_tail]; in lan743x_tx_frame_start()
1887 return -ENOMEM; in lan743x_tx_frame_start()
1889 tx_descriptor->data1 = cpu_to_le32(DMA_ADDR_LOW32(dma_ptr)); in lan743x_tx_frame_start()
1890 tx_descriptor->data2 = cpu_to_le32(DMA_ADDR_HIGH32(dma_ptr)); in lan743x_tx_frame_start()
1891 tx_descriptor->data3 = cpu_to_le32((frame_length << 16) & in lan743x_tx_frame_start()
1894 buffer_info->skb = NULL; in lan743x_tx_frame_start()
1895 buffer_info->dma_ptr = dma_ptr; in lan743x_tx_frame_start()
1896 buffer_info->buffer_length = first_buffer_length; in lan743x_tx_frame_start()
1897 buffer_info->flags |= TX_BUFFER_INFO_FLAG_ACTIVE; in lan743x_tx_frame_start()
1899 tx->frame_data0 = (first_buffer_length & in lan743x_tx_frame_start()
1905 tx->frame_data0 |= TX_DESC_DATA0_TSE_; in lan743x_tx_frame_start()
1908 tx->frame_data0 |= TX_DESC_DATA0_ICE_ | in lan743x_tx_frame_start()
1916 static void lan743x_tx_frame_add_lso(struct lan743x_tx *tx, in lan743x_tx_frame_add_lso() argument
1921 * assuming tx->ring_lock has already been acquired. in lan743x_tx_frame_add_lso()
1927 tx->frame_data0 |= TX_DESC_DATA0_EXT_; in lan743x_tx_frame_add_lso()
1929 tx->frame_data0 |= TX_DESC_DATA0_LS_; in lan743x_tx_frame_add_lso()
1930 tx->frame_data0 |= TX_DESC_DATA0_IOC_; in lan743x_tx_frame_add_lso()
1932 tx_descriptor = &tx->ring_cpu_ptr[tx->frame_tail]; in lan743x_tx_frame_add_lso()
1933 tx_descriptor->data0 = cpu_to_le32(tx->frame_data0); in lan743x_tx_frame_add_lso()
1936 tx->frame_tail = lan743x_tx_next_index(tx, tx->frame_tail); in lan743x_tx_frame_add_lso()
1937 tx_descriptor = &tx->ring_cpu_ptr[tx->frame_tail]; in lan743x_tx_frame_add_lso()
1938 buffer_info = &tx->buffer_info[tx->frame_tail]; in lan743x_tx_frame_add_lso()
1941 tx_descriptor->data1 = 0; in lan743x_tx_frame_add_lso()
1942 tx_descriptor->data2 = 0; in lan743x_tx_frame_add_lso()
1943 tx_descriptor->data3 = 0; in lan743x_tx_frame_add_lso()
1945 buffer_info->skb = NULL; in lan743x_tx_frame_add_lso()
1946 buffer_info->dma_ptr = 0; in lan743x_tx_frame_add_lso()
1947 buffer_info->buffer_length = 0; in lan743x_tx_frame_add_lso()
1948 buffer_info->flags |= TX_BUFFER_INFO_FLAG_ACTIVE; in lan743x_tx_frame_add_lso()
1950 tx->frame_data0 = (frame_length & TX_DESC_DATA0_EXT_PAY_LENGTH_MASK_) | in lan743x_tx_frame_add_lso()
1957 static int lan743x_tx_frame_add_fragment(struct lan743x_tx *tx, in lan743x_tx_frame_add_fragment() argument
1962 * assuming tx->ring_lock has already been acquired in lan743x_tx_frame_add_fragment()
1966 struct lan743x_adapter *adapter = tx->adapter; in lan743x_tx_frame_add_fragment()
1967 struct device *dev = &adapter->pdev->dev; in lan743x_tx_frame_add_fragment()
1976 tx_descriptor = &tx->ring_cpu_ptr[tx->frame_tail]; in lan743x_tx_frame_add_fragment()
1977 tx_descriptor->data0 = cpu_to_le32(tx->frame_data0); in lan743x_tx_frame_add_fragment()
1980 tx->frame_tail = lan743x_tx_next_index(tx, tx->frame_tail); in lan743x_tx_frame_add_fragment()
1981 tx_descriptor = &tx->ring_cpu_ptr[tx->frame_tail]; in lan743x_tx_frame_add_fragment()
1982 buffer_info = &tx->buffer_info[tx->frame_tail]; in lan743x_tx_frame_add_fragment()
1990 desc_index = tx->frame_first; in lan743x_tx_frame_add_fragment()
1991 while (desc_index != tx->frame_tail) { in lan743x_tx_frame_add_fragment()
1992 lan743x_tx_release_desc(tx, desc_index, true); in lan743x_tx_frame_add_fragment()
1993 desc_index = lan743x_tx_next_index(tx, desc_index); in lan743x_tx_frame_add_fragment()
1996 tx->frame_flags &= ~TX_FRAME_FLAG_IN_PROGRESS; in lan743x_tx_frame_add_fragment()
1997 tx->frame_first = 0; in lan743x_tx_frame_add_fragment()
1998 tx->frame_data0 = 0; in lan743x_tx_frame_add_fragment()
1999 tx->frame_tail = 0; in lan743x_tx_frame_add_fragment()
2000 return -ENOMEM; in lan743x_tx_frame_add_fragment()
2003 tx_descriptor->data1 = cpu_to_le32(DMA_ADDR_LOW32(dma_ptr)); in lan743x_tx_frame_add_fragment()
2004 tx_descriptor->data2 = cpu_to_le32(DMA_ADDR_HIGH32(dma_ptr)); in lan743x_tx_frame_add_fragment()
2005 tx_descriptor->data3 = cpu_to_le32((frame_length << 16) & in lan743x_tx_frame_add_fragment()
2008 buffer_info->skb = NULL; in lan743x_tx_frame_add_fragment()
2009 buffer_info->dma_ptr = dma_ptr; in lan743x_tx_frame_add_fragment()
2010 buffer_info->buffer_length = fragment_length; in lan743x_tx_frame_add_fragment()
2011 buffer_info->flags |= TX_BUFFER_INFO_FLAG_ACTIVE; in lan743x_tx_frame_add_fragment()
2012 buffer_info->flags |= TX_BUFFER_INFO_FLAG_SKB_FRAGMENT; in lan743x_tx_frame_add_fragment()
2014 tx->frame_data0 = (fragment_length & TX_DESC_DATA0_BUF_LENGTH_MASK_) | in lan743x_tx_frame_add_fragment()
2022 static void lan743x_tx_frame_end(struct lan743x_tx *tx, in lan743x_tx_frame_end() argument
2028 * assuming tx->ring_lock has already been acquired in lan743x_tx_frame_end()
2032 struct lan743x_adapter *adapter = tx->adapter; in lan743x_tx_frame_end()
2036 if ((tx->frame_data0 & TX_DESC_DATA0_DTYPE_MASK_) == in lan743x_tx_frame_end()
2038 tx->frame_data0 |= TX_DESC_DATA0_LS_; in lan743x_tx_frame_end()
2039 tx->frame_data0 |= TX_DESC_DATA0_IOC_; in lan743x_tx_frame_end()
2042 tx_descriptor = &tx->ring_cpu_ptr[tx->frame_tail]; in lan743x_tx_frame_end()
2043 buffer_info = &tx->buffer_info[tx->frame_tail]; in lan743x_tx_frame_end()
2044 buffer_info->skb = skb; in lan743x_tx_frame_end()
2046 buffer_info->flags |= TX_BUFFER_INFO_FLAG_TIMESTAMP_REQUESTED; in lan743x_tx_frame_end()
2048 buffer_info->flags |= TX_BUFFER_INFO_FLAG_IGNORE_SYNC; in lan743x_tx_frame_end()
2050 tx_descriptor->data0 = cpu_to_le32(tx->frame_data0); in lan743x_tx_frame_end()
2051 tx->frame_tail = lan743x_tx_next_index(tx, tx->frame_tail); in lan743x_tx_frame_end()
2052 tx->last_tail = tx->frame_tail; in lan743x_tx_frame_end()
2056 if (tx->vector_flags & LAN743X_VECTOR_FLAG_VECTOR_ENABLE_AUTO_SET) in lan743x_tx_frame_end()
2058 if (tx->vector_flags & LAN743X_VECTOR_FLAG_SOURCE_ENABLE_AUTO_SET) in lan743x_tx_frame_end()
2062 lan743x_csr_write(adapter, TX_TAIL(tx->channel_number), in lan743x_tx_frame_end()
2063 tx_tail_flags | tx->frame_tail); in lan743x_tx_frame_end()
2064 tx->frame_flags &= ~TX_FRAME_FLAG_IN_PROGRESS; in lan743x_tx_frame_end()
2067 static netdev_tx_t lan743x_tx_xmit_frame(struct lan743x_tx *tx, in lan743x_tx_xmit_frame() argument
2083 required_number_of_descriptors = lan743x_tx_get_desc_cnt(tx, skb); in lan743x_tx_xmit_frame()
2085 spin_lock_irqsave(&tx->ring_lock, irq_flags); in lan743x_tx_xmit_frame()
2087 lan743x_tx_get_avail_desc(tx)) { in lan743x_tx_xmit_frame()
2088 if (required_number_of_descriptors > (tx->ring_size - 1)) { in lan743x_tx_xmit_frame()
2092 tx->rqd_descriptors = required_number_of_descriptors; in lan743x_tx_xmit_frame()
2094 txq = netdev_get_tx_queue(tx->adapter->netdev, in lan743x_tx_xmit_frame()
2095 tx->channel_number); in lan743x_tx_xmit_frame()
2102 if ((skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP) && in lan743x_tx_xmit_frame()
2103 (tx->ts_flags & TX_TS_FLAG_TIMESTAMPING_ENABLED) && in lan743x_tx_xmit_frame()
2104 (lan743x_ptp_request_tx_timestamp(tx->adapter))) { in lan743x_tx_xmit_frame()
2105 skb_shinfo(skb)->tx_flags |= SKBTX_IN_PROGRESS; in lan743x_tx_xmit_frame()
2107 if (tx->ts_flags & TX_TS_FLAG_ONE_STEP_SYNC) in lan743x_tx_xmit_frame()
2112 nr_frags = skb_shinfo(skb)->nr_frags; in lan743x_tx_xmit_frame()
2116 start_frame_length = max(skb_shinfo(skb)->gso_size, in lan743x_tx_xmit_frame()
2120 if (lan743x_tx_frame_start(tx, in lan743x_tx_xmit_frame()
2121 skb->data, head_length, in lan743x_tx_xmit_frame()
2124 skb->ip_summed == CHECKSUM_PARTIAL)) { in lan743x_tx_xmit_frame()
2128 tx->frame_count++; in lan743x_tx_xmit_frame()
2131 lan743x_tx_frame_add_lso(tx, frame_length, nr_frags); in lan743x_tx_xmit_frame()
2137 const skb_frag_t *frag = &(skb_shinfo(skb)->frags[j]); in lan743x_tx_xmit_frame()
2139 if (lan743x_tx_frame_add_fragment(tx, frag, frame_length)) { in lan743x_tx_xmit_frame()
2151 lan743x_tx_frame_end(tx, skb, do_timestamp, ignore_sync); in lan743x_tx_xmit_frame()
2154 spin_unlock_irqrestore(&tx->ring_lock, irq_flags); in lan743x_tx_xmit_frame()
2160 struct lan743x_tx *tx = container_of(napi, struct lan743x_tx, napi); in lan743x_tx_napi_poll() local
2161 struct lan743x_adapter *adapter = tx->adapter; in lan743x_tx_napi_poll()
2166 ioc_bit = DMAC_INT_BIT_TX_IOC_(tx->channel_number); in lan743x_tx_napi_poll()
2168 if (tx->vector_flags & LAN743X_VECTOR_FLAG_SOURCE_STATUS_W2C) in lan743x_tx_napi_poll()
2170 spin_lock_irqsave(&tx->ring_lock, irq_flags); in lan743x_tx_napi_poll()
2172 /* clean up tx ring */ in lan743x_tx_napi_poll()
2173 lan743x_tx_release_completed_descriptors(tx); in lan743x_tx_napi_poll()
2174 txq = netdev_get_tx_queue(adapter->netdev, tx->channel_number); in lan743x_tx_napi_poll()
2176 if (tx->rqd_descriptors) { in lan743x_tx_napi_poll()
2177 if (tx->rqd_descriptors <= in lan743x_tx_napi_poll()
2178 lan743x_tx_get_avail_desc(tx)) { in lan743x_tx_napi_poll()
2179 tx->rqd_descriptors = 0; in lan743x_tx_napi_poll()
2186 spin_unlock_irqrestore(&tx->ring_lock, irq_flags); in lan743x_tx_napi_poll()
2193 INT_BIT_DMA_TX_(tx->channel_number)); in lan743x_tx_napi_poll()
2200 static void lan743x_tx_ring_cleanup(struct lan743x_tx *tx) in lan743x_tx_ring_cleanup() argument
2202 if (tx->head_cpu_ptr) { in lan743x_tx_ring_cleanup()
2203 dma_free_coherent(&tx->adapter->pdev->dev, in lan743x_tx_ring_cleanup()
2204 sizeof(*tx->head_cpu_ptr), tx->head_cpu_ptr, in lan743x_tx_ring_cleanup()
2205 tx->head_dma_ptr); in lan743x_tx_ring_cleanup()
2206 tx->head_cpu_ptr = NULL; in lan743x_tx_ring_cleanup()
2207 tx->head_dma_ptr = 0; in lan743x_tx_ring_cleanup()
2209 kfree(tx->buffer_info); in lan743x_tx_ring_cleanup()
2210 tx->buffer_info = NULL; in lan743x_tx_ring_cleanup()
2212 if (tx->ring_cpu_ptr) { in lan743x_tx_ring_cleanup()
2213 dma_free_coherent(&tx->adapter->pdev->dev, in lan743x_tx_ring_cleanup()
2214 tx->ring_allocation_size, tx->ring_cpu_ptr, in lan743x_tx_ring_cleanup()
2215 tx->ring_dma_ptr); in lan743x_tx_ring_cleanup()
2216 tx->ring_allocation_size = 0; in lan743x_tx_ring_cleanup()
2217 tx->ring_cpu_ptr = NULL; in lan743x_tx_ring_cleanup()
2218 tx->ring_dma_ptr = 0; in lan743x_tx_ring_cleanup()
2220 tx->ring_size = 0; in lan743x_tx_ring_cleanup()
2223 static int lan743x_tx_ring_init(struct lan743x_tx *tx) in lan743x_tx_ring_init() argument
2228 int ret = -ENOMEM; in lan743x_tx_ring_init()
2230 tx->ring_size = LAN743X_TX_RING_SIZE; in lan743x_tx_ring_init()
2231 if (tx->ring_size & ~TX_CFG_B_TX_RING_LEN_MASK_) { in lan743x_tx_ring_init()
2232 ret = -EINVAL; in lan743x_tx_ring_init()
2235 if (dma_set_mask_and_coherent(&tx->adapter->pdev->dev, in lan743x_tx_ring_init()
2237 dev_warn(&tx->adapter->pdev->dev, in lan743x_tx_ring_init()
2239 ret = -ENOMEM; in lan743x_tx_ring_init()
2242 ring_allocation_size = ALIGN(tx->ring_size * in lan743x_tx_ring_init()
2246 cpu_ptr = dma_alloc_coherent(&tx->adapter->pdev->dev, in lan743x_tx_ring_init()
2249 ret = -ENOMEM; in lan743x_tx_ring_init()
2253 tx->ring_allocation_size = ring_allocation_size; in lan743x_tx_ring_init()
2254 tx->ring_cpu_ptr = (struct lan743x_tx_descriptor *)cpu_ptr; in lan743x_tx_ring_init()
2255 tx->ring_dma_ptr = dma_ptr; in lan743x_tx_ring_init()
2257 cpu_ptr = kcalloc(tx->ring_size, sizeof(*tx->buffer_info), GFP_KERNEL); in lan743x_tx_ring_init()
2259 ret = -ENOMEM; in lan743x_tx_ring_init()
2262 tx->buffer_info = (struct lan743x_tx_buffer_info *)cpu_ptr; in lan743x_tx_ring_init()
2264 cpu_ptr = dma_alloc_coherent(&tx->adapter->pdev->dev, in lan743x_tx_ring_init()
2265 sizeof(*tx->head_cpu_ptr), &dma_ptr, in lan743x_tx_ring_init()
2268 ret = -ENOMEM; in lan743x_tx_ring_init()
2272 tx->head_cpu_ptr = cpu_ptr; in lan743x_tx_ring_init()
2273 tx->head_dma_ptr = dma_ptr; in lan743x_tx_ring_init()
2274 if (tx->head_dma_ptr & 0x3) { in lan743x_tx_ring_init()
2275 ret = -ENOMEM; in lan743x_tx_ring_init()
2282 lan743x_tx_ring_cleanup(tx); in lan743x_tx_ring_init()
2286 static void lan743x_tx_close(struct lan743x_tx *tx) in lan743x_tx_close() argument
2288 struct lan743x_adapter *adapter = tx->adapter; in lan743x_tx_close()
2292 DMAC_CMD_STOP_T_(tx->channel_number)); in lan743x_tx_close()
2293 lan743x_dmac_tx_wait_till_stopped(adapter, tx->channel_number); in lan743x_tx_close()
2297 DMAC_INT_BIT_TX_IOC_(tx->channel_number)); in lan743x_tx_close()
2299 INT_BIT_DMA_TX_(tx->channel_number)); in lan743x_tx_close()
2300 napi_disable(&tx->napi); in lan743x_tx_close()
2301 netif_napi_del(&tx->napi); in lan743x_tx_close()
2304 FCT_TX_CTL_DIS_(tx->channel_number)); in lan743x_tx_close()
2306 FCT_TX_CTL_EN_(tx->channel_number), in lan743x_tx_close()
2309 lan743x_tx_release_all_descriptors(tx); in lan743x_tx_close()
2311 tx->rqd_descriptors = 0; in lan743x_tx_close()
2313 lan743x_tx_ring_cleanup(tx); in lan743x_tx_close()
2316 static int lan743x_tx_open(struct lan743x_tx *tx) in lan743x_tx_open() argument
2322 adapter = tx->adapter; in lan743x_tx_open()
2323 ret = lan743x_tx_ring_init(tx); in lan743x_tx_open()
2329 FCT_TX_CTL_RESET_(tx->channel_number)); in lan743x_tx_open()
2331 FCT_TX_CTL_RESET_(tx->channel_number), in lan743x_tx_open()
2336 FCT_TX_CTL_EN_(tx->channel_number)); in lan743x_tx_open()
2338 /* reset tx channel */ in lan743x_tx_open()
2340 DMAC_CMD_TX_SWR_(tx->channel_number)); in lan743x_tx_open()
2342 DMAC_CMD_TX_SWR_(tx->channel_number), in lan743x_tx_open()
2347 TX_BASE_ADDRH(tx->channel_number), in lan743x_tx_open()
2348 DMA_ADDR_HIGH32(tx->ring_dma_ptr)); in lan743x_tx_open()
2350 TX_BASE_ADDRL(tx->channel_number), in lan743x_tx_open()
2351 DMA_ADDR_LOW32(tx->ring_dma_ptr)); in lan743x_tx_open()
2354 data = lan743x_csr_read(adapter, TX_CFG_B(tx->channel_number)); in lan743x_tx_open()
2356 data |= ((tx->ring_size) & TX_CFG_B_TX_RING_LEN_MASK_); in lan743x_tx_open()
2357 if (!(adapter->csr.flags & LAN743X_CSR_FLAG_IS_A0)) in lan743x_tx_open()
2359 lan743x_csr_write(adapter, TX_CFG_B(tx->channel_number), data); in lan743x_tx_open()
2363 if (!(adapter->csr.flags & LAN743X_CSR_FLAG_IS_A0)) { in lan743x_tx_open()
2369 lan743x_csr_write(adapter, TX_CFG_A(tx->channel_number), data); in lan743x_tx_open()
2373 TX_HEAD_WRITEBACK_ADDRH(tx->channel_number), in lan743x_tx_open()
2374 DMA_ADDR_HIGH32(tx->head_dma_ptr)); in lan743x_tx_open()
2376 TX_HEAD_WRITEBACK_ADDRL(tx->channel_number), in lan743x_tx_open()
2377 DMA_ADDR_LOW32(tx->head_dma_ptr)); in lan743x_tx_open()
2380 tx->last_head = lan743x_csr_read(adapter, TX_HEAD(tx->channel_number)); in lan743x_tx_open()
2383 tx->last_tail = 0; in lan743x_tx_open()
2384 lan743x_csr_write(adapter, TX_TAIL(tx->channel_number), in lan743x_tx_open()
2385 (u32)(tx->last_tail)); in lan743x_tx_open()
2386 tx->vector_flags = lan743x_intr_get_vector_flags(adapter, in lan743x_tx_open()
2388 (tx->channel_number)); in lan743x_tx_open()
2389 netif_napi_add_tx_weight(adapter->netdev, in lan743x_tx_open()
2390 &tx->napi, lan743x_tx_napi_poll, in lan743x_tx_open()
2392 napi_enable(&tx->napi); in lan743x_tx_open()
2395 if (tx->vector_flags & LAN743X_VECTOR_FLAG_SOURCE_ENABLE_AUTO_CLEAR) in lan743x_tx_open()
2397 if (tx->vector_flags & LAN743X_VECTOR_FLAG_SOURCE_STATUS_AUTO_CLEAR) in lan743x_tx_open()
2399 if (tx->vector_flags & LAN743X_VECTOR_FLAG_SOURCE_STATUS_R2C) in lan743x_tx_open()
2401 if (tx->vector_flags & LAN743X_VECTOR_FLAG_SOURCE_ENABLE_R2C) in lan743x_tx_open()
2403 lan743x_csr_write(adapter, TX_CFG_C(tx->channel_number), data); in lan743x_tx_open()
2405 if (!(tx->vector_flags & LAN743X_VECTOR_FLAG_SOURCE_ENABLE_AUTO_SET)) in lan743x_tx_open()
2407 INT_BIT_DMA_TX_(tx->channel_number)); in lan743x_tx_open()
2409 DMAC_INT_BIT_TX_IOC_(tx->channel_number)); in lan743x_tx_open()
2413 DMAC_CMD_START_T_(tx->channel_number)); in lan743x_tx_open()
2417 static int lan743x_rx_next_index(struct lan743x_rx *rx, int index) in lan743x_rx_next_index() argument
2419 return ((++index) % rx->ring_size); in lan743x_rx_next_index()
2422 static void lan743x_rx_update_tail(struct lan743x_rx *rx, int index) in lan743x_rx_update_tail() argument
2426 lan743x_csr_write(rx->adapter, RX_TAIL(rx->channel_number), in lan743x_rx_update_tail()
2430 static int lan743x_rx_init_ring_element(struct lan743x_rx *rx, int index, in lan743x_rx_init_ring_element() argument
2433 struct net_device *netdev = rx->adapter->netdev; in lan743x_rx_init_ring_element()
2434 struct device *dev = &rx->adapter->pdev->dev; in lan743x_rx_init_ring_element()
2441 buffer_length = netdev->mtu + ETH_HLEN + ETH_FCS_LEN + RX_HEAD_PADDING; in lan743x_rx_init_ring_element()
2443 descriptor = &rx->ring_cpu_ptr[index]; in lan743x_rx_init_ring_element()
2444 buffer_info = &rx->buffer_info[index]; in lan743x_rx_init_ring_element()
2447 return -ENOMEM; in lan743x_rx_init_ring_element()
2448 dma_ptr = dma_map_single(dev, skb->data, buffer_length, DMA_FROM_DEVICE); in lan743x_rx_init_ring_element()
2451 return -ENOMEM; in lan743x_rx_init_ring_element()
2453 if (buffer_info->dma_ptr) { in lan743x_rx_init_ring_element()
2455 if (le32_to_cpu(descriptor->data0) & RX_DESC_DATA0_LS_) in lan743x_rx_init_ring_element()
2461 (le32_to_cpu(descriptor->data0)), in lan743x_rx_init_ring_element()
2462 buffer_info->buffer_length); in lan743x_rx_init_ring_element()
2464 used_length = buffer_info->buffer_length; in lan743x_rx_init_ring_element()
2465 dma_sync_single_for_cpu(dev, buffer_info->dma_ptr, in lan743x_rx_init_ring_element()
2468 dma_unmap_single_attrs(dev, buffer_info->dma_ptr, in lan743x_rx_init_ring_element()
2469 buffer_info->buffer_length, in lan743x_rx_init_ring_element()
2474 buffer_info->skb = skb; in lan743x_rx_init_ring_element()
2475 buffer_info->dma_ptr = dma_ptr; in lan743x_rx_init_ring_element()
2476 buffer_info->buffer_length = buffer_length; in lan743x_rx_init_ring_element()
2477 descriptor->data1 = cpu_to_le32(DMA_ADDR_LOW32(buffer_info->dma_ptr)); in lan743x_rx_init_ring_element()
2478 descriptor->data2 = cpu_to_le32(DMA_ADDR_HIGH32(buffer_info->dma_ptr)); in lan743x_rx_init_ring_element()
2479 descriptor->data3 = 0; in lan743x_rx_init_ring_element()
2480 descriptor->data0 = cpu_to_le32((RX_DESC_DATA0_OWN_ | in lan743x_rx_init_ring_element()
2482 lan743x_rx_update_tail(rx, index); in lan743x_rx_init_ring_element()
2487 static void lan743x_rx_reuse_ring_element(struct lan743x_rx *rx, int index) in lan743x_rx_reuse_ring_element() argument
2492 descriptor = &rx->ring_cpu_ptr[index]; in lan743x_rx_reuse_ring_element()
2493 buffer_info = &rx->buffer_info[index]; in lan743x_rx_reuse_ring_element()
2495 descriptor->data1 = cpu_to_le32(DMA_ADDR_LOW32(buffer_info->dma_ptr)); in lan743x_rx_reuse_ring_element()
2496 descriptor->data2 = cpu_to_le32(DMA_ADDR_HIGH32(buffer_info->dma_ptr)); in lan743x_rx_reuse_ring_element()
2497 descriptor->data3 = 0; in lan743x_rx_reuse_ring_element()
2498 descriptor->data0 = cpu_to_le32((RX_DESC_DATA0_OWN_ | in lan743x_rx_reuse_ring_element()
2499 ((buffer_info->buffer_length) & in lan743x_rx_reuse_ring_element()
2501 lan743x_rx_update_tail(rx, index); in lan743x_rx_reuse_ring_element()
2504 static void lan743x_rx_release_ring_element(struct lan743x_rx *rx, int index) in lan743x_rx_release_ring_element() argument
2509 descriptor = &rx->ring_cpu_ptr[index]; in lan743x_rx_release_ring_element()
2510 buffer_info = &rx->buffer_info[index]; in lan743x_rx_release_ring_element()
2514 if (buffer_info->dma_ptr) { in lan743x_rx_release_ring_element()
2515 dma_unmap_single(&rx->adapter->pdev->dev, in lan743x_rx_release_ring_element()
2516 buffer_info->dma_ptr, in lan743x_rx_release_ring_element()
2517 buffer_info->buffer_length, in lan743x_rx_release_ring_element()
2519 buffer_info->dma_ptr = 0; in lan743x_rx_release_ring_element()
2522 if (buffer_info->skb) { in lan743x_rx_release_ring_element()
2523 dev_kfree_skb(buffer_info->skb); in lan743x_rx_release_ring_element()
2524 buffer_info->skb = NULL; in lan743x_rx_release_ring_element()
2537 frame_length = max_t(int, 0, frame_length - ETH_FCS_LEN); in lan743x_rx_trim_skb()
2538 if (skb->len > frame_length) { in lan743x_rx_trim_skb()
2539 skb->tail -= skb->len - frame_length; in lan743x_rx_trim_skb()
2540 skb->len = frame_length; in lan743x_rx_trim_skb()
2545 static int lan743x_rx_process_buffer(struct lan743x_rx *rx) in lan743x_rx_process_buffer() argument
2547 int current_head_index = le32_to_cpu(*rx->head_cpu_ptr); in lan743x_rx_process_buffer()
2549 struct net_device *netdev = rx->adapter->netdev; in lan743x_rx_process_buffer()
2554 int extension_index = -1; in lan743x_rx_process_buffer()
2558 if (current_head_index < 0 || current_head_index >= rx->ring_size) in lan743x_rx_process_buffer()
2561 if (rx->last_head < 0 || rx->last_head >= rx->ring_size) in lan743x_rx_process_buffer()
2564 if (rx->last_head == current_head_index) in lan743x_rx_process_buffer()
2567 descriptor = &rx->ring_cpu_ptr[rx->last_head]; in lan743x_rx_process_buffer()
2568 if (le32_to_cpu(descriptor->data0) & RX_DESC_DATA0_OWN_) in lan743x_rx_process_buffer()
2570 buffer_info = &rx->buffer_info[rx->last_head]; in lan743x_rx_process_buffer()
2572 is_last = le32_to_cpu(descriptor->data0) & RX_DESC_DATA0_LS_; in lan743x_rx_process_buffer()
2573 is_first = le32_to_cpu(descriptor->data0) & RX_DESC_DATA0_FS_; in lan743x_rx_process_buffer()
2575 if (is_last && le32_to_cpu(descriptor->data0) & RX_DESC_DATA0_EXT_) { in lan743x_rx_process_buffer()
2577 int index = lan743x_rx_next_index(rx, rx->last_head); in lan743x_rx_process_buffer()
2582 desc_ext = &rx->ring_cpu_ptr[index]; in lan743x_rx_process_buffer()
2583 if (le32_to_cpu(desc_ext->data0) & RX_DESC_DATA0_OWN_) in lan743x_rx_process_buffer()
2586 if (!(le32_to_cpu(desc_ext->data0) & RX_DESC_DATA0_EXT_)) in lan743x_rx_process_buffer()
2591 /* Only the last buffer in a multi-buffer frame contains the total frame in lan743x_rx_process_buffer()
2598 RX_DESC_DATA0_FRAME_LENGTH_GET_(le32_to_cpu(descriptor->data0)); in lan743x_rx_process_buffer()
2599 buffer_length = buffer_info->buffer_length; in lan743x_rx_process_buffer()
2600 is_ice = le32_to_cpu(descriptor->data1) & RX_DESC_DATA1_STATUS_ICE_; in lan743x_rx_process_buffer()
2601 is_tce = le32_to_cpu(descriptor->data1) & RX_DESC_DATA1_STATUS_TCE_; in lan743x_rx_process_buffer()
2602 is_icsm = le32_to_cpu(descriptor->data1) & RX_DESC_DATA1_STATUS_ICSM_; in lan743x_rx_process_buffer()
2610 skb = buffer_info->skb; in lan743x_rx_process_buffer()
2611 if (lan743x_rx_init_ring_element(rx, rx->last_head, in lan743x_rx_process_buffer()
2617 lan743x_rx_reuse_ring_element(rx, rx->last_head); in lan743x_rx_process_buffer()
2619 dev_kfree_skb_irq(rx->skb_head); in lan743x_rx_process_buffer()
2620 rx->skb_head = NULL; in lan743x_rx_process_buffer()
2624 /* add buffers to skb via skb->frag_list */ in lan743x_rx_process_buffer()
2627 skb_put(skb, buffer_length - RX_HEAD_PADDING); in lan743x_rx_process_buffer()
2628 if (rx->skb_head) in lan743x_rx_process_buffer()
2629 dev_kfree_skb_irq(rx->skb_head); in lan743x_rx_process_buffer()
2630 rx->skb_head = skb; in lan743x_rx_process_buffer()
2631 } else if (rx->skb_head) { in lan743x_rx_process_buffer()
2633 if (skb_shinfo(rx->skb_head)->frag_list) in lan743x_rx_process_buffer()
2634 rx->skb_tail->next = skb; in lan743x_rx_process_buffer()
2636 skb_shinfo(rx->skb_head)->frag_list = skb; in lan743x_rx_process_buffer()
2637 rx->skb_tail = skb; in lan743x_rx_process_buffer()
2638 rx->skb_head->len += skb->len; in lan743x_rx_process_buffer()
2639 rx->skb_head->data_len += skb->len; in lan743x_rx_process_buffer()
2640 rx->skb_head->truesize += skb->truesize; in lan743x_rx_process_buffer()
2654 ts_sec = le32_to_cpu(desc_ext->data1); in lan743x_rx_process_buffer()
2655 ts_nsec = (le32_to_cpu(desc_ext->data2) & in lan743x_rx_process_buffer()
2657 if (rx->skb_head) in lan743x_rx_process_buffer()
2658 skb_hwtstamps(rx->skb_head)->hwtstamp = in lan743x_rx_process_buffer()
2660 lan743x_rx_reuse_ring_element(rx, extension_index); in lan743x_rx_process_buffer()
2661 rx->last_head = extension_index; in lan743x_rx_process_buffer()
2665 if (is_last && rx->skb_head) in lan743x_rx_process_buffer()
2666 rx->skb_head = lan743x_rx_trim_skb(rx->skb_head, frame_length); in lan743x_rx_process_buffer()
2668 if (is_last && rx->skb_head) { in lan743x_rx_process_buffer()
2669 rx->skb_head->protocol = eth_type_trans(rx->skb_head, in lan743x_rx_process_buffer()
2670 rx->adapter->netdev); in lan743x_rx_process_buffer()
2671 if (rx->adapter->netdev->features & NETIF_F_RXCSUM) { in lan743x_rx_process_buffer()
2673 skb->ip_summed = CHECKSUM_UNNECESSARY; in lan743x_rx_process_buffer()
2676 rx->skb_head->len); in lan743x_rx_process_buffer()
2677 napi_gro_receive(&rx->napi, rx->skb_head); in lan743x_rx_process_buffer()
2678 rx->skb_head = NULL; in lan743x_rx_process_buffer()
2683 rx->last_tail = rx->last_head; in lan743x_rx_process_buffer()
2684 rx->last_head = lan743x_rx_next_index(rx, rx->last_head); in lan743x_rx_process_buffer()
2692 struct lan743x_rx *rx = container_of(napi, struct lan743x_rx, napi); in lan743x_rx_napi_poll() local
2693 struct lan743x_adapter *adapter = rx->adapter; in lan743x_rx_napi_poll()
2698 if (rx->vector_flags & LAN743X_VECTOR_FLAG_SOURCE_STATUS_W2C) { in lan743x_rx_napi_poll()
2701 DMAC_INT_BIT_RXFRM_(rx->channel_number)); in lan743x_rx_napi_poll()
2704 result = lan743x_rx_process_buffer(rx); in lan743x_rx_napi_poll()
2708 rx->frame_count += count; in lan743x_rx_napi_poll()
2715 /* re-arm interrupts, must write to rx tail on some chip variants */ in lan743x_rx_napi_poll()
2716 if (rx->vector_flags & LAN743X_VECTOR_FLAG_VECTOR_ENABLE_AUTO_SET) in lan743x_rx_napi_poll()
2718 if (rx->vector_flags & LAN743X_VECTOR_FLAG_SOURCE_ENABLE_AUTO_SET) { in lan743x_rx_napi_poll()
2722 INT_BIT_DMA_RX_(rx->channel_number)); in lan743x_rx_napi_poll()
2726 lan743x_csr_write(adapter, RX_TAIL(rx->channel_number), in lan743x_rx_napi_poll()
2727 rx_tail_flags | rx->last_tail); in lan743x_rx_napi_poll()
2732 static void lan743x_rx_ring_cleanup(struct lan743x_rx *rx) in lan743x_rx_ring_cleanup() argument
2734 if (rx->buffer_info && rx->ring_cpu_ptr) { in lan743x_rx_ring_cleanup()
2737 for (index = 0; index < rx->ring_size; index++) in lan743x_rx_ring_cleanup()
2738 lan743x_rx_release_ring_element(rx, index); in lan743x_rx_ring_cleanup()
2741 if (rx->head_cpu_ptr) { in lan743x_rx_ring_cleanup()
2742 dma_free_coherent(&rx->adapter->pdev->dev, in lan743x_rx_ring_cleanup()
2743 sizeof(*rx->head_cpu_ptr), rx->head_cpu_ptr, in lan743x_rx_ring_cleanup()
2744 rx->head_dma_ptr); in lan743x_rx_ring_cleanup()
2745 rx->head_cpu_ptr = NULL; in lan743x_rx_ring_cleanup()
2746 rx->head_dma_ptr = 0; in lan743x_rx_ring_cleanup()
2749 kfree(rx->buffer_info); in lan743x_rx_ring_cleanup()
2750 rx->buffer_info = NULL; in lan743x_rx_ring_cleanup()
2752 if (rx->ring_cpu_ptr) { in lan743x_rx_ring_cleanup()
2753 dma_free_coherent(&rx->adapter->pdev->dev, in lan743x_rx_ring_cleanup()
2754 rx->ring_allocation_size, rx->ring_cpu_ptr, in lan743x_rx_ring_cleanup()
2755 rx->ring_dma_ptr); in lan743x_rx_ring_cleanup()
2756 rx->ring_allocation_size = 0; in lan743x_rx_ring_cleanup()
2757 rx->ring_cpu_ptr = NULL; in lan743x_rx_ring_cleanup()
2758 rx->ring_dma_ptr = 0; in lan743x_rx_ring_cleanup()
2761 rx->ring_size = 0; in lan743x_rx_ring_cleanup()
2762 rx->last_head = 0; in lan743x_rx_ring_cleanup()
2765 static int lan743x_rx_ring_init(struct lan743x_rx *rx) in lan743x_rx_ring_init() argument
2770 int ret = -ENOMEM; in lan743x_rx_ring_init()
2773 rx->ring_size = LAN743X_RX_RING_SIZE; in lan743x_rx_ring_init()
2774 if (rx->ring_size <= 1) { in lan743x_rx_ring_init()
2775 ret = -EINVAL; in lan743x_rx_ring_init()
2778 if (rx->ring_size & ~RX_CFG_B_RX_RING_LEN_MASK_) { in lan743x_rx_ring_init()
2779 ret = -EINVAL; in lan743x_rx_ring_init()
2782 if (dma_set_mask_and_coherent(&rx->adapter->pdev->dev, in lan743x_rx_ring_init()
2784 dev_warn(&rx->adapter->pdev->dev, in lan743x_rx_ring_init()
2786 ret = -ENOMEM; in lan743x_rx_ring_init()
2789 ring_allocation_size = ALIGN(rx->ring_size * in lan743x_rx_ring_init()
2793 cpu_ptr = dma_alloc_coherent(&rx->adapter->pdev->dev, in lan743x_rx_ring_init()
2796 ret = -ENOMEM; in lan743x_rx_ring_init()
2799 rx->ring_allocation_size = ring_allocation_size; in lan743x_rx_ring_init()
2800 rx->ring_cpu_ptr = (struct lan743x_rx_descriptor *)cpu_ptr; in lan743x_rx_ring_init()
2801 rx->ring_dma_ptr = dma_ptr; in lan743x_rx_ring_init()
2803 cpu_ptr = kcalloc(rx->ring_size, sizeof(*rx->buffer_info), in lan743x_rx_ring_init()
2806 ret = -ENOMEM; in lan743x_rx_ring_init()
2809 rx->buffer_info = (struct lan743x_rx_buffer_info *)cpu_ptr; in lan743x_rx_ring_init()
2811 cpu_ptr = dma_alloc_coherent(&rx->adapter->pdev->dev, in lan743x_rx_ring_init()
2812 sizeof(*rx->head_cpu_ptr), &dma_ptr, in lan743x_rx_ring_init()
2815 ret = -ENOMEM; in lan743x_rx_ring_init()
2819 rx->head_cpu_ptr = cpu_ptr; in lan743x_rx_ring_init()
2820 rx->head_dma_ptr = dma_ptr; in lan743x_rx_ring_init()
2821 if (rx->head_dma_ptr & 0x3) { in lan743x_rx_ring_init()
2822 ret = -ENOMEM; in lan743x_rx_ring_init()
2826 rx->last_head = 0; in lan743x_rx_ring_init()
2827 for (index = 0; index < rx->ring_size; index++) { in lan743x_rx_ring_init()
2828 ret = lan743x_rx_init_ring_element(rx, index, GFP_KERNEL); in lan743x_rx_ring_init()
2835 netif_warn(rx->adapter, ifup, rx->adapter->netdev, in lan743x_rx_ring_init()
2838 lan743x_rx_ring_cleanup(rx); in lan743x_rx_ring_init()
2842 static void lan743x_rx_close(struct lan743x_rx *rx) in lan743x_rx_close() argument
2844 struct lan743x_adapter *adapter = rx->adapter; in lan743x_rx_close()
2847 FCT_RX_CTL_DIS_(rx->channel_number)); in lan743x_rx_close()
2849 FCT_RX_CTL_EN_(rx->channel_number), in lan743x_rx_close()
2853 DMAC_CMD_STOP_R_(rx->channel_number)); in lan743x_rx_close()
2854 lan743x_dmac_rx_wait_till_stopped(adapter, rx->channel_number); in lan743x_rx_close()
2857 DMAC_INT_BIT_RXFRM_(rx->channel_number)); in lan743x_rx_close()
2859 INT_BIT_DMA_RX_(rx->channel_number)); in lan743x_rx_close()
2860 napi_disable(&rx->napi); in lan743x_rx_close()
2862 netif_napi_del(&rx->napi); in lan743x_rx_close()
2864 lan743x_rx_ring_cleanup(rx); in lan743x_rx_close()
2867 static int lan743x_rx_open(struct lan743x_rx *rx) in lan743x_rx_open() argument
2869 struct lan743x_adapter *adapter = rx->adapter; in lan743x_rx_open()
2873 rx->frame_count = 0; in lan743x_rx_open()
2874 ret = lan743x_rx_ring_init(rx); in lan743x_rx_open()
2878 netif_napi_add(adapter->netdev, &rx->napi, lan743x_rx_napi_poll); in lan743x_rx_open()
2881 DMAC_CMD_RX_SWR_(rx->channel_number)); in lan743x_rx_open()
2883 DMAC_CMD_RX_SWR_(rx->channel_number), in lan743x_rx_open()
2888 RX_BASE_ADDRH(rx->channel_number), in lan743x_rx_open()
2889 DMA_ADDR_HIGH32(rx->ring_dma_ptr)); in lan743x_rx_open()
2891 RX_BASE_ADDRL(rx->channel_number), in lan743x_rx_open()
2892 DMA_ADDR_LOW32(rx->ring_dma_ptr)); in lan743x_rx_open()
2894 /* set rx write back address */ in lan743x_rx_open()
2896 RX_HEAD_WRITEBACK_ADDRH(rx->channel_number), in lan743x_rx_open()
2897 DMA_ADDR_HIGH32(rx->head_dma_ptr)); in lan743x_rx_open()
2899 RX_HEAD_WRITEBACK_ADDRL(rx->channel_number), in lan743x_rx_open()
2900 DMA_ADDR_LOW32(rx->head_dma_ptr)); in lan743x_rx_open()
2902 if (!(adapter->csr.flags & LAN743X_CSR_FLAG_IS_A0)) { in lan743x_rx_open()
2911 RX_CFG_A(rx->channel_number), data); in lan743x_rx_open()
2914 data = lan743x_csr_read(adapter, RX_CFG_B(rx->channel_number)); in lan743x_rx_open()
2921 data |= ((rx->ring_size) & RX_CFG_B_RX_RING_LEN_MASK_); in lan743x_rx_open()
2923 if (!(adapter->csr.flags & LAN743X_CSR_FLAG_IS_A0)) in lan743x_rx_open()
2926 lan743x_csr_write(adapter, RX_CFG_B(rx->channel_number), data); in lan743x_rx_open()
2927 rx->vector_flags = lan743x_intr_get_vector_flags(adapter, in lan743x_rx_open()
2929 (rx->channel_number)); in lan743x_rx_open()
2933 if (rx->vector_flags & LAN743X_VECTOR_FLAG_SOURCE_ENABLE_AUTO_CLEAR) in lan743x_rx_open()
2935 if (rx->vector_flags & LAN743X_VECTOR_FLAG_SOURCE_STATUS_AUTO_CLEAR) in lan743x_rx_open()
2937 if (rx->vector_flags & LAN743X_VECTOR_FLAG_SOURCE_STATUS_R2C) in lan743x_rx_open()
2939 if (rx->vector_flags & LAN743X_VECTOR_FLAG_SOURCE_ENABLE_R2C) in lan743x_rx_open()
2941 lan743x_csr_write(adapter, RX_CFG_C(rx->channel_number), data); in lan743x_rx_open()
2943 rx->last_tail = ((u32)(rx->ring_size - 1)); in lan743x_rx_open()
2944 lan743x_csr_write(adapter, RX_TAIL(rx->channel_number), in lan743x_rx_open()
2945 rx->last_tail); in lan743x_rx_open()
2946 rx->last_head = lan743x_csr_read(adapter, RX_HEAD(rx->channel_number)); in lan743x_rx_open()
2947 if (rx->last_head) { in lan743x_rx_open()
2948 ret = -EIO; in lan743x_rx_open()
2952 napi_enable(&rx->napi); in lan743x_rx_open()
2955 INT_BIT_DMA_RX_(rx->channel_number)); in lan743x_rx_open()
2957 DMAC_INT_BIT_RXFRM_(rx->channel_number)); in lan743x_rx_open()
2959 DMAC_INT_BIT_RXFRM_(rx->channel_number)); in lan743x_rx_open()
2961 DMAC_CMD_START_R_(rx->channel_number)); in lan743x_rx_open()
2965 FCT_RX_CTL_RESET_(rx->channel_number)); in lan743x_rx_open()
2967 FCT_RX_CTL_RESET_(rx->channel_number), in lan743x_rx_open()
2969 lan743x_csr_write(adapter, FCT_FLOW(rx->channel_number), in lan743x_rx_open()
2976 FCT_RX_CTL_EN_(rx->channel_number)); in lan743x_rx_open()
2980 netif_napi_del(&rx->napi); in lan743x_rx_open()
2981 lan743x_rx_ring_cleanup(rx); in lan743x_rx_open()
2992 for (index = 0; index < adapter->used_tx_channels; index++) in lan743x_netdev_close()
2993 lan743x_tx_close(&adapter->tx[index]); in lan743x_netdev_close()
2996 lan743x_rx_close(&adapter->rx[index]); in lan743x_netdev_close()
3034 ret = lan743x_rx_open(&adapter->rx[index]); in lan743x_netdev_open()
3039 for (index = 0; index < adapter->used_tx_channels; index++) { in lan743x_netdev_open()
3040 ret = lan743x_tx_open(&adapter->tx[index]); in lan743x_netdev_open()
3047 for (index = 0; index < adapter->used_tx_channels; index++) { in lan743x_netdev_open()
3048 if (adapter->tx[index].ring_cpu_ptr) in lan743x_netdev_open()
3049 lan743x_tx_close(&adapter->tx[index]); in lan743x_netdev_open()
3054 if (adapter->rx[index].ring_cpu_ptr) in lan743x_netdev_open()
3055 lan743x_rx_close(&adapter->rx[index]); in lan743x_netdev_open()
3069 netif_warn(adapter, ifup, adapter->netdev, in lan743x_netdev_open()
3080 if (adapter->is_pci11x1x) in lan743x_netdev_xmit_frame()
3081 ch = skb->queue_mapping % PCI11X1X_USED_TX_CHANNELS; in lan743x_netdev_xmit_frame()
3083 return lan743x_tx_xmit_frame(&adapter->tx[ch], skb); in lan743x_netdev_xmit_frame()
3090 return -EINVAL; in lan743x_netdev_ioctl()
3093 return phy_mii_ioctl(netdev->phydev, ifr, cmd); in lan743x_netdev_ioctl()
3110 netdev->mtu = new_mtu; in lan743x_netdev_change_mtu()
3119 stats->rx_packets = lan743x_csr_read(adapter, STAT_RX_TOTAL_FRAMES); in lan743x_netdev_get_stats64()
3120 stats->tx_packets = lan743x_csr_read(adapter, STAT_TX_TOTAL_FRAMES); in lan743x_netdev_get_stats64()
3121 stats->rx_bytes = lan743x_csr_read(adapter, in lan743x_netdev_get_stats64()
3127 stats->tx_bytes = lan743x_csr_read(adapter, in lan743x_netdev_get_stats64()
3133 stats->rx_errors = lan743x_csr_read(adapter, STAT_RX_FCS_ERRORS) + in lan743x_netdev_get_stats64()
3141 stats->tx_errors = lan743x_csr_read(adapter, STAT_TX_FCS_ERRORS) + in lan743x_netdev_get_stats64()
3145 stats->rx_dropped = lan743x_csr_read(adapter, in lan743x_netdev_get_stats64()
3147 stats->tx_dropped = lan743x_csr_read(adapter, in lan743x_netdev_get_stats64()
3149 stats->multicast = lan743x_csr_read(adapter, in lan743x_netdev_get_stats64()
3153 stats->collisions = lan743x_csr_read(adapter, in lan743x_netdev_get_stats64()
3171 eth_hw_addr_set(netdev, sock_addr->sa_data); in lan743x_netdev_set_mac_address()
3172 lan743x_mac_set_address(adapter, sock_addr->sa_data); in lan743x_netdev_set_mac_address()
3195 mdiobus_unregister(adapter->mdiobus); in lan743x_mdiobus_cleanup()
3200 unregister_netdev(adapter->netdev); in lan743x_full_cleanup()
3210 struct lan743x_tx *tx; in lan743x_hardware_init() local
3214 adapter->is_pci11x1x = is_pci11x1x_chip(adapter); in lan743x_hardware_init()
3215 if (adapter->is_pci11x1x) { in lan743x_hardware_init()
3216 adapter->max_tx_channels = PCI11X1X_MAX_TX_CHANNELS; in lan743x_hardware_init()
3217 adapter->used_tx_channels = PCI11X1X_USED_TX_CHANNELS; in lan743x_hardware_init()
3218 adapter->max_vector_count = PCI11X1X_MAX_VECTOR_COUNT; in lan743x_hardware_init()
3220 spin_lock_init(&adapter->eth_syslock_spinlock); in lan743x_hardware_init()
3221 mutex_init(&adapter->sgmii_rw_lock); in lan743x_hardware_init()
3223 adapter->max_tx_channels = LAN743X_MAX_TX_CHANNELS; in lan743x_hardware_init()
3224 adapter->used_tx_channels = LAN743X_USED_TX_CHANNELS; in lan743x_hardware_init()
3225 adapter->max_vector_count = LAN743X_MAX_VECTOR_COUNT; in lan743x_hardware_init()
3228 adapter->intr.irq = adapter->pdev->irq; in lan743x_hardware_init()
3254 adapter->rx[index].adapter = adapter; in lan743x_hardware_init()
3255 adapter->rx[index].channel_number = index; in lan743x_hardware_init()
3258 for (index = 0; index < adapter->used_tx_channels; index++) { in lan743x_hardware_init()
3259 tx = &adapter->tx[index]; in lan743x_hardware_init()
3260 tx->adapter = adapter; in lan743x_hardware_init()
3261 tx->channel_number = index; in lan743x_hardware_init()
3262 spin_lock_init(&tx->ring_lock); in lan743x_hardware_init()
3273 adapter->mdiobus = devm_mdiobus_alloc(&adapter->pdev->dev); in lan743x_mdiobus_init()
3274 if (!(adapter->mdiobus)) { in lan743x_mdiobus_init()
3275 ret = -ENOMEM; in lan743x_mdiobus_init()
3279 adapter->mdiobus->priv = (void *)adapter; in lan743x_mdiobus_init()
3280 if (adapter->is_pci11x1x) { in lan743x_mdiobus_init()
3281 if (adapter->is_sgmii_en) { in lan743x_mdiobus_init()
3286 netif_dbg(adapter, drv, adapter->netdev, in lan743x_mdiobus_init()
3288 adapter->mdiobus->probe_capabilities = MDIOBUS_C22_C45; in lan743x_mdiobus_init()
3289 adapter->mdiobus->read = lan743x_mdiobus_c45_read; in lan743x_mdiobus_init()
3290 adapter->mdiobus->write = lan743x_mdiobus_c45_write; in lan743x_mdiobus_init()
3291 adapter->mdiobus->name = "lan743x-mdiobus-c45"; in lan743x_mdiobus_init()
3292 netif_dbg(adapter, drv, adapter->netdev, in lan743x_mdiobus_init()
3293 "lan743x-mdiobus-c45\n"); in lan743x_mdiobus_init()
3299 netif_dbg(adapter, drv, adapter->netdev, in lan743x_mdiobus_init()
3302 adapter->mdiobus->probe_capabilities = MDIOBUS_C22; in lan743x_mdiobus_init()
3303 adapter->mdiobus->read = lan743x_mdiobus_read; in lan743x_mdiobus_init()
3304 adapter->mdiobus->write = lan743x_mdiobus_write; in lan743x_mdiobus_init()
3305 adapter->mdiobus->name = "lan743x-mdiobus"; in lan743x_mdiobus_init()
3306 netif_dbg(adapter, drv, adapter->netdev, in lan743x_mdiobus_init()
3307 "lan743x-mdiobus\n"); in lan743x_mdiobus_init()
3310 adapter->mdiobus->read = lan743x_mdiobus_read; in lan743x_mdiobus_init()
3311 adapter->mdiobus->write = lan743x_mdiobus_write; in lan743x_mdiobus_init()
3312 adapter->mdiobus->name = "lan743x-mdiobus"; in lan743x_mdiobus_init()
3313 netif_dbg(adapter, drv, adapter->netdev, "lan743x-mdiobus\n"); in lan743x_mdiobus_init()
3316 snprintf(adapter->mdiobus->id, MII_BUS_ID_SIZE, in lan743x_mdiobus_init()
3317 "pci-%s", pci_name(adapter->pdev)); in lan743x_mdiobus_init()
3319 if ((adapter->csr.id_rev & ID_REV_ID_MASK_) == ID_REV_ID_LAN7430_) in lan743x_mdiobus_init()
3321 adapter->mdiobus->phy_mask = ~(u32)BIT(1); in lan743x_mdiobus_init()
3324 ret = mdiobus_register(adapter->mdiobus); in lan743x_mdiobus_init()
3333 /* lan743x_pcidev_probe - Device Initialization Routine
3348 int ret = -ENODEV; in lan743x_pcidev_probe()
3350 if (id->device == PCI_DEVICE_ID_SMSC_A011 || in lan743x_pcidev_probe()
3351 id->device == PCI_DEVICE_ID_SMSC_A041) { in lan743x_pcidev_probe()
3352 netdev = devm_alloc_etherdev_mqs(&pdev->dev, in lan743x_pcidev_probe()
3357 netdev = devm_alloc_etherdev_mqs(&pdev->dev, in lan743x_pcidev_probe()
3366 SET_NETDEV_DEV(netdev, &pdev->dev); in lan743x_pcidev_probe()
3369 adapter->netdev = netdev; in lan743x_pcidev_probe()
3370 adapter->msg_enable = NETIF_MSG_DRV | NETIF_MSG_PROBE | in lan743x_pcidev_probe()
3373 netdev->max_mtu = LAN743X_MAX_FRAME_SIZE; in lan743x_pcidev_probe()
3375 of_get_mac_address(pdev->dev.of_node, adapter->mac_address); in lan743x_pcidev_probe()
3393 adapter->netdev->netdev_ops = &lan743x_netdev_ops; in lan743x_pcidev_probe()
3394 adapter->netdev->ethtool_ops = &lan743x_ethtool_ops; in lan743x_pcidev_probe()
3395 adapter->netdev->features = NETIF_F_SG | NETIF_F_TSO | in lan743x_pcidev_probe()
3397 adapter->netdev->hw_features = adapter->netdev->features; in lan743x_pcidev_probe()
3402 ret = register_netdev(adapter->netdev); in lan743x_pcidev_probe()
3422 * lan743x_pcidev_remove - Device Removal Routine
3427 * Hot-Plug event, or because the driver is going to be removed from
3447 * For instance, it is true when system goes to sleep by pm-suspend in lan743x_pcidev_shutdown()
3497 if (adapter->wolopts & WAKE_PHY) { in lan743x_pm_set_wol()
3501 if (adapter->wolopts & WAKE_MAGIC) { in lan743x_pm_set_wol()
3506 if (adapter->wolopts & WAKE_UCAST) { in lan743x_pm_set_wol()
3512 if (adapter->wolopts & WAKE_BCAST) { in lan743x_pm_set_wol()
3518 if (adapter->wolopts & WAKE_MCAST) { in lan743x_pm_set_wol()
3548 if (adapter->wolopts & WAKE_ARP) { in lan743x_pm_set_wol()
3569 if (adapter->wolopts & WAKE_MAGICSECURE) { in lan743x_pm_set_wol()
3570 sopass = *(u32 *)adapter->sopass; in lan743x_pm_set_wol()
3572 sopass = *(u16 *)&adapter->sopass[4]; in lan743x_pm_set_wol()
3596 if (adapter->wolopts) in lan743x_pm_suspend()
3599 if (adapter->is_pci11x1x) { in lan743x_pm_suspend()
3602 adapter->hw_cfg = data; in lan743x_pm_suspend()
3627 if (adapter->is_pci11x1x) in lan743x_pm_resume()
3628 lan743x_csr_write(adapter, HW_CFG, adapter->hw_cfg); in lan743x_pm_resume()
3632 netif_err(adapter, probe, adapter->netdev, in lan743x_pm_resume()
3639 * For instance, it is true when system wakesup after pm-suspend in lan743x_pm_resume()
3647 netif_info(adapter, drv, adapter->netdev, in lan743x_pm_resume()