LCOV - code coverage report
Current view: top level - drivers/net/ethernet/stmicro/stmmac - stmmac_ethtool.c (source / functions) Hit Total Coverage
Test: combined.info Lines: 6 315 1.9 %
Date: 2022-04-01 14:35:51 Functions: 2 29 6.9 %
Branches: 1 282 0.4 %

           Branch data     Line data    Source code
       1                 :            : // SPDX-License-Identifier: GPL-2.0-only
       2                 :            : /*******************************************************************************
       3                 :            :   STMMAC Ethtool support
       4                 :            : 
       5                 :            :   Copyright (C) 2007-2009  STMicroelectronics Ltd
       6                 :            : 
       7                 :            : 
       8                 :            :   Author: Giuseppe Cavallaro <peppe.cavallaro@st.com>
       9                 :            : *******************************************************************************/
      10                 :            : 
      11                 :            : #include <linux/etherdevice.h>
      12                 :            : #include <linux/ethtool.h>
      13                 :            : #include <linux/interrupt.h>
      14                 :            : #include <linux/mii.h>
      15                 :            : #include <linux/phylink.h>
      16                 :            : #include <linux/net_tstamp.h>
      17                 :            : #include <asm/io.h>
      18                 :            : 
      19                 :            : #include "stmmac.h"
      20                 :            : #include "dwmac_dma.h"
      21                 :            : #include "dwxgmac2.h"
      22                 :            : 
      23                 :            : #define REG_SPACE_SIZE  0x1060
      24                 :            : #define MAC100_ETHTOOL_NAME     "st_mac100"
      25                 :            : #define GMAC_ETHTOOL_NAME       "st_gmac"
      26                 :            : #define XGMAC_ETHTOOL_NAME      "st_xgmac"
      27                 :            : 
      28                 :            : #define ETHTOOL_DMA_OFFSET      55
      29                 :            : 
      30                 :            : struct stmmac_stats {
      31                 :            :         char stat_string[ETH_GSTRING_LEN];
      32                 :            :         int sizeof_stat;
      33                 :            :         int stat_offset;
      34                 :            : };
      35                 :            : 
      36                 :            : #define STMMAC_STAT(m)  \
      37                 :            :         { #m, sizeof_field(struct stmmac_extra_stats, m),       \
      38                 :            :         offsetof(struct stmmac_priv, xstats.m)}
      39                 :            : 
      40                 :            : static const struct stmmac_stats stmmac_gstrings_stats[] = {
      41                 :            :         /* Transmit errors */
      42                 :            :         STMMAC_STAT(tx_underflow),
      43                 :            :         STMMAC_STAT(tx_carrier),
      44                 :            :         STMMAC_STAT(tx_losscarrier),
      45                 :            :         STMMAC_STAT(vlan_tag),
      46                 :            :         STMMAC_STAT(tx_deferred),
      47                 :            :         STMMAC_STAT(tx_vlan),
      48                 :            :         STMMAC_STAT(tx_jabber),
      49                 :            :         STMMAC_STAT(tx_frame_flushed),
      50                 :            :         STMMAC_STAT(tx_payload_error),
      51                 :            :         STMMAC_STAT(tx_ip_header_error),
      52                 :            :         /* Receive errors */
      53                 :            :         STMMAC_STAT(rx_desc),
      54                 :            :         STMMAC_STAT(sa_filter_fail),
      55                 :            :         STMMAC_STAT(overflow_error),
      56                 :            :         STMMAC_STAT(ipc_csum_error),
      57                 :            :         STMMAC_STAT(rx_collision),
      58                 :            :         STMMAC_STAT(rx_crc_errors),
      59                 :            :         STMMAC_STAT(dribbling_bit),
      60                 :            :         STMMAC_STAT(rx_length),
      61                 :            :         STMMAC_STAT(rx_mii),
      62                 :            :         STMMAC_STAT(rx_multicast),
      63                 :            :         STMMAC_STAT(rx_gmac_overflow),
      64                 :            :         STMMAC_STAT(rx_watchdog),
      65                 :            :         STMMAC_STAT(da_rx_filter_fail),
      66                 :            :         STMMAC_STAT(sa_rx_filter_fail),
      67                 :            :         STMMAC_STAT(rx_missed_cntr),
      68                 :            :         STMMAC_STAT(rx_overflow_cntr),
      69                 :            :         STMMAC_STAT(rx_vlan),
      70                 :            :         STMMAC_STAT(rx_split_hdr_pkt_n),
      71                 :            :         /* Tx/Rx IRQ error info */
      72                 :            :         STMMAC_STAT(tx_undeflow_irq),
      73                 :            :         STMMAC_STAT(tx_process_stopped_irq),
      74                 :            :         STMMAC_STAT(tx_jabber_irq),
      75                 :            :         STMMAC_STAT(rx_overflow_irq),
      76                 :            :         STMMAC_STAT(rx_buf_unav_irq),
      77                 :            :         STMMAC_STAT(rx_process_stopped_irq),
      78                 :            :         STMMAC_STAT(rx_watchdog_irq),
      79                 :            :         STMMAC_STAT(tx_early_irq),
      80                 :            :         STMMAC_STAT(fatal_bus_error_irq),
      81                 :            :         /* Tx/Rx IRQ Events */
      82                 :            :         STMMAC_STAT(rx_early_irq),
      83                 :            :         STMMAC_STAT(threshold),
      84                 :            :         STMMAC_STAT(tx_pkt_n),
      85                 :            :         STMMAC_STAT(rx_pkt_n),
      86                 :            :         STMMAC_STAT(normal_irq_n),
      87                 :            :         STMMAC_STAT(rx_normal_irq_n),
      88                 :            :         STMMAC_STAT(napi_poll),
      89                 :            :         STMMAC_STAT(tx_normal_irq_n),
      90                 :            :         STMMAC_STAT(tx_clean),
      91                 :            :         STMMAC_STAT(tx_set_ic_bit),
      92                 :            :         STMMAC_STAT(irq_receive_pmt_irq_n),
      93                 :            :         /* MMC info */
      94                 :            :         STMMAC_STAT(mmc_tx_irq_n),
      95                 :            :         STMMAC_STAT(mmc_rx_irq_n),
      96                 :            :         STMMAC_STAT(mmc_rx_csum_offload_irq_n),
      97                 :            :         /* EEE */
      98                 :            :         STMMAC_STAT(irq_tx_path_in_lpi_mode_n),
      99                 :            :         STMMAC_STAT(irq_tx_path_exit_lpi_mode_n),
     100                 :            :         STMMAC_STAT(irq_rx_path_in_lpi_mode_n),
     101                 :            :         STMMAC_STAT(irq_rx_path_exit_lpi_mode_n),
     102                 :            :         STMMAC_STAT(phy_eee_wakeup_error_n),
     103                 :            :         /* Extended RDES status */
     104                 :            :         STMMAC_STAT(ip_hdr_err),
     105                 :            :         STMMAC_STAT(ip_payload_err),
     106                 :            :         STMMAC_STAT(ip_csum_bypassed),
     107                 :            :         STMMAC_STAT(ipv4_pkt_rcvd),
     108                 :            :         STMMAC_STAT(ipv6_pkt_rcvd),
     109                 :            :         STMMAC_STAT(no_ptp_rx_msg_type_ext),
     110                 :            :         STMMAC_STAT(ptp_rx_msg_type_sync),
     111                 :            :         STMMAC_STAT(ptp_rx_msg_type_follow_up),
     112                 :            :         STMMAC_STAT(ptp_rx_msg_type_delay_req),
     113                 :            :         STMMAC_STAT(ptp_rx_msg_type_delay_resp),
     114                 :            :         STMMAC_STAT(ptp_rx_msg_type_pdelay_req),
     115                 :            :         STMMAC_STAT(ptp_rx_msg_type_pdelay_resp),
     116                 :            :         STMMAC_STAT(ptp_rx_msg_type_pdelay_follow_up),
     117                 :            :         STMMAC_STAT(ptp_rx_msg_type_announce),
     118                 :            :         STMMAC_STAT(ptp_rx_msg_type_management),
     119                 :            :         STMMAC_STAT(ptp_rx_msg_pkt_reserved_type),
     120                 :            :         STMMAC_STAT(ptp_frame_type),
     121                 :            :         STMMAC_STAT(ptp_ver),
     122                 :            :         STMMAC_STAT(timestamp_dropped),
     123                 :            :         STMMAC_STAT(av_pkt_rcvd),
     124                 :            :         STMMAC_STAT(av_tagged_pkt_rcvd),
     125                 :            :         STMMAC_STAT(vlan_tag_priority_val),
     126                 :            :         STMMAC_STAT(l3_filter_match),
     127                 :            :         STMMAC_STAT(l4_filter_match),
     128                 :            :         STMMAC_STAT(l3_l4_filter_no_match),
     129                 :            :         /* PCS */
     130                 :            :         STMMAC_STAT(irq_pcs_ane_n),
     131                 :            :         STMMAC_STAT(irq_pcs_link_n),
     132                 :            :         STMMAC_STAT(irq_rgmii_n),
     133                 :            :         /* DEBUG */
     134                 :            :         STMMAC_STAT(mtl_tx_status_fifo_full),
     135                 :            :         STMMAC_STAT(mtl_tx_fifo_not_empty),
     136                 :            :         STMMAC_STAT(mmtl_fifo_ctrl),
     137                 :            :         STMMAC_STAT(mtl_tx_fifo_read_ctrl_write),
     138                 :            :         STMMAC_STAT(mtl_tx_fifo_read_ctrl_wait),
     139                 :            :         STMMAC_STAT(mtl_tx_fifo_read_ctrl_read),
     140                 :            :         STMMAC_STAT(mtl_tx_fifo_read_ctrl_idle),
     141                 :            :         STMMAC_STAT(mac_tx_in_pause),
     142                 :            :         STMMAC_STAT(mac_tx_frame_ctrl_xfer),
     143                 :            :         STMMAC_STAT(mac_tx_frame_ctrl_idle),
     144                 :            :         STMMAC_STAT(mac_tx_frame_ctrl_wait),
     145                 :            :         STMMAC_STAT(mac_tx_frame_ctrl_pause),
     146                 :            :         STMMAC_STAT(mac_gmii_tx_proto_engine),
     147                 :            :         STMMAC_STAT(mtl_rx_fifo_fill_level_full),
     148                 :            :         STMMAC_STAT(mtl_rx_fifo_fill_above_thresh),
     149                 :            :         STMMAC_STAT(mtl_rx_fifo_fill_below_thresh),
     150                 :            :         STMMAC_STAT(mtl_rx_fifo_fill_level_empty),
     151                 :            :         STMMAC_STAT(mtl_rx_fifo_read_ctrl_flush),
     152                 :            :         STMMAC_STAT(mtl_rx_fifo_read_ctrl_read_data),
     153                 :            :         STMMAC_STAT(mtl_rx_fifo_read_ctrl_status),
     154                 :            :         STMMAC_STAT(mtl_rx_fifo_read_ctrl_idle),
     155                 :            :         STMMAC_STAT(mtl_rx_fifo_ctrl_active),
     156                 :            :         STMMAC_STAT(mac_rx_frame_ctrl_fifo),
     157                 :            :         STMMAC_STAT(mac_gmii_rx_proto_engine),
     158                 :            :         /* TSO */
     159                 :            :         STMMAC_STAT(tx_tso_frames),
     160                 :            :         STMMAC_STAT(tx_tso_nfrags),
     161                 :            : };
     162                 :            : #define STMMAC_STATS_LEN ARRAY_SIZE(stmmac_gstrings_stats)
     163                 :            : 
     164                 :            : /* HW MAC Management counters (if supported) */
     165                 :            : #define STMMAC_MMC_STAT(m)      \
     166                 :            :         { #m, sizeof_field(struct stmmac_counters, m),  \
     167                 :            :         offsetof(struct stmmac_priv, mmc.m)}
     168                 :            : 
     169                 :            : static const struct stmmac_stats stmmac_mmc[] = {
     170                 :            :         STMMAC_MMC_STAT(mmc_tx_octetcount_gb),
     171                 :            :         STMMAC_MMC_STAT(mmc_tx_framecount_gb),
     172                 :            :         STMMAC_MMC_STAT(mmc_tx_broadcastframe_g),
     173                 :            :         STMMAC_MMC_STAT(mmc_tx_multicastframe_g),
     174                 :            :         STMMAC_MMC_STAT(mmc_tx_64_octets_gb),
     175                 :            :         STMMAC_MMC_STAT(mmc_tx_65_to_127_octets_gb),
     176                 :            :         STMMAC_MMC_STAT(mmc_tx_128_to_255_octets_gb),
     177                 :            :         STMMAC_MMC_STAT(mmc_tx_256_to_511_octets_gb),
     178                 :            :         STMMAC_MMC_STAT(mmc_tx_512_to_1023_octets_gb),
     179                 :            :         STMMAC_MMC_STAT(mmc_tx_1024_to_max_octets_gb),
     180                 :            :         STMMAC_MMC_STAT(mmc_tx_unicast_gb),
     181                 :            :         STMMAC_MMC_STAT(mmc_tx_multicast_gb),
     182                 :            :         STMMAC_MMC_STAT(mmc_tx_broadcast_gb),
     183                 :            :         STMMAC_MMC_STAT(mmc_tx_underflow_error),
     184                 :            :         STMMAC_MMC_STAT(mmc_tx_singlecol_g),
     185                 :            :         STMMAC_MMC_STAT(mmc_tx_multicol_g),
     186                 :            :         STMMAC_MMC_STAT(mmc_tx_deferred),
     187                 :            :         STMMAC_MMC_STAT(mmc_tx_latecol),
     188                 :            :         STMMAC_MMC_STAT(mmc_tx_exesscol),
     189                 :            :         STMMAC_MMC_STAT(mmc_tx_carrier_error),
     190                 :            :         STMMAC_MMC_STAT(mmc_tx_octetcount_g),
     191                 :            :         STMMAC_MMC_STAT(mmc_tx_framecount_g),
     192                 :            :         STMMAC_MMC_STAT(mmc_tx_excessdef),
     193                 :            :         STMMAC_MMC_STAT(mmc_tx_pause_frame),
     194                 :            :         STMMAC_MMC_STAT(mmc_tx_vlan_frame_g),
     195                 :            :         STMMAC_MMC_STAT(mmc_rx_framecount_gb),
     196                 :            :         STMMAC_MMC_STAT(mmc_rx_octetcount_gb),
     197                 :            :         STMMAC_MMC_STAT(mmc_rx_octetcount_g),
     198                 :            :         STMMAC_MMC_STAT(mmc_rx_broadcastframe_g),
     199                 :            :         STMMAC_MMC_STAT(mmc_rx_multicastframe_g),
     200                 :            :         STMMAC_MMC_STAT(mmc_rx_crc_error),
     201                 :            :         STMMAC_MMC_STAT(mmc_rx_align_error),
     202                 :            :         STMMAC_MMC_STAT(mmc_rx_run_error),
     203                 :            :         STMMAC_MMC_STAT(mmc_rx_jabber_error),
     204                 :            :         STMMAC_MMC_STAT(mmc_rx_undersize_g),
     205                 :            :         STMMAC_MMC_STAT(mmc_rx_oversize_g),
     206                 :            :         STMMAC_MMC_STAT(mmc_rx_64_octets_gb),
     207                 :            :         STMMAC_MMC_STAT(mmc_rx_65_to_127_octets_gb),
     208                 :            :         STMMAC_MMC_STAT(mmc_rx_128_to_255_octets_gb),
     209                 :            :         STMMAC_MMC_STAT(mmc_rx_256_to_511_octets_gb),
     210                 :            :         STMMAC_MMC_STAT(mmc_rx_512_to_1023_octets_gb),
     211                 :            :         STMMAC_MMC_STAT(mmc_rx_1024_to_max_octets_gb),
     212                 :            :         STMMAC_MMC_STAT(mmc_rx_unicast_g),
     213                 :            :         STMMAC_MMC_STAT(mmc_rx_length_error),
     214                 :            :         STMMAC_MMC_STAT(mmc_rx_autofrangetype),
     215                 :            :         STMMAC_MMC_STAT(mmc_rx_pause_frames),
     216                 :            :         STMMAC_MMC_STAT(mmc_rx_fifo_overflow),
     217                 :            :         STMMAC_MMC_STAT(mmc_rx_vlan_frames_gb),
     218                 :            :         STMMAC_MMC_STAT(mmc_rx_watchdog_error),
     219                 :            :         STMMAC_MMC_STAT(mmc_rx_ipc_intr_mask),
     220                 :            :         STMMAC_MMC_STAT(mmc_rx_ipc_intr),
     221                 :            :         STMMAC_MMC_STAT(mmc_rx_ipv4_gd),
     222                 :            :         STMMAC_MMC_STAT(mmc_rx_ipv4_hderr),
     223                 :            :         STMMAC_MMC_STAT(mmc_rx_ipv4_nopay),
     224                 :            :         STMMAC_MMC_STAT(mmc_rx_ipv4_frag),
     225                 :            :         STMMAC_MMC_STAT(mmc_rx_ipv4_udsbl),
     226                 :            :         STMMAC_MMC_STAT(mmc_rx_ipv4_gd_octets),
     227                 :            :         STMMAC_MMC_STAT(mmc_rx_ipv4_hderr_octets),
     228                 :            :         STMMAC_MMC_STAT(mmc_rx_ipv4_nopay_octets),
     229                 :            :         STMMAC_MMC_STAT(mmc_rx_ipv4_frag_octets),
     230                 :            :         STMMAC_MMC_STAT(mmc_rx_ipv4_udsbl_octets),
     231                 :            :         STMMAC_MMC_STAT(mmc_rx_ipv6_gd_octets),
     232                 :            :         STMMAC_MMC_STAT(mmc_rx_ipv6_hderr_octets),
     233                 :            :         STMMAC_MMC_STAT(mmc_rx_ipv6_nopay_octets),
     234                 :            :         STMMAC_MMC_STAT(mmc_rx_ipv6_gd),
     235                 :            :         STMMAC_MMC_STAT(mmc_rx_ipv6_hderr),
     236                 :            :         STMMAC_MMC_STAT(mmc_rx_ipv6_nopay),
     237                 :            :         STMMAC_MMC_STAT(mmc_rx_udp_gd),
     238                 :            :         STMMAC_MMC_STAT(mmc_rx_udp_err),
     239                 :            :         STMMAC_MMC_STAT(mmc_rx_tcp_gd),
     240                 :            :         STMMAC_MMC_STAT(mmc_rx_tcp_err),
     241                 :            :         STMMAC_MMC_STAT(mmc_rx_icmp_gd),
     242                 :            :         STMMAC_MMC_STAT(mmc_rx_icmp_err),
     243                 :            :         STMMAC_MMC_STAT(mmc_rx_udp_gd_octets),
     244                 :            :         STMMAC_MMC_STAT(mmc_rx_udp_err_octets),
     245                 :            :         STMMAC_MMC_STAT(mmc_rx_tcp_gd_octets),
     246                 :            :         STMMAC_MMC_STAT(mmc_rx_tcp_err_octets),
     247                 :            :         STMMAC_MMC_STAT(mmc_rx_icmp_gd_octets),
     248                 :            :         STMMAC_MMC_STAT(mmc_rx_icmp_err_octets),
     249                 :            :         STMMAC_MMC_STAT(mmc_tx_fpe_fragment_cntr),
     250                 :            :         STMMAC_MMC_STAT(mmc_tx_hold_req_cntr),
     251                 :            :         STMMAC_MMC_STAT(mmc_rx_packet_assembly_err_cntr),
     252                 :            :         STMMAC_MMC_STAT(mmc_rx_packet_smd_err_cntr),
     253                 :            :         STMMAC_MMC_STAT(mmc_rx_packet_assembly_ok_cntr),
     254                 :            :         STMMAC_MMC_STAT(mmc_rx_fpe_fragment_cntr),
     255                 :            : };
     256                 :            : #define STMMAC_MMC_STATS_LEN ARRAY_SIZE(stmmac_mmc)
     257                 :            : 
     258                 :          0 : static void stmmac_ethtool_getdrvinfo(struct net_device *dev,
     259                 :            :                                       struct ethtool_drvinfo *info)
     260                 :            : {
     261         [ #  # ]:          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     262                 :            : 
     263   [ #  #  #  # ]:          0 :         if (priv->plat->has_gmac || priv->plat->has_gmac4)
     264                 :          0 :                 strlcpy(info->driver, GMAC_ETHTOOL_NAME, sizeof(info->driver));
     265         [ #  # ]:          0 :         else if (priv->plat->has_xgmac)
     266                 :          0 :                 strlcpy(info->driver, XGMAC_ETHTOOL_NAME, sizeof(info->driver));
     267                 :            :         else
     268                 :          0 :                 strlcpy(info->driver, MAC100_ETHTOOL_NAME,
     269                 :            :                         sizeof(info->driver));
     270                 :            : 
     271                 :          0 :         strlcpy(info->version, DRV_MODULE_VERSION, sizeof(info->version));
     272                 :          0 : }
     273                 :            : 
     274                 :          0 : static int stmmac_ethtool_get_link_ksettings(struct net_device *dev,
     275                 :            :                                              struct ethtool_link_ksettings *cmd)
     276                 :            : {
     277         [ #  # ]:          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     278                 :            : 
     279         [ #  # ]:          0 :         if (priv->hw->pcs & STMMAC_PCS_RGMII ||
     280                 :            :             priv->hw->pcs & STMMAC_PCS_SGMII) {
     281                 :          0 :                 struct rgmii_adv adv;
     282                 :          0 :                 u32 supported, advertising, lp_advertising;
     283                 :            : 
     284         [ #  # ]:          0 :                 if (!priv->xstats.pcs_link) {
     285                 :          0 :                         cmd->base.speed = SPEED_UNKNOWN;
     286                 :          0 :                         cmd->base.duplex = DUPLEX_UNKNOWN;
     287                 :          0 :                         return 0;
     288                 :            :                 }
     289                 :          0 :                 cmd->base.duplex = priv->xstats.pcs_duplex;
     290                 :            : 
     291                 :          0 :                 cmd->base.speed = priv->xstats.pcs_speed;
     292                 :            : 
     293                 :            :                 /* Get and convert ADV/LP_ADV from the HW AN registers */
     294   [ #  #  #  # ]:          0 :                 if (stmmac_pcs_get_adv_lp(priv, priv->ioaddr, &adv))
     295                 :            :                         return -EOPNOTSUPP;     /* should never happen indeed */
     296                 :            : 
     297                 :            :                 /* Encoding of PSE bits is defined in 802.3z, 37.2.1.4 */
     298                 :            : 
     299                 :          0 :                 ethtool_convert_link_mode_to_legacy_u32(
     300                 :          0 :                         &supported, cmd->link_modes.supported);
     301                 :          0 :                 ethtool_convert_link_mode_to_legacy_u32(
     302                 :          0 :                         &advertising, cmd->link_modes.advertising);
     303                 :          0 :                 ethtool_convert_link_mode_to_legacy_u32(
     304                 :          0 :                         &lp_advertising, cmd->link_modes.lp_advertising);
     305                 :            : 
     306         [ #  # ]:          0 :                 if (adv.pause & STMMAC_PCS_PAUSE)
     307                 :          0 :                         advertising |= ADVERTISED_Pause;
     308         [ #  # ]:          0 :                 if (adv.pause & STMMAC_PCS_ASYM_PAUSE)
     309                 :          0 :                         advertising |= ADVERTISED_Asym_Pause;
     310         [ #  # ]:          0 :                 if (adv.lp_pause & STMMAC_PCS_PAUSE)
     311                 :          0 :                         lp_advertising |= ADVERTISED_Pause;
     312         [ #  # ]:          0 :                 if (adv.lp_pause & STMMAC_PCS_ASYM_PAUSE)
     313                 :          0 :                         lp_advertising |= ADVERTISED_Asym_Pause;
     314                 :            : 
     315                 :            :                 /* Reg49[3] always set because ANE is always supported */
     316                 :          0 :                 cmd->base.autoneg = ADVERTISED_Autoneg;
     317                 :          0 :                 supported |= SUPPORTED_Autoneg;
     318                 :          0 :                 advertising |= ADVERTISED_Autoneg;
     319                 :          0 :                 lp_advertising |= ADVERTISED_Autoneg;
     320                 :            : 
     321         [ #  # ]:          0 :                 if (adv.duplex) {
     322                 :          0 :                         supported |= (SUPPORTED_1000baseT_Full |
     323                 :            :                                       SUPPORTED_100baseT_Full |
     324                 :            :                                       SUPPORTED_10baseT_Full);
     325                 :          0 :                         advertising |= (ADVERTISED_1000baseT_Full |
     326                 :            :                                         ADVERTISED_100baseT_Full |
     327                 :            :                                         ADVERTISED_10baseT_Full);
     328                 :            :                 } else {
     329                 :          0 :                         supported |= (SUPPORTED_1000baseT_Half |
     330                 :            :                                       SUPPORTED_100baseT_Half |
     331                 :            :                                       SUPPORTED_10baseT_Half);
     332                 :          0 :                         advertising |= (ADVERTISED_1000baseT_Half |
     333                 :            :                                         ADVERTISED_100baseT_Half |
     334                 :            :                                         ADVERTISED_10baseT_Half);
     335                 :            :                 }
     336         [ #  # ]:          0 :                 if (adv.lp_duplex)
     337                 :          0 :                         lp_advertising |= (ADVERTISED_1000baseT_Full |
     338                 :            :                                            ADVERTISED_100baseT_Full |
     339                 :            :                                            ADVERTISED_10baseT_Full);
     340                 :            :                 else
     341                 :          0 :                         lp_advertising |= (ADVERTISED_1000baseT_Half |
     342                 :            :                                            ADVERTISED_100baseT_Half |
     343                 :            :                                            ADVERTISED_10baseT_Half);
     344                 :          0 :                 cmd->base.port = PORT_OTHER;
     345                 :            : 
     346                 :          0 :                 ethtool_convert_legacy_u32_to_link_mode(
     347                 :            :                         cmd->link_modes.supported, supported);
     348                 :          0 :                 ethtool_convert_legacy_u32_to_link_mode(
     349                 :            :                         cmd->link_modes.advertising, advertising);
     350                 :          0 :                 ethtool_convert_legacy_u32_to_link_mode(
     351                 :            :                         cmd->link_modes.lp_advertising, lp_advertising);
     352                 :            : 
     353                 :          0 :                 return 0;
     354                 :            :         }
     355                 :            : 
     356                 :          0 :         return phylink_ethtool_ksettings_get(priv->phylink, cmd);
     357                 :            : }
     358                 :            : 
     359                 :            : static int
     360                 :          0 : stmmac_ethtool_set_link_ksettings(struct net_device *dev,
     361                 :            :                                   const struct ethtool_link_ksettings *cmd)
     362                 :            : {
     363         [ #  # ]:          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     364                 :            : 
     365         [ #  # ]:          0 :         if (priv->hw->pcs & STMMAC_PCS_RGMII ||
     366                 :            :             priv->hw->pcs & STMMAC_PCS_SGMII) {
     367                 :          0 :                 u32 mask = ADVERTISED_Autoneg | ADVERTISED_Pause;
     368                 :            : 
     369                 :            :                 /* Only support ANE */
     370         [ #  # ]:          0 :                 if (cmd->base.autoneg != AUTONEG_ENABLE)
     371                 :            :                         return -EINVAL;
     372                 :            : 
     373                 :          0 :                 mask &= (ADVERTISED_1000baseT_Half |
     374                 :            :                         ADVERTISED_1000baseT_Full |
     375                 :            :                         ADVERTISED_100baseT_Half |
     376                 :            :                         ADVERTISED_100baseT_Full |
     377                 :            :                         ADVERTISED_10baseT_Half |
     378                 :            :                         ADVERTISED_10baseT_Full);
     379                 :            : 
     380                 :          0 :                 mutex_lock(&priv->lock);
     381   [ #  #  #  # ]:          0 :                 stmmac_pcs_ctrl_ane(priv, priv->ioaddr, 1, priv->hw->ps, 0);
     382                 :          0 :                 mutex_unlock(&priv->lock);
     383                 :            : 
     384                 :          0 :                 return 0;
     385                 :            :         }
     386                 :            : 
     387                 :          0 :         return phylink_ethtool_ksettings_set(priv->phylink, cmd);
     388                 :            : }
     389                 :            : 
     390                 :          0 : static u32 stmmac_ethtool_getmsglevel(struct net_device *dev)
     391                 :            : {
     392                 :          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     393                 :          0 :         return priv->msg_enable;
     394                 :            : }
     395                 :            : 
     396                 :          0 : static void stmmac_ethtool_setmsglevel(struct net_device *dev, u32 level)
     397                 :            : {
     398                 :          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     399                 :          0 :         priv->msg_enable = level;
     400                 :            : 
     401                 :          0 : }
     402                 :            : 
     403                 :         42 : static int stmmac_check_if_running(struct net_device *dev)
     404                 :            : {
     405         [ +  - ]:         42 :         if (!netif_running(dev))
     406                 :         42 :                 return -EBUSY;
     407                 :            :         return 0;
     408                 :            : }
     409                 :            : 
     410                 :          0 : static int stmmac_ethtool_get_regs_len(struct net_device *dev)
     411                 :            : {
     412         [ #  # ]:          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     413                 :            : 
     414         [ #  # ]:          0 :         if (priv->plat->has_xgmac)
     415                 :          0 :                 return XGMAC_REGSIZE * 4;
     416                 :            :         return REG_SPACE_SIZE;
     417                 :            : }
     418                 :            : 
     419                 :          0 : static void stmmac_ethtool_gregs(struct net_device *dev,
     420                 :            :                           struct ethtool_regs *regs, void *space)
     421                 :            : {
     422         [ #  # ]:          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     423                 :          0 :         u32 *reg_space = (u32 *) space;
     424                 :            : 
     425   [ #  #  #  # ]:          0 :         stmmac_dump_mac_regs(priv, priv->hw, reg_space);
     426   [ #  #  #  # ]:          0 :         stmmac_dump_dma_regs(priv, priv->ioaddr, reg_space);
     427                 :            : 
     428         [ #  # ]:          0 :         if (!priv->plat->has_xgmac) {
     429                 :            :                 /* Copy DMA registers to where ethtool expects them */
     430                 :          0 :                 memcpy(&reg_space[ETHTOOL_DMA_OFFSET],
     431                 :          0 :                        &reg_space[DMA_BUS_MODE / 4],
     432                 :            :                        NUM_DWMAC1000_DMA_REGS * 4);
     433                 :            :         }
     434                 :          0 : }
     435                 :            : 
     436                 :          0 : static int stmmac_nway_reset(struct net_device *dev)
     437                 :            : {
     438                 :          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     439                 :            : 
     440                 :          0 :         return phylink_ethtool_nway_reset(priv->phylink);
     441                 :            : }
     442                 :            : 
     443                 :            : static void
     444                 :          0 : stmmac_get_pauseparam(struct net_device *netdev,
     445                 :            :                       struct ethtool_pauseparam *pause)
     446                 :            : {
     447         [ #  # ]:          0 :         struct stmmac_priv *priv = netdev_priv(netdev);
     448                 :          0 :         struct rgmii_adv adv_lp;
     449                 :            : 
     450   [ #  #  #  #  :          0 :         if (priv->hw->pcs && !stmmac_pcs_get_adv_lp(priv, priv->ioaddr, &adv_lp)) {
                   #  # ]
     451                 :          0 :                 pause->autoneg = 1;
     452                 :          0 :                 if (!adv_lp.pause)
     453                 :          0 :                         return;
     454                 :            :         } else {
     455                 :          0 :                 phylink_ethtool_get_pauseparam(priv->phylink, pause);
     456                 :            :         }
     457                 :            : }
     458                 :            : 
     459                 :            : static int
     460                 :          0 : stmmac_set_pauseparam(struct net_device *netdev,
     461                 :            :                       struct ethtool_pauseparam *pause)
     462                 :            : {
     463         [ #  # ]:          0 :         struct stmmac_priv *priv = netdev_priv(netdev);
     464                 :          0 :         struct rgmii_adv adv_lp;
     465                 :            : 
     466   [ #  #  #  #  :          0 :         if (priv->hw->pcs && !stmmac_pcs_get_adv_lp(priv, priv->ioaddr, &adv_lp)) {
                   #  # ]
     467                 :          0 :                 pause->autoneg = 1;
     468         [ #  # ]:          0 :                 if (!adv_lp.pause)
     469                 :            :                         return -EOPNOTSUPP;
     470                 :          0 :                 return 0;
     471                 :            :         } else {
     472                 :          0 :                 return phylink_ethtool_set_pauseparam(priv->phylink, pause);
     473                 :            :         }
     474                 :            : }
     475                 :            : 
     476                 :          0 : static void stmmac_get_ethtool_stats(struct net_device *dev,
     477                 :            :                                  struct ethtool_stats *dummy, u64 *data)
     478                 :            : {
     479         [ #  # ]:          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     480                 :          0 :         u32 rx_queues_count = priv->plat->rx_queues_to_use;
     481                 :          0 :         u32 tx_queues_count = priv->plat->tx_queues_to_use;
     482                 :          0 :         unsigned long count;
     483                 :          0 :         int i, j = 0, ret;
     484                 :            : 
     485         [ #  # ]:          0 :         if (priv->dma_cap.asp) {
     486         [ #  # ]:          0 :                 for (i = 0; i < STMMAC_SAFETY_FEAT_SIZE; i++) {
     487   [ #  #  #  #  :          0 :                         if (!stmmac_safety_feat_dump(priv, &priv->sstats, i,
                   #  # ]
     488                 :            :                                                 &count, NULL))
     489                 :          0 :                                 data[j++] = count;
     490                 :            :                 }
     491                 :            :         }
     492                 :            : 
     493                 :            :         /* Update the DMA HW counters for dwmac10/100 */
     494   [ #  #  #  # ]:          0 :         ret = stmmac_dma_diagnostic_fr(priv, &dev->stats, (void *) &priv->xstats,
     495                 :            :                         priv->ioaddr);
     496                 :          0 :         if (ret) {
     497                 :            :                 /* If supported, for new GMAC chips expose the MMC counters */
     498         [ #  # ]:          0 :                 if (priv->dma_cap.rmon) {
     499   [ #  #  #  # ]:          0 :                         stmmac_mmc_read(priv, priv->mmcaddr, &priv->mmc);
     500                 :            : 
     501         [ #  # ]:          0 :                         for (i = 0; i < STMMAC_MMC_STATS_LEN; i++) {
     502                 :          0 :                                 char *p;
     503                 :          0 :                                 p = (char *)priv + stmmac_mmc[i].stat_offset;
     504                 :            : 
     505                 :          0 :                                 data[j++] = (stmmac_mmc[i].sizeof_stat ==
     506         [ #  # ]:          0 :                                              sizeof(u64)) ? (*(u64 *)p) :
     507                 :          0 :                                              (*(u32 *)p);
     508                 :            :                         }
     509                 :            :                 }
     510         [ #  # ]:          0 :                 if (priv->eee_enabled) {
     511                 :          0 :                         int val = phylink_get_eee_err(priv->phylink);
     512         [ #  # ]:          0 :                         if (val)
     513                 :          0 :                                 priv->xstats.phy_eee_wakeup_error_n = val;
     514                 :            :                 }
     515                 :            : 
     516         [ #  # ]:          0 :                 if (priv->synopsys_id >= DWMAC_CORE_3_50)
     517   [ #  #  #  # ]:          0 :                         stmmac_mac_debug(priv, priv->ioaddr,
     518                 :            :                                         (void *)&priv->xstats,
     519                 :            :                                         rx_queues_count, tx_queues_count);
     520                 :            :         }
     521         [ #  # ]:          0 :         for (i = 0; i < STMMAC_STATS_LEN; i++) {
     522                 :          0 :                 char *p = (char *)priv + stmmac_gstrings_stats[i].stat_offset;
     523                 :          0 :                 data[j++] = (stmmac_gstrings_stats[i].sizeof_stat ==
     524         [ #  # ]:          0 :                              sizeof(u64)) ? (*(u64 *)p) : (*(u32 *)p);
     525                 :            :         }
     526                 :          0 : }
     527                 :            : 
     528                 :          0 : static int stmmac_get_sset_count(struct net_device *netdev, int sset)
     529                 :            : {
     530         [ #  # ]:          0 :         struct stmmac_priv *priv = netdev_priv(netdev);
     531                 :          0 :         int i, len, safety_len = 0;
     532                 :            : 
     533         [ #  # ]:          0 :         switch (sset) {
     534                 :          0 :         case ETH_SS_STATS:
     535                 :          0 :                 len = STMMAC_STATS_LEN;
     536                 :            : 
     537         [ #  # ]:          0 :                 if (priv->dma_cap.rmon)
     538                 :          0 :                         len += STMMAC_MMC_STATS_LEN;
     539         [ #  # ]:          0 :                 if (priv->dma_cap.asp) {
     540         [ #  # ]:          0 :                         for (i = 0; i < STMMAC_SAFETY_FEAT_SIZE; i++) {
     541   [ #  #  #  #  :          0 :                                 if (!stmmac_safety_feat_dump(priv,
                   #  # ]
     542                 :            :                                                         &priv->sstats, i,
     543                 :            :                                                         NULL, NULL))
     544                 :          0 :                                         safety_len++;
     545                 :            :                         }
     546                 :            : 
     547                 :          0 :                         len += safety_len;
     548                 :            :                 }
     549                 :            : 
     550                 :            :                 return len;
     551                 :            :         case ETH_SS_TEST:
     552                 :            :                 return stmmac_selftest_get_count(priv);
     553                 :            :         default:
     554                 :            :                 return -EOPNOTSUPP;
     555                 :            :         }
     556                 :            : }
     557                 :            : 
     558                 :          0 : static void stmmac_get_strings(struct net_device *dev, u32 stringset, u8 *data)
     559                 :            : {
     560                 :          0 :         int i;
     561                 :          0 :         u8 *p = data;
     562      [ #  #  # ]:          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     563                 :            : 
     564      [ #  #  # ]:          0 :         switch (stringset) {
     565                 :          0 :         case ETH_SS_STATS:
     566         [ #  # ]:          0 :                 if (priv->dma_cap.asp) {
     567         [ #  # ]:          0 :                         for (i = 0; i < STMMAC_SAFETY_FEAT_SIZE; i++) {
     568                 :          0 :                                 const char *desc;
     569   [ #  #  #  #  :          0 :                                 if (!stmmac_safety_feat_dump(priv,
                   #  # ]
     570                 :            :                                                         &priv->sstats, i,
     571                 :            :                                                         NULL, &desc)) {
     572                 :          0 :                                         memcpy(p, desc, ETH_GSTRING_LEN);
     573                 :          0 :                                         p += ETH_GSTRING_LEN;
     574                 :            :                                 }
     575                 :            :                         }
     576                 :            :                 }
     577         [ #  # ]:          0 :                 if (priv->dma_cap.rmon)
     578         [ #  # ]:          0 :                         for (i = 0; i < STMMAC_MMC_STATS_LEN; i++) {
     579                 :          0 :                                 memcpy(p, stmmac_mmc[i].stat_string,
     580                 :            :                                        ETH_GSTRING_LEN);
     581                 :          0 :                                 p += ETH_GSTRING_LEN;
     582                 :            :                         }
     583         [ #  # ]:          0 :                 for (i = 0; i < STMMAC_STATS_LEN; i++) {
     584                 :          0 :                         memcpy(p, stmmac_gstrings_stats[i].stat_string,
     585                 :            :                                 ETH_GSTRING_LEN);
     586                 :          0 :                         p += ETH_GSTRING_LEN;
     587                 :            :                 }
     588                 :            :                 break;
     589                 :            :         case ETH_SS_TEST:
     590                 :            :                 stmmac_selftest_get_strings(priv, p);
     591                 :            :                 break;
     592                 :            :         default:
     593                 :          0 :                 WARN_ON(1);
     594                 :          0 :                 break;
     595                 :            :         }
     596                 :          0 : }
     597                 :            : 
     598                 :            : /* Currently only support WOL through Magic packet. */
     599                 :          0 : static void stmmac_get_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
     600                 :            : {
     601                 :          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     602                 :            : 
     603                 :          0 :         mutex_lock(&priv->lock);
     604         [ #  # ]:          0 :         if (device_can_wakeup(priv->device)) {
     605                 :          0 :                 wol->supported = WAKE_MAGIC | WAKE_UCAST;
     606                 :          0 :                 wol->wolopts = priv->wolopts;
     607                 :            :         }
     608                 :          0 :         mutex_unlock(&priv->lock);
     609                 :          0 : }
     610                 :            : 
     611                 :          0 : static int stmmac_set_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
     612                 :            : {
     613         [ #  # ]:          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     614                 :          0 :         u32 support = WAKE_MAGIC | WAKE_UCAST;
     615                 :            : 
     616                 :            :         /* By default almost all GMAC devices support the WoL via
     617                 :            :          * magic frame but we can disable it if the HW capability
     618                 :            :          * register shows no support for pmt_magic_frame. */
     619   [ #  #  #  # ]:          0 :         if ((priv->hw_cap_support) && (!priv->dma_cap.pmt_magic_frame))
     620                 :          0 :                 wol->wolopts &= ~WAKE_MAGIC;
     621                 :            : 
     622         [ #  # ]:          0 :         if (!device_can_wakeup(priv->device))
     623                 :            :                 return -EINVAL;
     624                 :            : 
     625         [ #  # ]:          0 :         if (wol->wolopts & ~support)
     626                 :            :                 return -EINVAL;
     627                 :            : 
     628         [ #  # ]:          0 :         if (wol->wolopts) {
     629                 :          0 :                 pr_info("stmmac: wakeup enable\n");
     630                 :          0 :                 device_set_wakeup_enable(priv->device, 1);
     631                 :          0 :                 enable_irq_wake(priv->wol_irq);
     632                 :            :         } else {
     633                 :          0 :                 device_set_wakeup_enable(priv->device, 0);
     634                 :          0 :                 disable_irq_wake(priv->wol_irq);
     635                 :            :         }
     636                 :            : 
     637                 :          0 :         mutex_lock(&priv->lock);
     638                 :          0 :         priv->wolopts = wol->wolopts;
     639                 :          0 :         mutex_unlock(&priv->lock);
     640                 :            : 
     641                 :          0 :         return 0;
     642                 :            : }
     643                 :            : 
     644                 :          0 : static int stmmac_ethtool_op_get_eee(struct net_device *dev,
     645                 :            :                                      struct ethtool_eee *edata)
     646                 :            : {
     647         [ #  # ]:          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     648                 :            : 
     649         [ #  # ]:          0 :         if (!priv->dma_cap.eee)
     650                 :            :                 return -EOPNOTSUPP;
     651                 :            : 
     652                 :          0 :         edata->eee_enabled = priv->eee_enabled;
     653                 :          0 :         edata->eee_active = priv->eee_active;
     654                 :          0 :         edata->tx_lpi_timer = priv->tx_lpi_timer;
     655                 :            : 
     656                 :          0 :         return phylink_ethtool_get_eee(priv->phylink, edata);
     657                 :            : }
     658                 :            : 
     659                 :          0 : static int stmmac_ethtool_op_set_eee(struct net_device *dev,
     660                 :            :                                      struct ethtool_eee *edata)
     661                 :            : {
     662         [ #  # ]:          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     663                 :          0 :         int ret;
     664                 :            : 
     665         [ #  # ]:          0 :         if (!edata->eee_enabled) {
     666                 :          0 :                 stmmac_disable_eee_mode(priv);
     667                 :            :         } else {
     668                 :            :                 /* We are asking for enabling the EEE but it is safe
     669                 :            :                  * to verify all by invoking the eee_init function.
     670                 :            :                  * In case of failure it will return an error.
     671                 :            :                  */
     672                 :          0 :                 edata->eee_enabled = stmmac_eee_init(priv);
     673         [ #  # ]:          0 :                 if (!edata->eee_enabled)
     674                 :            :                         return -EOPNOTSUPP;
     675                 :            :         }
     676                 :            : 
     677                 :          0 :         ret = phylink_ethtool_set_eee(priv->phylink, edata);
     678         [ #  # ]:          0 :         if (ret)
     679                 :            :                 return ret;
     680                 :            : 
     681                 :          0 :         priv->eee_enabled = edata->eee_enabled;
     682                 :          0 :         priv->tx_lpi_timer = edata->tx_lpi_timer;
     683                 :          0 :         return 0;
     684                 :            : }
     685                 :            : 
     686                 :            : static u32 stmmac_usec2riwt(u32 usec, struct stmmac_priv *priv)
     687                 :            : {
     688                 :            :         unsigned long clk = clk_get_rate(priv->plat->stmmac_clk);
     689                 :            : 
     690                 :            :         if (!clk) {
     691                 :            :                 clk = priv->plat->clk_ref_rate;
     692                 :            :                 if (!clk)
     693                 :            :                         return 0;
     694                 :            :         }
     695                 :            : 
     696                 :            :         return (usec * (clk / 1000000)) / 256;
     697                 :            : }
     698                 :            : 
     699                 :            : static u32 stmmac_riwt2usec(u32 riwt, struct stmmac_priv *priv)
     700                 :            : {
     701                 :            :         unsigned long clk = clk_get_rate(priv->plat->stmmac_clk);
     702                 :            : 
     703                 :            :         if (!clk) {
     704                 :            :                 clk = priv->plat->clk_ref_rate;
     705                 :            :                 if (!clk)
     706                 :            :                         return 0;
     707                 :            :         }
     708                 :            : 
     709                 :            :         return (riwt * 256) / (clk / 1000000);
     710                 :            : }
     711                 :            : 
     712                 :          0 : static int stmmac_get_coalesce(struct net_device *dev,
     713                 :            :                                struct ethtool_coalesce *ec)
     714                 :            : {
     715         [ #  # ]:          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     716                 :            : 
     717                 :          0 :         ec->tx_coalesce_usecs = priv->tx_coal_timer;
     718                 :          0 :         ec->tx_max_coalesced_frames = priv->tx_coal_frames;
     719                 :            : 
     720         [ #  # ]:          0 :         if (priv->use_riwt) {
     721                 :          0 :                 ec->rx_max_coalesced_frames = priv->rx_coal_frames;
     722                 :          0 :                 ec->rx_coalesce_usecs = stmmac_riwt2usec(priv->rx_riwt, priv);
     723                 :            :         }
     724                 :            : 
     725                 :          0 :         return 0;
     726                 :            : }
     727                 :            : 
     728                 :          0 : static int stmmac_set_coalesce(struct net_device *dev,
     729                 :            :                                struct ethtool_coalesce *ec)
     730                 :            : {
     731         [ #  # ]:          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     732                 :          0 :         u32 rx_cnt = priv->plat->rx_queues_to_use;
     733                 :          0 :         unsigned int rx_riwt;
     734                 :            : 
     735                 :            :         /* Check not supported parameters  */
     736         [ #  # ]:          0 :         if ((ec->rx_coalesce_usecs_irq) ||
     737   [ #  #  #  # ]:          0 :             (ec->rx_max_coalesced_frames_irq) || (ec->tx_coalesce_usecs_irq) ||
     738   [ #  #  #  # ]:          0 :             (ec->use_adaptive_rx_coalesce) || (ec->use_adaptive_tx_coalesce) ||
     739   [ #  #  #  # ]:          0 :             (ec->pkt_rate_low) || (ec->rx_coalesce_usecs_low) ||
     740   [ #  #  #  # ]:          0 :             (ec->rx_max_coalesced_frames_low) || (ec->tx_coalesce_usecs_high) ||
     741   [ #  #  #  # ]:          0 :             (ec->tx_max_coalesced_frames_low) || (ec->pkt_rate_high) ||
     742   [ #  #  #  # ]:          0 :             (ec->tx_coalesce_usecs_low) || (ec->rx_coalesce_usecs_high) ||
     743         [ #  # ]:          0 :             (ec->rx_max_coalesced_frames_high) ||
     744         [ #  # ]:          0 :             (ec->tx_max_coalesced_frames_irq) ||
     745         [ #  # ]:          0 :             (ec->stats_block_coalesce_usecs) ||
     746   [ #  #  #  # ]:          0 :             (ec->tx_max_coalesced_frames_high) || (ec->rate_sample_interval))
     747                 :            :                 return -EOPNOTSUPP;
     748                 :            : 
     749   [ #  #  #  # ]:          0 :         if (priv->use_riwt && (ec->rx_coalesce_usecs > 0)) {
     750                 :          0 :                 rx_riwt = stmmac_usec2riwt(ec->rx_coalesce_usecs, priv);
     751                 :            : 
     752         [ #  # ]:          0 :                 if ((rx_riwt > MAX_DMA_RIWT) || (rx_riwt < MIN_DMA_RIWT))
     753                 :            :                         return -EINVAL;
     754                 :            : 
     755                 :          0 :                 priv->rx_riwt = rx_riwt;
     756   [ #  #  #  # ]:          0 :                 stmmac_rx_watchdog(priv, priv->ioaddr, priv->rx_riwt, rx_cnt);
     757                 :            :         }
     758                 :            : 
     759         [ #  # ]:          0 :         if ((ec->tx_coalesce_usecs == 0) &&
     760         [ #  # ]:          0 :             (ec->tx_max_coalesced_frames == 0))
     761                 :            :                 return -EINVAL;
     762                 :            : 
     763         [ #  # ]:          0 :         if ((ec->tx_coalesce_usecs > STMMAC_MAX_COAL_TX_TICK) ||
     764         [ #  # ]:          0 :             (ec->tx_max_coalesced_frames > STMMAC_TX_MAX_FRAMES))
     765                 :            :                 return -EINVAL;
     766                 :            : 
     767                 :            :         /* Only copy relevant parameters, ignore all others. */
     768                 :          0 :         priv->tx_coal_frames = ec->tx_max_coalesced_frames;
     769                 :          0 :         priv->tx_coal_timer = ec->tx_coalesce_usecs;
     770                 :          0 :         priv->rx_coal_frames = ec->rx_max_coalesced_frames;
     771                 :          0 :         return 0;
     772                 :            : }
     773                 :            : 
     774                 :          0 : static int stmmac_get_rxnfc(struct net_device *dev,
     775                 :            :                             struct ethtool_rxnfc *rxnfc, u32 *rule_locs)
     776                 :            : {
     777         [ #  # ]:          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     778                 :            : 
     779         [ #  # ]:          0 :         switch (rxnfc->cmd) {
     780                 :          0 :         case ETHTOOL_GRXRINGS:
     781                 :          0 :                 rxnfc->data = priv->plat->rx_queues_to_use;
     782                 :          0 :                 break;
     783                 :            :         default:
     784                 :            :                 return -EOPNOTSUPP;
     785                 :            :         }
     786                 :            : 
     787                 :          0 :         return 0;
     788                 :            : }
     789                 :            : 
     790                 :          0 : static u32 stmmac_get_rxfh_key_size(struct net_device *dev)
     791                 :            : {
     792                 :          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     793                 :            : 
     794                 :          0 :         return sizeof(priv->rss.key);
     795                 :            : }
     796                 :            : 
     797                 :          0 : static u32 stmmac_get_rxfh_indir_size(struct net_device *dev)
     798                 :            : {
     799                 :          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     800                 :            : 
     801                 :          0 :         return ARRAY_SIZE(priv->rss.table);
     802                 :            : }
     803                 :            : 
     804                 :          0 : static int stmmac_get_rxfh(struct net_device *dev, u32 *indir, u8 *key,
     805                 :            :                            u8 *hfunc)
     806                 :            : {
     807         [ #  # ]:          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     808                 :          0 :         int i;
     809                 :            : 
     810         [ #  # ]:          0 :         if (indir) {
     811         [ #  # ]:          0 :                 for (i = 0; i < ARRAY_SIZE(priv->rss.table); i++)
     812                 :          0 :                         indir[i] = priv->rss.table[i];
     813                 :            :         }
     814                 :            : 
     815         [ #  # ]:          0 :         if (key)
     816                 :          0 :                 memcpy(key, priv->rss.key, sizeof(priv->rss.key));
     817         [ #  # ]:          0 :         if (hfunc)
     818                 :          0 :                 *hfunc = ETH_RSS_HASH_TOP;
     819                 :            : 
     820                 :          0 :         return 0;
     821                 :            : }
     822                 :            : 
     823                 :          0 : static int stmmac_set_rxfh(struct net_device *dev, const u32 *indir,
     824                 :            :                            const u8 *key, const u8 hfunc)
     825                 :            : {
     826         [ #  # ]:          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     827                 :          0 :         int i;
     828                 :            : 
     829         [ #  # ]:          0 :         if ((hfunc != ETH_RSS_HASH_NO_CHANGE) && (hfunc != ETH_RSS_HASH_TOP))
     830                 :            :                 return -EOPNOTSUPP;
     831                 :            : 
     832         [ #  # ]:          0 :         if (indir) {
     833         [ #  # ]:          0 :                 for (i = 0; i < ARRAY_SIZE(priv->rss.table); i++)
     834                 :          0 :                         priv->rss.table[i] = indir[i];
     835                 :            :         }
     836                 :            : 
     837         [ #  # ]:          0 :         if (key)
     838                 :          0 :                 memcpy(priv->rss.key, key, sizeof(priv->rss.key));
     839                 :            : 
     840   [ #  #  #  # ]:          0 :         return stmmac_rss_configure(priv, priv->hw, &priv->rss,
     841                 :            :                                     priv->plat->rx_queues_to_use);
     842                 :            : }
     843                 :            : 
     844                 :          0 : static int stmmac_get_ts_info(struct net_device *dev,
     845                 :            :                               struct ethtool_ts_info *info)
     846                 :            : {
     847         [ #  # ]:          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     848                 :            : 
     849         [ #  # ]:          0 :         if ((priv->dma_cap.time_stamp || priv->dma_cap.atime_stamp)) {
     850                 :            : 
     851                 :          0 :                 info->so_timestamping = SOF_TIMESTAMPING_TX_SOFTWARE |
     852                 :            :                                         SOF_TIMESTAMPING_TX_HARDWARE |
     853                 :            :                                         SOF_TIMESTAMPING_RX_SOFTWARE |
     854                 :            :                                         SOF_TIMESTAMPING_RX_HARDWARE |
     855                 :            :                                         SOF_TIMESTAMPING_SOFTWARE |
     856                 :            :                                         SOF_TIMESTAMPING_RAW_HARDWARE;
     857                 :            : 
     858         [ #  # ]:          0 :                 if (priv->ptp_clock)
     859                 :          0 :                         info->phc_index = ptp_clock_index(priv->ptp_clock);
     860                 :            : 
     861                 :          0 :                 info->tx_types = (1 << HWTSTAMP_TX_OFF) | (1 << HWTSTAMP_TX_ON);
     862                 :            : 
     863                 :          0 :                 info->rx_filters = ((1 << HWTSTAMP_FILTER_NONE) |
     864                 :            :                                     (1 << HWTSTAMP_FILTER_PTP_V1_L4_EVENT) |
     865                 :            :                                     (1 << HWTSTAMP_FILTER_PTP_V1_L4_SYNC) |
     866                 :            :                                     (1 << HWTSTAMP_FILTER_PTP_V1_L4_DELAY_REQ) |
     867                 :            :                                     (1 << HWTSTAMP_FILTER_PTP_V2_L4_EVENT) |
     868                 :            :                                     (1 << HWTSTAMP_FILTER_PTP_V2_L4_SYNC) |
     869                 :            :                                     (1 << HWTSTAMP_FILTER_PTP_V2_L4_DELAY_REQ) |
     870                 :            :                                     (1 << HWTSTAMP_FILTER_PTP_V2_EVENT) |
     871                 :            :                                     (1 << HWTSTAMP_FILTER_PTP_V2_SYNC) |
     872                 :            :                                     (1 << HWTSTAMP_FILTER_PTP_V2_DELAY_REQ) |
     873                 :            :                                     (1 << HWTSTAMP_FILTER_ALL));
     874                 :          0 :                 return 0;
     875                 :            :         } else
     876                 :          0 :                 return ethtool_op_get_ts_info(dev, info);
     877                 :            : }
     878                 :            : 
     879                 :          0 : static int stmmac_get_tunable(struct net_device *dev,
     880                 :            :                               const struct ethtool_tunable *tuna, void *data)
     881                 :            : {
     882         [ #  # ]:          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     883                 :          0 :         int ret = 0;
     884                 :            : 
     885         [ #  # ]:          0 :         switch (tuna->id) {
     886                 :          0 :         case ETHTOOL_RX_COPYBREAK:
     887                 :          0 :                 *(u32 *)data = priv->rx_copybreak;
     888                 :          0 :                 break;
     889                 :            :         default:
     890                 :            :                 ret = -EINVAL;
     891                 :            :                 break;
     892                 :            :         }
     893                 :            : 
     894                 :          0 :         return ret;
     895                 :            : }
     896                 :            : 
     897                 :          0 : static int stmmac_set_tunable(struct net_device *dev,
     898                 :            :                               const struct ethtool_tunable *tuna,
     899                 :            :                               const void *data)
     900                 :            : {
     901         [ #  # ]:          0 :         struct stmmac_priv *priv = netdev_priv(dev);
     902                 :          0 :         int ret = 0;
     903                 :            : 
     904         [ #  # ]:          0 :         switch (tuna->id) {
     905                 :          0 :         case ETHTOOL_RX_COPYBREAK:
     906                 :          0 :                 priv->rx_copybreak = *(u32 *)data;
     907                 :          0 :                 break;
     908                 :            :         default:
     909                 :            :                 ret = -EINVAL;
     910                 :            :                 break;
     911                 :            :         }
     912                 :            : 
     913                 :          0 :         return ret;
     914                 :            : }
     915                 :            : 
     916                 :            : static const struct ethtool_ops stmmac_ethtool_ops = {
     917                 :            :         .begin = stmmac_check_if_running,
     918                 :            :         .get_drvinfo = stmmac_ethtool_getdrvinfo,
     919                 :            :         .get_msglevel = stmmac_ethtool_getmsglevel,
     920                 :            :         .set_msglevel = stmmac_ethtool_setmsglevel,
     921                 :            :         .get_regs = stmmac_ethtool_gregs,
     922                 :            :         .get_regs_len = stmmac_ethtool_get_regs_len,
     923                 :            :         .get_link = ethtool_op_get_link,
     924                 :            :         .nway_reset = stmmac_nway_reset,
     925                 :            :         .get_pauseparam = stmmac_get_pauseparam,
     926                 :            :         .set_pauseparam = stmmac_set_pauseparam,
     927                 :            :         .self_test = stmmac_selftest_run,
     928                 :            :         .get_ethtool_stats = stmmac_get_ethtool_stats,
     929                 :            :         .get_strings = stmmac_get_strings,
     930                 :            :         .get_wol = stmmac_get_wol,
     931                 :            :         .set_wol = stmmac_set_wol,
     932                 :            :         .get_eee = stmmac_ethtool_op_get_eee,
     933                 :            :         .set_eee = stmmac_ethtool_op_set_eee,
     934                 :            :         .get_sset_count = stmmac_get_sset_count,
     935                 :            :         .get_rxnfc = stmmac_get_rxnfc,
     936                 :            :         .get_rxfh_key_size = stmmac_get_rxfh_key_size,
     937                 :            :         .get_rxfh_indir_size = stmmac_get_rxfh_indir_size,
     938                 :            :         .get_rxfh = stmmac_get_rxfh,
     939                 :            :         .set_rxfh = stmmac_set_rxfh,
     940                 :            :         .get_ts_info = stmmac_get_ts_info,
     941                 :            :         .get_coalesce = stmmac_get_coalesce,
     942                 :            :         .set_coalesce = stmmac_set_coalesce,
     943                 :            :         .get_tunable = stmmac_get_tunable,
     944                 :            :         .set_tunable = stmmac_set_tunable,
     945                 :            :         .get_link_ksettings = stmmac_ethtool_get_link_ksettings,
     946                 :            :         .set_link_ksettings = stmmac_ethtool_set_link_ksettings,
     947                 :            : };
     948                 :            : 
     949                 :         21 : void stmmac_set_ethtool_ops(struct net_device *netdev)
     950                 :            : {
     951                 :         21 :         netdev->ethtool_ops = &stmmac_ethtool_ops;
     952                 :         21 : }

Generated by: LCOV version 1.14