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
emac_get_drvinfo(struct net_device * ndev,struct ethtool_drvinfo * info)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
emac_get_msglevel(struct net_device * ndev)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
emac_set_msglevel(struct net_device * ndev,u32 value)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
emac_get_link_ksettings(struct net_device * ndev,struct ethtool_link_ksettings * ecmd)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
emac_set_link_ksettings(struct net_device * ndev,const struct ethtool_link_ksettings * ecmd)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
emac_get_eee(struct net_device * ndev,struct ethtool_keee * edata)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
emac_set_eee(struct net_device * ndev,struct ethtool_keee * edata)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
emac_nway_reset(struct net_device * ndev)64 static int emac_nway_reset(struct net_device *ndev)
65 {
66 return phy_ethtool_nway_reset(ndev);
67 }
68
emac_get_sset_count(struct net_device * ndev,int stringset)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
emac_get_strings(struct net_device * ndev,u32 stringset,u8 * data)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
emac_get_ethtool_stats(struct net_device * ndev,struct ethtool_stats * stats,u64 * data)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
emac_get_ts_info(struct net_device * ndev,struct kernel_ethtool_ts_info * info)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
emac_set_channels(struct net_device * ndev,struct ethtool_channels * ch)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
emac_get_channels(struct net_device * ndev,struct ethtool_channels * ch)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
emac_get_rmon_stats(struct net_device * ndev,struct ethtool_rmon_stats * rmon_stats,const struct ethtool_rmon_hist_range ** ranges)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
emac_get_coalesce(struct net_device * ndev,struct ethtool_coalesce * coal,struct kernel_ethtool_coalesce * kernel_coal,struct netlink_ext_ack * extack)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
emac_get_per_queue_coalesce(struct net_device * ndev,u32 queue,struct ethtool_coalesce * coal)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
emac_set_coalesce(struct net_device * ndev,struct ethtool_coalesce * coal,struct kernel_ethtool_coalesce * kernel_coal,struct netlink_ext_ack * extack)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
emac_set_per_queue_coalesce(struct net_device * ndev,u32 queue,struct ethtool_coalesce * coal)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);
322