drivers/net/ethernet/ti/icssg/icssg_ethtool.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /* Texas Instruments ICSSG Ethernet driver
   3  *
   4  * Copyright (C) 2018-2022 Texas Instruments Incorporated - https://www.ti.com/
   5  *
   6  */
   7
   8 #include "icssg_prueth.h"
   9 #include "icssg_stats.h"
  10
  11 static void emac_get_drvinfo(struct net_device *ndev,
  12                              struct ethtool_drvinfo *info)
  13 {
  14         struct prueth_emac *emac = netdev_priv(ndev);
  15         struct prueth *prueth = emac->prueth;
  16
  17         strscpy(info->driver, dev_driver_string(prueth->dev),
  18                 sizeof(info->driver));
  19         strscpy(info->bus_info, dev_name(prueth->dev), sizeof(info->bus_info));
  20 }
  21
  22 static u32 emac_get_msglevel(struct net_device *ndev)
  23 {
  24         struct prueth_emac *emac = netdev_priv(ndev);
  25
  26         return emac->msg_enable;
  27 }
  28
  29 static void emac_set_msglevel(struct net_device *ndev, u32 value)
  30 {
  31         struct prueth_emac *emac = netdev_priv(ndev);
  32
  33         emac->msg_enable = value;
  34 }
  35
  36 static int emac_get_link_ksettings(struct net_device *ndev,
  37                                    struct ethtool_link_ksettings *ecmd)
  38 {
  39         return phy_ethtool_get_link_ksettings(ndev, ecmd);
  40 }
  41
  42 static int emac_set_link_ksettings(struct net_device *ndev,
  43                                    const struct ethtool_link_ksettings *ecmd)
  44 {
  45         return phy_ethtool_set_link_ksettings(ndev, ecmd);
  46 }
  47
  48 static int emac_get_eee(struct net_device *ndev, struct ethtool_keee *edata)
  49 {
  50         if (!ndev->phydev)
  51                 return -EOPNOTSUPP;
  52
  53         return phy_ethtool_get_eee(ndev->phydev, edata);
  54 }
  55
  56 static int emac_set_eee(struct net_device *ndev, struct ethtool_keee *edata)
  57 {
  58         if (!ndev->phydev)
  59                 return -EOPNOTSUPP;
  60
  61         return phy_ethtool_set_eee(ndev->phydev, edata);
  62 }
  63
  64 static int emac_nway_reset(struct net_device *ndev)
  65 {
  66         return phy_ethtool_nway_reset(ndev);
  67 }
  68
  69 static int emac_get_sset_count(struct net_device *ndev, int stringset)
  70 {
  71         struct prueth_emac *emac = netdev_priv(ndev);
  72         switch (stringset) {
  73         case ETH_SS_STATS:
  74                 if (emac->prueth->pa_stats)
  75                         return ICSSG_NUM_ETHTOOL_STATS;
  76                 else
  77                         return ICSSG_NUM_ETHTOOL_STATS - ICSSG_NUM_PA_STATS;
  78         default:
  79                 return -EOPNOTSUPP;
  80         }
  81 }
  82
  83 static void emac_get_strings(struct net_device *ndev, u32 stringset, u8 *data)
  84 {
  85         struct prueth_emac *emac = netdev_priv(ndev);
  86         u8 *p = data;
  87         int i;
  88
  89         switch (stringset) {
  90         case ETH_SS_STATS:
  91                 for (i = 0; i < ARRAY_SIZE(icssg_all_miig_stats); i++)
  92                         if (!icssg_all_miig_stats[i].standard_stats)
  93                                 ethtool_puts(&p, icssg_all_miig_stats[i].name);
  94                 if (emac->prueth->pa_stats)
  95                         for (i = 0; i < ARRAY_SIZE(icssg_all_pa_stats); i++)
  96                                 ethtool_puts(&p, icssg_all_pa_stats[i].name);
  97                 break;
  98         default:
  99                 break;
 100         }
 101 }
 102
 103 static void emac_get_ethtool_stats(struct net_device *ndev,
 104                                    struct ethtool_stats *stats, u64 *data)
 105 {
 106         struct prueth_emac *emac = netdev_priv(ndev);
 107         int i;
 108
 109         emac_update_hardware_stats(emac);
 110
 111         for (i = 0; i < ARRAY_SIZE(icssg_all_miig_stats); i++)
 112                 if (!icssg_all_miig_stats[i].standard_stats)
 113                         *(data++) = emac->stats[i];
 114
 115         if (emac->prueth->pa_stats)
 116                 for (i = 0; i < ARRAY_SIZE(icssg_all_pa_stats); i++)
 117                         *(data++) = emac->pa_stats[i];
 118 }
 119
 120 static int emac_get_ts_info(struct net_device *ndev,
 121                             struct kernel_ethtool_ts_info *info)
 122 {
 123         struct prueth_emac *emac = netdev_priv(ndev);
 124
 125         info->so_timestamping =
 126                 SOF_TIMESTAMPING_TX_HARDWARE |
 127                 SOF_TIMESTAMPING_TX_SOFTWARE |
 128                 SOF_TIMESTAMPING_RX_HARDWARE |
 129                 SOF_TIMESTAMPING_RAW_HARDWARE;
 130
 131         info->phc_index = icss_iep_get_ptp_clock_idx(emac->iep);
 132         info->tx_types = BIT(HWTSTAMP_TX_OFF) | BIT(HWTSTAMP_TX_ON);
 133         info->rx_filters = BIT(HWTSTAMP_FILTER_NONE) | BIT(HWTSTAMP_FILTER_ALL);
 134
 135         return 0;
 136 }
 137
 138 static int emac_set_channels(struct net_device *ndev,
 139                              struct ethtool_channels *ch)
 140 {
 141         struct prueth_emac *emac = netdev_priv(ndev);
 142
 143         /* Check if interface is up. Can change the num queues when
 144          * the interface is down.
 145          */
 146         if (netif_running(emac->ndev))
 147                 return -EBUSY;
 148
 149         emac->tx_ch_num = ch->tx_count;
 150
 151         if (emac->is_sr1)
 152                 emac->tx_ch_num++;
 153
 154         return 0;
 155 }
 156
 157 static void emac_get_channels(struct net_device *ndev,
 158                               struct ethtool_channels *ch)
 159 {
 160         struct prueth_emac *emac = netdev_priv(ndev);
 161
 162         ch->max_rx = 1;
 163         ch->max_tx = PRUETH_MAX_TX_QUEUES;
 164
 165         /* Disable multiple TX channels due to timeouts
 166          * when using more than one queue */
 167         if (emac->is_sr1)
 168                 ch->max_tx = 1;
 169
 170         ch->rx_count = 1;
 171         ch->tx_count = emac->tx_ch_num;
 172
 173         if (emac->is_sr1)
 174                 ch->tx_count--;
 175 }
 176
 177 static const struct ethtool_rmon_hist_range emac_rmon_ranges[] = {
 178         {    0,   64},
 179         {   65,  128},
 180         {  129,  256},
 181         {  257,  512},
 182         {  513, PRUETH_MAX_PKT_SIZE},
 183         {}
 184 };
 185
 186 static void emac_get_rmon_stats(struct net_device *ndev,
 187                                 struct ethtool_rmon_stats *rmon_stats,
 188                                 const struct ethtool_rmon_hist_range **ranges)
 189 {
 190         struct prueth_emac *emac = netdev_priv(ndev);
 191
 192         *ranges = emac_rmon_ranges;
 193
 194         rmon_stats->undersize_pkts = emac_get_stat_by_name(emac, "rx_bucket1_frames") -
 195                                      emac_get_stat_by_name(emac, "rx_64B_frames");
 196
 197         rmon_stats->hist[0] = emac_get_stat_by_name(emac, "rx_bucket1_frames");
 198         rmon_stats->hist[1] = emac_get_stat_by_name(emac, "rx_bucket2_frames");
 199         rmon_stats->hist[2] = emac_get_stat_by_name(emac, "rx_bucket3_frames");
 200         rmon_stats->hist[3] = emac_get_stat_by_name(emac, "rx_bucket4_frames");
 201         rmon_stats->hist[4] = emac_get_stat_by_name(emac, "rx_bucket5_frames");
 202
 203         rmon_stats->hist_tx[0] = emac_get_stat_by_name(emac, "tx_bucket1_frames");
 204         rmon_stats->hist_tx[1] = emac_get_stat_by_name(emac, "tx_bucket2_frames");
 205         rmon_stats->hist_tx[2] = emac_get_stat_by_name(emac, "tx_bucket3_frames");
 206         rmon_stats->hist_tx[3] = emac_get_stat_by_name(emac, "tx_bucket4_frames");
 207         rmon_stats->hist_tx[4] = emac_get_stat_by_name(emac, "tx_bucket5_frames");
 208 }
 209
 210 static int emac_get_coalesce(struct net_device *ndev,
 211                              struct ethtool_coalesce *coal,
 212                              struct kernel_ethtool_coalesce *kernel_coal,
 213                              struct netlink_ext_ack *extack)
 214 {
 215         struct prueth_emac *emac = netdev_priv(ndev);
 216         struct prueth_tx_chn *tx_chn;
 217
 218         tx_chn = &emac->tx_chns[0];
 219
 220         coal->rx_coalesce_usecs = emac->rx_pace_timeout_ns / 1000;
 221         coal->tx_coalesce_usecs = tx_chn->tx_pace_timeout_ns / 1000;
 222
 223         return 0;
 224 }
 225
 226 static int emac_get_per_queue_coalesce(struct net_device *ndev, u32 queue,
 227                                        struct ethtool_coalesce *coal)
 228 {
 229         struct prueth_emac *emac = netdev_priv(ndev);
 230         struct prueth_tx_chn *tx_chn;
 231
 232         if (queue >= PRUETH_MAX_TX_QUEUES)
 233                 return -EINVAL;
 234
 235         tx_chn = &emac->tx_chns[queue];
 236
 237         coal->tx_coalesce_usecs = tx_chn->tx_pace_timeout_ns / 1000;
 238
 239         return 0;
 240 }
 241
 242 static int emac_set_coalesce(struct net_device *ndev,
 243                              struct ethtool_coalesce *coal,
 244                              struct kernel_ethtool_coalesce *kernel_coal,
 245                              struct netlink_ext_ack *extack)
 246 {
 247         struct prueth_emac *emac = netdev_priv(ndev);
 248         struct prueth *prueth = emac->prueth;
 249         struct prueth_tx_chn *tx_chn;
 250
 251         tx_chn = &emac->tx_chns[0];
 252
 253         if (coal->rx_coalesce_usecs &&
 254             coal->rx_coalesce_usecs < ICSSG_MIN_COALESCE_USECS) {
 255                 dev_info(prueth->dev, "defaulting to min value of %dus for rx-usecs\n",
 256                          ICSSG_MIN_COALESCE_USECS);
 257                 coal->rx_coalesce_usecs = ICSSG_MIN_COALESCE_USECS;
 258         }
 259
 260         if (coal->tx_coalesce_usecs &&
 261             coal->tx_coalesce_usecs < ICSSG_MIN_COALESCE_USECS) {
 262                 dev_info(prueth->dev, "defaulting to min value of %dus for tx-usecs\n",
 263                          ICSSG_MIN_COALESCE_USECS);
 264                 coal->tx_coalesce_usecs = ICSSG_MIN_COALESCE_USECS;
 265         }
 266
 267         emac->rx_pace_timeout_ns = coal->rx_coalesce_usecs * 1000;
 268         tx_chn->tx_pace_timeout_ns = coal->tx_coalesce_usecs * 1000;
 269
 270         return 0;
 271 }
 272
 273 static int emac_set_per_queue_coalesce(struct net_device *ndev, u32 queue,
 274                                        struct ethtool_coalesce *coal)
 275 {
 276         struct prueth_emac *emac = netdev_priv(ndev);
 277         struct prueth *prueth = emac->prueth;
 278         struct prueth_tx_chn *tx_chn;
 279
 280         if (queue >= PRUETH_MAX_TX_QUEUES)
 281                 return -EINVAL;
 282
 283         tx_chn = &emac->tx_chns[queue];
 284
 285         if (coal->tx_coalesce_usecs &&
 286             coal->tx_coalesce_usecs < ICSSG_MIN_COALESCE_USECS) {
 287                 dev_info(prueth->dev, "defaulting to min value of %dus for tx-usecs for tx-%u\n",
 288                          ICSSG_MIN_COALESCE_USECS, queue);
 289                 coal->tx_coalesce_usecs = ICSSG_MIN_COALESCE_USECS;
 290         }
 291
 292         tx_chn->tx_pace_timeout_ns = coal->tx_coalesce_usecs * 1000;
 293
 294         return 0;
 295 }
 296
 297 const struct ethtool_ops icssg_ethtool_ops = {
 298         .get_drvinfo = emac_get_drvinfo,
 299         .get_msglevel = emac_get_msglevel,
 300         .set_msglevel = emac_set_msglevel,
 301         .get_sset_count = emac_get_sset_count,
 302         .get_ethtool_stats = emac_get_ethtool_stats,
 303         .get_strings = emac_get_strings,
 304         .get_ts_info = emac_get_ts_info,
 305         .supported_coalesce_params = ETHTOOL_COALESCE_RX_USECS |
 306                                      ETHTOOL_COALESCE_TX_USECS,
 307         .get_coalesce = emac_get_coalesce,
 308         .set_coalesce = emac_set_coalesce,
 309         .get_per_queue_coalesce = emac_get_per_queue_coalesce,
 310         .set_per_queue_coalesce = emac_set_per_queue_coalesce,
 311         .get_channels = emac_get_channels,
 312         .set_channels = emac_set_channels,
 313         .get_link_ksettings = emac_get_link_ksettings,
 314         .set_link_ksettings = emac_set_link_ksettings,
 315         .get_link = ethtool_op_get_link,
 316         .get_eee = emac_get_eee,
 317         .set_eee = emac_set_eee,
 318         .nway_reset = emac_nway_reset,
 319         .get_rmon_stats = emac_get_rmon_stats,
 320 };
 321 EXPORT_SYMBOL_GPL(icssg_ethtool_ops);