1 | // SPDX-License-Identifier: GPL-2.0 |
2 | /* Copyright(c) 2013 - 2018 Intel Corporation. */ |
3 | |
4 | /* ethtool support for i40e */ |
5 | |
6 | #include "i40e_devids.h" |
7 | #include "i40e_diag.h" |
8 | #include "i40e_txrx_common.h" |
9 | #include "i40e_virtchnl_pf.h" |
10 | |
11 | /* ethtool statistics helpers */ |
12 | |
13 | /** |
14 | * struct i40e_stats - definition for an ethtool statistic |
15 | * @stat_string: statistic name to display in ethtool -S output |
16 | * @sizeof_stat: the sizeof() the stat, must be no greater than sizeof(u64) |
17 | * @stat_offset: offsetof() the stat from a base pointer |
18 | * |
19 | * This structure defines a statistic to be added to the ethtool stats buffer. |
20 | * It defines a statistic as offset from a common base pointer. Stats should |
21 | * be defined in constant arrays using the I40E_STAT macro, with every element |
22 | * of the array using the same _type for calculating the sizeof_stat and |
23 | * stat_offset. |
24 | * |
25 | * The @sizeof_stat is expected to be sizeof(u8), sizeof(u16), sizeof(u32) or |
26 | * sizeof(u64). Other sizes are not expected and will produce a WARN_ONCE from |
27 | * the i40e_add_ethtool_stat() helper function. |
28 | * |
29 | * The @stat_string is interpreted as a format string, allowing formatted |
30 | * values to be inserted while looping over multiple structures for a given |
31 | * statistics array. Thus, every statistic string in an array should have the |
32 | * same type and number of format specifiers, to be formatted by variadic |
33 | * arguments to the i40e_add_stat_string() helper function. |
34 | **/ |
35 | struct i40e_stats { |
36 | char stat_string[ETH_GSTRING_LEN]; |
37 | int sizeof_stat; |
38 | int stat_offset; |
39 | }; |
40 | |
41 | /* Helper macro to define an i40e_stat structure with proper size and type. |
42 | * Use this when defining constant statistics arrays. Note that @_type expects |
43 | * only a type name and is used multiple times. |
44 | */ |
45 | #define I40E_STAT(_type, _name, _stat) { \ |
46 | .stat_string = _name, \ |
47 | .sizeof_stat = sizeof_field(_type, _stat), \ |
48 | .stat_offset = offsetof(_type, _stat) \ |
49 | } |
50 | |
51 | /* Helper macro for defining some statistics directly copied from the netdev |
52 | * stats structure. |
53 | */ |
54 | #define I40E_NETDEV_STAT(_net_stat) \ |
55 | I40E_STAT(struct rtnl_link_stats64, #_net_stat, _net_stat) |
56 | |
57 | /* Helper macro for defining some statistics related to queues */ |
58 | #define I40E_QUEUE_STAT(_name, _stat) \ |
59 | I40E_STAT(struct i40e_ring, _name, _stat) |
60 | |
61 | /* Stats associated with a Tx or Rx ring */ |
62 | static const struct i40e_stats i40e_gstrings_queue_stats[] = { |
63 | I40E_QUEUE_STAT("%s-%u.packets" , stats.packets), |
64 | I40E_QUEUE_STAT("%s-%u.bytes" , stats.bytes), |
65 | }; |
66 | |
67 | /** |
68 | * i40e_add_one_ethtool_stat - copy the stat into the supplied buffer |
69 | * @data: location to store the stat value |
70 | * @pointer: basis for where to copy from |
71 | * @stat: the stat definition |
72 | * |
73 | * Copies the stat data defined by the pointer and stat structure pair into |
74 | * the memory supplied as data. Used to implement i40e_add_ethtool_stats and |
75 | * i40e_add_queue_stats. If the pointer is null, data will be zero'd. |
76 | */ |
77 | static void |
78 | i40e_add_one_ethtool_stat(u64 *data, void *pointer, |
79 | const struct i40e_stats *stat) |
80 | { |
81 | char *p; |
82 | |
83 | if (!pointer) { |
84 | /* ensure that the ethtool data buffer is zero'd for any stats |
85 | * which don't have a valid pointer. |
86 | */ |
87 | *data = 0; |
88 | return; |
89 | } |
90 | |
91 | p = (char *)pointer + stat->stat_offset; |
92 | switch (stat->sizeof_stat) { |
93 | case sizeof(u64): |
94 | *data = *((u64 *)p); |
95 | break; |
96 | case sizeof(u32): |
97 | *data = *((u32 *)p); |
98 | break; |
99 | case sizeof(u16): |
100 | *data = *((u16 *)p); |
101 | break; |
102 | case sizeof(u8): |
103 | *data = *((u8 *)p); |
104 | break; |
105 | default: |
106 | WARN_ONCE(1, "unexpected stat size for %s" , |
107 | stat->stat_string); |
108 | *data = 0; |
109 | } |
110 | } |
111 | |
112 | /** |
113 | * __i40e_add_ethtool_stats - copy stats into the ethtool supplied buffer |
114 | * @data: ethtool stats buffer |
115 | * @pointer: location to copy stats from |
116 | * @stats: array of stats to copy |
117 | * @size: the size of the stats definition |
118 | * |
119 | * Copy the stats defined by the stats array using the pointer as a base into |
120 | * the data buffer supplied by ethtool. Updates the data pointer to point to |
121 | * the next empty location for successive calls to __i40e_add_ethtool_stats. |
122 | * If pointer is null, set the data values to zero and update the pointer to |
123 | * skip these stats. |
124 | **/ |
125 | static void |
126 | __i40e_add_ethtool_stats(u64 **data, void *pointer, |
127 | const struct i40e_stats stats[], |
128 | const unsigned int size) |
129 | { |
130 | unsigned int i; |
131 | |
132 | for (i = 0; i < size; i++) |
133 | i40e_add_one_ethtool_stat(data: (*data)++, pointer, stat: &stats[i]); |
134 | } |
135 | |
136 | /** |
137 | * i40e_add_ethtool_stats - copy stats into ethtool supplied buffer |
138 | * @data: ethtool stats buffer |
139 | * @pointer: location where stats are stored |
140 | * @stats: static const array of stat definitions |
141 | * |
142 | * Macro to ease the use of __i40e_add_ethtool_stats by taking a static |
143 | * constant stats array and passing the ARRAY_SIZE(). This avoids typos by |
144 | * ensuring that we pass the size associated with the given stats array. |
145 | * |
146 | * The parameter @stats is evaluated twice, so parameters with side effects |
147 | * should be avoided. |
148 | **/ |
149 | #define i40e_add_ethtool_stats(data, pointer, stats) \ |
150 | __i40e_add_ethtool_stats(data, pointer, stats, ARRAY_SIZE(stats)) |
151 | |
152 | /** |
153 | * i40e_add_queue_stats - copy queue statistics into supplied buffer |
154 | * @data: ethtool stats buffer |
155 | * @ring: the ring to copy |
156 | * |
157 | * Queue statistics must be copied while protected by |
158 | * u64_stats_fetch_begin, so we can't directly use i40e_add_ethtool_stats. |
159 | * Assumes that queue stats are defined in i40e_gstrings_queue_stats. If the |
160 | * ring pointer is null, zero out the queue stat values and update the data |
161 | * pointer. Otherwise safely copy the stats from the ring into the supplied |
162 | * buffer and update the data pointer when finished. |
163 | * |
164 | * This function expects to be called while under rcu_read_lock(). |
165 | **/ |
166 | static void |
167 | i40e_add_queue_stats(u64 **data, struct i40e_ring *ring) |
168 | { |
169 | const unsigned int size = ARRAY_SIZE(i40e_gstrings_queue_stats); |
170 | const struct i40e_stats *stats = i40e_gstrings_queue_stats; |
171 | unsigned int start; |
172 | unsigned int i; |
173 | |
174 | /* To avoid invalid statistics values, ensure that we keep retrying |
175 | * the copy until we get a consistent value according to |
176 | * u64_stats_fetch_retry. But first, make sure our ring is |
177 | * non-null before attempting to access its syncp. |
178 | */ |
179 | do { |
180 | start = !ring ? 0 : u64_stats_fetch_begin(syncp: &ring->syncp); |
181 | for (i = 0; i < size; i++) { |
182 | i40e_add_one_ethtool_stat(data: &(*data)[i], pointer: ring, |
183 | stat: &stats[i]); |
184 | } |
185 | } while (ring && u64_stats_fetch_retry(syncp: &ring->syncp, start)); |
186 | |
187 | /* Once we successfully copy the stats in, update the data pointer */ |
188 | *data += size; |
189 | } |
190 | |
191 | /** |
192 | * __i40e_add_stat_strings - copy stat strings into ethtool buffer |
193 | * @p: ethtool supplied buffer |
194 | * @stats: stat definitions array |
195 | * @size: size of the stats array |
196 | * |
197 | * Format and copy the strings described by stats into the buffer pointed at |
198 | * by p. |
199 | **/ |
200 | static void __i40e_add_stat_strings(u8 **p, const struct i40e_stats stats[], |
201 | const unsigned int size, ...) |
202 | { |
203 | unsigned int i; |
204 | |
205 | for (i = 0; i < size; i++) { |
206 | va_list args; |
207 | |
208 | va_start(args, size); |
209 | vsnprintf(buf: *p, ETH_GSTRING_LEN, fmt: stats[i].stat_string, args); |
210 | *p += ETH_GSTRING_LEN; |
211 | va_end(args); |
212 | } |
213 | } |
214 | |
215 | /** |
216 | * i40e_add_stat_strings - copy stat strings into ethtool buffer |
217 | * @p: ethtool supplied buffer |
218 | * @stats: stat definitions array |
219 | * |
220 | * Format and copy the strings described by the const static stats value into |
221 | * the buffer pointed at by p. |
222 | * |
223 | * The parameter @stats is evaluated twice, so parameters with side effects |
224 | * should be avoided. Additionally, stats must be an array such that |
225 | * ARRAY_SIZE can be called on it. |
226 | **/ |
227 | #define i40e_add_stat_strings(p, stats, ...) \ |
228 | __i40e_add_stat_strings(p, stats, ARRAY_SIZE(stats), ## __VA_ARGS__) |
229 | |
230 | #define I40E_PF_STAT(_name, _stat) \ |
231 | I40E_STAT(struct i40e_pf, _name, _stat) |
232 | #define I40E_VSI_STAT(_name, _stat) \ |
233 | I40E_STAT(struct i40e_vsi, _name, _stat) |
234 | #define I40E_VEB_STAT(_name, _stat) \ |
235 | I40E_STAT(struct i40e_veb, _name, _stat) |
236 | #define I40E_VEB_TC_STAT(_name, _stat) \ |
237 | I40E_STAT(struct i40e_cp_veb_tc_stats, _name, _stat) |
238 | #define I40E_PFC_STAT(_name, _stat) \ |
239 | I40E_STAT(struct i40e_pfc_stats, _name, _stat) |
240 | |
241 | static const struct i40e_stats i40e_gstrings_net_stats[] = { |
242 | I40E_NETDEV_STAT(rx_packets), |
243 | I40E_NETDEV_STAT(tx_packets), |
244 | I40E_NETDEV_STAT(rx_bytes), |
245 | I40E_NETDEV_STAT(tx_bytes), |
246 | I40E_NETDEV_STAT(rx_errors), |
247 | I40E_NETDEV_STAT(tx_errors), |
248 | I40E_NETDEV_STAT(rx_dropped), |
249 | I40E_NETDEV_STAT(rx_missed_errors), |
250 | I40E_NETDEV_STAT(tx_dropped), |
251 | I40E_NETDEV_STAT(collisions), |
252 | I40E_NETDEV_STAT(rx_length_errors), |
253 | I40E_NETDEV_STAT(rx_crc_errors), |
254 | }; |
255 | |
256 | static const struct i40e_stats i40e_gstrings_veb_stats[] = { |
257 | I40E_VEB_STAT("veb.rx_bytes" , stats.rx_bytes), |
258 | I40E_VEB_STAT("veb.tx_bytes" , stats.tx_bytes), |
259 | I40E_VEB_STAT("veb.rx_unicast" , stats.rx_unicast), |
260 | I40E_VEB_STAT("veb.tx_unicast" , stats.tx_unicast), |
261 | I40E_VEB_STAT("veb.rx_multicast" , stats.rx_multicast), |
262 | I40E_VEB_STAT("veb.tx_multicast" , stats.tx_multicast), |
263 | I40E_VEB_STAT("veb.rx_broadcast" , stats.rx_broadcast), |
264 | I40E_VEB_STAT("veb.tx_broadcast" , stats.tx_broadcast), |
265 | I40E_VEB_STAT("veb.rx_discards" , stats.rx_discards), |
266 | I40E_VEB_STAT("veb.tx_discards" , stats.tx_discards), |
267 | I40E_VEB_STAT("veb.tx_errors" , stats.tx_errors), |
268 | I40E_VEB_STAT("veb.rx_unknown_protocol" , stats.rx_unknown_protocol), |
269 | }; |
270 | |
271 | struct i40e_cp_veb_tc_stats { |
272 | u64 tc_rx_packets; |
273 | u64 tc_rx_bytes; |
274 | u64 tc_tx_packets; |
275 | u64 tc_tx_bytes; |
276 | }; |
277 | |
278 | static const struct i40e_stats i40e_gstrings_veb_tc_stats[] = { |
279 | I40E_VEB_TC_STAT("veb.tc_%u_tx_packets" , tc_tx_packets), |
280 | I40E_VEB_TC_STAT("veb.tc_%u_tx_bytes" , tc_tx_bytes), |
281 | I40E_VEB_TC_STAT("veb.tc_%u_rx_packets" , tc_rx_packets), |
282 | I40E_VEB_TC_STAT("veb.tc_%u_rx_bytes" , tc_rx_bytes), |
283 | }; |
284 | |
285 | static const struct i40e_stats i40e_gstrings_misc_stats[] = { |
286 | I40E_VSI_STAT("rx_unicast" , eth_stats.rx_unicast), |
287 | I40E_VSI_STAT("tx_unicast" , eth_stats.tx_unicast), |
288 | I40E_VSI_STAT("rx_multicast" , eth_stats.rx_multicast), |
289 | I40E_VSI_STAT("tx_multicast" , eth_stats.tx_multicast), |
290 | I40E_VSI_STAT("rx_broadcast" , eth_stats.rx_broadcast), |
291 | I40E_VSI_STAT("tx_broadcast" , eth_stats.tx_broadcast), |
292 | I40E_VSI_STAT("rx_unknown_protocol" , eth_stats.rx_unknown_protocol), |
293 | I40E_VSI_STAT("tx_linearize" , tx_linearize), |
294 | I40E_VSI_STAT("tx_force_wb" , tx_force_wb), |
295 | I40E_VSI_STAT("tx_busy" , tx_busy), |
296 | I40E_VSI_STAT("tx_stopped" , tx_stopped), |
297 | I40E_VSI_STAT("rx_alloc_fail" , rx_buf_failed), |
298 | I40E_VSI_STAT("rx_pg_alloc_fail" , rx_page_failed), |
299 | I40E_VSI_STAT("rx_cache_reuse" , rx_page_reuse), |
300 | I40E_VSI_STAT("rx_cache_alloc" , rx_page_alloc), |
301 | I40E_VSI_STAT("rx_cache_waive" , rx_page_waive), |
302 | I40E_VSI_STAT("rx_cache_busy" , rx_page_busy), |
303 | I40E_VSI_STAT("tx_restart" , tx_restart), |
304 | }; |
305 | |
306 | /* These PF_STATs might look like duplicates of some NETDEV_STATs, |
307 | * but they are separate. This device supports Virtualization, and |
308 | * as such might have several netdevs supporting VMDq and FCoE going |
309 | * through a single port. The NETDEV_STATs are for individual netdevs |
310 | * seen at the top of the stack, and the PF_STATs are for the physical |
311 | * function at the bottom of the stack hosting those netdevs. |
312 | * |
313 | * The PF_STATs are appended to the netdev stats only when ethtool -S |
314 | * is queried on the base PF netdev, not on the VMDq or FCoE netdev. |
315 | */ |
316 | static const struct i40e_stats i40e_gstrings_stats[] = { |
317 | I40E_PF_STAT("port.rx_bytes" , stats.eth.rx_bytes), |
318 | I40E_PF_STAT("port.tx_bytes" , stats.eth.tx_bytes), |
319 | I40E_PF_STAT("port.rx_unicast" , stats.eth.rx_unicast), |
320 | I40E_PF_STAT("port.tx_unicast" , stats.eth.tx_unicast), |
321 | I40E_PF_STAT("port.rx_multicast" , stats.eth.rx_multicast), |
322 | I40E_PF_STAT("port.tx_multicast" , stats.eth.tx_multicast), |
323 | I40E_PF_STAT("port.rx_broadcast" , stats.eth.rx_broadcast), |
324 | I40E_PF_STAT("port.tx_broadcast" , stats.eth.tx_broadcast), |
325 | I40E_PF_STAT("port.tx_errors" , stats.eth.tx_errors), |
326 | I40E_PF_STAT("port.rx_discards" , stats.eth.rx_discards), |
327 | I40E_PF_STAT("port.tx_dropped_link_down" , stats.tx_dropped_link_down), |
328 | I40E_PF_STAT("port.rx_crc_errors" , stats.crc_errors), |
329 | I40E_PF_STAT("port.illegal_bytes" , stats.illegal_bytes), |
330 | I40E_PF_STAT("port.mac_local_faults" , stats.mac_local_faults), |
331 | I40E_PF_STAT("port.mac_remote_faults" , stats.mac_remote_faults), |
332 | I40E_PF_STAT("port.tx_timeout" , tx_timeout_count), |
333 | I40E_PF_STAT("port.rx_csum_bad" , hw_csum_rx_error), |
334 | I40E_PF_STAT("port.rx_length_errors" , stats.rx_length_errors), |
335 | I40E_PF_STAT("port.link_xon_rx" , stats.link_xon_rx), |
336 | I40E_PF_STAT("port.link_xoff_rx" , stats.link_xoff_rx), |
337 | I40E_PF_STAT("port.link_xon_tx" , stats.link_xon_tx), |
338 | I40E_PF_STAT("port.link_xoff_tx" , stats.link_xoff_tx), |
339 | I40E_PF_STAT("port.rx_size_64" , stats.rx_size_64), |
340 | I40E_PF_STAT("port.rx_size_127" , stats.rx_size_127), |
341 | I40E_PF_STAT("port.rx_size_255" , stats.rx_size_255), |
342 | I40E_PF_STAT("port.rx_size_511" , stats.rx_size_511), |
343 | I40E_PF_STAT("port.rx_size_1023" , stats.rx_size_1023), |
344 | I40E_PF_STAT("port.rx_size_1522" , stats.rx_size_1522), |
345 | I40E_PF_STAT("port.rx_size_big" , stats.rx_size_big), |
346 | I40E_PF_STAT("port.tx_size_64" , stats.tx_size_64), |
347 | I40E_PF_STAT("port.tx_size_127" , stats.tx_size_127), |
348 | I40E_PF_STAT("port.tx_size_255" , stats.tx_size_255), |
349 | I40E_PF_STAT("port.tx_size_511" , stats.tx_size_511), |
350 | I40E_PF_STAT("port.tx_size_1023" , stats.tx_size_1023), |
351 | I40E_PF_STAT("port.tx_size_1522" , stats.tx_size_1522), |
352 | I40E_PF_STAT("port.tx_size_big" , stats.tx_size_big), |
353 | I40E_PF_STAT("port.rx_undersize" , stats.rx_undersize), |
354 | I40E_PF_STAT("port.rx_fragments" , stats.rx_fragments), |
355 | I40E_PF_STAT("port.rx_oversize" , stats.rx_oversize), |
356 | I40E_PF_STAT("port.rx_jabber" , stats.rx_jabber), |
357 | I40E_PF_STAT("port.VF_admin_queue_requests" , vf_aq_requests), |
358 | I40E_PF_STAT("port.arq_overflows" , arq_overflows), |
359 | I40E_PF_STAT("port.tx_hwtstamp_timeouts" , tx_hwtstamp_timeouts), |
360 | I40E_PF_STAT("port.rx_hwtstamp_cleared" , rx_hwtstamp_cleared), |
361 | I40E_PF_STAT("port.tx_hwtstamp_skipped" , tx_hwtstamp_skipped), |
362 | I40E_PF_STAT("port.fdir_flush_cnt" , fd_flush_cnt), |
363 | I40E_PF_STAT("port.fdir_atr_match" , stats.fd_atr_match), |
364 | I40E_PF_STAT("port.fdir_atr_tunnel_match" , stats.fd_atr_tunnel_match), |
365 | I40E_PF_STAT("port.fdir_atr_status" , stats.fd_atr_status), |
366 | I40E_PF_STAT("port.fdir_sb_match" , stats.fd_sb_match), |
367 | I40E_PF_STAT("port.fdir_sb_status" , stats.fd_sb_status), |
368 | |
369 | /* LPI stats */ |
370 | I40E_PF_STAT("port.tx_lpi_status" , stats.tx_lpi_status), |
371 | I40E_PF_STAT("port.rx_lpi_status" , stats.rx_lpi_status), |
372 | I40E_PF_STAT("port.tx_lpi_count" , stats.tx_lpi_count), |
373 | I40E_PF_STAT("port.rx_lpi_count" , stats.rx_lpi_count), |
374 | }; |
375 | |
376 | struct i40e_pfc_stats { |
377 | u64 priority_xon_rx; |
378 | u64 priority_xoff_rx; |
379 | u64 priority_xon_tx; |
380 | u64 priority_xoff_tx; |
381 | u64 priority_xon_2_xoff; |
382 | }; |
383 | |
384 | static const struct i40e_stats i40e_gstrings_pfc_stats[] = { |
385 | I40E_PFC_STAT("port.tx_priority_%u_xon_tx" , priority_xon_tx), |
386 | I40E_PFC_STAT("port.tx_priority_%u_xoff_tx" , priority_xoff_tx), |
387 | I40E_PFC_STAT("port.rx_priority_%u_xon_rx" , priority_xon_rx), |
388 | I40E_PFC_STAT("port.rx_priority_%u_xoff_rx" , priority_xoff_rx), |
389 | I40E_PFC_STAT("port.rx_priority_%u_xon_2_xoff" , priority_xon_2_xoff), |
390 | }; |
391 | |
392 | #define I40E_NETDEV_STATS_LEN ARRAY_SIZE(i40e_gstrings_net_stats) |
393 | |
394 | #define I40E_MISC_STATS_LEN ARRAY_SIZE(i40e_gstrings_misc_stats) |
395 | |
396 | #define I40E_VSI_STATS_LEN (I40E_NETDEV_STATS_LEN + I40E_MISC_STATS_LEN) |
397 | |
398 | #define I40E_PFC_STATS_LEN (ARRAY_SIZE(i40e_gstrings_pfc_stats) * \ |
399 | I40E_MAX_USER_PRIORITY) |
400 | |
401 | #define I40E_VEB_STATS_LEN (ARRAY_SIZE(i40e_gstrings_veb_stats) + \ |
402 | (ARRAY_SIZE(i40e_gstrings_veb_tc_stats) * \ |
403 | I40E_MAX_TRAFFIC_CLASS)) |
404 | |
405 | #define I40E_GLOBAL_STATS_LEN ARRAY_SIZE(i40e_gstrings_stats) |
406 | |
407 | #define I40E_PF_STATS_LEN (I40E_GLOBAL_STATS_LEN + \ |
408 | I40E_PFC_STATS_LEN + \ |
409 | I40E_VEB_STATS_LEN + \ |
410 | I40E_VSI_STATS_LEN) |
411 | |
412 | /* Length of stats for a single queue */ |
413 | #define I40E_QUEUE_STATS_LEN ARRAY_SIZE(i40e_gstrings_queue_stats) |
414 | |
415 | enum i40e_ethtool_test_id { |
416 | I40E_ETH_TEST_REG = 0, |
417 | I40E_ETH_TEST_EEPROM, |
418 | I40E_ETH_TEST_INTR, |
419 | I40E_ETH_TEST_LINK, |
420 | }; |
421 | |
422 | static const char i40e_gstrings_test[][ETH_GSTRING_LEN] = { |
423 | "Register test (offline)" , |
424 | "Eeprom test (offline)" , |
425 | "Interrupt test (offline)" , |
426 | "Link test (on/offline)" |
427 | }; |
428 | |
429 | #define I40E_TEST_LEN (sizeof(i40e_gstrings_test) / ETH_GSTRING_LEN) |
430 | |
431 | struct i40e_priv_flags { |
432 | char flag_string[ETH_GSTRING_LEN]; |
433 | u64 flag; |
434 | bool read_only; |
435 | }; |
436 | |
437 | #define I40E_PRIV_FLAG(_name, _flag, _read_only) { \ |
438 | .flag_string = _name, \ |
439 | .flag = _flag, \ |
440 | .read_only = _read_only, \ |
441 | } |
442 | |
443 | static const struct i40e_priv_flags i40e_gstrings_priv_flags[] = { |
444 | /* NOTE: MFP setting cannot be changed */ |
445 | I40E_PRIV_FLAG("MFP" , I40E_FLAG_MFP_ENABLED, 1), |
446 | I40E_PRIV_FLAG("total-port-shutdown" , |
447 | I40E_FLAG_TOTAL_PORT_SHUTDOWN_ENABLED, 1), |
448 | I40E_PRIV_FLAG("LinkPolling" , I40E_FLAG_LINK_POLLING_ENABLED, 0), |
449 | I40E_PRIV_FLAG("flow-director-atr" , I40E_FLAG_FD_ATR_ENABLED, 0), |
450 | I40E_PRIV_FLAG("veb-stats" , I40E_FLAG_VEB_STATS_ENABLED, 0), |
451 | I40E_PRIV_FLAG("hw-atr-eviction" , I40E_FLAG_HW_ATR_EVICT_ENABLED, 0), |
452 | I40E_PRIV_FLAG("link-down-on-close" , |
453 | I40E_FLAG_LINK_DOWN_ON_CLOSE_ENABLED, 0), |
454 | I40E_PRIV_FLAG("legacy-rx" , I40E_FLAG_LEGACY_RX, 0), |
455 | I40E_PRIV_FLAG("disable-source-pruning" , |
456 | I40E_FLAG_SOURCE_PRUNING_DISABLED, 0), |
457 | I40E_PRIV_FLAG("disable-fw-lldp" , I40E_FLAG_DISABLE_FW_LLDP, 0), |
458 | I40E_PRIV_FLAG("rs-fec" , I40E_FLAG_RS_FEC, 0), |
459 | I40E_PRIV_FLAG("base-r-fec" , I40E_FLAG_BASE_R_FEC, 0), |
460 | I40E_PRIV_FLAG("vf-vlan-pruning" , |
461 | I40E_FLAG_VF_VLAN_PRUNING, 0), |
462 | }; |
463 | |
464 | #define I40E_PRIV_FLAGS_STR_LEN ARRAY_SIZE(i40e_gstrings_priv_flags) |
465 | |
466 | /* Private flags with a global effect, restricted to PF 0 */ |
467 | static const struct i40e_priv_flags i40e_gl_gstrings_priv_flags[] = { |
468 | I40E_PRIV_FLAG("vf-true-promisc-support" , |
469 | I40E_FLAG_TRUE_PROMISC_SUPPORT, 0), |
470 | }; |
471 | |
472 | #define I40E_GL_PRIV_FLAGS_STR_LEN ARRAY_SIZE(i40e_gl_gstrings_priv_flags) |
473 | |
474 | /** |
475 | * i40e_partition_setting_complaint - generic complaint for MFP restriction |
476 | * @pf: the PF struct |
477 | **/ |
478 | static void i40e_partition_setting_complaint(struct i40e_pf *pf) |
479 | { |
480 | dev_info(&pf->pdev->dev, |
481 | "The link settings are allowed to be changed only from the first partition of a given port. Please switch to the first partition in order to change the setting.\n" ); |
482 | } |
483 | |
484 | /** |
485 | * i40e_phy_type_to_ethtool - convert the phy_types to ethtool link modes |
486 | * @pf: PF struct with phy_types |
487 | * @ks: ethtool link ksettings struct to fill out |
488 | * |
489 | **/ |
490 | static void i40e_phy_type_to_ethtool(struct i40e_pf *pf, |
491 | struct ethtool_link_ksettings *ks) |
492 | { |
493 | struct i40e_link_status *hw_link_info = &pf->hw.phy.link_info; |
494 | u64 phy_types = pf->hw.phy.phy_types; |
495 | |
496 | ethtool_link_ksettings_zero_link_mode(ks, supported); |
497 | ethtool_link_ksettings_zero_link_mode(ks, advertising); |
498 | |
499 | if (phy_types & I40E_CAP_PHY_TYPE_SGMII) { |
500 | ethtool_link_ksettings_add_link_mode(ks, supported, |
501 | 1000baseT_Full); |
502 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_1GB) |
503 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
504 | 1000baseT_Full); |
505 | if (pf->hw_features & I40E_HW_100M_SGMII_CAPABLE) { |
506 | ethtool_link_ksettings_add_link_mode(ks, supported, |
507 | 100baseT_Full); |
508 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
509 | 100baseT_Full); |
510 | } |
511 | } |
512 | if (phy_types & I40E_CAP_PHY_TYPE_XAUI || |
513 | phy_types & I40E_CAP_PHY_TYPE_XFI || |
514 | phy_types & I40E_CAP_PHY_TYPE_SFI || |
515 | phy_types & I40E_CAP_PHY_TYPE_10GBASE_SFPP_CU || |
516 | phy_types & I40E_CAP_PHY_TYPE_10GBASE_AOC) { |
517 | ethtool_link_ksettings_add_link_mode(ks, supported, |
518 | 10000baseT_Full); |
519 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_10GB) |
520 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
521 | 10000baseT_Full); |
522 | } |
523 | if (phy_types & I40E_CAP_PHY_TYPE_10GBASE_T) { |
524 | ethtool_link_ksettings_add_link_mode(ks, supported, |
525 | 10000baseT_Full); |
526 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_10GB) |
527 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
528 | 10000baseT_Full); |
529 | } |
530 | if (phy_types & I40E_CAP_PHY_TYPE_2_5GBASE_T) { |
531 | ethtool_link_ksettings_add_link_mode(ks, supported, |
532 | 2500baseT_Full); |
533 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_2_5GB) |
534 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
535 | 2500baseT_Full); |
536 | } |
537 | if (phy_types & I40E_CAP_PHY_TYPE_5GBASE_T) { |
538 | ethtool_link_ksettings_add_link_mode(ks, supported, |
539 | 5000baseT_Full); |
540 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_5GB) |
541 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
542 | 5000baseT_Full); |
543 | } |
544 | if (phy_types & I40E_CAP_PHY_TYPE_XLAUI || |
545 | phy_types & I40E_CAP_PHY_TYPE_XLPPI || |
546 | phy_types & I40E_CAP_PHY_TYPE_40GBASE_AOC) |
547 | ethtool_link_ksettings_add_link_mode(ks, supported, |
548 | 40000baseCR4_Full); |
549 | if (phy_types & I40E_CAP_PHY_TYPE_40GBASE_CR4_CU || |
550 | phy_types & I40E_CAP_PHY_TYPE_40GBASE_CR4) { |
551 | ethtool_link_ksettings_add_link_mode(ks, supported, |
552 | 40000baseCR4_Full); |
553 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_40GB) |
554 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
555 | 40000baseCR4_Full); |
556 | } |
557 | if (phy_types & I40E_CAP_PHY_TYPE_100BASE_TX) { |
558 | ethtool_link_ksettings_add_link_mode(ks, supported, |
559 | 100baseT_Full); |
560 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_100MB) |
561 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
562 | 100baseT_Full); |
563 | } |
564 | if (phy_types & I40E_CAP_PHY_TYPE_1000BASE_T) { |
565 | ethtool_link_ksettings_add_link_mode(ks, supported, |
566 | 1000baseT_Full); |
567 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_1GB) |
568 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
569 | 1000baseT_Full); |
570 | } |
571 | if (phy_types & I40E_CAP_PHY_TYPE_40GBASE_SR4) { |
572 | ethtool_link_ksettings_add_link_mode(ks, supported, |
573 | 40000baseSR4_Full); |
574 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
575 | 40000baseSR4_Full); |
576 | } |
577 | if (phy_types & I40E_CAP_PHY_TYPE_40GBASE_LR4) { |
578 | ethtool_link_ksettings_add_link_mode(ks, supported, |
579 | 40000baseLR4_Full); |
580 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
581 | 40000baseLR4_Full); |
582 | } |
583 | if (phy_types & I40E_CAP_PHY_TYPE_40GBASE_KR4) { |
584 | ethtool_link_ksettings_add_link_mode(ks, supported, |
585 | 40000baseKR4_Full); |
586 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
587 | 40000baseKR4_Full); |
588 | } |
589 | if (phy_types & I40E_CAP_PHY_TYPE_20GBASE_KR2) { |
590 | ethtool_link_ksettings_add_link_mode(ks, supported, |
591 | 20000baseKR2_Full); |
592 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_20GB) |
593 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
594 | 20000baseKR2_Full); |
595 | } |
596 | if (phy_types & I40E_CAP_PHY_TYPE_10GBASE_KX4) { |
597 | ethtool_link_ksettings_add_link_mode(ks, supported, |
598 | 10000baseKX4_Full); |
599 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_10GB) |
600 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
601 | 10000baseKX4_Full); |
602 | } |
603 | if (phy_types & I40E_CAP_PHY_TYPE_10GBASE_KR && |
604 | !(pf->hw_features & I40E_HW_HAVE_CRT_RETIMER)) { |
605 | ethtool_link_ksettings_add_link_mode(ks, supported, |
606 | 10000baseKR_Full); |
607 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_10GB) |
608 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
609 | 10000baseKR_Full); |
610 | } |
611 | if (phy_types & I40E_CAP_PHY_TYPE_1000BASE_KX && |
612 | !(pf->hw_features & I40E_HW_HAVE_CRT_RETIMER)) { |
613 | ethtool_link_ksettings_add_link_mode(ks, supported, |
614 | 1000baseKX_Full); |
615 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_1GB) |
616 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
617 | 1000baseKX_Full); |
618 | } |
619 | /* need to add 25G PHY types */ |
620 | if (phy_types & I40E_CAP_PHY_TYPE_25GBASE_KR) { |
621 | ethtool_link_ksettings_add_link_mode(ks, supported, |
622 | 25000baseKR_Full); |
623 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_25GB) |
624 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
625 | 25000baseKR_Full); |
626 | } |
627 | if (phy_types & I40E_CAP_PHY_TYPE_25GBASE_CR) { |
628 | ethtool_link_ksettings_add_link_mode(ks, supported, |
629 | 25000baseCR_Full); |
630 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_25GB) |
631 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
632 | 25000baseCR_Full); |
633 | } |
634 | if (phy_types & I40E_CAP_PHY_TYPE_25GBASE_SR || |
635 | phy_types & I40E_CAP_PHY_TYPE_25GBASE_LR) { |
636 | ethtool_link_ksettings_add_link_mode(ks, supported, |
637 | 25000baseSR_Full); |
638 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_25GB) |
639 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
640 | 25000baseSR_Full); |
641 | } |
642 | if (phy_types & I40E_CAP_PHY_TYPE_25GBASE_AOC || |
643 | phy_types & I40E_CAP_PHY_TYPE_25GBASE_ACC) { |
644 | ethtool_link_ksettings_add_link_mode(ks, supported, |
645 | 25000baseCR_Full); |
646 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_25GB) |
647 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
648 | 25000baseCR_Full); |
649 | } |
650 | if (phy_types & I40E_CAP_PHY_TYPE_25GBASE_KR || |
651 | phy_types & I40E_CAP_PHY_TYPE_25GBASE_CR || |
652 | phy_types & I40E_CAP_PHY_TYPE_25GBASE_SR || |
653 | phy_types & I40E_CAP_PHY_TYPE_25GBASE_LR || |
654 | phy_types & I40E_CAP_PHY_TYPE_25GBASE_AOC || |
655 | phy_types & I40E_CAP_PHY_TYPE_25GBASE_ACC) { |
656 | ethtool_link_ksettings_add_link_mode(ks, supported, FEC_NONE); |
657 | ethtool_link_ksettings_add_link_mode(ks, supported, FEC_RS); |
658 | ethtool_link_ksettings_add_link_mode(ks, supported, FEC_BASER); |
659 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_25GB) { |
660 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
661 | FEC_NONE); |
662 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
663 | FEC_RS); |
664 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
665 | FEC_BASER); |
666 | } |
667 | } |
668 | /* need to add new 10G PHY types */ |
669 | if (phy_types & I40E_CAP_PHY_TYPE_10GBASE_CR1 || |
670 | phy_types & I40E_CAP_PHY_TYPE_10GBASE_CR1_CU) { |
671 | ethtool_link_ksettings_add_link_mode(ks, supported, |
672 | 10000baseCR_Full); |
673 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_10GB) |
674 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
675 | 10000baseCR_Full); |
676 | } |
677 | if (phy_types & I40E_CAP_PHY_TYPE_10GBASE_SR) { |
678 | ethtool_link_ksettings_add_link_mode(ks, supported, |
679 | 10000baseSR_Full); |
680 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_10GB) |
681 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
682 | 10000baseSR_Full); |
683 | } |
684 | if (phy_types & I40E_CAP_PHY_TYPE_10GBASE_LR) { |
685 | ethtool_link_ksettings_add_link_mode(ks, supported, |
686 | 10000baseLR_Full); |
687 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_10GB) |
688 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
689 | 10000baseLR_Full); |
690 | } |
691 | if (phy_types & I40E_CAP_PHY_TYPE_1000BASE_SX || |
692 | phy_types & I40E_CAP_PHY_TYPE_1000BASE_LX || |
693 | phy_types & I40E_CAP_PHY_TYPE_1000BASE_T_OPTICAL) { |
694 | ethtool_link_ksettings_add_link_mode(ks, supported, |
695 | 1000baseX_Full); |
696 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_1GB) |
697 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
698 | 1000baseX_Full); |
699 | } |
700 | /* Autoneg PHY types */ |
701 | if (phy_types & I40E_CAP_PHY_TYPE_SGMII || |
702 | phy_types & I40E_CAP_PHY_TYPE_40GBASE_KR4 || |
703 | phy_types & I40E_CAP_PHY_TYPE_40GBASE_CR4_CU || |
704 | phy_types & I40E_CAP_PHY_TYPE_40GBASE_CR4 || |
705 | phy_types & I40E_CAP_PHY_TYPE_25GBASE_SR || |
706 | phy_types & I40E_CAP_PHY_TYPE_25GBASE_LR || |
707 | phy_types & I40E_CAP_PHY_TYPE_25GBASE_KR || |
708 | phy_types & I40E_CAP_PHY_TYPE_25GBASE_CR || |
709 | phy_types & I40E_CAP_PHY_TYPE_20GBASE_KR2 || |
710 | phy_types & I40E_CAP_PHY_TYPE_10GBASE_SR || |
711 | phy_types & I40E_CAP_PHY_TYPE_10GBASE_LR || |
712 | phy_types & I40E_CAP_PHY_TYPE_10GBASE_KX4 || |
713 | phy_types & I40E_CAP_PHY_TYPE_10GBASE_KR || |
714 | phy_types & I40E_CAP_PHY_TYPE_10GBASE_CR1_CU || |
715 | phy_types & I40E_CAP_PHY_TYPE_10GBASE_CR1 || |
716 | phy_types & I40E_CAP_PHY_TYPE_10GBASE_T || |
717 | phy_types & I40E_CAP_PHY_TYPE_5GBASE_T || |
718 | phy_types & I40E_CAP_PHY_TYPE_2_5GBASE_T || |
719 | phy_types & I40E_CAP_PHY_TYPE_1000BASE_T_OPTICAL || |
720 | phy_types & I40E_CAP_PHY_TYPE_1000BASE_T || |
721 | phy_types & I40E_CAP_PHY_TYPE_1000BASE_SX || |
722 | phy_types & I40E_CAP_PHY_TYPE_1000BASE_LX || |
723 | phy_types & I40E_CAP_PHY_TYPE_1000BASE_KX || |
724 | phy_types & I40E_CAP_PHY_TYPE_100BASE_TX) { |
725 | ethtool_link_ksettings_add_link_mode(ks, supported, |
726 | Autoneg); |
727 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
728 | Autoneg); |
729 | } |
730 | } |
731 | |
732 | /** |
733 | * i40e_get_settings_link_up_fec - Get the FEC mode encoding from mask |
734 | * @req_fec_info: mask request FEC info |
735 | * @ks: ethtool ksettings to fill in |
736 | **/ |
737 | static void i40e_get_settings_link_up_fec(u8 req_fec_info, |
738 | struct ethtool_link_ksettings *ks) |
739 | { |
740 | ethtool_link_ksettings_add_link_mode(ks, supported, FEC_NONE); |
741 | ethtool_link_ksettings_add_link_mode(ks, supported, FEC_RS); |
742 | ethtool_link_ksettings_add_link_mode(ks, supported, FEC_BASER); |
743 | |
744 | if ((I40E_AQ_SET_FEC_REQUEST_RS & req_fec_info) && |
745 | (I40E_AQ_SET_FEC_REQUEST_KR & req_fec_info)) { |
746 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
747 | FEC_NONE); |
748 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
749 | FEC_BASER); |
750 | ethtool_link_ksettings_add_link_mode(ks, advertising, FEC_RS); |
751 | } else if (I40E_AQ_SET_FEC_REQUEST_RS & req_fec_info) { |
752 | ethtool_link_ksettings_add_link_mode(ks, advertising, FEC_RS); |
753 | } else if (I40E_AQ_SET_FEC_REQUEST_KR & req_fec_info) { |
754 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
755 | FEC_BASER); |
756 | } else { |
757 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
758 | FEC_NONE); |
759 | } |
760 | } |
761 | |
762 | /** |
763 | * i40e_get_settings_link_up - Get the Link settings for when link is up |
764 | * @hw: hw structure |
765 | * @ks: ethtool ksettings to fill in |
766 | * @netdev: network interface device structure |
767 | * @pf: pointer to physical function struct |
768 | **/ |
769 | static void i40e_get_settings_link_up(struct i40e_hw *hw, |
770 | struct ethtool_link_ksettings *ks, |
771 | struct net_device *netdev, |
772 | struct i40e_pf *pf) |
773 | { |
774 | struct i40e_link_status *hw_link_info = &hw->phy.link_info; |
775 | struct ethtool_link_ksettings cap_ksettings; |
776 | u32 link_speed = hw_link_info->link_speed; |
777 | |
778 | /* Initialize supported and advertised settings based on phy settings */ |
779 | switch (hw_link_info->phy_type) { |
780 | case I40E_PHY_TYPE_40GBASE_CR4: |
781 | case I40E_PHY_TYPE_40GBASE_CR4_CU: |
782 | ethtool_link_ksettings_add_link_mode(ks, supported, Autoneg); |
783 | ethtool_link_ksettings_add_link_mode(ks, supported, |
784 | 40000baseCR4_Full); |
785 | ethtool_link_ksettings_add_link_mode(ks, advertising, Autoneg); |
786 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
787 | 40000baseCR4_Full); |
788 | break; |
789 | case I40E_PHY_TYPE_XLAUI: |
790 | case I40E_PHY_TYPE_XLPPI: |
791 | case I40E_PHY_TYPE_40GBASE_AOC: |
792 | ethtool_link_ksettings_add_link_mode(ks, supported, |
793 | 40000baseCR4_Full); |
794 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
795 | 40000baseCR4_Full); |
796 | break; |
797 | case I40E_PHY_TYPE_40GBASE_SR4: |
798 | ethtool_link_ksettings_add_link_mode(ks, supported, |
799 | 40000baseSR4_Full); |
800 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
801 | 40000baseSR4_Full); |
802 | break; |
803 | case I40E_PHY_TYPE_40GBASE_LR4: |
804 | ethtool_link_ksettings_add_link_mode(ks, supported, |
805 | 40000baseLR4_Full); |
806 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
807 | 40000baseLR4_Full); |
808 | break; |
809 | case I40E_PHY_TYPE_25GBASE_SR: |
810 | case I40E_PHY_TYPE_25GBASE_LR: |
811 | case I40E_PHY_TYPE_10GBASE_SR: |
812 | case I40E_PHY_TYPE_10GBASE_LR: |
813 | case I40E_PHY_TYPE_1000BASE_SX: |
814 | case I40E_PHY_TYPE_1000BASE_LX: |
815 | ethtool_link_ksettings_add_link_mode(ks, supported, Autoneg); |
816 | ethtool_link_ksettings_add_link_mode(ks, advertising, Autoneg); |
817 | ethtool_link_ksettings_add_link_mode(ks, supported, |
818 | 25000baseSR_Full); |
819 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
820 | 25000baseSR_Full); |
821 | i40e_get_settings_link_up_fec(req_fec_info: hw_link_info->req_fec_info, ks); |
822 | ethtool_link_ksettings_add_link_mode(ks, supported, |
823 | 10000baseSR_Full); |
824 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
825 | 10000baseSR_Full); |
826 | ethtool_link_ksettings_add_link_mode(ks, supported, |
827 | 10000baseLR_Full); |
828 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
829 | 10000baseLR_Full); |
830 | ethtool_link_ksettings_add_link_mode(ks, supported, |
831 | 1000baseX_Full); |
832 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
833 | 1000baseX_Full); |
834 | ethtool_link_ksettings_add_link_mode(ks, supported, |
835 | 10000baseT_Full); |
836 | if (hw_link_info->module_type[2] & |
837 | I40E_MODULE_TYPE_1000BASE_SX || |
838 | hw_link_info->module_type[2] & |
839 | I40E_MODULE_TYPE_1000BASE_LX) { |
840 | ethtool_link_ksettings_add_link_mode(ks, supported, |
841 | 1000baseT_Full); |
842 | if (hw_link_info->requested_speeds & |
843 | I40E_LINK_SPEED_1GB) |
844 | ethtool_link_ksettings_add_link_mode( |
845 | ks, advertising, 1000baseT_Full); |
846 | } |
847 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_10GB) |
848 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
849 | 10000baseT_Full); |
850 | break; |
851 | case I40E_PHY_TYPE_10GBASE_T: |
852 | case I40E_PHY_TYPE_5GBASE_T_LINK_STATUS: |
853 | case I40E_PHY_TYPE_2_5GBASE_T_LINK_STATUS: |
854 | case I40E_PHY_TYPE_1000BASE_T: |
855 | case I40E_PHY_TYPE_100BASE_TX: |
856 | ethtool_link_ksettings_add_link_mode(ks, supported, Autoneg); |
857 | ethtool_link_ksettings_add_link_mode(ks, supported, |
858 | 10000baseT_Full); |
859 | ethtool_link_ksettings_add_link_mode(ks, supported, |
860 | 5000baseT_Full); |
861 | ethtool_link_ksettings_add_link_mode(ks, supported, |
862 | 2500baseT_Full); |
863 | ethtool_link_ksettings_add_link_mode(ks, supported, |
864 | 1000baseT_Full); |
865 | ethtool_link_ksettings_add_link_mode(ks, supported, |
866 | 100baseT_Full); |
867 | ethtool_link_ksettings_add_link_mode(ks, advertising, Autoneg); |
868 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_10GB) |
869 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
870 | 10000baseT_Full); |
871 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_5GB) |
872 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
873 | 5000baseT_Full); |
874 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_2_5GB) |
875 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
876 | 2500baseT_Full); |
877 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_1GB) |
878 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
879 | 1000baseT_Full); |
880 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_100MB) |
881 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
882 | 100baseT_Full); |
883 | break; |
884 | case I40E_PHY_TYPE_1000BASE_T_OPTICAL: |
885 | ethtool_link_ksettings_add_link_mode(ks, supported, Autoneg); |
886 | ethtool_link_ksettings_add_link_mode(ks, supported, |
887 | 1000baseT_Full); |
888 | ethtool_link_ksettings_add_link_mode(ks, advertising, Autoneg); |
889 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
890 | 1000baseT_Full); |
891 | break; |
892 | case I40E_PHY_TYPE_10GBASE_CR1_CU: |
893 | case I40E_PHY_TYPE_10GBASE_CR1: |
894 | ethtool_link_ksettings_add_link_mode(ks, supported, Autoneg); |
895 | ethtool_link_ksettings_add_link_mode(ks, supported, |
896 | 10000baseT_Full); |
897 | ethtool_link_ksettings_add_link_mode(ks, advertising, Autoneg); |
898 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
899 | 10000baseT_Full); |
900 | break; |
901 | case I40E_PHY_TYPE_XAUI: |
902 | case I40E_PHY_TYPE_XFI: |
903 | case I40E_PHY_TYPE_SFI: |
904 | case I40E_PHY_TYPE_10GBASE_SFPP_CU: |
905 | case I40E_PHY_TYPE_10GBASE_AOC: |
906 | ethtool_link_ksettings_add_link_mode(ks, supported, |
907 | 10000baseT_Full); |
908 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_10GB) |
909 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
910 | 10000baseT_Full); |
911 | i40e_get_settings_link_up_fec(req_fec_info: hw_link_info->req_fec_info, ks); |
912 | break; |
913 | case I40E_PHY_TYPE_SGMII: |
914 | ethtool_link_ksettings_add_link_mode(ks, supported, Autoneg); |
915 | ethtool_link_ksettings_add_link_mode(ks, supported, |
916 | 1000baseT_Full); |
917 | if (hw_link_info->requested_speeds & I40E_LINK_SPEED_1GB) |
918 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
919 | 1000baseT_Full); |
920 | if (pf->hw_features & I40E_HW_100M_SGMII_CAPABLE) { |
921 | ethtool_link_ksettings_add_link_mode(ks, supported, |
922 | 100baseT_Full); |
923 | if (hw_link_info->requested_speeds & |
924 | I40E_LINK_SPEED_100MB) |
925 | ethtool_link_ksettings_add_link_mode( |
926 | ks, advertising, 100baseT_Full); |
927 | } |
928 | break; |
929 | case I40E_PHY_TYPE_40GBASE_KR4: |
930 | case I40E_PHY_TYPE_25GBASE_KR: |
931 | case I40E_PHY_TYPE_20GBASE_KR2: |
932 | case I40E_PHY_TYPE_10GBASE_KR: |
933 | case I40E_PHY_TYPE_10GBASE_KX4: |
934 | case I40E_PHY_TYPE_1000BASE_KX: |
935 | ethtool_link_ksettings_add_link_mode(ks, supported, |
936 | 40000baseKR4_Full); |
937 | ethtool_link_ksettings_add_link_mode(ks, supported, |
938 | 25000baseKR_Full); |
939 | ethtool_link_ksettings_add_link_mode(ks, supported, |
940 | 20000baseKR2_Full); |
941 | ethtool_link_ksettings_add_link_mode(ks, supported, |
942 | 10000baseKR_Full); |
943 | ethtool_link_ksettings_add_link_mode(ks, supported, |
944 | 10000baseKX4_Full); |
945 | ethtool_link_ksettings_add_link_mode(ks, supported, |
946 | 1000baseKX_Full); |
947 | ethtool_link_ksettings_add_link_mode(ks, supported, Autoneg); |
948 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
949 | 40000baseKR4_Full); |
950 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
951 | 25000baseKR_Full); |
952 | i40e_get_settings_link_up_fec(req_fec_info: hw_link_info->req_fec_info, ks); |
953 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
954 | 20000baseKR2_Full); |
955 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
956 | 10000baseKR_Full); |
957 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
958 | 10000baseKX4_Full); |
959 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
960 | 1000baseKX_Full); |
961 | ethtool_link_ksettings_add_link_mode(ks, advertising, Autoneg); |
962 | break; |
963 | case I40E_PHY_TYPE_25GBASE_CR: |
964 | ethtool_link_ksettings_add_link_mode(ks, supported, Autoneg); |
965 | ethtool_link_ksettings_add_link_mode(ks, advertising, Autoneg); |
966 | ethtool_link_ksettings_add_link_mode(ks, supported, |
967 | 25000baseCR_Full); |
968 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
969 | 25000baseCR_Full); |
970 | i40e_get_settings_link_up_fec(req_fec_info: hw_link_info->req_fec_info, ks); |
971 | |
972 | break; |
973 | case I40E_PHY_TYPE_25GBASE_AOC: |
974 | case I40E_PHY_TYPE_25GBASE_ACC: |
975 | ethtool_link_ksettings_add_link_mode(ks, supported, Autoneg); |
976 | ethtool_link_ksettings_add_link_mode(ks, advertising, Autoneg); |
977 | ethtool_link_ksettings_add_link_mode(ks, supported, |
978 | 25000baseCR_Full); |
979 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
980 | 25000baseCR_Full); |
981 | i40e_get_settings_link_up_fec(req_fec_info: hw_link_info->req_fec_info, ks); |
982 | |
983 | ethtool_link_ksettings_add_link_mode(ks, supported, |
984 | 10000baseCR_Full); |
985 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
986 | 10000baseCR_Full); |
987 | break; |
988 | default: |
989 | /* if we got here and link is up something bad is afoot */ |
990 | netdev_info(dev: netdev, |
991 | format: "WARNING: Link is up but PHY type 0x%x is not recognized, or incorrect cable is in use\n" , |
992 | hw_link_info->phy_type); |
993 | } |
994 | |
995 | /* Now that we've worked out everything that could be supported by the |
996 | * current PHY type, get what is supported by the NVM and intersect |
997 | * them to get what is truly supported |
998 | */ |
999 | memset(&cap_ksettings, 0, sizeof(struct ethtool_link_ksettings)); |
1000 | i40e_phy_type_to_ethtool(pf, ks: &cap_ksettings); |
1001 | ethtool_intersect_link_masks(dst: ks, src: &cap_ksettings); |
1002 | |
1003 | /* Set speed and duplex */ |
1004 | switch (link_speed) { |
1005 | case I40E_LINK_SPEED_40GB: |
1006 | ks->base.speed = SPEED_40000; |
1007 | break; |
1008 | case I40E_LINK_SPEED_25GB: |
1009 | ks->base.speed = SPEED_25000; |
1010 | break; |
1011 | case I40E_LINK_SPEED_20GB: |
1012 | ks->base.speed = SPEED_20000; |
1013 | break; |
1014 | case I40E_LINK_SPEED_10GB: |
1015 | ks->base.speed = SPEED_10000; |
1016 | break; |
1017 | case I40E_LINK_SPEED_5GB: |
1018 | ks->base.speed = SPEED_5000; |
1019 | break; |
1020 | case I40E_LINK_SPEED_2_5GB: |
1021 | ks->base.speed = SPEED_2500; |
1022 | break; |
1023 | case I40E_LINK_SPEED_1GB: |
1024 | ks->base.speed = SPEED_1000; |
1025 | break; |
1026 | case I40E_LINK_SPEED_100MB: |
1027 | ks->base.speed = SPEED_100; |
1028 | break; |
1029 | default: |
1030 | ks->base.speed = SPEED_UNKNOWN; |
1031 | break; |
1032 | } |
1033 | ks->base.duplex = DUPLEX_FULL; |
1034 | } |
1035 | |
1036 | /** |
1037 | * i40e_get_settings_link_down - Get the Link settings for when link is down |
1038 | * @hw: hw structure |
1039 | * @ks: ethtool ksettings to fill in |
1040 | * @pf: pointer to physical function struct |
1041 | * |
1042 | * Reports link settings that can be determined when link is down |
1043 | **/ |
1044 | static void i40e_get_settings_link_down(struct i40e_hw *hw, |
1045 | struct ethtool_link_ksettings *ks, |
1046 | struct i40e_pf *pf) |
1047 | { |
1048 | /* link is down and the driver needs to fall back on |
1049 | * supported phy types to figure out what info to display |
1050 | */ |
1051 | i40e_phy_type_to_ethtool(pf, ks); |
1052 | |
1053 | /* With no link speed and duplex are unknown */ |
1054 | ks->base.speed = SPEED_UNKNOWN; |
1055 | ks->base.duplex = DUPLEX_UNKNOWN; |
1056 | } |
1057 | |
1058 | /** |
1059 | * i40e_get_link_ksettings - Get Link Speed and Duplex settings |
1060 | * @netdev: network interface device structure |
1061 | * @ks: ethtool ksettings |
1062 | * |
1063 | * Reports speed/duplex settings based on media_type |
1064 | **/ |
1065 | static int i40e_get_link_ksettings(struct net_device *netdev, |
1066 | struct ethtool_link_ksettings *ks) |
1067 | { |
1068 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
1069 | struct i40e_pf *pf = np->vsi->back; |
1070 | struct i40e_hw *hw = &pf->hw; |
1071 | struct i40e_link_status *hw_link_info = &hw->phy.link_info; |
1072 | bool link_up = hw_link_info->link_info & I40E_AQ_LINK_UP; |
1073 | |
1074 | ethtool_link_ksettings_zero_link_mode(ks, supported); |
1075 | ethtool_link_ksettings_zero_link_mode(ks, advertising); |
1076 | |
1077 | if (link_up) |
1078 | i40e_get_settings_link_up(hw, ks, netdev, pf); |
1079 | else |
1080 | i40e_get_settings_link_down(hw, ks, pf); |
1081 | |
1082 | /* Now set the settings that don't rely on link being up/down */ |
1083 | /* Set autoneg settings */ |
1084 | ks->base.autoneg = ((hw_link_info->an_info & I40E_AQ_AN_COMPLETED) ? |
1085 | AUTONEG_ENABLE : AUTONEG_DISABLE); |
1086 | |
1087 | /* Set media type settings */ |
1088 | switch (hw->phy.media_type) { |
1089 | case I40E_MEDIA_TYPE_BACKPLANE: |
1090 | ethtool_link_ksettings_add_link_mode(ks, supported, Autoneg); |
1091 | ethtool_link_ksettings_add_link_mode(ks, supported, Backplane); |
1092 | ethtool_link_ksettings_add_link_mode(ks, advertising, Autoneg); |
1093 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
1094 | Backplane); |
1095 | ks->base.port = PORT_NONE; |
1096 | break; |
1097 | case I40E_MEDIA_TYPE_BASET: |
1098 | ethtool_link_ksettings_add_link_mode(ks, supported, TP); |
1099 | ethtool_link_ksettings_add_link_mode(ks, advertising, TP); |
1100 | ks->base.port = PORT_TP; |
1101 | break; |
1102 | case I40E_MEDIA_TYPE_DA: |
1103 | case I40E_MEDIA_TYPE_CX4: |
1104 | ethtool_link_ksettings_add_link_mode(ks, supported, FIBRE); |
1105 | ethtool_link_ksettings_add_link_mode(ks, advertising, FIBRE); |
1106 | ks->base.port = PORT_DA; |
1107 | break; |
1108 | case I40E_MEDIA_TYPE_FIBER: |
1109 | ethtool_link_ksettings_add_link_mode(ks, supported, FIBRE); |
1110 | ethtool_link_ksettings_add_link_mode(ks, advertising, FIBRE); |
1111 | ks->base.port = PORT_FIBRE; |
1112 | break; |
1113 | case I40E_MEDIA_TYPE_UNKNOWN: |
1114 | default: |
1115 | ks->base.port = PORT_OTHER; |
1116 | break; |
1117 | } |
1118 | |
1119 | /* Set flow control settings */ |
1120 | ethtool_link_ksettings_add_link_mode(ks, supported, Pause); |
1121 | ethtool_link_ksettings_add_link_mode(ks, supported, Asym_Pause); |
1122 | |
1123 | switch (hw->fc.requested_mode) { |
1124 | case I40E_FC_FULL: |
1125 | ethtool_link_ksettings_add_link_mode(ks, advertising, Pause); |
1126 | break; |
1127 | case I40E_FC_TX_PAUSE: |
1128 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
1129 | Asym_Pause); |
1130 | break; |
1131 | case I40E_FC_RX_PAUSE: |
1132 | ethtool_link_ksettings_add_link_mode(ks, advertising, Pause); |
1133 | ethtool_link_ksettings_add_link_mode(ks, advertising, |
1134 | Asym_Pause); |
1135 | break; |
1136 | default: |
1137 | ethtool_link_ksettings_del_link_mode(ks, advertising, Pause); |
1138 | ethtool_link_ksettings_del_link_mode(ks, advertising, |
1139 | Asym_Pause); |
1140 | break; |
1141 | } |
1142 | |
1143 | return 0; |
1144 | } |
1145 | |
1146 | #define I40E_LBIT_SIZE 8 |
1147 | /** |
1148 | * i40e_speed_to_link_speed - Translate decimal speed to i40e_aq_link_speed |
1149 | * @speed: speed in decimal |
1150 | * @ks: ethtool ksettings |
1151 | * |
1152 | * Return i40e_aq_link_speed based on speed |
1153 | **/ |
1154 | static enum i40e_aq_link_speed |
1155 | i40e_speed_to_link_speed(__u32 speed, const struct ethtool_link_ksettings *ks) |
1156 | { |
1157 | enum i40e_aq_link_speed link_speed = I40E_LINK_SPEED_UNKNOWN; |
1158 | bool speed_changed = false; |
1159 | int i, j; |
1160 | |
1161 | static const struct { |
1162 | __u32 speed; |
1163 | enum i40e_aq_link_speed link_speed; |
1164 | __u8 bit[I40E_LBIT_SIZE]; |
1165 | } i40e_speed_lut[] = { |
1166 | #define I40E_LBIT(mode) ETHTOOL_LINK_MODE_ ## mode ##_Full_BIT |
1167 | {SPEED_100, I40E_LINK_SPEED_100MB, {I40E_LBIT(100baseT)} }, |
1168 | {SPEED_1000, I40E_LINK_SPEED_1GB, |
1169 | {I40E_LBIT(1000baseT), I40E_LBIT(1000baseX), |
1170 | I40E_LBIT(1000baseKX)} }, |
1171 | {SPEED_10000, I40E_LINK_SPEED_10GB, |
1172 | {I40E_LBIT(10000baseT), I40E_LBIT(10000baseKR), |
1173 | I40E_LBIT(10000baseLR), I40E_LBIT(10000baseCR), |
1174 | I40E_LBIT(10000baseSR), I40E_LBIT(10000baseKX4)} }, |
1175 | |
1176 | {SPEED_25000, I40E_LINK_SPEED_25GB, |
1177 | {I40E_LBIT(25000baseCR), I40E_LBIT(25000baseKR), |
1178 | I40E_LBIT(25000baseSR)} }, |
1179 | {SPEED_40000, I40E_LINK_SPEED_40GB, |
1180 | {I40E_LBIT(40000baseKR4), I40E_LBIT(40000baseCR4), |
1181 | I40E_LBIT(40000baseSR4), I40E_LBIT(40000baseLR4)} }, |
1182 | {SPEED_20000, I40E_LINK_SPEED_20GB, |
1183 | {I40E_LBIT(20000baseKR2)} }, |
1184 | {SPEED_2500, I40E_LINK_SPEED_2_5GB, {I40E_LBIT(2500baseT)} }, |
1185 | {SPEED_5000, I40E_LINK_SPEED_5GB, {I40E_LBIT(2500baseT)} } |
1186 | #undef I40E_LBIT |
1187 | }; |
1188 | |
1189 | for (i = 0; i < ARRAY_SIZE(i40e_speed_lut); i++) { |
1190 | if (i40e_speed_lut[i].speed == speed) { |
1191 | for (j = 0; j < I40E_LBIT_SIZE; j++) { |
1192 | if (test_bit(i40e_speed_lut[i].bit[j], |
1193 | ks->link_modes.supported)) { |
1194 | speed_changed = true; |
1195 | break; |
1196 | } |
1197 | if (!i40e_speed_lut[i].bit[j]) |
1198 | break; |
1199 | } |
1200 | if (speed_changed) { |
1201 | link_speed = i40e_speed_lut[i].link_speed; |
1202 | break; |
1203 | } |
1204 | } |
1205 | } |
1206 | return link_speed; |
1207 | } |
1208 | |
1209 | #undef I40E_LBIT_SIZE |
1210 | |
1211 | /** |
1212 | * i40e_set_link_ksettings - Set Speed and Duplex |
1213 | * @netdev: network interface device structure |
1214 | * @ks: ethtool ksettings |
1215 | * |
1216 | * Set speed/duplex per media_types advertised/forced |
1217 | **/ |
1218 | static int i40e_set_link_ksettings(struct net_device *netdev, |
1219 | const struct ethtool_link_ksettings *ks) |
1220 | { |
1221 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
1222 | struct i40e_aq_get_phy_abilities_resp abilities; |
1223 | struct ethtool_link_ksettings safe_ks; |
1224 | struct ethtool_link_ksettings copy_ks; |
1225 | struct i40e_aq_set_phy_config config; |
1226 | struct i40e_pf *pf = np->vsi->back; |
1227 | enum i40e_aq_link_speed link_speed; |
1228 | struct i40e_vsi *vsi = np->vsi; |
1229 | struct i40e_hw *hw = &pf->hw; |
1230 | bool autoneg_changed = false; |
1231 | int timeout = 50; |
1232 | int status = 0; |
1233 | int err = 0; |
1234 | __u32 speed; |
1235 | u8 autoneg; |
1236 | |
1237 | /* Changing port settings is not supported if this isn't the |
1238 | * port's controlling PF |
1239 | */ |
1240 | if (hw->partition_id != 1) { |
1241 | i40e_partition_setting_complaint(pf); |
1242 | return -EOPNOTSUPP; |
1243 | } |
1244 | if (vsi != pf->vsi[pf->lan_vsi]) |
1245 | return -EOPNOTSUPP; |
1246 | if (hw->phy.media_type != I40E_MEDIA_TYPE_BASET && |
1247 | hw->phy.media_type != I40E_MEDIA_TYPE_FIBER && |
1248 | hw->phy.media_type != I40E_MEDIA_TYPE_BACKPLANE && |
1249 | hw->phy.media_type != I40E_MEDIA_TYPE_DA && |
1250 | hw->phy.link_info.link_info & I40E_AQ_LINK_UP) |
1251 | return -EOPNOTSUPP; |
1252 | if (hw->device_id == I40E_DEV_ID_KX_B || |
1253 | hw->device_id == I40E_DEV_ID_KX_C || |
1254 | hw->device_id == I40E_DEV_ID_20G_KR2 || |
1255 | hw->device_id == I40E_DEV_ID_20G_KR2_A || |
1256 | hw->device_id == I40E_DEV_ID_25G_B || |
1257 | hw->device_id == I40E_DEV_ID_KX_X722) { |
1258 | netdev_info(dev: netdev, format: "Changing settings is not supported on backplane.\n" ); |
1259 | return -EOPNOTSUPP; |
1260 | } |
1261 | |
1262 | /* copy the ksettings to copy_ks to avoid modifying the origin */ |
1263 | memcpy(©_ks, ks, sizeof(struct ethtool_link_ksettings)); |
1264 | |
1265 | /* save autoneg out of ksettings */ |
1266 | autoneg = copy_ks.base.autoneg; |
1267 | speed = copy_ks.base.speed; |
1268 | |
1269 | /* get our own copy of the bits to check against */ |
1270 | memset(&safe_ks, 0, sizeof(struct ethtool_link_ksettings)); |
1271 | safe_ks.base.cmd = copy_ks.base.cmd; |
1272 | safe_ks.base.link_mode_masks_nwords = |
1273 | copy_ks.base.link_mode_masks_nwords; |
1274 | i40e_get_link_ksettings(netdev, ks: &safe_ks); |
1275 | |
1276 | /* Get link modes supported by hardware and check against modes |
1277 | * requested by the user. Return an error if unsupported mode was set. |
1278 | */ |
1279 | if (!bitmap_subset(src1: copy_ks.link_modes.advertising, |
1280 | src2: safe_ks.link_modes.supported, |
1281 | nbits: __ETHTOOL_LINK_MODE_MASK_NBITS)) |
1282 | return -EINVAL; |
1283 | |
1284 | /* set autoneg back to what it currently is */ |
1285 | copy_ks.base.autoneg = safe_ks.base.autoneg; |
1286 | copy_ks.base.speed = safe_ks.base.speed; |
1287 | |
1288 | /* If copy_ks.base and safe_ks.base are not the same now, then they are |
1289 | * trying to set something that we do not support. |
1290 | */ |
1291 | if (memcmp(p: ©_ks.base, q: &safe_ks.base, |
1292 | size: sizeof(struct ethtool_link_settings))) { |
1293 | netdev_err(dev: netdev, format: "Only speed and autoneg are supported.\n" ); |
1294 | return -EOPNOTSUPP; |
1295 | } |
1296 | |
1297 | while (test_and_set_bit(nr: __I40E_CONFIG_BUSY, addr: pf->state)) { |
1298 | timeout--; |
1299 | if (!timeout) |
1300 | return -EBUSY; |
1301 | usleep_range(min: 1000, max: 2000); |
1302 | } |
1303 | |
1304 | /* Get the current phy config */ |
1305 | status = i40e_aq_get_phy_capabilities(hw, qualified_modules: false, report_init: false, abilities: &abilities, |
1306 | NULL); |
1307 | if (status) { |
1308 | err = -EAGAIN; |
1309 | goto done; |
1310 | } |
1311 | |
1312 | /* Copy abilities to config in case autoneg is not |
1313 | * set below |
1314 | */ |
1315 | memset(&config, 0, sizeof(struct i40e_aq_set_phy_config)); |
1316 | config.abilities = abilities.abilities; |
1317 | |
1318 | /* Check autoneg */ |
1319 | if (autoneg == AUTONEG_ENABLE) { |
1320 | /* If autoneg was not already enabled */ |
1321 | if (!(hw->phy.link_info.an_info & I40E_AQ_AN_COMPLETED)) { |
1322 | /* If autoneg is not supported, return error */ |
1323 | if (!ethtool_link_ksettings_test_link_mode(&safe_ks, |
1324 | supported, |
1325 | Autoneg)) { |
1326 | netdev_info(dev: netdev, format: "Autoneg not supported on this phy\n" ); |
1327 | err = -EINVAL; |
1328 | goto done; |
1329 | } |
1330 | /* Autoneg is allowed to change */ |
1331 | config.abilities = abilities.abilities | |
1332 | I40E_AQ_PHY_ENABLE_AN; |
1333 | autoneg_changed = true; |
1334 | } |
1335 | } else { |
1336 | /* If autoneg is currently enabled */ |
1337 | if (hw->phy.link_info.an_info & I40E_AQ_AN_COMPLETED) { |
1338 | /* If autoneg is supported 10GBASE_T is the only PHY |
1339 | * that can disable it, so otherwise return error |
1340 | */ |
1341 | if (ethtool_link_ksettings_test_link_mode(&safe_ks, |
1342 | supported, |
1343 | Autoneg) && |
1344 | hw->phy.media_type != I40E_MEDIA_TYPE_BASET) { |
1345 | netdev_info(dev: netdev, format: "Autoneg cannot be disabled on this phy\n" ); |
1346 | err = -EINVAL; |
1347 | goto done; |
1348 | } |
1349 | /* Autoneg is allowed to change */ |
1350 | config.abilities = abilities.abilities & |
1351 | ~I40E_AQ_PHY_ENABLE_AN; |
1352 | autoneg_changed = true; |
1353 | } |
1354 | } |
1355 | |
1356 | if (ethtool_link_ksettings_test_link_mode(ks, advertising, |
1357 | 100baseT_Full)) |
1358 | config.link_speed |= I40E_LINK_SPEED_100MB; |
1359 | if (ethtool_link_ksettings_test_link_mode(ks, advertising, |
1360 | 1000baseT_Full) || |
1361 | ethtool_link_ksettings_test_link_mode(ks, advertising, |
1362 | 1000baseX_Full) || |
1363 | ethtool_link_ksettings_test_link_mode(ks, advertising, |
1364 | 1000baseKX_Full)) |
1365 | config.link_speed |= I40E_LINK_SPEED_1GB; |
1366 | if (ethtool_link_ksettings_test_link_mode(ks, advertising, |
1367 | 10000baseT_Full) || |
1368 | ethtool_link_ksettings_test_link_mode(ks, advertising, |
1369 | 10000baseKX4_Full) || |
1370 | ethtool_link_ksettings_test_link_mode(ks, advertising, |
1371 | 10000baseKR_Full) || |
1372 | ethtool_link_ksettings_test_link_mode(ks, advertising, |
1373 | 10000baseCR_Full) || |
1374 | ethtool_link_ksettings_test_link_mode(ks, advertising, |
1375 | 10000baseSR_Full) || |
1376 | ethtool_link_ksettings_test_link_mode(ks, advertising, |
1377 | 10000baseLR_Full)) |
1378 | config.link_speed |= I40E_LINK_SPEED_10GB; |
1379 | if (ethtool_link_ksettings_test_link_mode(ks, advertising, |
1380 | 2500baseT_Full)) |
1381 | config.link_speed |= I40E_LINK_SPEED_2_5GB; |
1382 | if (ethtool_link_ksettings_test_link_mode(ks, advertising, |
1383 | 5000baseT_Full)) |
1384 | config.link_speed |= I40E_LINK_SPEED_5GB; |
1385 | if (ethtool_link_ksettings_test_link_mode(ks, advertising, |
1386 | 20000baseKR2_Full)) |
1387 | config.link_speed |= I40E_LINK_SPEED_20GB; |
1388 | if (ethtool_link_ksettings_test_link_mode(ks, advertising, |
1389 | 25000baseCR_Full) || |
1390 | ethtool_link_ksettings_test_link_mode(ks, advertising, |
1391 | 25000baseKR_Full) || |
1392 | ethtool_link_ksettings_test_link_mode(ks, advertising, |
1393 | 25000baseSR_Full)) |
1394 | config.link_speed |= I40E_LINK_SPEED_25GB; |
1395 | if (ethtool_link_ksettings_test_link_mode(ks, advertising, |
1396 | 40000baseKR4_Full) || |
1397 | ethtool_link_ksettings_test_link_mode(ks, advertising, |
1398 | 40000baseCR4_Full) || |
1399 | ethtool_link_ksettings_test_link_mode(ks, advertising, |
1400 | 40000baseSR4_Full) || |
1401 | ethtool_link_ksettings_test_link_mode(ks, advertising, |
1402 | 40000baseLR4_Full)) |
1403 | config.link_speed |= I40E_LINK_SPEED_40GB; |
1404 | |
1405 | /* Autonegotiation must be disabled to change speed */ |
1406 | if ((speed != SPEED_UNKNOWN && safe_ks.base.speed != speed) && |
1407 | (autoneg == AUTONEG_DISABLE || |
1408 | (safe_ks.base.autoneg == AUTONEG_DISABLE && !autoneg_changed))) { |
1409 | link_speed = i40e_speed_to_link_speed(speed, ks); |
1410 | if (link_speed == I40E_LINK_SPEED_UNKNOWN) { |
1411 | netdev_info(dev: netdev, format: "Given speed is not supported\n" ); |
1412 | err = -EOPNOTSUPP; |
1413 | goto done; |
1414 | } else { |
1415 | config.link_speed = link_speed; |
1416 | } |
1417 | } else { |
1418 | if (safe_ks.base.speed != speed) { |
1419 | netdev_info(dev: netdev, |
1420 | format: "Unable to set speed, disable autoneg\n" ); |
1421 | err = -EOPNOTSUPP; |
1422 | goto done; |
1423 | } |
1424 | } |
1425 | |
1426 | /* If speed didn't get set, set it to what it currently is. |
1427 | * This is needed because if advertise is 0 (as it is when autoneg |
1428 | * is disabled) then speed won't get set. |
1429 | */ |
1430 | if (!config.link_speed) |
1431 | config.link_speed = abilities.link_speed; |
1432 | if (autoneg_changed || abilities.link_speed != config.link_speed) { |
1433 | /* copy over the rest of the abilities */ |
1434 | config.phy_type = abilities.phy_type; |
1435 | config.phy_type_ext = abilities.phy_type_ext; |
1436 | config.eee_capability = abilities.eee_capability; |
1437 | config.eeer = abilities.eeer_val; |
1438 | config.low_power_ctrl = abilities.d3_lpan; |
1439 | config.fec_config = abilities.fec_cfg_curr_mod_ext_info & |
1440 | I40E_AQ_PHY_FEC_CONFIG_MASK; |
1441 | |
1442 | /* save the requested speeds */ |
1443 | hw->phy.link_info.requested_speeds = config.link_speed; |
1444 | /* set link and auto negotiation so changes take effect */ |
1445 | config.abilities |= I40E_AQ_PHY_ENABLE_ATOMIC_LINK; |
1446 | /* If link is up put link down */ |
1447 | if (hw->phy.link_info.link_info & I40E_AQ_LINK_UP) { |
1448 | /* Tell the OS link is going down, the link will go |
1449 | * back up when fw says it is ready asynchronously |
1450 | */ |
1451 | i40e_print_link_message(vsi, isup: false); |
1452 | netif_carrier_off(dev: netdev); |
1453 | netif_tx_stop_all_queues(dev: netdev); |
1454 | } |
1455 | |
1456 | /* make the aq call */ |
1457 | status = i40e_aq_set_phy_config(hw, config: &config, NULL); |
1458 | if (status) { |
1459 | netdev_info(dev: netdev, |
1460 | format: "Set phy config failed, err %pe aq_err %s\n" , |
1461 | ERR_PTR(error: status), |
1462 | i40e_aq_str(hw, aq_err: hw->aq.asq_last_status)); |
1463 | err = -EAGAIN; |
1464 | goto done; |
1465 | } |
1466 | |
1467 | status = i40e_update_link_info(hw); |
1468 | if (status) |
1469 | netdev_dbg(netdev, |
1470 | "Updating link info failed with err %pe aq_err %s\n" , |
1471 | ERR_PTR(status), |
1472 | i40e_aq_str(hw, hw->aq.asq_last_status)); |
1473 | |
1474 | } else { |
1475 | netdev_info(dev: netdev, format: "Nothing changed, exiting without setting anything.\n" ); |
1476 | } |
1477 | |
1478 | done: |
1479 | clear_bit(nr: __I40E_CONFIG_BUSY, addr: pf->state); |
1480 | |
1481 | return err; |
1482 | } |
1483 | |
1484 | static int i40e_set_fec_cfg(struct net_device *netdev, u8 fec_cfg) |
1485 | { |
1486 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
1487 | struct i40e_aq_get_phy_abilities_resp abilities; |
1488 | struct i40e_pf *pf = np->vsi->back; |
1489 | struct i40e_hw *hw = &pf->hw; |
1490 | int status = 0; |
1491 | u32 flags = 0; |
1492 | int err = 0; |
1493 | |
1494 | flags = READ_ONCE(pf->flags); |
1495 | i40e_set_fec_in_flags(fec_cfg, flags: &flags); |
1496 | |
1497 | /* Get the current phy config */ |
1498 | memset(&abilities, 0, sizeof(abilities)); |
1499 | status = i40e_aq_get_phy_capabilities(hw, qualified_modules: false, report_init: false, abilities: &abilities, |
1500 | NULL); |
1501 | if (status) { |
1502 | err = -EAGAIN; |
1503 | goto done; |
1504 | } |
1505 | |
1506 | if (abilities.fec_cfg_curr_mod_ext_info != fec_cfg) { |
1507 | struct i40e_aq_set_phy_config config; |
1508 | |
1509 | memset(&config, 0, sizeof(config)); |
1510 | config.phy_type = abilities.phy_type; |
1511 | config.abilities = abilities.abilities | |
1512 | I40E_AQ_PHY_ENABLE_ATOMIC_LINK; |
1513 | config.phy_type_ext = abilities.phy_type_ext; |
1514 | config.link_speed = abilities.link_speed; |
1515 | config.eee_capability = abilities.eee_capability; |
1516 | config.eeer = abilities.eeer_val; |
1517 | config.low_power_ctrl = abilities.d3_lpan; |
1518 | config.fec_config = fec_cfg & I40E_AQ_PHY_FEC_CONFIG_MASK; |
1519 | status = i40e_aq_set_phy_config(hw, config: &config, NULL); |
1520 | if (status) { |
1521 | netdev_info(dev: netdev, |
1522 | format: "Set phy config failed, err %pe aq_err %s\n" , |
1523 | ERR_PTR(error: status), |
1524 | i40e_aq_str(hw, aq_err: hw->aq.asq_last_status)); |
1525 | err = -EAGAIN; |
1526 | goto done; |
1527 | } |
1528 | pf->flags = flags; |
1529 | status = i40e_update_link_info(hw); |
1530 | if (status) |
1531 | /* debug level message only due to relation to the link |
1532 | * itself rather than to the FEC settings |
1533 | * (e.g. no physical connection etc.) |
1534 | */ |
1535 | netdev_dbg(netdev, |
1536 | "Updating link info failed with err %pe aq_err %s\n" , |
1537 | ERR_PTR(status), |
1538 | i40e_aq_str(hw, hw->aq.asq_last_status)); |
1539 | } |
1540 | |
1541 | done: |
1542 | return err; |
1543 | } |
1544 | |
1545 | static int i40e_get_fec_param(struct net_device *netdev, |
1546 | struct ethtool_fecparam *fecparam) |
1547 | { |
1548 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
1549 | struct i40e_aq_get_phy_abilities_resp abilities; |
1550 | struct i40e_pf *pf = np->vsi->back; |
1551 | struct i40e_hw *hw = &pf->hw; |
1552 | int status = 0; |
1553 | int err = 0; |
1554 | u8 fec_cfg; |
1555 | |
1556 | /* Get the current phy config */ |
1557 | memset(&abilities, 0, sizeof(abilities)); |
1558 | status = i40e_aq_get_phy_capabilities(hw, qualified_modules: false, report_init: false, abilities: &abilities, |
1559 | NULL); |
1560 | if (status) { |
1561 | err = -EAGAIN; |
1562 | goto done; |
1563 | } |
1564 | |
1565 | fecparam->fec = 0; |
1566 | fec_cfg = abilities.fec_cfg_curr_mod_ext_info; |
1567 | if (fec_cfg & I40E_AQ_SET_FEC_AUTO) |
1568 | fecparam->fec |= ETHTOOL_FEC_AUTO; |
1569 | else if (fec_cfg & (I40E_AQ_SET_FEC_REQUEST_RS | |
1570 | I40E_AQ_SET_FEC_ABILITY_RS)) |
1571 | fecparam->fec |= ETHTOOL_FEC_RS; |
1572 | else if (fec_cfg & (I40E_AQ_SET_FEC_REQUEST_KR | |
1573 | I40E_AQ_SET_FEC_ABILITY_KR)) |
1574 | fecparam->fec |= ETHTOOL_FEC_BASER; |
1575 | if (fec_cfg == 0) |
1576 | fecparam->fec |= ETHTOOL_FEC_OFF; |
1577 | |
1578 | if (hw->phy.link_info.fec_info & I40E_AQ_CONFIG_FEC_KR_ENA) |
1579 | fecparam->active_fec = ETHTOOL_FEC_BASER; |
1580 | else if (hw->phy.link_info.fec_info & I40E_AQ_CONFIG_FEC_RS_ENA) |
1581 | fecparam->active_fec = ETHTOOL_FEC_RS; |
1582 | else |
1583 | fecparam->active_fec = ETHTOOL_FEC_OFF; |
1584 | done: |
1585 | return err; |
1586 | } |
1587 | |
1588 | static int i40e_set_fec_param(struct net_device *netdev, |
1589 | struct ethtool_fecparam *fecparam) |
1590 | { |
1591 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
1592 | struct i40e_pf *pf = np->vsi->back; |
1593 | struct i40e_hw *hw = &pf->hw; |
1594 | u8 fec_cfg = 0; |
1595 | |
1596 | if (hw->device_id != I40E_DEV_ID_25G_SFP28 && |
1597 | hw->device_id != I40E_DEV_ID_25G_B && |
1598 | hw->device_id != I40E_DEV_ID_KX_X722) |
1599 | return -EPERM; |
1600 | |
1601 | if (hw->mac.type == I40E_MAC_X722 && |
1602 | !(hw->flags & I40E_HW_FLAG_X722_FEC_REQUEST_CAPABLE)) { |
1603 | netdev_err(dev: netdev, format: "Setting FEC encoding not supported by firmware. Please update the NVM image.\n" ); |
1604 | return -EOPNOTSUPP; |
1605 | } |
1606 | |
1607 | switch (fecparam->fec) { |
1608 | case ETHTOOL_FEC_AUTO: |
1609 | fec_cfg = I40E_AQ_SET_FEC_AUTO; |
1610 | break; |
1611 | case ETHTOOL_FEC_RS: |
1612 | fec_cfg = (I40E_AQ_SET_FEC_REQUEST_RS | |
1613 | I40E_AQ_SET_FEC_ABILITY_RS); |
1614 | break; |
1615 | case ETHTOOL_FEC_BASER: |
1616 | fec_cfg = (I40E_AQ_SET_FEC_REQUEST_KR | |
1617 | I40E_AQ_SET_FEC_ABILITY_KR); |
1618 | break; |
1619 | case ETHTOOL_FEC_OFF: |
1620 | case ETHTOOL_FEC_NONE: |
1621 | fec_cfg = 0; |
1622 | break; |
1623 | default: |
1624 | dev_warn(&pf->pdev->dev, "Unsupported FEC mode: %d" , |
1625 | fecparam->fec); |
1626 | return -EINVAL; |
1627 | } |
1628 | |
1629 | return i40e_set_fec_cfg(netdev, fec_cfg); |
1630 | } |
1631 | |
1632 | static int i40e_nway_reset(struct net_device *netdev) |
1633 | { |
1634 | /* restart autonegotiation */ |
1635 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
1636 | struct i40e_pf *pf = np->vsi->back; |
1637 | struct i40e_hw *hw = &pf->hw; |
1638 | bool link_up = hw->phy.link_info.link_info & I40E_AQ_LINK_UP; |
1639 | int ret = 0; |
1640 | |
1641 | ret = i40e_aq_set_link_restart_an(hw, enable_link: link_up, NULL); |
1642 | if (ret) { |
1643 | netdev_info(dev: netdev, format: "link restart failed, err %pe aq_err %s\n" , |
1644 | ERR_PTR(error: ret), |
1645 | i40e_aq_str(hw, aq_err: hw->aq.asq_last_status)); |
1646 | return -EIO; |
1647 | } |
1648 | |
1649 | return 0; |
1650 | } |
1651 | |
1652 | /** |
1653 | * i40e_get_pauseparam - Get Flow Control status |
1654 | * @netdev: netdevice structure |
1655 | * @pause: buffer to return pause parameters |
1656 | * |
1657 | * Return tx/rx-pause status |
1658 | **/ |
1659 | static void i40e_get_pauseparam(struct net_device *netdev, |
1660 | struct ethtool_pauseparam *pause) |
1661 | { |
1662 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
1663 | struct i40e_pf *pf = np->vsi->back; |
1664 | struct i40e_hw *hw = &pf->hw; |
1665 | struct i40e_link_status *hw_link_info = &hw->phy.link_info; |
1666 | struct i40e_dcbx_config *dcbx_cfg = &hw->local_dcbx_config; |
1667 | |
1668 | pause->autoneg = |
1669 | ((hw_link_info->an_info & I40E_AQ_AN_COMPLETED) ? |
1670 | AUTONEG_ENABLE : AUTONEG_DISABLE); |
1671 | |
1672 | /* PFC enabled so report LFC as off */ |
1673 | if (dcbx_cfg->pfc.pfcenable) { |
1674 | pause->rx_pause = 0; |
1675 | pause->tx_pause = 0; |
1676 | return; |
1677 | } |
1678 | |
1679 | if (hw->fc.current_mode == I40E_FC_RX_PAUSE) { |
1680 | pause->rx_pause = 1; |
1681 | } else if (hw->fc.current_mode == I40E_FC_TX_PAUSE) { |
1682 | pause->tx_pause = 1; |
1683 | } else if (hw->fc.current_mode == I40E_FC_FULL) { |
1684 | pause->rx_pause = 1; |
1685 | pause->tx_pause = 1; |
1686 | } |
1687 | } |
1688 | |
1689 | /** |
1690 | * i40e_set_pauseparam - Set Flow Control parameter |
1691 | * @netdev: network interface device structure |
1692 | * @pause: return tx/rx flow control status |
1693 | **/ |
1694 | static int i40e_set_pauseparam(struct net_device *netdev, |
1695 | struct ethtool_pauseparam *pause) |
1696 | { |
1697 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
1698 | struct i40e_pf *pf = np->vsi->back; |
1699 | struct i40e_vsi *vsi = np->vsi; |
1700 | struct i40e_hw *hw = &pf->hw; |
1701 | struct i40e_link_status *hw_link_info = &hw->phy.link_info; |
1702 | struct i40e_dcbx_config *dcbx_cfg = &hw->local_dcbx_config; |
1703 | bool link_up = hw_link_info->link_info & I40E_AQ_LINK_UP; |
1704 | u8 aq_failures; |
1705 | int err = 0; |
1706 | int status; |
1707 | u32 is_an; |
1708 | |
1709 | /* Changing the port's flow control is not supported if this isn't the |
1710 | * port's controlling PF |
1711 | */ |
1712 | if (hw->partition_id != 1) { |
1713 | i40e_partition_setting_complaint(pf); |
1714 | return -EOPNOTSUPP; |
1715 | } |
1716 | |
1717 | if (vsi != pf->vsi[pf->lan_vsi]) |
1718 | return -EOPNOTSUPP; |
1719 | |
1720 | is_an = hw_link_info->an_info & I40E_AQ_AN_COMPLETED; |
1721 | if (pause->autoneg != is_an) { |
1722 | netdev_info(dev: netdev, format: "To change autoneg please use: ethtool -s <dev> autoneg <on|off>\n" ); |
1723 | return -EOPNOTSUPP; |
1724 | } |
1725 | |
1726 | /* If we have link and don't have autoneg */ |
1727 | if (!test_bit(__I40E_DOWN, pf->state) && !is_an) { |
1728 | /* Send message that it might not necessarily work*/ |
1729 | netdev_info(dev: netdev, format: "Autoneg did not complete so changing settings may not result in an actual change.\n" ); |
1730 | } |
1731 | |
1732 | if (dcbx_cfg->pfc.pfcenable) { |
1733 | netdev_info(dev: netdev, |
1734 | format: "Priority flow control enabled. Cannot set link flow control.\n" ); |
1735 | return -EOPNOTSUPP; |
1736 | } |
1737 | |
1738 | if (pause->rx_pause && pause->tx_pause) |
1739 | hw->fc.requested_mode = I40E_FC_FULL; |
1740 | else if (pause->rx_pause && !pause->tx_pause) |
1741 | hw->fc.requested_mode = I40E_FC_RX_PAUSE; |
1742 | else if (!pause->rx_pause && pause->tx_pause) |
1743 | hw->fc.requested_mode = I40E_FC_TX_PAUSE; |
1744 | else if (!pause->rx_pause && !pause->tx_pause) |
1745 | hw->fc.requested_mode = I40E_FC_NONE; |
1746 | else |
1747 | return -EINVAL; |
1748 | |
1749 | /* Tell the OS link is going down, the link will go back up when fw |
1750 | * says it is ready asynchronously |
1751 | */ |
1752 | i40e_print_link_message(vsi, isup: false); |
1753 | netif_carrier_off(dev: netdev); |
1754 | netif_tx_stop_all_queues(dev: netdev); |
1755 | |
1756 | /* Set the fc mode and only restart an if link is up*/ |
1757 | status = i40e_set_fc(hw, aq_failures: &aq_failures, atomic_reset: link_up); |
1758 | |
1759 | if (aq_failures & I40E_SET_FC_AQ_FAIL_GET) { |
1760 | netdev_info(dev: netdev, format: "Set fc failed on the get_phy_capabilities call with err %pe aq_err %s\n" , |
1761 | ERR_PTR(error: status), |
1762 | i40e_aq_str(hw, aq_err: hw->aq.asq_last_status)); |
1763 | err = -EAGAIN; |
1764 | } |
1765 | if (aq_failures & I40E_SET_FC_AQ_FAIL_SET) { |
1766 | netdev_info(dev: netdev, format: "Set fc failed on the set_phy_config call with err %pe aq_err %s\n" , |
1767 | ERR_PTR(error: status), |
1768 | i40e_aq_str(hw, aq_err: hw->aq.asq_last_status)); |
1769 | err = -EAGAIN; |
1770 | } |
1771 | if (aq_failures & I40E_SET_FC_AQ_FAIL_UPDATE) { |
1772 | netdev_info(dev: netdev, format: "Set fc failed on the get_link_info call with err %pe aq_err %s\n" , |
1773 | ERR_PTR(error: status), |
1774 | i40e_aq_str(hw, aq_err: hw->aq.asq_last_status)); |
1775 | err = -EAGAIN; |
1776 | } |
1777 | |
1778 | if (!test_bit(__I40E_DOWN, pf->state) && is_an) { |
1779 | /* Give it a little more time to try to come back */ |
1780 | msleep(msecs: 75); |
1781 | if (!test_bit(__I40E_DOWN, pf->state)) |
1782 | return i40e_nway_reset(netdev); |
1783 | } |
1784 | |
1785 | return err; |
1786 | } |
1787 | |
1788 | static u32 i40e_get_msglevel(struct net_device *netdev) |
1789 | { |
1790 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
1791 | struct i40e_pf *pf = np->vsi->back; |
1792 | u32 debug_mask = pf->hw.debug_mask; |
1793 | |
1794 | if (debug_mask) |
1795 | netdev_info(dev: netdev, format: "i40e debug_mask: 0x%08X\n" , debug_mask); |
1796 | |
1797 | return pf->msg_enable; |
1798 | } |
1799 | |
1800 | static void i40e_set_msglevel(struct net_device *netdev, u32 data) |
1801 | { |
1802 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
1803 | struct i40e_pf *pf = np->vsi->back; |
1804 | |
1805 | if (I40E_DEBUG_USER & data) |
1806 | pf->hw.debug_mask = data; |
1807 | else |
1808 | pf->msg_enable = data; |
1809 | } |
1810 | |
1811 | static int i40e_get_regs_len(struct net_device *netdev) |
1812 | { |
1813 | int reg_count = 0; |
1814 | int i; |
1815 | |
1816 | for (i = 0; i40e_reg_list[i].offset != 0; i++) |
1817 | reg_count += i40e_reg_list[i].elements; |
1818 | |
1819 | return reg_count * sizeof(u32); |
1820 | } |
1821 | |
1822 | static void i40e_get_regs(struct net_device *netdev, struct ethtool_regs *regs, |
1823 | void *p) |
1824 | { |
1825 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
1826 | struct i40e_pf *pf = np->vsi->back; |
1827 | struct i40e_hw *hw = &pf->hw; |
1828 | u32 *reg_buf = p; |
1829 | unsigned int i, j, ri; |
1830 | u32 reg; |
1831 | |
1832 | /* Tell ethtool which driver-version-specific regs output we have. |
1833 | * |
1834 | * At some point, if we have ethtool doing special formatting of |
1835 | * this data, it will rely on this version number to know how to |
1836 | * interpret things. Hence, this needs to be updated if/when the |
1837 | * diags register table is changed. |
1838 | */ |
1839 | regs->version = 1; |
1840 | |
1841 | /* loop through the diags reg table for what to print */ |
1842 | ri = 0; |
1843 | for (i = 0; i40e_reg_list[i].offset != 0; i++) { |
1844 | for (j = 0; j < i40e_reg_list[i].elements; j++) { |
1845 | reg = i40e_reg_list[i].offset |
1846 | + (j * i40e_reg_list[i].stride); |
1847 | reg_buf[ri++] = rd32(hw, reg); |
1848 | } |
1849 | } |
1850 | |
1851 | } |
1852 | |
1853 | static int i40e_get_eeprom(struct net_device *netdev, |
1854 | struct ethtool_eeprom *eeprom, u8 *bytes) |
1855 | { |
1856 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
1857 | struct i40e_hw *hw = &np->vsi->back->hw; |
1858 | struct i40e_pf *pf = np->vsi->back; |
1859 | int ret_val = 0, len, offset; |
1860 | u8 *eeprom_buff; |
1861 | u16 i, sectors; |
1862 | bool last; |
1863 | u32 magic; |
1864 | |
1865 | #define I40E_NVM_SECTOR_SIZE 4096 |
1866 | if (eeprom->len == 0) |
1867 | return -EINVAL; |
1868 | |
1869 | /* check for NVMUpdate access method */ |
1870 | magic = hw->vendor_id | (hw->device_id << 16); |
1871 | if (eeprom->magic && eeprom->magic != magic) { |
1872 | struct i40e_nvm_access *cmd = (struct i40e_nvm_access *)eeprom; |
1873 | int errno = 0; |
1874 | |
1875 | /* make sure it is the right magic for NVMUpdate */ |
1876 | if ((eeprom->magic >> 16) != hw->device_id) |
1877 | errno = -EINVAL; |
1878 | else if (test_bit(__I40E_RESET_RECOVERY_PENDING, pf->state) || |
1879 | test_bit(__I40E_RESET_INTR_RECEIVED, pf->state)) |
1880 | errno = -EBUSY; |
1881 | else |
1882 | ret_val = i40e_nvmupd_command(hw, cmd, bytes, errno: &errno); |
1883 | |
1884 | if ((errno || ret_val) && (hw->debug_mask & I40E_DEBUG_NVM)) |
1885 | dev_info(&pf->pdev->dev, |
1886 | "NVMUpdate read failed err=%d status=0x%x errno=%d module=%d offset=0x%x size=%d\n" , |
1887 | ret_val, hw->aq.asq_last_status, errno, |
1888 | (u8)(cmd->config & I40E_NVM_MOD_PNT_MASK), |
1889 | cmd->offset, cmd->data_size); |
1890 | |
1891 | return errno; |
1892 | } |
1893 | |
1894 | /* normal ethtool get_eeprom support */ |
1895 | eeprom->magic = hw->vendor_id | (hw->device_id << 16); |
1896 | |
1897 | eeprom_buff = kzalloc(size: eeprom->len, GFP_KERNEL); |
1898 | if (!eeprom_buff) |
1899 | return -ENOMEM; |
1900 | |
1901 | ret_val = i40e_acquire_nvm(hw, access: I40E_RESOURCE_READ); |
1902 | if (ret_val) { |
1903 | dev_info(&pf->pdev->dev, |
1904 | "Failed Acquiring NVM resource for read err=%d status=0x%x\n" , |
1905 | ret_val, hw->aq.asq_last_status); |
1906 | goto free_buff; |
1907 | } |
1908 | |
1909 | sectors = eeprom->len / I40E_NVM_SECTOR_SIZE; |
1910 | sectors += (eeprom->len % I40E_NVM_SECTOR_SIZE) ? 1 : 0; |
1911 | len = I40E_NVM_SECTOR_SIZE; |
1912 | last = false; |
1913 | for (i = 0; i < sectors; i++) { |
1914 | if (i == (sectors - 1)) { |
1915 | len = eeprom->len - (I40E_NVM_SECTOR_SIZE * i); |
1916 | last = true; |
1917 | } |
1918 | offset = eeprom->offset + (I40E_NVM_SECTOR_SIZE * i), |
1919 | ret_val = i40e_aq_read_nvm(hw, module_pointer: 0x0, offset, length: len, |
1920 | data: (u8 *)eeprom_buff + (I40E_NVM_SECTOR_SIZE * i), |
1921 | last_command: last, NULL); |
1922 | if (ret_val && hw->aq.asq_last_status == I40E_AQ_RC_EPERM) { |
1923 | dev_info(&pf->pdev->dev, |
1924 | "read NVM failed, invalid offset 0x%x\n" , |
1925 | offset); |
1926 | break; |
1927 | } else if (ret_val && |
1928 | hw->aq.asq_last_status == I40E_AQ_RC_EACCES) { |
1929 | dev_info(&pf->pdev->dev, |
1930 | "read NVM failed, access, offset 0x%x\n" , |
1931 | offset); |
1932 | break; |
1933 | } else if (ret_val) { |
1934 | dev_info(&pf->pdev->dev, |
1935 | "read NVM failed offset %d err=%d status=0x%x\n" , |
1936 | offset, ret_val, hw->aq.asq_last_status); |
1937 | break; |
1938 | } |
1939 | } |
1940 | |
1941 | i40e_release_nvm(hw); |
1942 | memcpy(bytes, (u8 *)eeprom_buff, eeprom->len); |
1943 | free_buff: |
1944 | kfree(objp: eeprom_buff); |
1945 | return ret_val; |
1946 | } |
1947 | |
1948 | static int i40e_get_eeprom_len(struct net_device *netdev) |
1949 | { |
1950 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
1951 | struct i40e_hw *hw = &np->vsi->back->hw; |
1952 | u32 val; |
1953 | |
1954 | #define X722_EEPROM_SCOPE_LIMIT 0x5B9FFF |
1955 | if (hw->mac.type == I40E_MAC_X722) { |
1956 | val = X722_EEPROM_SCOPE_LIMIT + 1; |
1957 | return val; |
1958 | } |
1959 | val = (rd32(hw, I40E_GLPCI_LBARCTRL) |
1960 | & I40E_GLPCI_LBARCTRL_FL_SIZE_MASK) |
1961 | >> I40E_GLPCI_LBARCTRL_FL_SIZE_SHIFT; |
1962 | /* register returns value in power of 2, 64Kbyte chunks. */ |
1963 | val = (64 * 1024) * BIT(val); |
1964 | return val; |
1965 | } |
1966 | |
1967 | static int i40e_set_eeprom(struct net_device *netdev, |
1968 | struct ethtool_eeprom *eeprom, u8 *bytes) |
1969 | { |
1970 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
1971 | struct i40e_hw *hw = &np->vsi->back->hw; |
1972 | struct i40e_pf *pf = np->vsi->back; |
1973 | struct i40e_nvm_access *cmd = (struct i40e_nvm_access *)eeprom; |
1974 | int ret_val = 0; |
1975 | int errno = 0; |
1976 | u32 magic; |
1977 | |
1978 | /* normal ethtool set_eeprom is not supported */ |
1979 | magic = hw->vendor_id | (hw->device_id << 16); |
1980 | if (eeprom->magic == magic) |
1981 | errno = -EOPNOTSUPP; |
1982 | /* check for NVMUpdate access method */ |
1983 | else if (!eeprom->magic || (eeprom->magic >> 16) != hw->device_id) |
1984 | errno = -EINVAL; |
1985 | else if (test_bit(__I40E_RESET_RECOVERY_PENDING, pf->state) || |
1986 | test_bit(__I40E_RESET_INTR_RECEIVED, pf->state)) |
1987 | errno = -EBUSY; |
1988 | else |
1989 | ret_val = i40e_nvmupd_command(hw, cmd, bytes, errno: &errno); |
1990 | |
1991 | if ((errno || ret_val) && (hw->debug_mask & I40E_DEBUG_NVM)) |
1992 | dev_info(&pf->pdev->dev, |
1993 | "NVMUpdate write failed err=%d status=0x%x errno=%d module=%d offset=0x%x size=%d\n" , |
1994 | ret_val, hw->aq.asq_last_status, errno, |
1995 | (u8)(cmd->config & I40E_NVM_MOD_PNT_MASK), |
1996 | cmd->offset, cmd->data_size); |
1997 | |
1998 | return errno; |
1999 | } |
2000 | |
2001 | static void i40e_get_drvinfo(struct net_device *netdev, |
2002 | struct ethtool_drvinfo *drvinfo) |
2003 | { |
2004 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
2005 | struct i40e_vsi *vsi = np->vsi; |
2006 | struct i40e_pf *pf = vsi->back; |
2007 | |
2008 | strscpy(p: drvinfo->driver, q: i40e_driver_name, size: sizeof(drvinfo->driver)); |
2009 | i40e_nvm_version_str(hw: &pf->hw, buf: drvinfo->fw_version, |
2010 | len: sizeof(drvinfo->fw_version)); |
2011 | strscpy(p: drvinfo->bus_info, q: pci_name(pdev: pf->pdev), |
2012 | size: sizeof(drvinfo->bus_info)); |
2013 | drvinfo->n_priv_flags = I40E_PRIV_FLAGS_STR_LEN; |
2014 | if (pf->hw.pf_id == 0) |
2015 | drvinfo->n_priv_flags += I40E_GL_PRIV_FLAGS_STR_LEN; |
2016 | } |
2017 | |
2018 | static void i40e_get_ringparam(struct net_device *netdev, |
2019 | struct ethtool_ringparam *ring, |
2020 | struct kernel_ethtool_ringparam *kernel_ring, |
2021 | struct netlink_ext_ack *extack) |
2022 | { |
2023 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
2024 | struct i40e_pf *pf = np->vsi->back; |
2025 | struct i40e_vsi *vsi = pf->vsi[pf->lan_vsi]; |
2026 | |
2027 | ring->rx_max_pending = I40E_MAX_NUM_DESCRIPTORS; |
2028 | ring->tx_max_pending = I40E_MAX_NUM_DESCRIPTORS; |
2029 | ring->rx_mini_max_pending = 0; |
2030 | ring->rx_jumbo_max_pending = 0; |
2031 | ring->rx_pending = vsi->rx_rings[0]->count; |
2032 | ring->tx_pending = vsi->tx_rings[0]->count; |
2033 | ring->rx_mini_pending = 0; |
2034 | ring->rx_jumbo_pending = 0; |
2035 | } |
2036 | |
2037 | static bool i40e_active_tx_ring_index(struct i40e_vsi *vsi, u16 index) |
2038 | { |
2039 | if (i40e_enabled_xdp_vsi(vsi)) { |
2040 | return index < vsi->num_queue_pairs || |
2041 | (index >= vsi->alloc_queue_pairs && |
2042 | index < vsi->alloc_queue_pairs + vsi->num_queue_pairs); |
2043 | } |
2044 | |
2045 | return index < vsi->num_queue_pairs; |
2046 | } |
2047 | |
2048 | static int i40e_set_ringparam(struct net_device *netdev, |
2049 | struct ethtool_ringparam *ring, |
2050 | struct kernel_ethtool_ringparam *kernel_ring, |
2051 | struct netlink_ext_ack *extack) |
2052 | { |
2053 | struct i40e_ring *tx_rings = NULL, *rx_rings = NULL; |
2054 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
2055 | struct i40e_hw *hw = &np->vsi->back->hw; |
2056 | struct i40e_vsi *vsi = np->vsi; |
2057 | struct i40e_pf *pf = vsi->back; |
2058 | u32 new_rx_count, new_tx_count; |
2059 | u16 tx_alloc_queue_pairs; |
2060 | int timeout = 50; |
2061 | int i, err = 0; |
2062 | |
2063 | if ((ring->rx_mini_pending) || (ring->rx_jumbo_pending)) |
2064 | return -EINVAL; |
2065 | |
2066 | if (ring->tx_pending > I40E_MAX_NUM_DESCRIPTORS || |
2067 | ring->tx_pending < I40E_MIN_NUM_DESCRIPTORS || |
2068 | ring->rx_pending > I40E_MAX_NUM_DESCRIPTORS || |
2069 | ring->rx_pending < I40E_MIN_NUM_DESCRIPTORS) { |
2070 | netdev_info(dev: netdev, |
2071 | format: "Descriptors requested (Tx: %d / Rx: %d) out of range [%d-%d]\n" , |
2072 | ring->tx_pending, ring->rx_pending, |
2073 | I40E_MIN_NUM_DESCRIPTORS, I40E_MAX_NUM_DESCRIPTORS); |
2074 | return -EINVAL; |
2075 | } |
2076 | |
2077 | new_tx_count = ALIGN(ring->tx_pending, I40E_REQ_DESCRIPTOR_MULTIPLE); |
2078 | new_rx_count = ALIGN(ring->rx_pending, I40E_REQ_DESCRIPTOR_MULTIPLE); |
2079 | |
2080 | /* if nothing to do return success */ |
2081 | if ((new_tx_count == vsi->tx_rings[0]->count) && |
2082 | (new_rx_count == vsi->rx_rings[0]->count)) |
2083 | return 0; |
2084 | |
2085 | /* If there is a AF_XDP page pool attached to any of Rx rings, |
2086 | * disallow changing the number of descriptors -- regardless |
2087 | * if the netdev is running or not. |
2088 | */ |
2089 | if (i40e_xsk_any_rx_ring_enabled(vsi)) |
2090 | return -EBUSY; |
2091 | |
2092 | while (test_and_set_bit(nr: __I40E_CONFIG_BUSY, addr: pf->state)) { |
2093 | timeout--; |
2094 | if (!timeout) |
2095 | return -EBUSY; |
2096 | usleep_range(min: 1000, max: 2000); |
2097 | } |
2098 | |
2099 | if (!netif_running(dev: vsi->netdev)) { |
2100 | /* simple case - set for the next time the netdev is started */ |
2101 | for (i = 0; i < vsi->num_queue_pairs; i++) { |
2102 | vsi->tx_rings[i]->count = new_tx_count; |
2103 | vsi->rx_rings[i]->count = new_rx_count; |
2104 | if (i40e_enabled_xdp_vsi(vsi)) |
2105 | vsi->xdp_rings[i]->count = new_tx_count; |
2106 | } |
2107 | vsi->num_tx_desc = new_tx_count; |
2108 | vsi->num_rx_desc = new_rx_count; |
2109 | goto done; |
2110 | } |
2111 | |
2112 | /* We can't just free everything and then setup again, |
2113 | * because the ISRs in MSI-X mode get passed pointers |
2114 | * to the Tx and Rx ring structs. |
2115 | */ |
2116 | |
2117 | /* alloc updated Tx and XDP Tx resources */ |
2118 | tx_alloc_queue_pairs = vsi->alloc_queue_pairs * |
2119 | (i40e_enabled_xdp_vsi(vsi) ? 2 : 1); |
2120 | if (new_tx_count != vsi->tx_rings[0]->count) { |
2121 | netdev_info(dev: netdev, |
2122 | format: "Changing Tx descriptor count from %d to %d.\n" , |
2123 | vsi->tx_rings[0]->count, new_tx_count); |
2124 | tx_rings = kcalloc(n: tx_alloc_queue_pairs, |
2125 | size: sizeof(struct i40e_ring), GFP_KERNEL); |
2126 | if (!tx_rings) { |
2127 | err = -ENOMEM; |
2128 | goto done; |
2129 | } |
2130 | |
2131 | for (i = 0; i < tx_alloc_queue_pairs; i++) { |
2132 | if (!i40e_active_tx_ring_index(vsi, index: i)) |
2133 | continue; |
2134 | |
2135 | tx_rings[i] = *vsi->tx_rings[i]; |
2136 | tx_rings[i].count = new_tx_count; |
2137 | /* the desc and bi pointers will be reallocated in the |
2138 | * setup call |
2139 | */ |
2140 | tx_rings[i].desc = NULL; |
2141 | tx_rings[i].rx_bi = NULL; |
2142 | err = i40e_setup_tx_descriptors(tx_ring: &tx_rings[i]); |
2143 | if (err) { |
2144 | while (i) { |
2145 | i--; |
2146 | if (!i40e_active_tx_ring_index(vsi, index: i)) |
2147 | continue; |
2148 | i40e_free_tx_resources(tx_ring: &tx_rings[i]); |
2149 | } |
2150 | kfree(objp: tx_rings); |
2151 | tx_rings = NULL; |
2152 | |
2153 | goto done; |
2154 | } |
2155 | } |
2156 | } |
2157 | |
2158 | /* alloc updated Rx resources */ |
2159 | if (new_rx_count != vsi->rx_rings[0]->count) { |
2160 | netdev_info(dev: netdev, |
2161 | format: "Changing Rx descriptor count from %d to %d\n" , |
2162 | vsi->rx_rings[0]->count, new_rx_count); |
2163 | rx_rings = kcalloc(n: vsi->alloc_queue_pairs, |
2164 | size: sizeof(struct i40e_ring), GFP_KERNEL); |
2165 | if (!rx_rings) { |
2166 | err = -ENOMEM; |
2167 | goto free_tx; |
2168 | } |
2169 | |
2170 | for (i = 0; i < vsi->num_queue_pairs; i++) { |
2171 | u16 unused; |
2172 | |
2173 | /* clone ring and setup updated count */ |
2174 | rx_rings[i] = *vsi->rx_rings[i]; |
2175 | rx_rings[i].count = new_rx_count; |
2176 | /* the desc and bi pointers will be reallocated in the |
2177 | * setup call |
2178 | */ |
2179 | rx_rings[i].desc = NULL; |
2180 | rx_rings[i].rx_bi = NULL; |
2181 | /* Clear cloned XDP RX-queue info before setup call */ |
2182 | memset(&rx_rings[i].xdp_rxq, 0, sizeof(rx_rings[i].xdp_rxq)); |
2183 | /* this is to allow wr32 to have something to write to |
2184 | * during early allocation of Rx buffers |
2185 | */ |
2186 | rx_rings[i].tail = hw->hw_addr + I40E_PRTGEN_STATUS; |
2187 | err = i40e_setup_rx_descriptors(rx_ring: &rx_rings[i]); |
2188 | if (err) |
2189 | goto rx_unwind; |
2190 | |
2191 | /* now allocate the Rx buffers to make sure the OS |
2192 | * has enough memory, any failure here means abort |
2193 | */ |
2194 | unused = I40E_DESC_UNUSED(&rx_rings[i]); |
2195 | err = i40e_alloc_rx_buffers(rxr: &rx_rings[i], cleaned_count: unused); |
2196 | rx_unwind: |
2197 | if (err) { |
2198 | do { |
2199 | i40e_free_rx_resources(rx_ring: &rx_rings[i]); |
2200 | } while (i--); |
2201 | kfree(objp: rx_rings); |
2202 | rx_rings = NULL; |
2203 | |
2204 | goto free_tx; |
2205 | } |
2206 | } |
2207 | } |
2208 | |
2209 | /* Bring interface down, copy in the new ring info, |
2210 | * then restore the interface |
2211 | */ |
2212 | i40e_down(vsi); |
2213 | |
2214 | if (tx_rings) { |
2215 | for (i = 0; i < tx_alloc_queue_pairs; i++) { |
2216 | if (i40e_active_tx_ring_index(vsi, index: i)) { |
2217 | i40e_free_tx_resources(tx_ring: vsi->tx_rings[i]); |
2218 | *vsi->tx_rings[i] = tx_rings[i]; |
2219 | } |
2220 | } |
2221 | kfree(objp: tx_rings); |
2222 | tx_rings = NULL; |
2223 | } |
2224 | |
2225 | if (rx_rings) { |
2226 | for (i = 0; i < vsi->num_queue_pairs; i++) { |
2227 | i40e_free_rx_resources(rx_ring: vsi->rx_rings[i]); |
2228 | /* get the real tail offset */ |
2229 | rx_rings[i].tail = vsi->rx_rings[i]->tail; |
2230 | /* this is to fake out the allocation routine |
2231 | * into thinking it has to realloc everything |
2232 | * but the recycling logic will let us re-use |
2233 | * the buffers allocated above |
2234 | */ |
2235 | rx_rings[i].next_to_use = 0; |
2236 | rx_rings[i].next_to_clean = 0; |
2237 | rx_rings[i].next_to_alloc = 0; |
2238 | /* do a struct copy */ |
2239 | *vsi->rx_rings[i] = rx_rings[i]; |
2240 | } |
2241 | kfree(objp: rx_rings); |
2242 | rx_rings = NULL; |
2243 | } |
2244 | |
2245 | vsi->num_tx_desc = new_tx_count; |
2246 | vsi->num_rx_desc = new_rx_count; |
2247 | i40e_up(vsi); |
2248 | |
2249 | free_tx: |
2250 | /* error cleanup if the Rx allocations failed after getting Tx */ |
2251 | if (tx_rings) { |
2252 | for (i = 0; i < tx_alloc_queue_pairs; i++) { |
2253 | if (i40e_active_tx_ring_index(vsi, index: i)) |
2254 | i40e_free_tx_resources(tx_ring: vsi->tx_rings[i]); |
2255 | } |
2256 | kfree(objp: tx_rings); |
2257 | tx_rings = NULL; |
2258 | } |
2259 | |
2260 | done: |
2261 | clear_bit(nr: __I40E_CONFIG_BUSY, addr: pf->state); |
2262 | |
2263 | return err; |
2264 | } |
2265 | |
2266 | /** |
2267 | * i40e_get_stats_count - return the stats count for a device |
2268 | * @netdev: the netdev to return the count for |
2269 | * |
2270 | * Returns the total number of statistics for this netdev. Note that even |
2271 | * though this is a function, it is required that the count for a specific |
2272 | * netdev must never change. Basing the count on static values such as the |
2273 | * maximum number of queues or the device type is ok. However, the API for |
2274 | * obtaining stats is *not* safe against changes based on non-static |
2275 | * values such as the *current* number of queues, or runtime flags. |
2276 | * |
2277 | * If a statistic is not always enabled, return it as part of the count |
2278 | * anyways, always return its string, and report its value as zero. |
2279 | **/ |
2280 | static int i40e_get_stats_count(struct net_device *netdev) |
2281 | { |
2282 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
2283 | struct i40e_vsi *vsi = np->vsi; |
2284 | struct i40e_pf *pf = vsi->back; |
2285 | int stats_len; |
2286 | |
2287 | if (vsi == pf->vsi[pf->lan_vsi] && pf->hw.partition_id == 1) |
2288 | stats_len = I40E_PF_STATS_LEN; |
2289 | else |
2290 | stats_len = I40E_VSI_STATS_LEN; |
2291 | |
2292 | /* The number of stats reported for a given net_device must remain |
2293 | * constant throughout the life of that device. |
2294 | * |
2295 | * This is because the API for obtaining the size, strings, and stats |
2296 | * is spread out over three separate ethtool ioctls. There is no safe |
2297 | * way to lock the number of stats across these calls, so we must |
2298 | * assume that they will never change. |
2299 | * |
2300 | * Due to this, we report the maximum number of queues, even if not |
2301 | * every queue is currently configured. Since we always allocate |
2302 | * queues in pairs, we'll just use netdev->num_tx_queues * 2. This |
2303 | * works because the num_tx_queues is set at device creation and never |
2304 | * changes. |
2305 | */ |
2306 | stats_len += I40E_QUEUE_STATS_LEN * 2 * netdev->num_tx_queues; |
2307 | |
2308 | return stats_len; |
2309 | } |
2310 | |
2311 | static int i40e_get_sset_count(struct net_device *netdev, int sset) |
2312 | { |
2313 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
2314 | struct i40e_vsi *vsi = np->vsi; |
2315 | struct i40e_pf *pf = vsi->back; |
2316 | |
2317 | switch (sset) { |
2318 | case ETH_SS_TEST: |
2319 | return I40E_TEST_LEN; |
2320 | case ETH_SS_STATS: |
2321 | return i40e_get_stats_count(netdev); |
2322 | case ETH_SS_PRIV_FLAGS: |
2323 | return I40E_PRIV_FLAGS_STR_LEN + |
2324 | (pf->hw.pf_id == 0 ? I40E_GL_PRIV_FLAGS_STR_LEN : 0); |
2325 | default: |
2326 | return -EOPNOTSUPP; |
2327 | } |
2328 | } |
2329 | |
2330 | /** |
2331 | * i40e_get_veb_tc_stats - copy VEB TC statistics to formatted structure |
2332 | * @tc: the TC statistics in VEB structure (veb->tc_stats) |
2333 | * @i: the index of traffic class in (veb->tc_stats) structure to copy |
2334 | * |
2335 | * Copy VEB TC statistics from structure of arrays (veb->tc_stats) to |
2336 | * one dimensional structure i40e_cp_veb_tc_stats. |
2337 | * Produce formatted i40e_cp_veb_tc_stats structure of the VEB TC |
2338 | * statistics for the given TC. |
2339 | **/ |
2340 | static struct i40e_cp_veb_tc_stats |
2341 | i40e_get_veb_tc_stats(struct i40e_veb_tc_stats *tc, unsigned int i) |
2342 | { |
2343 | struct i40e_cp_veb_tc_stats veb_tc = { |
2344 | .tc_rx_packets = tc->tc_rx_packets[i], |
2345 | .tc_rx_bytes = tc->tc_rx_bytes[i], |
2346 | .tc_tx_packets = tc->tc_tx_packets[i], |
2347 | .tc_tx_bytes = tc->tc_tx_bytes[i], |
2348 | }; |
2349 | |
2350 | return veb_tc; |
2351 | } |
2352 | |
2353 | /** |
2354 | * i40e_get_pfc_stats - copy HW PFC statistics to formatted structure |
2355 | * @pf: the PF device structure |
2356 | * @i: the priority value to copy |
2357 | * |
2358 | * The PFC stats are found as arrays in pf->stats, which is not easy to pass |
2359 | * into i40e_add_ethtool_stats. Produce a formatted i40e_pfc_stats structure |
2360 | * of the PFC stats for the given priority. |
2361 | **/ |
2362 | static inline struct i40e_pfc_stats |
2363 | i40e_get_pfc_stats(struct i40e_pf *pf, unsigned int i) |
2364 | { |
2365 | #define I40E_GET_PFC_STAT(stat, priority) \ |
2366 | .stat = pf->stats.stat[priority] |
2367 | |
2368 | struct i40e_pfc_stats pfc = { |
2369 | I40E_GET_PFC_STAT(priority_xon_rx, i), |
2370 | I40E_GET_PFC_STAT(priority_xoff_rx, i), |
2371 | I40E_GET_PFC_STAT(priority_xon_tx, i), |
2372 | I40E_GET_PFC_STAT(priority_xoff_tx, i), |
2373 | I40E_GET_PFC_STAT(priority_xon_2_xoff, i), |
2374 | }; |
2375 | return pfc; |
2376 | } |
2377 | |
2378 | /** |
2379 | * i40e_get_ethtool_stats - copy stat values into supplied buffer |
2380 | * @netdev: the netdev to collect stats for |
2381 | * @stats: ethtool stats command structure |
2382 | * @data: ethtool supplied buffer |
2383 | * |
2384 | * Copy the stats values for this netdev into the buffer. Expects data to be |
2385 | * pre-allocated to the size returned by i40e_get_stats_count.. Note that all |
2386 | * statistics must be copied in a static order, and the count must not change |
2387 | * for a given netdev. See i40e_get_stats_count for more details. |
2388 | * |
2389 | * If a statistic is not currently valid (such as a disabled queue), this |
2390 | * function reports its value as zero. |
2391 | **/ |
2392 | static void i40e_get_ethtool_stats(struct net_device *netdev, |
2393 | struct ethtool_stats *stats, u64 *data) |
2394 | { |
2395 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
2396 | struct i40e_vsi *vsi = np->vsi; |
2397 | struct i40e_pf *pf = vsi->back; |
2398 | struct i40e_veb *veb = NULL; |
2399 | unsigned int i; |
2400 | bool veb_stats; |
2401 | u64 *p = data; |
2402 | |
2403 | i40e_update_stats(vsi); |
2404 | |
2405 | i40e_add_ethtool_stats(&data, i40e_get_vsi_stats_struct(vsi), |
2406 | i40e_gstrings_net_stats); |
2407 | |
2408 | i40e_add_ethtool_stats(&data, vsi, i40e_gstrings_misc_stats); |
2409 | |
2410 | rcu_read_lock(); |
2411 | for (i = 0; i < netdev->num_tx_queues; i++) { |
2412 | i40e_add_queue_stats(data: &data, READ_ONCE(vsi->tx_rings[i])); |
2413 | i40e_add_queue_stats(data: &data, READ_ONCE(vsi->rx_rings[i])); |
2414 | } |
2415 | rcu_read_unlock(); |
2416 | |
2417 | if (vsi != pf->vsi[pf->lan_vsi] || pf->hw.partition_id != 1) |
2418 | goto check_data_pointer; |
2419 | |
2420 | veb_stats = ((pf->lan_veb != I40E_NO_VEB) && |
2421 | (pf->lan_veb < I40E_MAX_VEB) && |
2422 | (pf->flags & I40E_FLAG_VEB_STATS_ENABLED)); |
2423 | |
2424 | if (veb_stats) { |
2425 | veb = pf->veb[pf->lan_veb]; |
2426 | i40e_update_veb_stats(veb); |
2427 | } |
2428 | |
2429 | /* If veb stats aren't enabled, pass NULL instead of the veb so that |
2430 | * we initialize stats to zero and update the data pointer |
2431 | * intelligently |
2432 | */ |
2433 | i40e_add_ethtool_stats(&data, veb_stats ? veb : NULL, |
2434 | i40e_gstrings_veb_stats); |
2435 | |
2436 | for (i = 0; i < I40E_MAX_TRAFFIC_CLASS; i++) |
2437 | if (veb_stats) { |
2438 | struct i40e_cp_veb_tc_stats veb_tc = |
2439 | i40e_get_veb_tc_stats(tc: &veb->tc_stats, i); |
2440 | |
2441 | i40e_add_ethtool_stats(&data, &veb_tc, |
2442 | i40e_gstrings_veb_tc_stats); |
2443 | } else { |
2444 | i40e_add_ethtool_stats(&data, NULL, |
2445 | i40e_gstrings_veb_tc_stats); |
2446 | } |
2447 | |
2448 | i40e_add_ethtool_stats(&data, pf, i40e_gstrings_stats); |
2449 | |
2450 | for (i = 0; i < I40E_MAX_USER_PRIORITY; i++) { |
2451 | struct i40e_pfc_stats pfc = i40e_get_pfc_stats(pf, i); |
2452 | |
2453 | i40e_add_ethtool_stats(&data, &pfc, i40e_gstrings_pfc_stats); |
2454 | } |
2455 | |
2456 | check_data_pointer: |
2457 | WARN_ONCE(data - p != i40e_get_stats_count(netdev), |
2458 | "ethtool stats count mismatch!" ); |
2459 | } |
2460 | |
2461 | /** |
2462 | * i40e_get_stat_strings - copy stat strings into supplied buffer |
2463 | * @netdev: the netdev to collect strings for |
2464 | * @data: supplied buffer to copy strings into |
2465 | * |
2466 | * Copy the strings related to stats for this netdev. Expects data to be |
2467 | * pre-allocated with the size reported by i40e_get_stats_count. Note that the |
2468 | * strings must be copied in a static order and the total count must not |
2469 | * change for a given netdev. See i40e_get_stats_count for more details. |
2470 | **/ |
2471 | static void i40e_get_stat_strings(struct net_device *netdev, u8 *data) |
2472 | { |
2473 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
2474 | struct i40e_vsi *vsi = np->vsi; |
2475 | struct i40e_pf *pf = vsi->back; |
2476 | unsigned int i; |
2477 | u8 *p = data; |
2478 | |
2479 | i40e_add_stat_strings(&data, i40e_gstrings_net_stats); |
2480 | |
2481 | i40e_add_stat_strings(&data, i40e_gstrings_misc_stats); |
2482 | |
2483 | for (i = 0; i < netdev->num_tx_queues; i++) { |
2484 | i40e_add_stat_strings(&data, i40e_gstrings_queue_stats, |
2485 | "tx" , i); |
2486 | i40e_add_stat_strings(&data, i40e_gstrings_queue_stats, |
2487 | "rx" , i); |
2488 | } |
2489 | |
2490 | if (vsi != pf->vsi[pf->lan_vsi] || pf->hw.partition_id != 1) |
2491 | goto check_data_pointer; |
2492 | |
2493 | i40e_add_stat_strings(&data, i40e_gstrings_veb_stats); |
2494 | |
2495 | for (i = 0; i < I40E_MAX_TRAFFIC_CLASS; i++) |
2496 | i40e_add_stat_strings(&data, i40e_gstrings_veb_tc_stats, i); |
2497 | |
2498 | i40e_add_stat_strings(&data, i40e_gstrings_stats); |
2499 | |
2500 | for (i = 0; i < I40E_MAX_USER_PRIORITY; i++) |
2501 | i40e_add_stat_strings(&data, i40e_gstrings_pfc_stats, i); |
2502 | |
2503 | check_data_pointer: |
2504 | WARN_ONCE(data - p != i40e_get_stats_count(netdev) * ETH_GSTRING_LEN, |
2505 | "stat strings count mismatch!" ); |
2506 | } |
2507 | |
2508 | static void i40e_get_priv_flag_strings(struct net_device *netdev, u8 *data) |
2509 | { |
2510 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
2511 | struct i40e_vsi *vsi = np->vsi; |
2512 | struct i40e_pf *pf = vsi->back; |
2513 | unsigned int i; |
2514 | u8 *p = data; |
2515 | |
2516 | for (i = 0; i < I40E_PRIV_FLAGS_STR_LEN; i++) |
2517 | ethtool_sprintf(data: &p, fmt: "%s" , |
2518 | i40e_gstrings_priv_flags[i].flag_string); |
2519 | if (pf->hw.pf_id != 0) |
2520 | return; |
2521 | for (i = 0; i < I40E_GL_PRIV_FLAGS_STR_LEN; i++) |
2522 | ethtool_sprintf(data: &p, fmt: "%s" , |
2523 | i40e_gl_gstrings_priv_flags[i].flag_string); |
2524 | } |
2525 | |
2526 | static void i40e_get_strings(struct net_device *netdev, u32 stringset, |
2527 | u8 *data) |
2528 | { |
2529 | switch (stringset) { |
2530 | case ETH_SS_TEST: |
2531 | memcpy(data, i40e_gstrings_test, |
2532 | I40E_TEST_LEN * ETH_GSTRING_LEN); |
2533 | break; |
2534 | case ETH_SS_STATS: |
2535 | i40e_get_stat_strings(netdev, data); |
2536 | break; |
2537 | case ETH_SS_PRIV_FLAGS: |
2538 | i40e_get_priv_flag_strings(netdev, data); |
2539 | break; |
2540 | default: |
2541 | break; |
2542 | } |
2543 | } |
2544 | |
2545 | static int i40e_get_ts_info(struct net_device *dev, |
2546 | struct ethtool_ts_info *info) |
2547 | { |
2548 | struct i40e_pf *pf = i40e_netdev_to_pf(netdev: dev); |
2549 | |
2550 | /* only report HW timestamping if PTP is enabled */ |
2551 | if (!(pf->flags & I40E_FLAG_PTP)) |
2552 | return ethtool_op_get_ts_info(dev, eti: info); |
2553 | |
2554 | info->so_timestamping = SOF_TIMESTAMPING_TX_SOFTWARE | |
2555 | SOF_TIMESTAMPING_RX_SOFTWARE | |
2556 | SOF_TIMESTAMPING_SOFTWARE | |
2557 | SOF_TIMESTAMPING_TX_HARDWARE | |
2558 | SOF_TIMESTAMPING_RX_HARDWARE | |
2559 | SOF_TIMESTAMPING_RAW_HARDWARE; |
2560 | |
2561 | if (pf->ptp_clock) |
2562 | info->phc_index = ptp_clock_index(ptp: pf->ptp_clock); |
2563 | else |
2564 | info->phc_index = -1; |
2565 | |
2566 | info->tx_types = BIT(HWTSTAMP_TX_OFF) | BIT(HWTSTAMP_TX_ON); |
2567 | |
2568 | info->rx_filters = BIT(HWTSTAMP_FILTER_NONE) | |
2569 | BIT(HWTSTAMP_FILTER_PTP_V2_L2_EVENT) | |
2570 | BIT(HWTSTAMP_FILTER_PTP_V2_L2_SYNC) | |
2571 | BIT(HWTSTAMP_FILTER_PTP_V2_L2_DELAY_REQ); |
2572 | |
2573 | if (pf->hw_features & I40E_HW_PTP_L4_CAPABLE) |
2574 | info->rx_filters |= BIT(HWTSTAMP_FILTER_PTP_V1_L4_SYNC) | |
2575 | BIT(HWTSTAMP_FILTER_PTP_V1_L4_DELAY_REQ) | |
2576 | BIT(HWTSTAMP_FILTER_PTP_V2_EVENT) | |
2577 | BIT(HWTSTAMP_FILTER_PTP_V2_L4_EVENT) | |
2578 | BIT(HWTSTAMP_FILTER_PTP_V2_SYNC) | |
2579 | BIT(HWTSTAMP_FILTER_PTP_V2_L4_SYNC) | |
2580 | BIT(HWTSTAMP_FILTER_PTP_V2_DELAY_REQ) | |
2581 | BIT(HWTSTAMP_FILTER_PTP_V2_L4_DELAY_REQ); |
2582 | |
2583 | return 0; |
2584 | } |
2585 | |
2586 | static u64 i40e_link_test(struct net_device *netdev, u64 *data) |
2587 | { |
2588 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
2589 | struct i40e_pf *pf = np->vsi->back; |
2590 | bool link_up = false; |
2591 | int status; |
2592 | |
2593 | netif_info(pf, hw, netdev, "link test\n" ); |
2594 | status = i40e_get_link_status(hw: &pf->hw, link_up: &link_up); |
2595 | if (status) { |
2596 | netif_err(pf, drv, netdev, "link query timed out, please retry test\n" ); |
2597 | *data = 1; |
2598 | return *data; |
2599 | } |
2600 | |
2601 | if (link_up) |
2602 | *data = 0; |
2603 | else |
2604 | *data = 1; |
2605 | |
2606 | return *data; |
2607 | } |
2608 | |
2609 | static u64 i40e_reg_test(struct net_device *netdev, u64 *data) |
2610 | { |
2611 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
2612 | struct i40e_pf *pf = np->vsi->back; |
2613 | |
2614 | netif_info(pf, hw, netdev, "register test\n" ); |
2615 | *data = i40e_diag_reg_test(hw: &pf->hw); |
2616 | |
2617 | return *data; |
2618 | } |
2619 | |
2620 | static u64 i40e_eeprom_test(struct net_device *netdev, u64 *data) |
2621 | { |
2622 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
2623 | struct i40e_pf *pf = np->vsi->back; |
2624 | |
2625 | netif_info(pf, hw, netdev, "eeprom test\n" ); |
2626 | *data = i40e_diag_eeprom_test(hw: &pf->hw); |
2627 | |
2628 | /* forcebly clear the NVM Update state machine */ |
2629 | pf->hw.nvmupd_state = I40E_NVMUPD_STATE_INIT; |
2630 | |
2631 | return *data; |
2632 | } |
2633 | |
2634 | static u64 i40e_intr_test(struct net_device *netdev, u64 *data) |
2635 | { |
2636 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
2637 | struct i40e_pf *pf = np->vsi->back; |
2638 | u16 swc_old = pf->sw_int_count; |
2639 | |
2640 | netif_info(pf, hw, netdev, "interrupt test\n" ); |
2641 | wr32(&pf->hw, I40E_PFINT_DYN_CTL0, |
2642 | (I40E_PFINT_DYN_CTL0_INTENA_MASK | |
2643 | I40E_PFINT_DYN_CTL0_SWINT_TRIG_MASK | |
2644 | I40E_PFINT_DYN_CTL0_ITR_INDX_MASK | |
2645 | I40E_PFINT_DYN_CTL0_SW_ITR_INDX_ENA_MASK | |
2646 | I40E_PFINT_DYN_CTL0_SW_ITR_INDX_MASK)); |
2647 | usleep_range(min: 1000, max: 2000); |
2648 | *data = (swc_old == pf->sw_int_count); |
2649 | |
2650 | return *data; |
2651 | } |
2652 | |
2653 | static inline bool i40e_active_vfs(struct i40e_pf *pf) |
2654 | { |
2655 | struct i40e_vf *vfs = pf->vf; |
2656 | int i; |
2657 | |
2658 | for (i = 0; i < pf->num_alloc_vfs; i++) |
2659 | if (test_bit(I40E_VF_STATE_ACTIVE, &vfs[i].vf_states)) |
2660 | return true; |
2661 | return false; |
2662 | } |
2663 | |
2664 | static inline bool i40e_active_vmdqs(struct i40e_pf *pf) |
2665 | { |
2666 | return !!i40e_find_vsi_by_type(pf, type: I40E_VSI_VMDQ2); |
2667 | } |
2668 | |
2669 | static void i40e_diag_test(struct net_device *netdev, |
2670 | struct ethtool_test *eth_test, u64 *data) |
2671 | { |
2672 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
2673 | bool if_running = netif_running(dev: netdev); |
2674 | struct i40e_pf *pf = np->vsi->back; |
2675 | |
2676 | if (eth_test->flags == ETH_TEST_FL_OFFLINE) { |
2677 | /* Offline tests */ |
2678 | netif_info(pf, drv, netdev, "offline testing starting\n" ); |
2679 | |
2680 | set_bit(nr: __I40E_TESTING, addr: pf->state); |
2681 | |
2682 | if (test_bit(__I40E_RESET_RECOVERY_PENDING, pf->state) || |
2683 | test_bit(__I40E_RESET_INTR_RECEIVED, pf->state)) { |
2684 | dev_warn(&pf->pdev->dev, |
2685 | "Cannot start offline testing when PF is in reset state.\n" ); |
2686 | goto skip_ol_tests; |
2687 | } |
2688 | |
2689 | if (i40e_active_vfs(pf) || i40e_active_vmdqs(pf)) { |
2690 | dev_warn(&pf->pdev->dev, |
2691 | "Please take active VFs and Netqueues offline and restart the adapter before running NIC diagnostics\n" ); |
2692 | goto skip_ol_tests; |
2693 | } |
2694 | |
2695 | /* If the device is online then take it offline */ |
2696 | if (if_running) |
2697 | /* indicate we're in test mode */ |
2698 | i40e_close(netdev); |
2699 | else |
2700 | /* This reset does not affect link - if it is |
2701 | * changed to a type of reset that does affect |
2702 | * link then the following link test would have |
2703 | * to be moved to before the reset |
2704 | */ |
2705 | i40e_do_reset(pf, BIT(__I40E_PF_RESET_REQUESTED), lock_acquired: true); |
2706 | |
2707 | if (i40e_link_test(netdev, data: &data[I40E_ETH_TEST_LINK])) |
2708 | eth_test->flags |= ETH_TEST_FL_FAILED; |
2709 | |
2710 | if (i40e_eeprom_test(netdev, data: &data[I40E_ETH_TEST_EEPROM])) |
2711 | eth_test->flags |= ETH_TEST_FL_FAILED; |
2712 | |
2713 | if (i40e_intr_test(netdev, data: &data[I40E_ETH_TEST_INTR])) |
2714 | eth_test->flags |= ETH_TEST_FL_FAILED; |
2715 | |
2716 | /* run reg test last, a reset is required after it */ |
2717 | if (i40e_reg_test(netdev, data: &data[I40E_ETH_TEST_REG])) |
2718 | eth_test->flags |= ETH_TEST_FL_FAILED; |
2719 | |
2720 | clear_bit(nr: __I40E_TESTING, addr: pf->state); |
2721 | i40e_do_reset(pf, BIT(__I40E_PF_RESET_REQUESTED), lock_acquired: true); |
2722 | |
2723 | if (if_running) |
2724 | i40e_open(netdev); |
2725 | } else { |
2726 | /* Online tests */ |
2727 | netif_info(pf, drv, netdev, "online testing starting\n" ); |
2728 | |
2729 | if (i40e_link_test(netdev, data: &data[I40E_ETH_TEST_LINK])) |
2730 | eth_test->flags |= ETH_TEST_FL_FAILED; |
2731 | |
2732 | /* Offline only tests, not run in online; pass by default */ |
2733 | data[I40E_ETH_TEST_REG] = 0; |
2734 | data[I40E_ETH_TEST_EEPROM] = 0; |
2735 | data[I40E_ETH_TEST_INTR] = 0; |
2736 | } |
2737 | |
2738 | netif_info(pf, drv, netdev, "testing finished\n" ); |
2739 | return; |
2740 | |
2741 | skip_ol_tests: |
2742 | data[I40E_ETH_TEST_REG] = 1; |
2743 | data[I40E_ETH_TEST_EEPROM] = 1; |
2744 | data[I40E_ETH_TEST_INTR] = 1; |
2745 | data[I40E_ETH_TEST_LINK] = 1; |
2746 | eth_test->flags |= ETH_TEST_FL_FAILED; |
2747 | clear_bit(nr: __I40E_TESTING, addr: pf->state); |
2748 | netif_info(pf, drv, netdev, "testing failed\n" ); |
2749 | } |
2750 | |
2751 | static void i40e_get_wol(struct net_device *netdev, |
2752 | struct ethtool_wolinfo *wol) |
2753 | { |
2754 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
2755 | struct i40e_pf *pf = np->vsi->back; |
2756 | struct i40e_hw *hw = &pf->hw; |
2757 | u16 wol_nvm_bits; |
2758 | |
2759 | /* NVM bit on means WoL disabled for the port */ |
2760 | i40e_read_nvm_word(hw, I40E_SR_NVM_WAKE_ON_LAN, data: &wol_nvm_bits); |
2761 | if ((BIT(hw->port) & wol_nvm_bits) || (hw->partition_id != 1)) { |
2762 | wol->supported = 0; |
2763 | wol->wolopts = 0; |
2764 | } else { |
2765 | wol->supported = WAKE_MAGIC; |
2766 | wol->wolopts = (pf->wol_en ? WAKE_MAGIC : 0); |
2767 | } |
2768 | } |
2769 | |
2770 | /** |
2771 | * i40e_set_wol - set the WakeOnLAN configuration |
2772 | * @netdev: the netdev in question |
2773 | * @wol: the ethtool WoL setting data |
2774 | **/ |
2775 | static int i40e_set_wol(struct net_device *netdev, struct ethtool_wolinfo *wol) |
2776 | { |
2777 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
2778 | struct i40e_pf *pf = np->vsi->back; |
2779 | struct i40e_vsi *vsi = np->vsi; |
2780 | struct i40e_hw *hw = &pf->hw; |
2781 | u16 wol_nvm_bits; |
2782 | |
2783 | /* WoL not supported if this isn't the controlling PF on the port */ |
2784 | if (hw->partition_id != 1) { |
2785 | i40e_partition_setting_complaint(pf); |
2786 | return -EOPNOTSUPP; |
2787 | } |
2788 | |
2789 | if (vsi != pf->vsi[pf->lan_vsi]) |
2790 | return -EOPNOTSUPP; |
2791 | |
2792 | /* NVM bit on means WoL disabled for the port */ |
2793 | i40e_read_nvm_word(hw, I40E_SR_NVM_WAKE_ON_LAN, data: &wol_nvm_bits); |
2794 | if (BIT(hw->port) & wol_nvm_bits) |
2795 | return -EOPNOTSUPP; |
2796 | |
2797 | /* only magic packet is supported */ |
2798 | if (wol->wolopts & ~WAKE_MAGIC) |
2799 | return -EOPNOTSUPP; |
2800 | |
2801 | /* is this a new value? */ |
2802 | if (pf->wol_en != !!wol->wolopts) { |
2803 | pf->wol_en = !!wol->wolopts; |
2804 | device_set_wakeup_enable(dev: &pf->pdev->dev, enable: pf->wol_en); |
2805 | } |
2806 | |
2807 | return 0; |
2808 | } |
2809 | |
2810 | static int i40e_set_phys_id(struct net_device *netdev, |
2811 | enum ethtool_phys_id_state state) |
2812 | { |
2813 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
2814 | struct i40e_pf *pf = np->vsi->back; |
2815 | struct i40e_hw *hw = &pf->hw; |
2816 | int blink_freq = 2; |
2817 | u16 temp_status; |
2818 | int ret = 0; |
2819 | |
2820 | switch (state) { |
2821 | case ETHTOOL_ID_ACTIVE: |
2822 | if (!(pf->hw_features & I40E_HW_PHY_CONTROLS_LEDS)) { |
2823 | pf->led_status = i40e_led_get(hw); |
2824 | } else { |
2825 | if (!(hw->flags & I40E_HW_FLAG_AQ_PHY_ACCESS_CAPABLE)) |
2826 | i40e_aq_set_phy_debug(hw, I40E_PHY_DEBUG_ALL, |
2827 | NULL); |
2828 | ret = i40e_led_get_phy(hw, led_addr: &temp_status, |
2829 | val: &pf->phy_led_val); |
2830 | pf->led_status = temp_status; |
2831 | } |
2832 | return blink_freq; |
2833 | case ETHTOOL_ID_ON: |
2834 | if (!(pf->hw_features & I40E_HW_PHY_CONTROLS_LEDS)) |
2835 | i40e_led_set(hw, mode: 0xf, blink: false); |
2836 | else |
2837 | ret = i40e_led_set_phy(hw, on: true, led_addr: pf->led_status, mode: 0); |
2838 | break; |
2839 | case ETHTOOL_ID_OFF: |
2840 | if (!(pf->hw_features & I40E_HW_PHY_CONTROLS_LEDS)) |
2841 | i40e_led_set(hw, mode: 0x0, blink: false); |
2842 | else |
2843 | ret = i40e_led_set_phy(hw, on: false, led_addr: pf->led_status, mode: 0); |
2844 | break; |
2845 | case ETHTOOL_ID_INACTIVE: |
2846 | if (!(pf->hw_features & I40E_HW_PHY_CONTROLS_LEDS)) { |
2847 | i40e_led_set(hw, mode: pf->led_status, blink: false); |
2848 | } else { |
2849 | ret = i40e_led_set_phy(hw, on: false, led_addr: pf->led_status, |
2850 | mode: (pf->phy_led_val | |
2851 | I40E_PHY_LED_MODE_ORIG)); |
2852 | if (!(hw->flags & I40E_HW_FLAG_AQ_PHY_ACCESS_CAPABLE)) |
2853 | i40e_aq_set_phy_debug(hw, cmd_flags: 0, NULL); |
2854 | } |
2855 | break; |
2856 | default: |
2857 | break; |
2858 | } |
2859 | if (ret) |
2860 | return -ENOENT; |
2861 | else |
2862 | return 0; |
2863 | } |
2864 | |
2865 | /* NOTE: i40e hardware uses a conversion factor of 2 for Interrupt |
2866 | * Throttle Rate (ITR) ie. ITR(1) = 2us ITR(10) = 20 us, and also |
2867 | * 125us (8000 interrupts per second) == ITR(62) |
2868 | */ |
2869 | |
2870 | /** |
2871 | * __i40e_get_coalesce - get per-queue coalesce settings |
2872 | * @netdev: the netdev to check |
2873 | * @ec: ethtool coalesce data structure |
2874 | * @queue: which queue to pick |
2875 | * |
2876 | * Gets the per-queue settings for coalescence. Specifically Rx and Tx usecs |
2877 | * are per queue. If queue is <0 then we default to queue 0 as the |
2878 | * representative value. |
2879 | **/ |
2880 | static int __i40e_get_coalesce(struct net_device *netdev, |
2881 | struct ethtool_coalesce *ec, |
2882 | int queue) |
2883 | { |
2884 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
2885 | struct i40e_ring *rx_ring, *tx_ring; |
2886 | struct i40e_vsi *vsi = np->vsi; |
2887 | |
2888 | ec->tx_max_coalesced_frames_irq = vsi->work_limit; |
2889 | ec->rx_max_coalesced_frames_irq = vsi->work_limit; |
2890 | |
2891 | /* rx and tx usecs has per queue value. If user doesn't specify the |
2892 | * queue, return queue 0's value to represent. |
2893 | */ |
2894 | if (queue < 0) |
2895 | queue = 0; |
2896 | else if (queue >= vsi->num_queue_pairs) |
2897 | return -EINVAL; |
2898 | |
2899 | rx_ring = vsi->rx_rings[queue]; |
2900 | tx_ring = vsi->tx_rings[queue]; |
2901 | |
2902 | if (ITR_IS_DYNAMIC(rx_ring->itr_setting)) |
2903 | ec->use_adaptive_rx_coalesce = 1; |
2904 | |
2905 | if (ITR_IS_DYNAMIC(tx_ring->itr_setting)) |
2906 | ec->use_adaptive_tx_coalesce = 1; |
2907 | |
2908 | ec->rx_coalesce_usecs = rx_ring->itr_setting & ~I40E_ITR_DYNAMIC; |
2909 | ec->tx_coalesce_usecs = tx_ring->itr_setting & ~I40E_ITR_DYNAMIC; |
2910 | |
2911 | /* we use the _usecs_high to store/set the interrupt rate limit |
2912 | * that the hardware supports, that almost but not quite |
2913 | * fits the original intent of the ethtool variable, |
2914 | * the rx_coalesce_usecs_high limits total interrupts |
2915 | * per second from both tx/rx sources. |
2916 | */ |
2917 | ec->rx_coalesce_usecs_high = vsi->int_rate_limit; |
2918 | ec->tx_coalesce_usecs_high = vsi->int_rate_limit; |
2919 | |
2920 | return 0; |
2921 | } |
2922 | |
2923 | /** |
2924 | * i40e_get_coalesce - get a netdev's coalesce settings |
2925 | * @netdev: the netdev to check |
2926 | * @ec: ethtool coalesce data structure |
2927 | * @kernel_coal: ethtool CQE mode setting structure |
2928 | * @extack: extack for reporting error messages |
2929 | * |
2930 | * Gets the coalesce settings for a particular netdev. Note that if user has |
2931 | * modified per-queue settings, this only guarantees to represent queue 0. See |
2932 | * __i40e_get_coalesce for more details. |
2933 | **/ |
2934 | static int i40e_get_coalesce(struct net_device *netdev, |
2935 | struct ethtool_coalesce *ec, |
2936 | struct kernel_ethtool_coalesce *kernel_coal, |
2937 | struct netlink_ext_ack *extack) |
2938 | { |
2939 | return __i40e_get_coalesce(netdev, ec, queue: -1); |
2940 | } |
2941 | |
2942 | /** |
2943 | * i40e_get_per_queue_coalesce - gets coalesce settings for particular queue |
2944 | * @netdev: netdev structure |
2945 | * @ec: ethtool's coalesce settings |
2946 | * @queue: the particular queue to read |
2947 | * |
2948 | * Will read a specific queue's coalesce settings |
2949 | **/ |
2950 | static int i40e_get_per_queue_coalesce(struct net_device *netdev, u32 queue, |
2951 | struct ethtool_coalesce *ec) |
2952 | { |
2953 | return __i40e_get_coalesce(netdev, ec, queue); |
2954 | } |
2955 | |
2956 | /** |
2957 | * i40e_set_itr_per_queue - set ITR values for specific queue |
2958 | * @vsi: the VSI to set values for |
2959 | * @ec: coalesce settings from ethtool |
2960 | * @queue: the queue to modify |
2961 | * |
2962 | * Change the ITR settings for a specific queue. |
2963 | **/ |
2964 | static void i40e_set_itr_per_queue(struct i40e_vsi *vsi, |
2965 | struct ethtool_coalesce *ec, |
2966 | int queue) |
2967 | { |
2968 | struct i40e_ring *rx_ring = vsi->rx_rings[queue]; |
2969 | struct i40e_ring *tx_ring = vsi->tx_rings[queue]; |
2970 | struct i40e_pf *pf = vsi->back; |
2971 | struct i40e_hw *hw = &pf->hw; |
2972 | struct i40e_q_vector *q_vector; |
2973 | u16 intrl; |
2974 | |
2975 | intrl = i40e_intrl_usec_to_reg(intrl: vsi->int_rate_limit); |
2976 | |
2977 | rx_ring->itr_setting = ITR_REG_ALIGN(ec->rx_coalesce_usecs); |
2978 | tx_ring->itr_setting = ITR_REG_ALIGN(ec->tx_coalesce_usecs); |
2979 | |
2980 | if (ec->use_adaptive_rx_coalesce) |
2981 | rx_ring->itr_setting |= I40E_ITR_DYNAMIC; |
2982 | else |
2983 | rx_ring->itr_setting &= ~I40E_ITR_DYNAMIC; |
2984 | |
2985 | if (ec->use_adaptive_tx_coalesce) |
2986 | tx_ring->itr_setting |= I40E_ITR_DYNAMIC; |
2987 | else |
2988 | tx_ring->itr_setting &= ~I40E_ITR_DYNAMIC; |
2989 | |
2990 | q_vector = rx_ring->q_vector; |
2991 | q_vector->rx.target_itr = ITR_TO_REG(rx_ring->itr_setting); |
2992 | |
2993 | q_vector = tx_ring->q_vector; |
2994 | q_vector->tx.target_itr = ITR_TO_REG(tx_ring->itr_setting); |
2995 | |
2996 | /* The interrupt handler itself will take care of programming |
2997 | * the Tx and Rx ITR values based on the values we have entered |
2998 | * into the q_vector, no need to write the values now. |
2999 | */ |
3000 | |
3001 | wr32(hw, I40E_PFINT_RATEN(q_vector->reg_idx), intrl); |
3002 | i40e_flush(hw); |
3003 | } |
3004 | |
3005 | /** |
3006 | * __i40e_set_coalesce - set coalesce settings for particular queue |
3007 | * @netdev: the netdev to change |
3008 | * @ec: ethtool coalesce settings |
3009 | * @queue: the queue to change |
3010 | * |
3011 | * Sets the coalesce settings for a particular queue. |
3012 | **/ |
3013 | static int __i40e_set_coalesce(struct net_device *netdev, |
3014 | struct ethtool_coalesce *ec, |
3015 | int queue) |
3016 | { |
3017 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
3018 | u16 intrl_reg, cur_rx_itr, cur_tx_itr; |
3019 | struct i40e_vsi *vsi = np->vsi; |
3020 | struct i40e_pf *pf = vsi->back; |
3021 | int i; |
3022 | |
3023 | if (ec->tx_max_coalesced_frames_irq || ec->rx_max_coalesced_frames_irq) |
3024 | vsi->work_limit = ec->tx_max_coalesced_frames_irq; |
3025 | |
3026 | if (queue < 0) { |
3027 | cur_rx_itr = vsi->rx_rings[0]->itr_setting; |
3028 | cur_tx_itr = vsi->tx_rings[0]->itr_setting; |
3029 | } else if (queue < vsi->num_queue_pairs) { |
3030 | cur_rx_itr = vsi->rx_rings[queue]->itr_setting; |
3031 | cur_tx_itr = vsi->tx_rings[queue]->itr_setting; |
3032 | } else { |
3033 | netif_info(pf, drv, netdev, "Invalid queue value, queue range is 0 - %d\n" , |
3034 | vsi->num_queue_pairs - 1); |
3035 | return -EINVAL; |
3036 | } |
3037 | |
3038 | cur_tx_itr &= ~I40E_ITR_DYNAMIC; |
3039 | cur_rx_itr &= ~I40E_ITR_DYNAMIC; |
3040 | |
3041 | /* tx_coalesce_usecs_high is ignored, use rx-usecs-high instead */ |
3042 | if (ec->tx_coalesce_usecs_high != vsi->int_rate_limit) { |
3043 | netif_info(pf, drv, netdev, "tx-usecs-high is not used, please program rx-usecs-high\n" ); |
3044 | return -EINVAL; |
3045 | } |
3046 | |
3047 | if (ec->rx_coalesce_usecs_high > INTRL_REG_TO_USEC(I40E_MAX_INTRL)) { |
3048 | netif_info(pf, drv, netdev, "Invalid value, rx-usecs-high range is 0-%lu\n" , |
3049 | INTRL_REG_TO_USEC(I40E_MAX_INTRL)); |
3050 | return -EINVAL; |
3051 | } |
3052 | |
3053 | if (ec->rx_coalesce_usecs != cur_rx_itr && |
3054 | ec->use_adaptive_rx_coalesce) { |
3055 | netif_info(pf, drv, netdev, "RX interrupt moderation cannot be changed if adaptive-rx is enabled.\n" ); |
3056 | return -EINVAL; |
3057 | } |
3058 | |
3059 | if (ec->rx_coalesce_usecs > I40E_MAX_ITR) { |
3060 | netif_info(pf, drv, netdev, "Invalid value, rx-usecs range is 0-8160\n" ); |
3061 | return -EINVAL; |
3062 | } |
3063 | |
3064 | if (ec->tx_coalesce_usecs != cur_tx_itr && |
3065 | ec->use_adaptive_tx_coalesce) { |
3066 | netif_info(pf, drv, netdev, "TX interrupt moderation cannot be changed if adaptive-tx is enabled.\n" ); |
3067 | return -EINVAL; |
3068 | } |
3069 | |
3070 | if (ec->tx_coalesce_usecs > I40E_MAX_ITR) { |
3071 | netif_info(pf, drv, netdev, "Invalid value, tx-usecs range is 0-8160\n" ); |
3072 | return -EINVAL; |
3073 | } |
3074 | |
3075 | if (ec->use_adaptive_rx_coalesce && !cur_rx_itr) |
3076 | ec->rx_coalesce_usecs = I40E_MIN_ITR; |
3077 | |
3078 | if (ec->use_adaptive_tx_coalesce && !cur_tx_itr) |
3079 | ec->tx_coalesce_usecs = I40E_MIN_ITR; |
3080 | |
3081 | intrl_reg = i40e_intrl_usec_to_reg(intrl: ec->rx_coalesce_usecs_high); |
3082 | vsi->int_rate_limit = INTRL_REG_TO_USEC(intrl_reg); |
3083 | if (vsi->int_rate_limit != ec->rx_coalesce_usecs_high) { |
3084 | netif_info(pf, drv, netdev, "Interrupt rate limit rounded down to %d\n" , |
3085 | vsi->int_rate_limit); |
3086 | } |
3087 | |
3088 | /* rx and tx usecs has per queue value. If user doesn't specify the |
3089 | * queue, apply to all queues. |
3090 | */ |
3091 | if (queue < 0) { |
3092 | for (i = 0; i < vsi->num_queue_pairs; i++) |
3093 | i40e_set_itr_per_queue(vsi, ec, queue: i); |
3094 | } else { |
3095 | i40e_set_itr_per_queue(vsi, ec, queue); |
3096 | } |
3097 | |
3098 | return 0; |
3099 | } |
3100 | |
3101 | /** |
3102 | * i40e_set_coalesce - set coalesce settings for every queue on the netdev |
3103 | * @netdev: the netdev to change |
3104 | * @ec: ethtool coalesce settings |
3105 | * @kernel_coal: ethtool CQE mode setting structure |
3106 | * @extack: extack for reporting error messages |
3107 | * |
3108 | * This will set each queue to the same coalesce settings. |
3109 | **/ |
3110 | static int i40e_set_coalesce(struct net_device *netdev, |
3111 | struct ethtool_coalesce *ec, |
3112 | struct kernel_ethtool_coalesce *kernel_coal, |
3113 | struct netlink_ext_ack *extack) |
3114 | { |
3115 | return __i40e_set_coalesce(netdev, ec, queue: -1); |
3116 | } |
3117 | |
3118 | /** |
3119 | * i40e_set_per_queue_coalesce - set specific queue's coalesce settings |
3120 | * @netdev: the netdev to change |
3121 | * @ec: ethtool's coalesce settings |
3122 | * @queue: the queue to change |
3123 | * |
3124 | * Sets the specified queue's coalesce settings. |
3125 | **/ |
3126 | static int i40e_set_per_queue_coalesce(struct net_device *netdev, u32 queue, |
3127 | struct ethtool_coalesce *ec) |
3128 | { |
3129 | return __i40e_set_coalesce(netdev, ec, queue); |
3130 | } |
3131 | |
3132 | /** |
3133 | * i40e_get_rss_hash_opts - Get RSS hash Input Set for each flow type |
3134 | * @pf: pointer to the physical function struct |
3135 | * @cmd: ethtool rxnfc command |
3136 | * |
3137 | * Returns Success if the flow is supported, else Invalid Input. |
3138 | **/ |
3139 | static int (struct i40e_pf *pf, struct ethtool_rxnfc *cmd) |
3140 | { |
3141 | struct i40e_hw *hw = &pf->hw; |
3142 | u8 flow_pctype = 0; |
3143 | u64 i_set = 0; |
3144 | |
3145 | cmd->data = 0; |
3146 | |
3147 | switch (cmd->flow_type) { |
3148 | case TCP_V4_FLOW: |
3149 | flow_pctype = I40E_FILTER_PCTYPE_NONF_IPV4_TCP; |
3150 | break; |
3151 | case UDP_V4_FLOW: |
3152 | flow_pctype = I40E_FILTER_PCTYPE_NONF_IPV4_UDP; |
3153 | break; |
3154 | case TCP_V6_FLOW: |
3155 | flow_pctype = I40E_FILTER_PCTYPE_NONF_IPV6_TCP; |
3156 | break; |
3157 | case UDP_V6_FLOW: |
3158 | flow_pctype = I40E_FILTER_PCTYPE_NONF_IPV6_UDP; |
3159 | break; |
3160 | case SCTP_V4_FLOW: |
3161 | case AH_ESP_V4_FLOW: |
3162 | case AH_V4_FLOW: |
3163 | case ESP_V4_FLOW: |
3164 | case IPV4_FLOW: |
3165 | case SCTP_V6_FLOW: |
3166 | case AH_ESP_V6_FLOW: |
3167 | case AH_V6_FLOW: |
3168 | case ESP_V6_FLOW: |
3169 | case IPV6_FLOW: |
3170 | /* Default is src/dest for IP, no matter the L4 hashing */ |
3171 | cmd->data |= RXH_IP_SRC | RXH_IP_DST; |
3172 | break; |
3173 | default: |
3174 | return -EINVAL; |
3175 | } |
3176 | |
3177 | /* Read flow based hash input set register */ |
3178 | if (flow_pctype) { |
3179 | i_set = (u64)i40e_read_rx_ctl(hw, I40E_GLQF_HASH_INSET(0, |
3180 | flow_pctype)) | |
3181 | ((u64)i40e_read_rx_ctl(hw, I40E_GLQF_HASH_INSET(1, |
3182 | flow_pctype)) << 32); |
3183 | } |
3184 | |
3185 | /* Process bits of hash input set */ |
3186 | if (i_set) { |
3187 | if (i_set & I40E_L4_SRC_MASK) |
3188 | cmd->data |= RXH_L4_B_0_1; |
3189 | if (i_set & I40E_L4_DST_MASK) |
3190 | cmd->data |= RXH_L4_B_2_3; |
3191 | |
3192 | if (cmd->flow_type == TCP_V4_FLOW || |
3193 | cmd->flow_type == UDP_V4_FLOW) { |
3194 | if (hw->mac.type == I40E_MAC_X722) { |
3195 | if (i_set & I40E_X722_L3_SRC_MASK) |
3196 | cmd->data |= RXH_IP_SRC; |
3197 | if (i_set & I40E_X722_L3_DST_MASK) |
3198 | cmd->data |= RXH_IP_DST; |
3199 | } else { |
3200 | if (i_set & I40E_L3_SRC_MASK) |
3201 | cmd->data |= RXH_IP_SRC; |
3202 | if (i_set & I40E_L3_DST_MASK) |
3203 | cmd->data |= RXH_IP_DST; |
3204 | } |
3205 | } else if (cmd->flow_type == TCP_V6_FLOW || |
3206 | cmd->flow_type == UDP_V6_FLOW) { |
3207 | if (i_set & I40E_L3_V6_SRC_MASK) |
3208 | cmd->data |= RXH_IP_SRC; |
3209 | if (i_set & I40E_L3_V6_DST_MASK) |
3210 | cmd->data |= RXH_IP_DST; |
3211 | } |
3212 | } |
3213 | |
3214 | return 0; |
3215 | } |
3216 | |
3217 | /** |
3218 | * i40e_check_mask - Check whether a mask field is set |
3219 | * @mask: the full mask value |
3220 | * @field: mask of the field to check |
3221 | * |
3222 | * If the given mask is fully set, return positive value. If the mask for the |
3223 | * field is fully unset, return zero. Otherwise return a negative error code. |
3224 | **/ |
3225 | static int i40e_check_mask(u64 mask, u64 field) |
3226 | { |
3227 | u64 value = mask & field; |
3228 | |
3229 | if (value == field) |
3230 | return 1; |
3231 | else if (!value) |
3232 | return 0; |
3233 | else |
3234 | return -1; |
3235 | } |
3236 | |
3237 | /** |
3238 | * i40e_parse_rx_flow_user_data - Deconstruct user-defined data |
3239 | * @fsp: pointer to rx flow specification |
3240 | * @data: pointer to userdef data structure for storage |
3241 | * |
3242 | * Read the user-defined data and deconstruct the value into a structure. No |
3243 | * other code should read the user-defined data, so as to ensure that every |
3244 | * place consistently reads the value correctly. |
3245 | * |
3246 | * The user-defined field is a 64bit Big Endian format value, which we |
3247 | * deconstruct by reading bits or bit fields from it. Single bit flags shall |
3248 | * be defined starting from the highest bits, while small bit field values |
3249 | * shall be defined starting from the lowest bits. |
3250 | * |
3251 | * Returns 0 if the data is valid, and non-zero if the userdef data is invalid |
3252 | * and the filter should be rejected. The data structure will always be |
3253 | * modified even if FLOW_EXT is not set. |
3254 | * |
3255 | **/ |
3256 | static int i40e_parse_rx_flow_user_data(struct ethtool_rx_flow_spec *fsp, |
3257 | struct i40e_rx_flow_userdef *data) |
3258 | { |
3259 | u64 value, mask; |
3260 | int valid; |
3261 | |
3262 | /* Zero memory first so it's always consistent. */ |
3263 | memset(data, 0, sizeof(*data)); |
3264 | |
3265 | if (!(fsp->flow_type & FLOW_EXT)) |
3266 | return 0; |
3267 | |
3268 | value = be64_to_cpu(*((__be64 *)fsp->h_ext.data)); |
3269 | mask = be64_to_cpu(*((__be64 *)fsp->m_ext.data)); |
3270 | |
3271 | #define I40E_USERDEF_FLEX_WORD GENMASK_ULL(15, 0) |
3272 | #define I40E_USERDEF_FLEX_OFFSET GENMASK_ULL(31, 16) |
3273 | #define I40E_USERDEF_FLEX_FILTER GENMASK_ULL(31, 0) |
3274 | |
3275 | valid = i40e_check_mask(mask, I40E_USERDEF_FLEX_FILTER); |
3276 | if (valid < 0) { |
3277 | return -EINVAL; |
3278 | } else if (valid) { |
3279 | data->flex_word = value & I40E_USERDEF_FLEX_WORD; |
3280 | data->flex_offset = |
3281 | (value & I40E_USERDEF_FLEX_OFFSET) >> 16; |
3282 | data->flex_filter = true; |
3283 | } |
3284 | |
3285 | return 0; |
3286 | } |
3287 | |
3288 | /** |
3289 | * i40e_fill_rx_flow_user_data - Fill in user-defined data field |
3290 | * @fsp: pointer to rx_flow specification |
3291 | * @data: pointer to return userdef data |
3292 | * |
3293 | * Reads the userdef data structure and properly fills in the user defined |
3294 | * fields of the rx_flow_spec. |
3295 | **/ |
3296 | static void i40e_fill_rx_flow_user_data(struct ethtool_rx_flow_spec *fsp, |
3297 | struct i40e_rx_flow_userdef *data) |
3298 | { |
3299 | u64 value = 0, mask = 0; |
3300 | |
3301 | if (data->flex_filter) { |
3302 | value |= data->flex_word; |
3303 | value |= (u64)data->flex_offset << 16; |
3304 | mask |= I40E_USERDEF_FLEX_FILTER; |
3305 | } |
3306 | |
3307 | if (value || mask) |
3308 | fsp->flow_type |= FLOW_EXT; |
3309 | |
3310 | *((__be64 *)fsp->h_ext.data) = cpu_to_be64(value); |
3311 | *((__be64 *)fsp->m_ext.data) = cpu_to_be64(mask); |
3312 | } |
3313 | |
3314 | /** |
3315 | * i40e_get_ethtool_fdir_all - Populates the rule count of a command |
3316 | * @pf: Pointer to the physical function struct |
3317 | * @cmd: The command to get or set Rx flow classification rules |
3318 | * @rule_locs: Array of used rule locations |
3319 | * |
3320 | * This function populates both the total and actual rule count of |
3321 | * the ethtool flow classification command |
3322 | * |
3323 | * Returns 0 on success or -EMSGSIZE if entry not found |
3324 | **/ |
3325 | static int i40e_get_ethtool_fdir_all(struct i40e_pf *pf, |
3326 | struct ethtool_rxnfc *cmd, |
3327 | u32 *rule_locs) |
3328 | { |
3329 | struct i40e_fdir_filter *rule; |
3330 | struct hlist_node *node2; |
3331 | int cnt = 0; |
3332 | |
3333 | /* report total rule count */ |
3334 | cmd->data = i40e_get_fd_cnt_all(pf); |
3335 | |
3336 | hlist_for_each_entry_safe(rule, node2, |
3337 | &pf->fdir_filter_list, fdir_node) { |
3338 | if (cnt == cmd->rule_cnt) |
3339 | return -EMSGSIZE; |
3340 | |
3341 | rule_locs[cnt] = rule->fd_id; |
3342 | cnt++; |
3343 | } |
3344 | |
3345 | cmd->rule_cnt = cnt; |
3346 | |
3347 | return 0; |
3348 | } |
3349 | |
3350 | /** |
3351 | * i40e_get_ethtool_fdir_entry - Look up a filter based on Rx flow |
3352 | * @pf: Pointer to the physical function struct |
3353 | * @cmd: The command to get or set Rx flow classification rules |
3354 | * |
3355 | * This function looks up a filter based on the Rx flow classification |
3356 | * command and fills the flow spec info for it if found |
3357 | * |
3358 | * Returns 0 on success or -EINVAL if filter not found |
3359 | **/ |
3360 | static int i40e_get_ethtool_fdir_entry(struct i40e_pf *pf, |
3361 | struct ethtool_rxnfc *cmd) |
3362 | { |
3363 | struct ethtool_rx_flow_spec *fsp = |
3364 | (struct ethtool_rx_flow_spec *)&cmd->fs; |
3365 | struct i40e_rx_flow_userdef userdef = {0}; |
3366 | struct i40e_fdir_filter *rule = NULL; |
3367 | struct hlist_node *node2; |
3368 | u64 input_set; |
3369 | u16 index; |
3370 | |
3371 | hlist_for_each_entry_safe(rule, node2, |
3372 | &pf->fdir_filter_list, fdir_node) { |
3373 | if (fsp->location <= rule->fd_id) |
3374 | break; |
3375 | } |
3376 | |
3377 | if (!rule || fsp->location != rule->fd_id) |
3378 | return -EINVAL; |
3379 | |
3380 | fsp->flow_type = rule->flow_type; |
3381 | if (fsp->flow_type == IP_USER_FLOW) { |
3382 | fsp->h_u.usr_ip4_spec.ip_ver = ETH_RX_NFC_IP4; |
3383 | fsp->h_u.usr_ip4_spec.proto = 0; |
3384 | fsp->m_u.usr_ip4_spec.proto = 0; |
3385 | } |
3386 | |
3387 | if (fsp->flow_type == IPV6_USER_FLOW || |
3388 | fsp->flow_type == UDP_V6_FLOW || |
3389 | fsp->flow_type == TCP_V6_FLOW || |
3390 | fsp->flow_type == SCTP_V6_FLOW) { |
3391 | /* Reverse the src and dest notion, since the HW views them |
3392 | * from Tx perspective where as the user expects it from |
3393 | * Rx filter view. |
3394 | */ |
3395 | fsp->h_u.tcp_ip6_spec.psrc = rule->dst_port; |
3396 | fsp->h_u.tcp_ip6_spec.pdst = rule->src_port; |
3397 | memcpy(fsp->h_u.tcp_ip6_spec.ip6dst, rule->src_ip6, |
3398 | sizeof(__be32) * 4); |
3399 | memcpy(fsp->h_u.tcp_ip6_spec.ip6src, rule->dst_ip6, |
3400 | sizeof(__be32) * 4); |
3401 | } else { |
3402 | /* Reverse the src and dest notion, since the HW views them |
3403 | * from Tx perspective where as the user expects it from |
3404 | * Rx filter view. |
3405 | */ |
3406 | fsp->h_u.tcp_ip4_spec.psrc = rule->dst_port; |
3407 | fsp->h_u.tcp_ip4_spec.pdst = rule->src_port; |
3408 | fsp->h_u.tcp_ip4_spec.ip4src = rule->dst_ip; |
3409 | fsp->h_u.tcp_ip4_spec.ip4dst = rule->src_ip; |
3410 | } |
3411 | |
3412 | switch (rule->flow_type) { |
3413 | case SCTP_V4_FLOW: |
3414 | index = I40E_FILTER_PCTYPE_NONF_IPV4_SCTP; |
3415 | break; |
3416 | case TCP_V4_FLOW: |
3417 | index = I40E_FILTER_PCTYPE_NONF_IPV4_TCP; |
3418 | break; |
3419 | case UDP_V4_FLOW: |
3420 | index = I40E_FILTER_PCTYPE_NONF_IPV4_UDP; |
3421 | break; |
3422 | case SCTP_V6_FLOW: |
3423 | index = I40E_FILTER_PCTYPE_NONF_IPV6_SCTP; |
3424 | break; |
3425 | case TCP_V6_FLOW: |
3426 | index = I40E_FILTER_PCTYPE_NONF_IPV6_TCP; |
3427 | break; |
3428 | case UDP_V6_FLOW: |
3429 | index = I40E_FILTER_PCTYPE_NONF_IPV6_UDP; |
3430 | break; |
3431 | case IP_USER_FLOW: |
3432 | index = I40E_FILTER_PCTYPE_NONF_IPV4_OTHER; |
3433 | break; |
3434 | case IPV6_USER_FLOW: |
3435 | index = I40E_FILTER_PCTYPE_NONF_IPV6_OTHER; |
3436 | break; |
3437 | default: |
3438 | /* If we have stored a filter with a flow type not listed here |
3439 | * it is almost certainly a driver bug. WARN(), and then |
3440 | * assign the input_set as if all fields are enabled to avoid |
3441 | * reading unassigned memory. |
3442 | */ |
3443 | WARN(1, "Missing input set index for flow_type %d\n" , |
3444 | rule->flow_type); |
3445 | input_set = 0xFFFFFFFFFFFFFFFFULL; |
3446 | goto no_input_set; |
3447 | } |
3448 | |
3449 | input_set = i40e_read_fd_input_set(pf, addr: index); |
3450 | |
3451 | no_input_set: |
3452 | if (input_set & I40E_L3_V6_SRC_MASK) { |
3453 | fsp->m_u.tcp_ip6_spec.ip6src[0] = htonl(0xFFFFFFFF); |
3454 | fsp->m_u.tcp_ip6_spec.ip6src[1] = htonl(0xFFFFFFFF); |
3455 | fsp->m_u.tcp_ip6_spec.ip6src[2] = htonl(0xFFFFFFFF); |
3456 | fsp->m_u.tcp_ip6_spec.ip6src[3] = htonl(0xFFFFFFFF); |
3457 | } |
3458 | |
3459 | if (input_set & I40E_L3_V6_DST_MASK) { |
3460 | fsp->m_u.tcp_ip6_spec.ip6dst[0] = htonl(0xFFFFFFFF); |
3461 | fsp->m_u.tcp_ip6_spec.ip6dst[1] = htonl(0xFFFFFFFF); |
3462 | fsp->m_u.tcp_ip6_spec.ip6dst[2] = htonl(0xFFFFFFFF); |
3463 | fsp->m_u.tcp_ip6_spec.ip6dst[3] = htonl(0xFFFFFFFF); |
3464 | } |
3465 | |
3466 | if (input_set & I40E_L3_SRC_MASK) |
3467 | fsp->m_u.tcp_ip4_spec.ip4src = htonl(0xFFFFFFFF); |
3468 | |
3469 | if (input_set & I40E_L3_DST_MASK) |
3470 | fsp->m_u.tcp_ip4_spec.ip4dst = htonl(0xFFFFFFFF); |
3471 | |
3472 | if (input_set & I40E_L4_SRC_MASK) |
3473 | fsp->m_u.tcp_ip4_spec.psrc = htons(0xFFFF); |
3474 | |
3475 | if (input_set & I40E_L4_DST_MASK) |
3476 | fsp->m_u.tcp_ip4_spec.pdst = htons(0xFFFF); |
3477 | |
3478 | if (rule->dest_ctl == I40E_FILTER_PROGRAM_DESC_DEST_DROP_PACKET) |
3479 | fsp->ring_cookie = RX_CLS_FLOW_DISC; |
3480 | else |
3481 | fsp->ring_cookie = rule->q_index; |
3482 | |
3483 | if (rule->vlan_tag) { |
3484 | fsp->h_ext.vlan_etype = rule->vlan_etype; |
3485 | fsp->m_ext.vlan_etype = htons(0xFFFF); |
3486 | fsp->h_ext.vlan_tci = rule->vlan_tag; |
3487 | fsp->m_ext.vlan_tci = htons(0xFFFF); |
3488 | fsp->flow_type |= FLOW_EXT; |
3489 | } |
3490 | |
3491 | if (rule->dest_vsi != pf->vsi[pf->lan_vsi]->id) { |
3492 | struct i40e_vsi *vsi; |
3493 | |
3494 | vsi = i40e_find_vsi_from_id(pf, id: rule->dest_vsi); |
3495 | if (vsi && vsi->type == I40E_VSI_SRIOV) { |
3496 | /* VFs are zero-indexed by the driver, but ethtool |
3497 | * expects them to be one-indexed, so add one here |
3498 | */ |
3499 | u64 ring_vf = vsi->vf_id + 1; |
3500 | |
3501 | ring_vf <<= ETHTOOL_RX_FLOW_SPEC_RING_VF_OFF; |
3502 | fsp->ring_cookie |= ring_vf; |
3503 | } |
3504 | } |
3505 | |
3506 | if (rule->flex_filter) { |
3507 | userdef.flex_filter = true; |
3508 | userdef.flex_word = be16_to_cpu(rule->flex_word); |
3509 | userdef.flex_offset = rule->flex_offset; |
3510 | } |
3511 | |
3512 | i40e_fill_rx_flow_user_data(fsp, data: &userdef); |
3513 | |
3514 | return 0; |
3515 | } |
3516 | |
3517 | /** |
3518 | * i40e_get_rxnfc - command to get RX flow classification rules |
3519 | * @netdev: network interface device structure |
3520 | * @cmd: ethtool rxnfc command |
3521 | * @rule_locs: pointer to store rule data |
3522 | * |
3523 | * Returns Success if the command is supported. |
3524 | **/ |
3525 | static int i40e_get_rxnfc(struct net_device *netdev, struct ethtool_rxnfc *cmd, |
3526 | u32 *rule_locs) |
3527 | { |
3528 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
3529 | struct i40e_vsi *vsi = np->vsi; |
3530 | struct i40e_pf *pf = vsi->back; |
3531 | int ret = -EOPNOTSUPP; |
3532 | |
3533 | switch (cmd->cmd) { |
3534 | case ETHTOOL_GRXRINGS: |
3535 | cmd->data = vsi->rss_size; |
3536 | ret = 0; |
3537 | break; |
3538 | case ETHTOOL_GRXFH: |
3539 | ret = i40e_get_rss_hash_opts(pf, cmd); |
3540 | break; |
3541 | case ETHTOOL_GRXCLSRLCNT: |
3542 | cmd->rule_cnt = pf->fdir_pf_active_filters; |
3543 | /* report total rule count */ |
3544 | cmd->data = i40e_get_fd_cnt_all(pf); |
3545 | ret = 0; |
3546 | break; |
3547 | case ETHTOOL_GRXCLSRULE: |
3548 | ret = i40e_get_ethtool_fdir_entry(pf, cmd); |
3549 | break; |
3550 | case ETHTOOL_GRXCLSRLALL: |
3551 | ret = i40e_get_ethtool_fdir_all(pf, cmd, rule_locs); |
3552 | break; |
3553 | default: |
3554 | break; |
3555 | } |
3556 | |
3557 | return ret; |
3558 | } |
3559 | |
3560 | /** |
3561 | * i40e_get_rss_hash_bits - Read RSS Hash bits from register |
3562 | * @hw: hw structure |
3563 | * @nfc: pointer to user request |
3564 | * @i_setc: bits currently set |
3565 | * |
3566 | * Returns value of bits to be set per user request |
3567 | **/ |
3568 | static u64 (struct i40e_hw *hw, |
3569 | struct ethtool_rxnfc *nfc, |
3570 | u64 i_setc) |
3571 | { |
3572 | u64 i_set = i_setc; |
3573 | u64 src_l3 = 0, dst_l3 = 0; |
3574 | |
3575 | if (nfc->data & RXH_L4_B_0_1) |
3576 | i_set |= I40E_L4_SRC_MASK; |
3577 | else |
3578 | i_set &= ~I40E_L4_SRC_MASK; |
3579 | if (nfc->data & RXH_L4_B_2_3) |
3580 | i_set |= I40E_L4_DST_MASK; |
3581 | else |
3582 | i_set &= ~I40E_L4_DST_MASK; |
3583 | |
3584 | if (nfc->flow_type == TCP_V6_FLOW || nfc->flow_type == UDP_V6_FLOW) { |
3585 | src_l3 = I40E_L3_V6_SRC_MASK; |
3586 | dst_l3 = I40E_L3_V6_DST_MASK; |
3587 | } else if (nfc->flow_type == TCP_V4_FLOW || |
3588 | nfc->flow_type == UDP_V4_FLOW) { |
3589 | if (hw->mac.type == I40E_MAC_X722) { |
3590 | src_l3 = I40E_X722_L3_SRC_MASK; |
3591 | dst_l3 = I40E_X722_L3_DST_MASK; |
3592 | } else { |
3593 | src_l3 = I40E_L3_SRC_MASK; |
3594 | dst_l3 = I40E_L3_DST_MASK; |
3595 | } |
3596 | } else { |
3597 | /* Any other flow type are not supported here */ |
3598 | return i_set; |
3599 | } |
3600 | |
3601 | if (nfc->data & RXH_IP_SRC) |
3602 | i_set |= src_l3; |
3603 | else |
3604 | i_set &= ~src_l3; |
3605 | if (nfc->data & RXH_IP_DST) |
3606 | i_set |= dst_l3; |
3607 | else |
3608 | i_set &= ~dst_l3; |
3609 | |
3610 | return i_set; |
3611 | } |
3612 | |
3613 | #define FLOW_PCTYPES_SIZE 64 |
3614 | /** |
3615 | * i40e_set_rss_hash_opt - Enable/Disable flow types for RSS hash |
3616 | * @pf: pointer to the physical function struct |
3617 | * @nfc: ethtool rxnfc command |
3618 | * |
3619 | * Returns Success if the flow input set is supported. |
3620 | **/ |
3621 | static int (struct i40e_pf *pf, struct ethtool_rxnfc *nfc) |
3622 | { |
3623 | struct i40e_hw *hw = &pf->hw; |
3624 | u64 hena = (u64)i40e_read_rx_ctl(hw, I40E_PFQF_HENA(0)) | |
3625 | ((u64)i40e_read_rx_ctl(hw, I40E_PFQF_HENA(1)) << 32); |
3626 | DECLARE_BITMAP(flow_pctypes, FLOW_PCTYPES_SIZE); |
3627 | u64 i_set, i_setc; |
3628 | |
3629 | bitmap_zero(dst: flow_pctypes, FLOW_PCTYPES_SIZE); |
3630 | |
3631 | if (pf->flags & I40E_FLAG_MFP_ENABLED) { |
3632 | dev_err(&pf->pdev->dev, |
3633 | "Change of RSS hash input set is not supported when MFP mode is enabled\n" ); |
3634 | return -EOPNOTSUPP; |
3635 | } |
3636 | |
3637 | /* RSS does not support anything other than hashing |
3638 | * to queues on src and dst IPs and ports |
3639 | */ |
3640 | if (nfc->data & ~(RXH_IP_SRC | RXH_IP_DST | |
3641 | RXH_L4_B_0_1 | RXH_L4_B_2_3)) |
3642 | return -EINVAL; |
3643 | |
3644 | switch (nfc->flow_type) { |
3645 | case TCP_V4_FLOW: |
3646 | set_bit(nr: I40E_FILTER_PCTYPE_NONF_IPV4_TCP, addr: flow_pctypes); |
3647 | if (pf->hw_features & I40E_HW_MULTIPLE_TCP_UDP_RSS_PCTYPE) |
3648 | set_bit(nr: I40E_FILTER_PCTYPE_NONF_IPV4_TCP_SYN_NO_ACK, |
3649 | addr: flow_pctypes); |
3650 | break; |
3651 | case TCP_V6_FLOW: |
3652 | set_bit(nr: I40E_FILTER_PCTYPE_NONF_IPV6_TCP, addr: flow_pctypes); |
3653 | if (pf->hw_features & I40E_HW_MULTIPLE_TCP_UDP_RSS_PCTYPE) |
3654 | set_bit(nr: I40E_FILTER_PCTYPE_NONF_IPV6_TCP_SYN_NO_ACK, |
3655 | addr: flow_pctypes); |
3656 | break; |
3657 | case UDP_V4_FLOW: |
3658 | set_bit(nr: I40E_FILTER_PCTYPE_NONF_IPV4_UDP, addr: flow_pctypes); |
3659 | if (pf->hw_features & I40E_HW_MULTIPLE_TCP_UDP_RSS_PCTYPE) { |
3660 | set_bit(nr: I40E_FILTER_PCTYPE_NONF_UNICAST_IPV4_UDP, |
3661 | addr: flow_pctypes); |
3662 | set_bit(nr: I40E_FILTER_PCTYPE_NONF_MULTICAST_IPV4_UDP, |
3663 | addr: flow_pctypes); |
3664 | } |
3665 | hena |= BIT_ULL(I40E_FILTER_PCTYPE_FRAG_IPV4); |
3666 | break; |
3667 | case UDP_V6_FLOW: |
3668 | set_bit(nr: I40E_FILTER_PCTYPE_NONF_IPV6_UDP, addr: flow_pctypes); |
3669 | if (pf->hw_features & I40E_HW_MULTIPLE_TCP_UDP_RSS_PCTYPE) { |
3670 | set_bit(nr: I40E_FILTER_PCTYPE_NONF_UNICAST_IPV6_UDP, |
3671 | addr: flow_pctypes); |
3672 | set_bit(nr: I40E_FILTER_PCTYPE_NONF_MULTICAST_IPV6_UDP, |
3673 | addr: flow_pctypes); |
3674 | } |
3675 | hena |= BIT_ULL(I40E_FILTER_PCTYPE_FRAG_IPV6); |
3676 | break; |
3677 | case AH_ESP_V4_FLOW: |
3678 | case AH_V4_FLOW: |
3679 | case ESP_V4_FLOW: |
3680 | case SCTP_V4_FLOW: |
3681 | if ((nfc->data & RXH_L4_B_0_1) || |
3682 | (nfc->data & RXH_L4_B_2_3)) |
3683 | return -EINVAL; |
3684 | hena |= BIT_ULL(I40E_FILTER_PCTYPE_NONF_IPV4_OTHER); |
3685 | break; |
3686 | case AH_ESP_V6_FLOW: |
3687 | case AH_V6_FLOW: |
3688 | case ESP_V6_FLOW: |
3689 | case SCTP_V6_FLOW: |
3690 | if ((nfc->data & RXH_L4_B_0_1) || |
3691 | (nfc->data & RXH_L4_B_2_3)) |
3692 | return -EINVAL; |
3693 | hena |= BIT_ULL(I40E_FILTER_PCTYPE_NONF_IPV6_OTHER); |
3694 | break; |
3695 | case IPV4_FLOW: |
3696 | hena |= BIT_ULL(I40E_FILTER_PCTYPE_NONF_IPV4_OTHER) | |
3697 | BIT_ULL(I40E_FILTER_PCTYPE_FRAG_IPV4); |
3698 | break; |
3699 | case IPV6_FLOW: |
3700 | hena |= BIT_ULL(I40E_FILTER_PCTYPE_NONF_IPV6_OTHER) | |
3701 | BIT_ULL(I40E_FILTER_PCTYPE_FRAG_IPV6); |
3702 | break; |
3703 | default: |
3704 | return -EINVAL; |
3705 | } |
3706 | |
3707 | if (bitmap_weight(src: flow_pctypes, FLOW_PCTYPES_SIZE)) { |
3708 | u8 flow_id; |
3709 | |
3710 | for_each_set_bit(flow_id, flow_pctypes, FLOW_PCTYPES_SIZE) { |
3711 | i_setc = (u64)i40e_read_rx_ctl(hw, I40E_GLQF_HASH_INSET(0, flow_id)) | |
3712 | ((u64)i40e_read_rx_ctl(hw, I40E_GLQF_HASH_INSET(1, flow_id)) << 32); |
3713 | i_set = i40e_get_rss_hash_bits(hw: &pf->hw, nfc, i_setc); |
3714 | |
3715 | i40e_write_rx_ctl(hw, I40E_GLQF_HASH_INSET(0, flow_id), |
3716 | reg_val: (u32)i_set); |
3717 | i40e_write_rx_ctl(hw, I40E_GLQF_HASH_INSET(1, flow_id), |
3718 | reg_val: (u32)(i_set >> 32)); |
3719 | hena |= BIT_ULL(flow_id); |
3720 | } |
3721 | } |
3722 | |
3723 | i40e_write_rx_ctl(hw, I40E_PFQF_HENA(0), reg_val: (u32)hena); |
3724 | i40e_write_rx_ctl(hw, I40E_PFQF_HENA(1), reg_val: (u32)(hena >> 32)); |
3725 | i40e_flush(hw); |
3726 | |
3727 | return 0; |
3728 | } |
3729 | |
3730 | /** |
3731 | * i40e_update_ethtool_fdir_entry - Updates the fdir filter entry |
3732 | * @vsi: Pointer to the targeted VSI |
3733 | * @input: The filter to update or NULL to indicate deletion |
3734 | * @sw_idx: Software index to the filter |
3735 | * @cmd: The command to get or set Rx flow classification rules |
3736 | * |
3737 | * This function updates (or deletes) a Flow Director entry from |
3738 | * the hlist of the corresponding PF |
3739 | * |
3740 | * Returns 0 on success |
3741 | **/ |
3742 | static int i40e_update_ethtool_fdir_entry(struct i40e_vsi *vsi, |
3743 | struct i40e_fdir_filter *input, |
3744 | u16 sw_idx, |
3745 | struct ethtool_rxnfc *cmd) |
3746 | { |
3747 | struct i40e_fdir_filter *rule, *parent; |
3748 | struct i40e_pf *pf = vsi->back; |
3749 | struct hlist_node *node2; |
3750 | int err = -EINVAL; |
3751 | |
3752 | parent = NULL; |
3753 | rule = NULL; |
3754 | |
3755 | hlist_for_each_entry_safe(rule, node2, |
3756 | &pf->fdir_filter_list, fdir_node) { |
3757 | /* hash found, or no matching entry */ |
3758 | if (rule->fd_id >= sw_idx) |
3759 | break; |
3760 | parent = rule; |
3761 | } |
3762 | |
3763 | /* if there is an old rule occupying our place remove it */ |
3764 | if (rule && (rule->fd_id == sw_idx)) { |
3765 | /* Remove this rule, since we're either deleting it, or |
3766 | * replacing it. |
3767 | */ |
3768 | err = i40e_add_del_fdir(vsi, input: rule, add: false); |
3769 | hlist_del(n: &rule->fdir_node); |
3770 | kfree(objp: rule); |
3771 | pf->fdir_pf_active_filters--; |
3772 | } |
3773 | |
3774 | /* If we weren't given an input, this is a delete, so just return the |
3775 | * error code indicating if there was an entry at the requested slot |
3776 | */ |
3777 | if (!input) |
3778 | return err; |
3779 | |
3780 | /* Otherwise, install the new rule as requested */ |
3781 | INIT_HLIST_NODE(h: &input->fdir_node); |
3782 | |
3783 | /* add filter to the list */ |
3784 | if (parent) |
3785 | hlist_add_behind(n: &input->fdir_node, prev: &parent->fdir_node); |
3786 | else |
3787 | hlist_add_head(n: &input->fdir_node, |
3788 | h: &pf->fdir_filter_list); |
3789 | |
3790 | /* update counts */ |
3791 | pf->fdir_pf_active_filters++; |
3792 | |
3793 | return 0; |
3794 | } |
3795 | |
3796 | /** |
3797 | * i40e_prune_flex_pit_list - Cleanup unused entries in FLX_PIT table |
3798 | * @pf: pointer to PF structure |
3799 | * |
3800 | * This function searches the list of filters and determines which FLX_PIT |
3801 | * entries are still required. It will prune any entries which are no longer |
3802 | * in use after the deletion. |
3803 | **/ |
3804 | static void i40e_prune_flex_pit_list(struct i40e_pf *pf) |
3805 | { |
3806 | struct i40e_flex_pit *entry, *tmp; |
3807 | struct i40e_fdir_filter *rule; |
3808 | |
3809 | /* First, we'll check the l3 table */ |
3810 | list_for_each_entry_safe(entry, tmp, &pf->l3_flex_pit_list, list) { |
3811 | bool found = false; |
3812 | |
3813 | hlist_for_each_entry(rule, &pf->fdir_filter_list, fdir_node) { |
3814 | if (rule->flow_type != IP_USER_FLOW) |
3815 | continue; |
3816 | if (rule->flex_filter && |
3817 | rule->flex_offset == entry->src_offset) { |
3818 | found = true; |
3819 | break; |
3820 | } |
3821 | } |
3822 | |
3823 | /* If we didn't find the filter, then we can prune this entry |
3824 | * from the list. |
3825 | */ |
3826 | if (!found) { |
3827 | list_del(entry: &entry->list); |
3828 | kfree(objp: entry); |
3829 | } |
3830 | } |
3831 | |
3832 | /* Followed by the L4 table */ |
3833 | list_for_each_entry_safe(entry, tmp, &pf->l4_flex_pit_list, list) { |
3834 | bool found = false; |
3835 | |
3836 | hlist_for_each_entry(rule, &pf->fdir_filter_list, fdir_node) { |
3837 | /* Skip this filter if it's L3, since we already |
3838 | * checked those in the above loop |
3839 | */ |
3840 | if (rule->flow_type == IP_USER_FLOW) |
3841 | continue; |
3842 | if (rule->flex_filter && |
3843 | rule->flex_offset == entry->src_offset) { |
3844 | found = true; |
3845 | break; |
3846 | } |
3847 | } |
3848 | |
3849 | /* If we didn't find the filter, then we can prune this entry |
3850 | * from the list. |
3851 | */ |
3852 | if (!found) { |
3853 | list_del(entry: &entry->list); |
3854 | kfree(objp: entry); |
3855 | } |
3856 | } |
3857 | } |
3858 | |
3859 | /** |
3860 | * i40e_del_fdir_entry - Deletes a Flow Director filter entry |
3861 | * @vsi: Pointer to the targeted VSI |
3862 | * @cmd: The command to get or set Rx flow classification rules |
3863 | * |
3864 | * The function removes a Flow Director filter entry from the |
3865 | * hlist of the corresponding PF |
3866 | * |
3867 | * Returns 0 on success |
3868 | */ |
3869 | static int i40e_del_fdir_entry(struct i40e_vsi *vsi, |
3870 | struct ethtool_rxnfc *cmd) |
3871 | { |
3872 | struct ethtool_rx_flow_spec *fsp = |
3873 | (struct ethtool_rx_flow_spec *)&cmd->fs; |
3874 | struct i40e_pf *pf = vsi->back; |
3875 | int ret = 0; |
3876 | |
3877 | if (test_bit(__I40E_RESET_RECOVERY_PENDING, pf->state) || |
3878 | test_bit(__I40E_RESET_INTR_RECEIVED, pf->state)) |
3879 | return -EBUSY; |
3880 | |
3881 | if (test_bit(__I40E_FD_FLUSH_REQUESTED, pf->state)) |
3882 | return -EBUSY; |
3883 | |
3884 | ret = i40e_update_ethtool_fdir_entry(vsi, NULL, sw_idx: fsp->location, cmd); |
3885 | |
3886 | i40e_prune_flex_pit_list(pf); |
3887 | |
3888 | i40e_fdir_check_and_reenable(pf); |
3889 | return ret; |
3890 | } |
3891 | |
3892 | /** |
3893 | * i40e_unused_pit_index - Find an unused PIT index for given list |
3894 | * @pf: the PF data structure |
3895 | * |
3896 | * Find the first unused flexible PIT index entry. We search both the L3 and |
3897 | * L4 flexible PIT lists so that the returned index is unique and unused by |
3898 | * either currently programmed L3 or L4 filters. We use a bit field as storage |
3899 | * to track which indexes are already used. |
3900 | **/ |
3901 | static u8 i40e_unused_pit_index(struct i40e_pf *pf) |
3902 | { |
3903 | unsigned long available_index = 0xFF; |
3904 | struct i40e_flex_pit *entry; |
3905 | |
3906 | /* We need to make sure that the new index isn't in use by either L3 |
3907 | * or L4 filters so that IP_USER_FLOW filters can program both L3 and |
3908 | * L4 to use the same index. |
3909 | */ |
3910 | |
3911 | list_for_each_entry(entry, &pf->l4_flex_pit_list, list) |
3912 | clear_bit(nr: entry->pit_index, addr: &available_index); |
3913 | |
3914 | list_for_each_entry(entry, &pf->l3_flex_pit_list, list) |
3915 | clear_bit(nr: entry->pit_index, addr: &available_index); |
3916 | |
3917 | return find_first_bit(addr: &available_index, size: 8); |
3918 | } |
3919 | |
3920 | /** |
3921 | * i40e_find_flex_offset - Find an existing flex src_offset |
3922 | * @flex_pit_list: L3 or L4 flex PIT list |
3923 | * @src_offset: new src_offset to find |
3924 | * |
3925 | * Searches the flex_pit_list for an existing offset. If no offset is |
3926 | * currently programmed, then this will return an ERR_PTR if there is no space |
3927 | * to add a new offset, otherwise it returns NULL. |
3928 | **/ |
3929 | static |
3930 | struct i40e_flex_pit *i40e_find_flex_offset(struct list_head *flex_pit_list, |
3931 | u16 src_offset) |
3932 | { |
3933 | struct i40e_flex_pit *entry; |
3934 | int size = 0; |
3935 | |
3936 | /* Search for the src_offset first. If we find a matching entry |
3937 | * already programmed, we can simply re-use it. |
3938 | */ |
3939 | list_for_each_entry(entry, flex_pit_list, list) { |
3940 | size++; |
3941 | if (entry->src_offset == src_offset) |
3942 | return entry; |
3943 | } |
3944 | |
3945 | /* If we haven't found an entry yet, then the provided src offset has |
3946 | * not yet been programmed. We will program the src offset later on, |
3947 | * but we need to indicate whether there is enough space to do so |
3948 | * here. We'll make use of ERR_PTR for this purpose. |
3949 | */ |
3950 | if (size >= I40E_FLEX_PIT_TABLE_SIZE) |
3951 | return ERR_PTR(error: -ENOSPC); |
3952 | |
3953 | return NULL; |
3954 | } |
3955 | |
3956 | /** |
3957 | * i40e_add_flex_offset - Add src_offset to flex PIT table list |
3958 | * @flex_pit_list: L3 or L4 flex PIT list |
3959 | * @src_offset: new src_offset to add |
3960 | * @pit_index: the PIT index to program |
3961 | * |
3962 | * This function programs the new src_offset to the list. It is expected that |
3963 | * i40e_find_flex_offset has already been tried and returned NULL, indicating |
3964 | * that this offset is not programmed, and that the list has enough space to |
3965 | * store another offset. |
3966 | * |
3967 | * Returns 0 on success, and negative value on error. |
3968 | **/ |
3969 | static int i40e_add_flex_offset(struct list_head *flex_pit_list, |
3970 | u16 src_offset, |
3971 | u8 pit_index) |
3972 | { |
3973 | struct i40e_flex_pit *new_pit, *entry; |
3974 | |
3975 | new_pit = kzalloc(size: sizeof(*entry), GFP_KERNEL); |
3976 | if (!new_pit) |
3977 | return -ENOMEM; |
3978 | |
3979 | new_pit->src_offset = src_offset; |
3980 | new_pit->pit_index = pit_index; |
3981 | |
3982 | /* We need to insert this item such that the list is sorted by |
3983 | * src_offset in ascending order. |
3984 | */ |
3985 | list_for_each_entry(entry, flex_pit_list, list) { |
3986 | if (new_pit->src_offset < entry->src_offset) { |
3987 | list_add_tail(new: &new_pit->list, head: &entry->list); |
3988 | return 0; |
3989 | } |
3990 | |
3991 | /* If we found an entry with our offset already programmed we |
3992 | * can simply return here, after freeing the memory. However, |
3993 | * if the pit_index does not match we need to report an error. |
3994 | */ |
3995 | if (new_pit->src_offset == entry->src_offset) { |
3996 | int err = 0; |
3997 | |
3998 | /* If the PIT index is not the same we can't re-use |
3999 | * the entry, so we must report an error. |
4000 | */ |
4001 | if (new_pit->pit_index != entry->pit_index) |
4002 | err = -EINVAL; |
4003 | |
4004 | kfree(objp: new_pit); |
4005 | return err; |
4006 | } |
4007 | } |
4008 | |
4009 | /* If we reached here, then we haven't yet added the item. This means |
4010 | * that we should add the item at the end of the list. |
4011 | */ |
4012 | list_add_tail(new: &new_pit->list, head: flex_pit_list); |
4013 | return 0; |
4014 | } |
4015 | |
4016 | /** |
4017 | * __i40e_reprogram_flex_pit - Re-program specific FLX_PIT table |
4018 | * @pf: Pointer to the PF structure |
4019 | * @flex_pit_list: list of flexible src offsets in use |
4020 | * @flex_pit_start: index to first entry for this section of the table |
4021 | * |
4022 | * In order to handle flexible data, the hardware uses a table of values |
4023 | * called the FLX_PIT table. This table is used to indicate which sections of |
4024 | * the input correspond to what PIT index values. Unfortunately, hardware is |
4025 | * very restrictive about programming this table. Entries must be ordered by |
4026 | * src_offset in ascending order, without duplicates. Additionally, unused |
4027 | * entries must be set to the unused index value, and must have valid size and |
4028 | * length according to the src_offset ordering. |
4029 | * |
4030 | * This function will reprogram the FLX_PIT register from a book-keeping |
4031 | * structure that we guarantee is already ordered correctly, and has no more |
4032 | * than 3 entries. |
4033 | * |
4034 | * To make things easier, we only support flexible values of one word length, |
4035 | * rather than allowing variable length flexible values. |
4036 | **/ |
4037 | static void __i40e_reprogram_flex_pit(struct i40e_pf *pf, |
4038 | struct list_head *flex_pit_list, |
4039 | int flex_pit_start) |
4040 | { |
4041 | struct i40e_flex_pit *entry = NULL; |
4042 | u16 last_offset = 0; |
4043 | int i = 0, j = 0; |
4044 | |
4045 | /* First, loop over the list of flex PIT entries, and reprogram the |
4046 | * registers. |
4047 | */ |
4048 | list_for_each_entry(entry, flex_pit_list, list) { |
4049 | /* We have to be careful when programming values for the |
4050 | * largest SRC_OFFSET value. It is possible that adding |
4051 | * additional empty values at the end would overflow the space |
4052 | * for the SRC_OFFSET in the FLX_PIT register. To avoid this, |
4053 | * we check here and add the empty values prior to adding the |
4054 | * largest value. |
4055 | * |
4056 | * To determine this, we will use a loop from i+1 to 3, which |
4057 | * will determine whether the unused entries would have valid |
4058 | * SRC_OFFSET. Note that there cannot be extra entries past |
4059 | * this value, because the only valid values would have been |
4060 | * larger than I40E_MAX_FLEX_SRC_OFFSET, and thus would not |
4061 | * have been added to the list in the first place. |
4062 | */ |
4063 | for (j = i + 1; j < 3; j++) { |
4064 | u16 offset = entry->src_offset + j; |
4065 | int index = flex_pit_start + i; |
4066 | u32 value = I40E_FLEX_PREP_VAL(I40E_FLEX_DEST_UNUSED, |
4067 | 1, |
4068 | offset - 3); |
4069 | |
4070 | if (offset > I40E_MAX_FLEX_SRC_OFFSET) { |
4071 | i40e_write_rx_ctl(hw: &pf->hw, |
4072 | I40E_PRTQF_FLX_PIT(index), |
4073 | reg_val: value); |
4074 | i++; |
4075 | } |
4076 | } |
4077 | |
4078 | /* Now, we can program the actual value into the table */ |
4079 | i40e_write_rx_ctl(hw: &pf->hw, |
4080 | I40E_PRTQF_FLX_PIT(flex_pit_start + i), |
4081 | I40E_FLEX_PREP_VAL(entry->pit_index + 50, |
4082 | 1, |
4083 | entry->src_offset)); |
4084 | i++; |
4085 | } |
4086 | |
4087 | /* In order to program the last entries in the table, we need to |
4088 | * determine the valid offset. If the list is empty, we'll just start |
4089 | * with 0. Otherwise, we'll start with the last item offset and add 1. |
4090 | * This ensures that all entries have valid sizes. If we don't do this |
4091 | * correctly, the hardware will disable flexible field parsing. |
4092 | */ |
4093 | if (!list_empty(head: flex_pit_list)) |
4094 | last_offset = list_prev_entry(entry, list)->src_offset + 1; |
4095 | |
4096 | for (; i < 3; i++, last_offset++) { |
4097 | i40e_write_rx_ctl(hw: &pf->hw, |
4098 | I40E_PRTQF_FLX_PIT(flex_pit_start + i), |
4099 | I40E_FLEX_PREP_VAL(I40E_FLEX_DEST_UNUSED, |
4100 | 1, |
4101 | last_offset)); |
4102 | } |
4103 | } |
4104 | |
4105 | /** |
4106 | * i40e_reprogram_flex_pit - Reprogram all FLX_PIT tables after input set change |
4107 | * @pf: pointer to the PF structure |
4108 | * |
4109 | * This function reprograms both the L3 and L4 FLX_PIT tables. See the |
4110 | * internal helper function for implementation details. |
4111 | **/ |
4112 | static void i40e_reprogram_flex_pit(struct i40e_pf *pf) |
4113 | { |
4114 | __i40e_reprogram_flex_pit(pf, flex_pit_list: &pf->l3_flex_pit_list, |
4115 | I40E_FLEX_PIT_IDX_START_L3); |
4116 | |
4117 | __i40e_reprogram_flex_pit(pf, flex_pit_list: &pf->l4_flex_pit_list, |
4118 | I40E_FLEX_PIT_IDX_START_L4); |
4119 | |
4120 | /* We also need to program the L3 and L4 GLQF ORT register */ |
4121 | i40e_write_rx_ctl(hw: &pf->hw, |
4122 | I40E_GLQF_ORT(I40E_L3_GLQF_ORT_IDX), |
4123 | I40E_ORT_PREP_VAL(I40E_FLEX_PIT_IDX_START_L3, |
4124 | 3, 1)); |
4125 | |
4126 | i40e_write_rx_ctl(hw: &pf->hw, |
4127 | I40E_GLQF_ORT(I40E_L4_GLQF_ORT_IDX), |
4128 | I40E_ORT_PREP_VAL(I40E_FLEX_PIT_IDX_START_L4, |
4129 | 3, 1)); |
4130 | } |
4131 | |
4132 | /** |
4133 | * i40e_flow_str - Converts a flow_type into a human readable string |
4134 | * @fsp: the flow specification |
4135 | * |
4136 | * Currently only flow types we support are included here, and the string |
4137 | * value attempts to match what ethtool would use to configure this flow type. |
4138 | **/ |
4139 | static const char *i40e_flow_str(struct ethtool_rx_flow_spec *fsp) |
4140 | { |
4141 | switch (fsp->flow_type & ~FLOW_EXT) { |
4142 | case TCP_V4_FLOW: |
4143 | return "tcp4" ; |
4144 | case UDP_V4_FLOW: |
4145 | return "udp4" ; |
4146 | case SCTP_V4_FLOW: |
4147 | return "sctp4" ; |
4148 | case IP_USER_FLOW: |
4149 | return "ip4" ; |
4150 | case TCP_V6_FLOW: |
4151 | return "tcp6" ; |
4152 | case UDP_V6_FLOW: |
4153 | return "udp6" ; |
4154 | case SCTP_V6_FLOW: |
4155 | return "sctp6" ; |
4156 | case IPV6_USER_FLOW: |
4157 | return "ip6" ; |
4158 | default: |
4159 | return "unknown" ; |
4160 | } |
4161 | } |
4162 | |
4163 | /** |
4164 | * i40e_pit_index_to_mask - Return the FLEX mask for a given PIT index |
4165 | * @pit_index: PIT index to convert |
4166 | * |
4167 | * Returns the mask for a given PIT index. Will return 0 if the pit_index is |
4168 | * of range. |
4169 | **/ |
4170 | static u64 i40e_pit_index_to_mask(int pit_index) |
4171 | { |
4172 | switch (pit_index) { |
4173 | case 0: |
4174 | return I40E_FLEX_50_MASK; |
4175 | case 1: |
4176 | return I40E_FLEX_51_MASK; |
4177 | case 2: |
4178 | return I40E_FLEX_52_MASK; |
4179 | case 3: |
4180 | return I40E_FLEX_53_MASK; |
4181 | case 4: |
4182 | return I40E_FLEX_54_MASK; |
4183 | case 5: |
4184 | return I40E_FLEX_55_MASK; |
4185 | case 6: |
4186 | return I40E_FLEX_56_MASK; |
4187 | case 7: |
4188 | return I40E_FLEX_57_MASK; |
4189 | default: |
4190 | return 0; |
4191 | } |
4192 | } |
4193 | |
4194 | /** |
4195 | * i40e_print_input_set - Show changes between two input sets |
4196 | * @vsi: the vsi being configured |
4197 | * @old: the old input set |
4198 | * @new: the new input set |
4199 | * |
4200 | * Print the difference between old and new input sets by showing which series |
4201 | * of words are toggled on or off. Only displays the bits we actually support |
4202 | * changing. |
4203 | **/ |
4204 | static void i40e_print_input_set(struct i40e_vsi *vsi, u64 old, u64 new) |
4205 | { |
4206 | struct i40e_pf *pf = vsi->back; |
4207 | bool old_value, new_value; |
4208 | int i; |
4209 | |
4210 | old_value = !!(old & I40E_L3_SRC_MASK); |
4211 | new_value = !!(new & I40E_L3_SRC_MASK); |
4212 | if (old_value != new_value) |
4213 | netif_info(pf, drv, vsi->netdev, "L3 source address: %s -> %s\n" , |
4214 | old_value ? "ON" : "OFF" , |
4215 | new_value ? "ON" : "OFF" ); |
4216 | |
4217 | old_value = !!(old & I40E_L3_DST_MASK); |
4218 | new_value = !!(new & I40E_L3_DST_MASK); |
4219 | if (old_value != new_value) |
4220 | netif_info(pf, drv, vsi->netdev, "L3 destination address: %s -> %s\n" , |
4221 | old_value ? "ON" : "OFF" , |
4222 | new_value ? "ON" : "OFF" ); |
4223 | |
4224 | old_value = !!(old & I40E_L4_SRC_MASK); |
4225 | new_value = !!(new & I40E_L4_SRC_MASK); |
4226 | if (old_value != new_value) |
4227 | netif_info(pf, drv, vsi->netdev, "L4 source port: %s -> %s\n" , |
4228 | old_value ? "ON" : "OFF" , |
4229 | new_value ? "ON" : "OFF" ); |
4230 | |
4231 | old_value = !!(old & I40E_L4_DST_MASK); |
4232 | new_value = !!(new & I40E_L4_DST_MASK); |
4233 | if (old_value != new_value) |
4234 | netif_info(pf, drv, vsi->netdev, "L4 destination port: %s -> %s\n" , |
4235 | old_value ? "ON" : "OFF" , |
4236 | new_value ? "ON" : "OFF" ); |
4237 | |
4238 | old_value = !!(old & I40E_VERIFY_TAG_MASK); |
4239 | new_value = !!(new & I40E_VERIFY_TAG_MASK); |
4240 | if (old_value != new_value) |
4241 | netif_info(pf, drv, vsi->netdev, "SCTP verification tag: %s -> %s\n" , |
4242 | old_value ? "ON" : "OFF" , |
4243 | new_value ? "ON" : "OFF" ); |
4244 | |
4245 | /* Show change of flexible filter entries */ |
4246 | for (i = 0; i < I40E_FLEX_INDEX_ENTRIES; i++) { |
4247 | u64 flex_mask = i40e_pit_index_to_mask(pit_index: i); |
4248 | |
4249 | old_value = !!(old & flex_mask); |
4250 | new_value = !!(new & flex_mask); |
4251 | if (old_value != new_value) |
4252 | netif_info(pf, drv, vsi->netdev, "FLEX index %d: %s -> %s\n" , |
4253 | i, |
4254 | old_value ? "ON" : "OFF" , |
4255 | new_value ? "ON" : "OFF" ); |
4256 | } |
4257 | |
4258 | netif_info(pf, drv, vsi->netdev, " Current input set: %0llx\n" , |
4259 | old); |
4260 | netif_info(pf, drv, vsi->netdev, "Requested input set: %0llx\n" , |
4261 | new); |
4262 | } |
4263 | |
4264 | /** |
4265 | * i40e_check_fdir_input_set - Check that a given rx_flow_spec mask is valid |
4266 | * @vsi: pointer to the targeted VSI |
4267 | * @fsp: pointer to Rx flow specification |
4268 | * @userdef: userdefined data from flow specification |
4269 | * |
4270 | * Ensures that a given ethtool_rx_flow_spec has a valid mask. Some support |
4271 | * for partial matches exists with a few limitations. First, hardware only |
4272 | * supports masking by word boundary (2 bytes) and not per individual bit. |
4273 | * Second, hardware is limited to using one mask for a flow type and cannot |
4274 | * use a separate mask for each filter. |
4275 | * |
4276 | * To support these limitations, if we already have a configured filter for |
4277 | * the specified type, this function enforces that new filters of the type |
4278 | * match the configured input set. Otherwise, if we do not have a filter of |
4279 | * the specified type, we allow the input set to be updated to match the |
4280 | * desired filter. |
4281 | * |
4282 | * To help ensure that administrators understand why filters weren't displayed |
4283 | * as supported, we print a diagnostic message displaying how the input set |
4284 | * would change and warning to delete the preexisting filters if required. |
4285 | * |
4286 | * Returns 0 on successful input set match, and a negative return code on |
4287 | * failure. |
4288 | **/ |
4289 | static int i40e_check_fdir_input_set(struct i40e_vsi *vsi, |
4290 | struct ethtool_rx_flow_spec *fsp, |
4291 | struct i40e_rx_flow_userdef *userdef) |
4292 | { |
4293 | static const __be32 ipv6_full_mask[4] = {cpu_to_be32(0xffffffff), |
4294 | cpu_to_be32(0xffffffff), cpu_to_be32(0xffffffff), |
4295 | cpu_to_be32(0xffffffff)}; |
4296 | struct ethtool_tcpip6_spec *tcp_ip6_spec; |
4297 | struct ethtool_usrip6_spec *usr_ip6_spec; |
4298 | struct ethtool_tcpip4_spec *tcp_ip4_spec; |
4299 | struct ethtool_usrip4_spec *usr_ip4_spec; |
4300 | struct i40e_pf *pf = vsi->back; |
4301 | u64 current_mask, new_mask; |
4302 | bool new_flex_offset = false; |
4303 | bool flex_l3 = false; |
4304 | u16 *fdir_filter_count; |
4305 | u16 index, src_offset = 0; |
4306 | u8 pit_index = 0; |
4307 | int err; |
4308 | |
4309 | switch (fsp->flow_type & ~FLOW_EXT) { |
4310 | case SCTP_V4_FLOW: |
4311 | index = I40E_FILTER_PCTYPE_NONF_IPV4_SCTP; |
4312 | fdir_filter_count = &pf->fd_sctp4_filter_cnt; |
4313 | break; |
4314 | case TCP_V4_FLOW: |
4315 | index = I40E_FILTER_PCTYPE_NONF_IPV4_TCP; |
4316 | fdir_filter_count = &pf->fd_tcp4_filter_cnt; |
4317 | break; |
4318 | case UDP_V4_FLOW: |
4319 | index = I40E_FILTER_PCTYPE_NONF_IPV4_UDP; |
4320 | fdir_filter_count = &pf->fd_udp4_filter_cnt; |
4321 | break; |
4322 | case SCTP_V6_FLOW: |
4323 | index = I40E_FILTER_PCTYPE_NONF_IPV6_SCTP; |
4324 | fdir_filter_count = &pf->fd_sctp6_filter_cnt; |
4325 | break; |
4326 | case TCP_V6_FLOW: |
4327 | index = I40E_FILTER_PCTYPE_NONF_IPV6_TCP; |
4328 | fdir_filter_count = &pf->fd_tcp6_filter_cnt; |
4329 | break; |
4330 | case UDP_V6_FLOW: |
4331 | index = I40E_FILTER_PCTYPE_NONF_IPV6_UDP; |
4332 | fdir_filter_count = &pf->fd_udp6_filter_cnt; |
4333 | break; |
4334 | case IP_USER_FLOW: |
4335 | index = I40E_FILTER_PCTYPE_NONF_IPV4_OTHER; |
4336 | fdir_filter_count = &pf->fd_ip4_filter_cnt; |
4337 | flex_l3 = true; |
4338 | break; |
4339 | case IPV6_USER_FLOW: |
4340 | index = I40E_FILTER_PCTYPE_NONF_IPV6_OTHER; |
4341 | fdir_filter_count = &pf->fd_ip6_filter_cnt; |
4342 | flex_l3 = true; |
4343 | break; |
4344 | default: |
4345 | return -EOPNOTSUPP; |
4346 | } |
4347 | |
4348 | /* Read the current input set from register memory. */ |
4349 | current_mask = i40e_read_fd_input_set(pf, addr: index); |
4350 | new_mask = current_mask; |
4351 | |
4352 | /* Determine, if any, the required changes to the input set in order |
4353 | * to support the provided mask. |
4354 | * |
4355 | * Hardware only supports masking at word (2 byte) granularity and does |
4356 | * not support full bitwise masking. This implementation simplifies |
4357 | * even further and only supports fully enabled or fully disabled |
4358 | * masks for each field, even though we could split the ip4src and |
4359 | * ip4dst fields. |
4360 | */ |
4361 | switch (fsp->flow_type & ~FLOW_EXT) { |
4362 | case SCTP_V4_FLOW: |
4363 | new_mask &= ~I40E_VERIFY_TAG_MASK; |
4364 | fallthrough; |
4365 | case TCP_V4_FLOW: |
4366 | case UDP_V4_FLOW: |
4367 | tcp_ip4_spec = &fsp->m_u.tcp_ip4_spec; |
4368 | |
4369 | /* IPv4 source address */ |
4370 | if (tcp_ip4_spec->ip4src == htonl(0xFFFFFFFF)) |
4371 | new_mask |= I40E_L3_SRC_MASK; |
4372 | else if (!tcp_ip4_spec->ip4src) |
4373 | new_mask &= ~I40E_L3_SRC_MASK; |
4374 | else |
4375 | return -EOPNOTSUPP; |
4376 | |
4377 | /* IPv4 destination address */ |
4378 | if (tcp_ip4_spec->ip4dst == htonl(0xFFFFFFFF)) |
4379 | new_mask |= I40E_L3_DST_MASK; |
4380 | else if (!tcp_ip4_spec->ip4dst) |
4381 | new_mask &= ~I40E_L3_DST_MASK; |
4382 | else |
4383 | return -EOPNOTSUPP; |
4384 | |
4385 | /* L4 source port */ |
4386 | if (tcp_ip4_spec->psrc == htons(0xFFFF)) |
4387 | new_mask |= I40E_L4_SRC_MASK; |
4388 | else if (!tcp_ip4_spec->psrc) |
4389 | new_mask &= ~I40E_L4_SRC_MASK; |
4390 | else |
4391 | return -EOPNOTSUPP; |
4392 | |
4393 | /* L4 destination port */ |
4394 | if (tcp_ip4_spec->pdst == htons(0xFFFF)) |
4395 | new_mask |= I40E_L4_DST_MASK; |
4396 | else if (!tcp_ip4_spec->pdst) |
4397 | new_mask &= ~I40E_L4_DST_MASK; |
4398 | else |
4399 | return -EOPNOTSUPP; |
4400 | |
4401 | /* Filtering on Type of Service is not supported. */ |
4402 | if (tcp_ip4_spec->tos) |
4403 | return -EOPNOTSUPP; |
4404 | |
4405 | break; |
4406 | case SCTP_V6_FLOW: |
4407 | new_mask &= ~I40E_VERIFY_TAG_MASK; |
4408 | fallthrough; |
4409 | case TCP_V6_FLOW: |
4410 | case UDP_V6_FLOW: |
4411 | tcp_ip6_spec = &fsp->m_u.tcp_ip6_spec; |
4412 | |
4413 | /* Check if user provided IPv6 source address. */ |
4414 | if (ipv6_addr_equal(a1: (struct in6_addr *)&tcp_ip6_spec->ip6src, |
4415 | a2: (struct in6_addr *)&ipv6_full_mask)) |
4416 | new_mask |= I40E_L3_V6_SRC_MASK; |
4417 | else if (ipv6_addr_any(a: (struct in6_addr *) |
4418 | &tcp_ip6_spec->ip6src)) |
4419 | new_mask &= ~I40E_L3_V6_SRC_MASK; |
4420 | else |
4421 | return -EOPNOTSUPP; |
4422 | |
4423 | /* Check if user provided destination address. */ |
4424 | if (ipv6_addr_equal(a1: (struct in6_addr *)&tcp_ip6_spec->ip6dst, |
4425 | a2: (struct in6_addr *)&ipv6_full_mask)) |
4426 | new_mask |= I40E_L3_V6_DST_MASK; |
4427 | else if (ipv6_addr_any(a: (struct in6_addr *) |
4428 | &tcp_ip6_spec->ip6dst)) |
4429 | new_mask &= ~I40E_L3_V6_DST_MASK; |
4430 | else |
4431 | return -EOPNOTSUPP; |
4432 | |
4433 | /* L4 source port */ |
4434 | if (tcp_ip6_spec->psrc == htons(0xFFFF)) |
4435 | new_mask |= I40E_L4_SRC_MASK; |
4436 | else if (!tcp_ip6_spec->psrc) |
4437 | new_mask &= ~I40E_L4_SRC_MASK; |
4438 | else |
4439 | return -EOPNOTSUPP; |
4440 | |
4441 | /* L4 destination port */ |
4442 | if (tcp_ip6_spec->pdst == htons(0xFFFF)) |
4443 | new_mask |= I40E_L4_DST_MASK; |
4444 | else if (!tcp_ip6_spec->pdst) |
4445 | new_mask &= ~I40E_L4_DST_MASK; |
4446 | else |
4447 | return -EOPNOTSUPP; |
4448 | |
4449 | /* Filtering on Traffic Classes is not supported. */ |
4450 | if (tcp_ip6_spec->tclass) |
4451 | return -EOPNOTSUPP; |
4452 | break; |
4453 | case IP_USER_FLOW: |
4454 | usr_ip4_spec = &fsp->m_u.usr_ip4_spec; |
4455 | |
4456 | /* IPv4 source address */ |
4457 | if (usr_ip4_spec->ip4src == htonl(0xFFFFFFFF)) |
4458 | new_mask |= I40E_L3_SRC_MASK; |
4459 | else if (!usr_ip4_spec->ip4src) |
4460 | new_mask &= ~I40E_L3_SRC_MASK; |
4461 | else |
4462 | return -EOPNOTSUPP; |
4463 | |
4464 | /* IPv4 destination address */ |
4465 | if (usr_ip4_spec->ip4dst == htonl(0xFFFFFFFF)) |
4466 | new_mask |= I40E_L3_DST_MASK; |
4467 | else if (!usr_ip4_spec->ip4dst) |
4468 | new_mask &= ~I40E_L3_DST_MASK; |
4469 | else |
4470 | return -EOPNOTSUPP; |
4471 | |
4472 | /* First 4 bytes of L4 header */ |
4473 | if (usr_ip4_spec->l4_4_bytes) |
4474 | return -EOPNOTSUPP; |
4475 | |
4476 | /* Filtering on Type of Service is not supported. */ |
4477 | if (usr_ip4_spec->tos) |
4478 | return -EOPNOTSUPP; |
4479 | |
4480 | /* Filtering on IP version is not supported */ |
4481 | if (usr_ip4_spec->ip_ver) |
4482 | return -EINVAL; |
4483 | |
4484 | /* Filtering on L4 protocol is not supported */ |
4485 | if (usr_ip4_spec->proto) |
4486 | return -EINVAL; |
4487 | |
4488 | break; |
4489 | case IPV6_USER_FLOW: |
4490 | usr_ip6_spec = &fsp->m_u.usr_ip6_spec; |
4491 | |
4492 | /* Check if user provided IPv6 source address. */ |
4493 | if (ipv6_addr_equal(a1: (struct in6_addr *)&usr_ip6_spec->ip6src, |
4494 | a2: (struct in6_addr *)&ipv6_full_mask)) |
4495 | new_mask |= I40E_L3_V6_SRC_MASK; |
4496 | else if (ipv6_addr_any(a: (struct in6_addr *) |
4497 | &usr_ip6_spec->ip6src)) |
4498 | new_mask &= ~I40E_L3_V6_SRC_MASK; |
4499 | else |
4500 | return -EOPNOTSUPP; |
4501 | |
4502 | /* Check if user provided destination address. */ |
4503 | if (ipv6_addr_equal(a1: (struct in6_addr *)&usr_ip6_spec->ip6dst, |
4504 | a2: (struct in6_addr *)&ipv6_full_mask)) |
4505 | new_mask |= I40E_L3_V6_DST_MASK; |
4506 | else if (ipv6_addr_any(a: (struct in6_addr *) |
4507 | &usr_ip6_spec->ip6dst)) |
4508 | new_mask &= ~I40E_L3_V6_DST_MASK; |
4509 | else |
4510 | return -EOPNOTSUPP; |
4511 | |
4512 | if (usr_ip6_spec->l4_4_bytes) |
4513 | return -EOPNOTSUPP; |
4514 | |
4515 | /* Filtering on Traffic class is not supported. */ |
4516 | if (usr_ip6_spec->tclass) |
4517 | return -EOPNOTSUPP; |
4518 | |
4519 | /* Filtering on L4 protocol is not supported */ |
4520 | if (usr_ip6_spec->l4_proto) |
4521 | return -EINVAL; |
4522 | |
4523 | break; |
4524 | default: |
4525 | return -EOPNOTSUPP; |
4526 | } |
4527 | |
4528 | if (fsp->flow_type & FLOW_EXT) { |
4529 | /* Allow only 802.1Q and no etype defined, as |
4530 | * later it's modified to 0x8100 |
4531 | */ |
4532 | if (fsp->h_ext.vlan_etype != htons(ETH_P_8021Q) && |
4533 | fsp->h_ext.vlan_etype != 0) |
4534 | return -EOPNOTSUPP; |
4535 | if (fsp->m_ext.vlan_tci == htons(0xFFFF)) |
4536 | new_mask |= I40E_VLAN_SRC_MASK; |
4537 | else |
4538 | new_mask &= ~I40E_VLAN_SRC_MASK; |
4539 | } |
4540 | |
4541 | /* First, clear all flexible filter entries */ |
4542 | new_mask &= ~I40E_FLEX_INPUT_MASK; |
4543 | |
4544 | /* If we have a flexible filter, try to add this offset to the correct |
4545 | * flexible filter PIT list. Once finished, we can update the mask. |
4546 | * If the src_offset changed, we will get a new mask value which will |
4547 | * trigger an input set change. |
4548 | */ |
4549 | if (userdef->flex_filter) { |
4550 | struct i40e_flex_pit *l3_flex_pit = NULL, *flex_pit = NULL; |
4551 | |
4552 | /* Flexible offset must be even, since the flexible payload |
4553 | * must be aligned on 2-byte boundary. |
4554 | */ |
4555 | if (userdef->flex_offset & 0x1) { |
4556 | dev_warn(&pf->pdev->dev, |
4557 | "Flexible data offset must be 2-byte aligned\n" ); |
4558 | return -EINVAL; |
4559 | } |
4560 | |
4561 | src_offset = userdef->flex_offset >> 1; |
4562 | |
4563 | /* FLX_PIT source offset value is only so large */ |
4564 | if (src_offset > I40E_MAX_FLEX_SRC_OFFSET) { |
4565 | dev_warn(&pf->pdev->dev, |
4566 | "Flexible data must reside within first 64 bytes of the packet payload\n" ); |
4567 | return -EINVAL; |
4568 | } |
4569 | |
4570 | /* See if this offset has already been programmed. If we get |
4571 | * an ERR_PTR, then the filter is not safe to add. Otherwise, |
4572 | * if we get a NULL pointer, this means we will need to add |
4573 | * the offset. |
4574 | */ |
4575 | flex_pit = i40e_find_flex_offset(flex_pit_list: &pf->l4_flex_pit_list, |
4576 | src_offset); |
4577 | if (IS_ERR(ptr: flex_pit)) |
4578 | return PTR_ERR(ptr: flex_pit); |
4579 | |
4580 | /* IP_USER_FLOW filters match both L4 (ICMP) and L3 (unknown) |
4581 | * packet types, and thus we need to program both L3 and L4 |
4582 | * flexible values. These must have identical flexible index, |
4583 | * as otherwise we can't correctly program the input set. So |
4584 | * we'll find both an L3 and L4 index and make sure they are |
4585 | * the same. |
4586 | */ |
4587 | if (flex_l3) { |
4588 | l3_flex_pit = |
4589 | i40e_find_flex_offset(flex_pit_list: &pf->l3_flex_pit_list, |
4590 | src_offset); |
4591 | if (IS_ERR(ptr: l3_flex_pit)) |
4592 | return PTR_ERR(ptr: l3_flex_pit); |
4593 | |
4594 | if (flex_pit) { |
4595 | /* If we already had a matching L4 entry, we |
4596 | * need to make sure that the L3 entry we |
4597 | * obtained uses the same index. |
4598 | */ |
4599 | if (l3_flex_pit) { |
4600 | if (l3_flex_pit->pit_index != |
4601 | flex_pit->pit_index) { |
4602 | return -EINVAL; |
4603 | } |
4604 | } else { |
4605 | new_flex_offset = true; |
4606 | } |
4607 | } else { |
4608 | flex_pit = l3_flex_pit; |
4609 | } |
4610 | } |
4611 | |
4612 | /* If we didn't find an existing flex offset, we need to |
4613 | * program a new one. However, we don't immediately program it |
4614 | * here because we will wait to program until after we check |
4615 | * that it is safe to change the input set. |
4616 | */ |
4617 | if (!flex_pit) { |
4618 | new_flex_offset = true; |
4619 | pit_index = i40e_unused_pit_index(pf); |
4620 | } else { |
4621 | pit_index = flex_pit->pit_index; |
4622 | } |
4623 | |
4624 | /* Update the mask with the new offset */ |
4625 | new_mask |= i40e_pit_index_to_mask(pit_index); |
4626 | } |
4627 | |
4628 | /* If the mask and flexible filter offsets for this filter match the |
4629 | * currently programmed values we don't need any input set change, so |
4630 | * this filter is safe to install. |
4631 | */ |
4632 | if (new_mask == current_mask && !new_flex_offset) |
4633 | return 0; |
4634 | |
4635 | netif_info(pf, drv, vsi->netdev, "Input set change requested for %s flows:\n" , |
4636 | i40e_flow_str(fsp)); |
4637 | i40e_print_input_set(vsi, old: current_mask, new: new_mask); |
4638 | if (new_flex_offset) { |
4639 | netif_info(pf, drv, vsi->netdev, "FLEX index %d: Offset -> %d" , |
4640 | pit_index, src_offset); |
4641 | } |
4642 | |
4643 | /* Hardware input sets are global across multiple ports, so even the |
4644 | * main port cannot change them when in MFP mode as this would impact |
4645 | * any filters on the other ports. |
4646 | */ |
4647 | if (pf->flags & I40E_FLAG_MFP_ENABLED) { |
4648 | netif_err(pf, drv, vsi->netdev, "Cannot change Flow Director input sets while MFP is enabled\n" ); |
4649 | return -EOPNOTSUPP; |
4650 | } |
4651 | |
4652 | /* This filter requires us to update the input set. However, hardware |
4653 | * only supports one input set per flow type, and does not support |
4654 | * separate masks for each filter. This means that we can only support |
4655 | * a single mask for all filters of a specific type. |
4656 | * |
4657 | * If we have preexisting filters, they obviously depend on the |
4658 | * current programmed input set. Display a diagnostic message in this |
4659 | * case explaining why the filter could not be accepted. |
4660 | */ |
4661 | if (*fdir_filter_count) { |
4662 | netif_err(pf, drv, vsi->netdev, "Cannot change input set for %s flows until %d preexisting filters are removed\n" , |
4663 | i40e_flow_str(fsp), |
4664 | *fdir_filter_count); |
4665 | return -EOPNOTSUPP; |
4666 | } |
4667 | |
4668 | i40e_write_fd_input_set(pf, addr: index, val: new_mask); |
4669 | |
4670 | /* IP_USER_FLOW filters match both IPv4/Other and IPv4/Fragmented |
4671 | * frames. If we're programming the input set for IPv4/Other, we also |
4672 | * need to program the IPv4/Fragmented input set. Since we don't have |
4673 | * separate support, we'll always assume and enforce that the two flow |
4674 | * types must have matching input sets. |
4675 | */ |
4676 | if (index == I40E_FILTER_PCTYPE_NONF_IPV4_OTHER) |
4677 | i40e_write_fd_input_set(pf, addr: I40E_FILTER_PCTYPE_FRAG_IPV4, |
4678 | val: new_mask); |
4679 | |
4680 | /* Add the new offset and update table, if necessary */ |
4681 | if (new_flex_offset) { |
4682 | err = i40e_add_flex_offset(flex_pit_list: &pf->l4_flex_pit_list, src_offset, |
4683 | pit_index); |
4684 | if (err) |
4685 | return err; |
4686 | |
4687 | if (flex_l3) { |
4688 | err = i40e_add_flex_offset(flex_pit_list: &pf->l3_flex_pit_list, |
4689 | src_offset, |
4690 | pit_index); |
4691 | if (err) |
4692 | return err; |
4693 | } |
4694 | |
4695 | i40e_reprogram_flex_pit(pf); |
4696 | } |
4697 | |
4698 | return 0; |
4699 | } |
4700 | |
4701 | /** |
4702 | * i40e_match_fdir_filter - Return true of two filters match |
4703 | * @a: pointer to filter struct |
4704 | * @b: pointer to filter struct |
4705 | * |
4706 | * Returns true if the two filters match exactly the same criteria. I.e. they |
4707 | * match the same flow type and have the same parameters. We don't need to |
4708 | * check any input-set since all filters of the same flow type must use the |
4709 | * same input set. |
4710 | **/ |
4711 | static bool i40e_match_fdir_filter(struct i40e_fdir_filter *a, |
4712 | struct i40e_fdir_filter *b) |
4713 | { |
4714 | /* The filters do not much if any of these criteria differ. */ |
4715 | if (a->dst_ip != b->dst_ip || |
4716 | a->src_ip != b->src_ip || |
4717 | a->dst_port != b->dst_port || |
4718 | a->src_port != b->src_port || |
4719 | a->flow_type != b->flow_type || |
4720 | a->ipl4_proto != b->ipl4_proto || |
4721 | a->vlan_tag != b->vlan_tag || |
4722 | a->vlan_etype != b->vlan_etype) |
4723 | return false; |
4724 | |
4725 | return true; |
4726 | } |
4727 | |
4728 | /** |
4729 | * i40e_disallow_matching_filters - Check that new filters differ |
4730 | * @vsi: pointer to the targeted VSI |
4731 | * @input: new filter to check |
4732 | * |
4733 | * Due to hardware limitations, it is not possible for two filters that match |
4734 | * similar criteria to be programmed at the same time. This is true for a few |
4735 | * reasons: |
4736 | * |
4737 | * (a) all filters matching a particular flow type must use the same input |
4738 | * set, that is they must match the same criteria. |
4739 | * (b) different flow types will never match the same packet, as the flow type |
4740 | * is decided by hardware before checking which rules apply. |
4741 | * (c) hardware has no way to distinguish which order filters apply in. |
4742 | * |
4743 | * Due to this, we can't really support using the location data to order |
4744 | * filters in the hardware parsing. It is technically possible for the user to |
4745 | * request two filters matching the same criteria but which select different |
4746 | * queues. In this case, rather than keep both filters in the list, we reject |
4747 | * the 2nd filter when the user requests adding it. |
4748 | * |
4749 | * This avoids needing to track location for programming the filter to |
4750 | * hardware, and ensures that we avoid some strange scenarios involving |
4751 | * deleting filters which match the same criteria. |
4752 | **/ |
4753 | static int i40e_disallow_matching_filters(struct i40e_vsi *vsi, |
4754 | struct i40e_fdir_filter *input) |
4755 | { |
4756 | struct i40e_pf *pf = vsi->back; |
4757 | struct i40e_fdir_filter *rule; |
4758 | struct hlist_node *node2; |
4759 | |
4760 | /* Loop through every filter, and check that it doesn't match */ |
4761 | hlist_for_each_entry_safe(rule, node2, |
4762 | &pf->fdir_filter_list, fdir_node) { |
4763 | /* Don't check the filters match if they share the same fd_id, |
4764 | * since the new filter is actually just updating the target |
4765 | * of the old filter. |
4766 | */ |
4767 | if (rule->fd_id == input->fd_id) |
4768 | continue; |
4769 | |
4770 | /* If any filters match, then print a warning message to the |
4771 | * kernel message buffer and bail out. |
4772 | */ |
4773 | if (i40e_match_fdir_filter(a: rule, b: input)) { |
4774 | dev_warn(&pf->pdev->dev, |
4775 | "Existing user defined filter %d already matches this flow.\n" , |
4776 | rule->fd_id); |
4777 | return -EINVAL; |
4778 | } |
4779 | } |
4780 | |
4781 | return 0; |
4782 | } |
4783 | |
4784 | /** |
4785 | * i40e_add_fdir_ethtool - Add/Remove Flow Director filters |
4786 | * @vsi: pointer to the targeted VSI |
4787 | * @cmd: command to get or set RX flow classification rules |
4788 | * |
4789 | * Add Flow Director filters for a specific flow spec based on their |
4790 | * protocol. Returns 0 if the filters were successfully added. |
4791 | **/ |
4792 | static int i40e_add_fdir_ethtool(struct i40e_vsi *vsi, |
4793 | struct ethtool_rxnfc *cmd) |
4794 | { |
4795 | struct i40e_rx_flow_userdef userdef; |
4796 | struct ethtool_rx_flow_spec *fsp; |
4797 | struct i40e_fdir_filter *input; |
4798 | u16 dest_vsi = 0, q_index = 0; |
4799 | struct i40e_pf *pf; |
4800 | int ret = -EINVAL; |
4801 | u8 dest_ctl; |
4802 | |
4803 | if (!vsi) |
4804 | return -EINVAL; |
4805 | pf = vsi->back; |
4806 | |
4807 | if (!(pf->flags & I40E_FLAG_FD_SB_ENABLED)) |
4808 | return -EOPNOTSUPP; |
4809 | |
4810 | if (test_bit(__I40E_FD_SB_AUTO_DISABLED, pf->state)) |
4811 | return -ENOSPC; |
4812 | |
4813 | if (test_bit(__I40E_RESET_RECOVERY_PENDING, pf->state) || |
4814 | test_bit(__I40E_RESET_INTR_RECEIVED, pf->state)) |
4815 | return -EBUSY; |
4816 | |
4817 | if (test_bit(__I40E_FD_FLUSH_REQUESTED, pf->state)) |
4818 | return -EBUSY; |
4819 | |
4820 | fsp = (struct ethtool_rx_flow_spec *)&cmd->fs; |
4821 | |
4822 | /* Parse the user-defined field */ |
4823 | if (i40e_parse_rx_flow_user_data(fsp, data: &userdef)) |
4824 | return -EINVAL; |
4825 | |
4826 | /* Extended MAC field is not supported */ |
4827 | if (fsp->flow_type & FLOW_MAC_EXT) |
4828 | return -EINVAL; |
4829 | |
4830 | ret = i40e_check_fdir_input_set(vsi, fsp, userdef: &userdef); |
4831 | if (ret) |
4832 | return ret; |
4833 | |
4834 | if (fsp->location >= (pf->hw.func_caps.fd_filters_best_effort + |
4835 | pf->hw.func_caps.fd_filters_guaranteed)) { |
4836 | return -EINVAL; |
4837 | } |
4838 | |
4839 | /* ring_cookie is either the drop index, or is a mask of the queue |
4840 | * index and VF id we wish to target. |
4841 | */ |
4842 | if (fsp->ring_cookie == RX_CLS_FLOW_DISC) { |
4843 | dest_ctl = I40E_FILTER_PROGRAM_DESC_DEST_DROP_PACKET; |
4844 | } else { |
4845 | u32 ring = ethtool_get_flow_spec_ring(ring_cookie: fsp->ring_cookie); |
4846 | u8 vf = ethtool_get_flow_spec_ring_vf(ring_cookie: fsp->ring_cookie); |
4847 | |
4848 | if (!vf) { |
4849 | if (ring >= vsi->num_queue_pairs) |
4850 | return -EINVAL; |
4851 | dest_vsi = vsi->id; |
4852 | } else { |
4853 | /* VFs are zero-indexed, so we subtract one here */ |
4854 | vf--; |
4855 | |
4856 | if (vf >= pf->num_alloc_vfs) |
4857 | return -EINVAL; |
4858 | if (ring >= pf->vf[vf].num_queue_pairs) |
4859 | return -EINVAL; |
4860 | dest_vsi = pf->vf[vf].lan_vsi_id; |
4861 | } |
4862 | dest_ctl = I40E_FILTER_PROGRAM_DESC_DEST_DIRECT_PACKET_QINDEX; |
4863 | q_index = ring; |
4864 | } |
4865 | |
4866 | input = kzalloc(size: sizeof(*input), GFP_KERNEL); |
4867 | |
4868 | if (!input) |
4869 | return -ENOMEM; |
4870 | |
4871 | input->fd_id = fsp->location; |
4872 | input->q_index = q_index; |
4873 | input->dest_vsi = dest_vsi; |
4874 | input->dest_ctl = dest_ctl; |
4875 | input->fd_status = I40E_FILTER_PROGRAM_DESC_FD_STATUS_FD_ID; |
4876 | input->cnt_index = I40E_FD_SB_STAT_IDX(pf->hw.pf_id); |
4877 | input->dst_ip = fsp->h_u.tcp_ip4_spec.ip4src; |
4878 | input->src_ip = fsp->h_u.tcp_ip4_spec.ip4dst; |
4879 | input->flow_type = fsp->flow_type & ~FLOW_EXT; |
4880 | |
4881 | input->vlan_etype = fsp->h_ext.vlan_etype; |
4882 | if (!fsp->m_ext.vlan_etype && fsp->h_ext.vlan_tci) |
4883 | input->vlan_etype = cpu_to_be16(ETH_P_8021Q); |
4884 | if (fsp->m_ext.vlan_tci && input->vlan_etype) |
4885 | input->vlan_tag = fsp->h_ext.vlan_tci; |
4886 | if (input->flow_type == IPV6_USER_FLOW || |
4887 | input->flow_type == UDP_V6_FLOW || |
4888 | input->flow_type == TCP_V6_FLOW || |
4889 | input->flow_type == SCTP_V6_FLOW) { |
4890 | /* Reverse the src and dest notion, since the HW expects them |
4891 | * to be from Tx perspective where as the input from user is |
4892 | * from Rx filter view. |
4893 | */ |
4894 | input->ipl4_proto = fsp->h_u.usr_ip6_spec.l4_proto; |
4895 | input->dst_port = fsp->h_u.tcp_ip6_spec.psrc; |
4896 | input->src_port = fsp->h_u.tcp_ip6_spec.pdst; |
4897 | memcpy(input->dst_ip6, fsp->h_u.ah_ip6_spec.ip6src, |
4898 | sizeof(__be32) * 4); |
4899 | memcpy(input->src_ip6, fsp->h_u.ah_ip6_spec.ip6dst, |
4900 | sizeof(__be32) * 4); |
4901 | } else { |
4902 | /* Reverse the src and dest notion, since the HW expects them |
4903 | * to be from Tx perspective where as the input from user is |
4904 | * from Rx filter view. |
4905 | */ |
4906 | input->ipl4_proto = fsp->h_u.usr_ip4_spec.proto; |
4907 | input->dst_port = fsp->h_u.tcp_ip4_spec.psrc; |
4908 | input->src_port = fsp->h_u.tcp_ip4_spec.pdst; |
4909 | input->dst_ip = fsp->h_u.tcp_ip4_spec.ip4src; |
4910 | input->src_ip = fsp->h_u.tcp_ip4_spec.ip4dst; |
4911 | } |
4912 | |
4913 | if (userdef.flex_filter) { |
4914 | input->flex_filter = true; |
4915 | input->flex_word = cpu_to_be16(userdef.flex_word); |
4916 | input->flex_offset = userdef.flex_offset; |
4917 | } |
4918 | |
4919 | /* Avoid programming two filters with identical match criteria. */ |
4920 | ret = i40e_disallow_matching_filters(vsi, input); |
4921 | if (ret) |
4922 | goto free_filter_memory; |
4923 | |
4924 | /* Add the input filter to the fdir_input_list, possibly replacing |
4925 | * a previous filter. Do not free the input structure after adding it |
4926 | * to the list as this would cause a use-after-free bug. |
4927 | */ |
4928 | i40e_update_ethtool_fdir_entry(vsi, input, sw_idx: fsp->location, NULL); |
4929 | ret = i40e_add_del_fdir(vsi, input, add: true); |
4930 | if (ret) |
4931 | goto remove_sw_rule; |
4932 | return 0; |
4933 | |
4934 | remove_sw_rule: |
4935 | hlist_del(n: &input->fdir_node); |
4936 | pf->fdir_pf_active_filters--; |
4937 | free_filter_memory: |
4938 | kfree(objp: input); |
4939 | return ret; |
4940 | } |
4941 | |
4942 | /** |
4943 | * i40e_set_rxnfc - command to set RX flow classification rules |
4944 | * @netdev: network interface device structure |
4945 | * @cmd: ethtool rxnfc command |
4946 | * |
4947 | * Returns Success if the command is supported. |
4948 | **/ |
4949 | static int i40e_set_rxnfc(struct net_device *netdev, struct ethtool_rxnfc *cmd) |
4950 | { |
4951 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
4952 | struct i40e_vsi *vsi = np->vsi; |
4953 | struct i40e_pf *pf = vsi->back; |
4954 | int ret = -EOPNOTSUPP; |
4955 | |
4956 | switch (cmd->cmd) { |
4957 | case ETHTOOL_SRXFH: |
4958 | ret = i40e_set_rss_hash_opt(pf, nfc: cmd); |
4959 | break; |
4960 | case ETHTOOL_SRXCLSRLINS: |
4961 | ret = i40e_add_fdir_ethtool(vsi, cmd); |
4962 | break; |
4963 | case ETHTOOL_SRXCLSRLDEL: |
4964 | ret = i40e_del_fdir_entry(vsi, cmd); |
4965 | break; |
4966 | default: |
4967 | break; |
4968 | } |
4969 | |
4970 | return ret; |
4971 | } |
4972 | |
4973 | /** |
4974 | * i40e_max_channels - get Max number of combined channels supported |
4975 | * @vsi: vsi pointer |
4976 | **/ |
4977 | static unsigned int i40e_max_channels(struct i40e_vsi *vsi) |
4978 | { |
4979 | /* TODO: This code assumes DCB and FD is disabled for now. */ |
4980 | return vsi->alloc_queue_pairs; |
4981 | } |
4982 | |
4983 | /** |
4984 | * i40e_get_channels - Get the current channels enabled and max supported etc. |
4985 | * @dev: network interface device structure |
4986 | * @ch: ethtool channels structure |
4987 | * |
4988 | * We don't support separate tx and rx queues as channels. The other count |
4989 | * represents how many queues are being used for control. max_combined counts |
4990 | * how many queue pairs we can support. They may not be mapped 1 to 1 with |
4991 | * q_vectors since we support a lot more queue pairs than q_vectors. |
4992 | **/ |
4993 | static void i40e_get_channels(struct net_device *dev, |
4994 | struct ethtool_channels *ch) |
4995 | { |
4996 | struct i40e_netdev_priv *np = netdev_priv(dev); |
4997 | struct i40e_vsi *vsi = np->vsi; |
4998 | struct i40e_pf *pf = vsi->back; |
4999 | |
5000 | /* report maximum channels */ |
5001 | ch->max_combined = i40e_max_channels(vsi); |
5002 | |
5003 | /* report info for other vector */ |
5004 | ch->other_count = (pf->flags & I40E_FLAG_FD_SB_ENABLED) ? 1 : 0; |
5005 | ch->max_other = ch->other_count; |
5006 | |
5007 | /* Note: This code assumes DCB is disabled for now. */ |
5008 | ch->combined_count = vsi->num_queue_pairs; |
5009 | } |
5010 | |
5011 | /** |
5012 | * i40e_set_channels - Set the new channels count. |
5013 | * @dev: network interface device structure |
5014 | * @ch: ethtool channels structure |
5015 | * |
5016 | * The new channels count may not be the same as requested by the user |
5017 | * since it gets rounded down to a power of 2 value. |
5018 | **/ |
5019 | static int i40e_set_channels(struct net_device *dev, |
5020 | struct ethtool_channels *ch) |
5021 | { |
5022 | const u8 drop = I40E_FILTER_PROGRAM_DESC_DEST_DROP_PACKET; |
5023 | struct i40e_netdev_priv *np = netdev_priv(dev); |
5024 | unsigned int count = ch->combined_count; |
5025 | struct i40e_vsi *vsi = np->vsi; |
5026 | struct i40e_pf *pf = vsi->back; |
5027 | struct i40e_fdir_filter *rule; |
5028 | struct hlist_node *node2; |
5029 | int new_count; |
5030 | int err = 0; |
5031 | |
5032 | /* We do not support setting channels for any other VSI at present */ |
5033 | if (vsi->type != I40E_VSI_MAIN) |
5034 | return -EINVAL; |
5035 | |
5036 | /* We do not support setting channels via ethtool when TCs are |
5037 | * configured through mqprio |
5038 | */ |
5039 | if (i40e_is_tc_mqprio_enabled(pf)) |
5040 | return -EINVAL; |
5041 | |
5042 | /* verify they are not requesting separate vectors */ |
5043 | if (!count || ch->rx_count || ch->tx_count) |
5044 | return -EINVAL; |
5045 | |
5046 | /* verify other_count has not changed */ |
5047 | if (ch->other_count != ((pf->flags & I40E_FLAG_FD_SB_ENABLED) ? 1 : 0)) |
5048 | return -EINVAL; |
5049 | |
5050 | /* verify the number of channels does not exceed hardware limits */ |
5051 | if (count > i40e_max_channels(vsi)) |
5052 | return -EINVAL; |
5053 | |
5054 | /* verify that the number of channels does not invalidate any current |
5055 | * flow director rules |
5056 | */ |
5057 | hlist_for_each_entry_safe(rule, node2, |
5058 | &pf->fdir_filter_list, fdir_node) { |
5059 | if (rule->dest_ctl != drop && count <= rule->q_index) { |
5060 | dev_warn(&pf->pdev->dev, |
5061 | "Existing user defined filter %d assigns flow to queue %d\n" , |
5062 | rule->fd_id, rule->q_index); |
5063 | err = -EINVAL; |
5064 | } |
5065 | } |
5066 | |
5067 | if (err) { |
5068 | dev_err(&pf->pdev->dev, |
5069 | "Existing filter rules must be deleted to reduce combined channel count to %d\n" , |
5070 | count); |
5071 | return err; |
5072 | } |
5073 | |
5074 | /* update feature limits from largest to smallest supported values */ |
5075 | /* TODO: Flow director limit, DCB etc */ |
5076 | |
5077 | /* use rss_reconfig to rebuild with new queue count and update traffic |
5078 | * class queue mapping |
5079 | */ |
5080 | new_count = i40e_reconfig_rss_queues(pf, queue_count: count); |
5081 | if (new_count > 0) |
5082 | return 0; |
5083 | else |
5084 | return -EINVAL; |
5085 | } |
5086 | |
5087 | /** |
5088 | * i40e_get_rxfh_key_size - get the RSS hash key size |
5089 | * @netdev: network interface device structure |
5090 | * |
5091 | * Returns the table size. |
5092 | **/ |
5093 | static u32 i40e_get_rxfh_key_size(struct net_device *netdev) |
5094 | { |
5095 | return I40E_HKEY_ARRAY_SIZE; |
5096 | } |
5097 | |
5098 | /** |
5099 | * i40e_get_rxfh_indir_size - get the rx flow hash indirection table size |
5100 | * @netdev: network interface device structure |
5101 | * |
5102 | * Returns the table size. |
5103 | **/ |
5104 | static u32 i40e_get_rxfh_indir_size(struct net_device *netdev) |
5105 | { |
5106 | return I40E_HLUT_ARRAY_SIZE; |
5107 | } |
5108 | |
5109 | /** |
5110 | * i40e_get_rxfh - get the rx flow hash indirection table |
5111 | * @netdev: network interface device structure |
5112 | * @indir: indirection table |
5113 | * @key: hash key |
5114 | * @hfunc: hash function |
5115 | * |
5116 | * Reads the indirection table directly from the hardware. Returns 0 on |
5117 | * success. |
5118 | **/ |
5119 | static int i40e_get_rxfh(struct net_device *netdev, u32 *indir, u8 *key, |
5120 | u8 *hfunc) |
5121 | { |
5122 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
5123 | struct i40e_vsi *vsi = np->vsi; |
5124 | u8 *lut, *seed = NULL; |
5125 | int ret; |
5126 | u16 i; |
5127 | |
5128 | if (hfunc) |
5129 | *hfunc = ETH_RSS_HASH_TOP; |
5130 | |
5131 | if (!indir) |
5132 | return 0; |
5133 | |
5134 | seed = key; |
5135 | lut = kzalloc(I40E_HLUT_ARRAY_SIZE, GFP_KERNEL); |
5136 | if (!lut) |
5137 | return -ENOMEM; |
5138 | ret = i40e_get_rss(vsi, seed, lut, I40E_HLUT_ARRAY_SIZE); |
5139 | if (ret) |
5140 | goto out; |
5141 | for (i = 0; i < I40E_HLUT_ARRAY_SIZE; i++) |
5142 | indir[i] = (u32)(lut[i]); |
5143 | |
5144 | out: |
5145 | kfree(objp: lut); |
5146 | |
5147 | return ret; |
5148 | } |
5149 | |
5150 | /** |
5151 | * i40e_set_rxfh - set the rx flow hash indirection table |
5152 | * @netdev: network interface device structure |
5153 | * @indir: indirection table |
5154 | * @key: hash key |
5155 | * @hfunc: hash function to use |
5156 | * |
5157 | * Returns -EINVAL if the table specifies an invalid queue id, otherwise |
5158 | * returns 0 after programming the table. |
5159 | **/ |
5160 | static int i40e_set_rxfh(struct net_device *netdev, const u32 *indir, |
5161 | const u8 *key, const u8 hfunc) |
5162 | { |
5163 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
5164 | struct i40e_vsi *vsi = np->vsi; |
5165 | struct i40e_pf *pf = vsi->back; |
5166 | u8 *seed = NULL; |
5167 | u16 i; |
5168 | |
5169 | if (hfunc != ETH_RSS_HASH_NO_CHANGE && hfunc != ETH_RSS_HASH_TOP) |
5170 | return -EOPNOTSUPP; |
5171 | |
5172 | if (key) { |
5173 | if (!vsi->rss_hkey_user) { |
5174 | vsi->rss_hkey_user = kzalloc(I40E_HKEY_ARRAY_SIZE, |
5175 | GFP_KERNEL); |
5176 | if (!vsi->rss_hkey_user) |
5177 | return -ENOMEM; |
5178 | } |
5179 | memcpy(vsi->rss_hkey_user, key, I40E_HKEY_ARRAY_SIZE); |
5180 | seed = vsi->rss_hkey_user; |
5181 | } |
5182 | if (!vsi->rss_lut_user) { |
5183 | vsi->rss_lut_user = kzalloc(I40E_HLUT_ARRAY_SIZE, GFP_KERNEL); |
5184 | if (!vsi->rss_lut_user) |
5185 | return -ENOMEM; |
5186 | } |
5187 | |
5188 | /* Each 32 bits pointed by 'indir' is stored with a lut entry */ |
5189 | if (indir) |
5190 | for (i = 0; i < I40E_HLUT_ARRAY_SIZE; i++) |
5191 | vsi->rss_lut_user[i] = (u8)(indir[i]); |
5192 | else |
5193 | i40e_fill_rss_lut(pf, lut: vsi->rss_lut_user, I40E_HLUT_ARRAY_SIZE, |
5194 | rss_size: vsi->rss_size); |
5195 | |
5196 | return i40e_config_rss(vsi, seed, lut: vsi->rss_lut_user, |
5197 | I40E_HLUT_ARRAY_SIZE); |
5198 | } |
5199 | |
5200 | /** |
5201 | * i40e_get_priv_flags - report device private flags |
5202 | * @dev: network interface device structure |
5203 | * |
5204 | * The get string set count and the string set should be matched for each |
5205 | * flag returned. Add new strings for each flag to the i40e_gstrings_priv_flags |
5206 | * array. |
5207 | * |
5208 | * Returns a u32 bitmap of flags. |
5209 | **/ |
5210 | static u32 i40e_get_priv_flags(struct net_device *dev) |
5211 | { |
5212 | struct i40e_netdev_priv *np = netdev_priv(dev); |
5213 | struct i40e_vsi *vsi = np->vsi; |
5214 | struct i40e_pf *pf = vsi->back; |
5215 | u32 i, j, ret_flags = 0; |
5216 | |
5217 | for (i = 0; i < I40E_PRIV_FLAGS_STR_LEN; i++) { |
5218 | const struct i40e_priv_flags *priv_flags; |
5219 | |
5220 | priv_flags = &i40e_gstrings_priv_flags[i]; |
5221 | |
5222 | if (priv_flags->flag & pf->flags) |
5223 | ret_flags |= BIT(i); |
5224 | } |
5225 | |
5226 | if (pf->hw.pf_id != 0) |
5227 | return ret_flags; |
5228 | |
5229 | for (j = 0; j < I40E_GL_PRIV_FLAGS_STR_LEN; j++) { |
5230 | const struct i40e_priv_flags *priv_flags; |
5231 | |
5232 | priv_flags = &i40e_gl_gstrings_priv_flags[j]; |
5233 | |
5234 | if (priv_flags->flag & pf->flags) |
5235 | ret_flags |= BIT(i + j); |
5236 | } |
5237 | |
5238 | return ret_flags; |
5239 | } |
5240 | |
5241 | /** |
5242 | * i40e_set_priv_flags - set private flags |
5243 | * @dev: network interface device structure |
5244 | * @flags: bit flags to be set |
5245 | **/ |
5246 | static int i40e_set_priv_flags(struct net_device *dev, u32 flags) |
5247 | { |
5248 | struct i40e_netdev_priv *np = netdev_priv(dev); |
5249 | u64 orig_flags, new_flags, changed_flags; |
5250 | enum i40e_admin_queue_err adq_err; |
5251 | struct i40e_vsi *vsi = np->vsi; |
5252 | struct i40e_pf *pf = vsi->back; |
5253 | u32 reset_needed = 0; |
5254 | int status; |
5255 | u32 i, j; |
5256 | |
5257 | orig_flags = READ_ONCE(pf->flags); |
5258 | new_flags = orig_flags; |
5259 | |
5260 | for (i = 0; i < I40E_PRIV_FLAGS_STR_LEN; i++) { |
5261 | const struct i40e_priv_flags *priv_flags; |
5262 | |
5263 | priv_flags = &i40e_gstrings_priv_flags[i]; |
5264 | |
5265 | if (flags & BIT(i)) |
5266 | new_flags |= priv_flags->flag; |
5267 | else |
5268 | new_flags &= ~(priv_flags->flag); |
5269 | |
5270 | /* If this is a read-only flag, it can't be changed */ |
5271 | if (priv_flags->read_only && |
5272 | ((orig_flags ^ new_flags) & ~BIT(i))) |
5273 | return -EOPNOTSUPP; |
5274 | } |
5275 | |
5276 | if (pf->hw.pf_id != 0) |
5277 | goto flags_complete; |
5278 | |
5279 | for (j = 0; j < I40E_GL_PRIV_FLAGS_STR_LEN; j++) { |
5280 | const struct i40e_priv_flags *priv_flags; |
5281 | |
5282 | priv_flags = &i40e_gl_gstrings_priv_flags[j]; |
5283 | |
5284 | if (flags & BIT(i + j)) |
5285 | new_flags |= priv_flags->flag; |
5286 | else |
5287 | new_flags &= ~(priv_flags->flag); |
5288 | |
5289 | /* If this is a read-only flag, it can't be changed */ |
5290 | if (priv_flags->read_only && |
5291 | ((orig_flags ^ new_flags) & ~BIT(i))) |
5292 | return -EOPNOTSUPP; |
5293 | } |
5294 | |
5295 | flags_complete: |
5296 | changed_flags = orig_flags ^ new_flags; |
5297 | |
5298 | if (changed_flags & I40E_FLAG_DISABLE_FW_LLDP) |
5299 | reset_needed = I40E_PF_RESET_AND_REBUILD_FLAG; |
5300 | if (changed_flags & (I40E_FLAG_VEB_STATS_ENABLED | |
5301 | I40E_FLAG_LEGACY_RX | I40E_FLAG_SOURCE_PRUNING_DISABLED)) |
5302 | reset_needed = BIT(__I40E_PF_RESET_REQUESTED); |
5303 | |
5304 | /* Before we finalize any flag changes, we need to perform some |
5305 | * checks to ensure that the changes are supported and safe. |
5306 | */ |
5307 | |
5308 | /* ATR eviction is not supported on all devices */ |
5309 | if ((new_flags & I40E_FLAG_HW_ATR_EVICT_ENABLED) && |
5310 | !(pf->hw_features & I40E_HW_ATR_EVICT_CAPABLE)) |
5311 | return -EOPNOTSUPP; |
5312 | |
5313 | /* If the driver detected FW LLDP was disabled on init, this flag could |
5314 | * be set, however we do not support _changing_ the flag: |
5315 | * - on XL710 if NPAR is enabled or FW API version < 1.7 |
5316 | * - on X722 with FW API version < 1.6 |
5317 | * There are situations where older FW versions/NPAR enabled PFs could |
5318 | * disable LLDP, however we _must_ not allow the user to enable/disable |
5319 | * LLDP with this flag on unsupported FW versions. |
5320 | */ |
5321 | if (changed_flags & I40E_FLAG_DISABLE_FW_LLDP) { |
5322 | if (!(pf->hw.flags & I40E_HW_FLAG_FW_LLDP_STOPPABLE)) { |
5323 | dev_warn(&pf->pdev->dev, |
5324 | "Device does not support changing FW LLDP\n" ); |
5325 | return -EOPNOTSUPP; |
5326 | } |
5327 | } |
5328 | |
5329 | if (changed_flags & I40E_FLAG_RS_FEC && |
5330 | pf->hw.device_id != I40E_DEV_ID_25G_SFP28 && |
5331 | pf->hw.device_id != I40E_DEV_ID_25G_B) { |
5332 | dev_warn(&pf->pdev->dev, |
5333 | "Device does not support changing FEC configuration\n" ); |
5334 | return -EOPNOTSUPP; |
5335 | } |
5336 | |
5337 | if (changed_flags & I40E_FLAG_BASE_R_FEC && |
5338 | pf->hw.device_id != I40E_DEV_ID_25G_SFP28 && |
5339 | pf->hw.device_id != I40E_DEV_ID_25G_B && |
5340 | pf->hw.device_id != I40E_DEV_ID_KX_X722) { |
5341 | dev_warn(&pf->pdev->dev, |
5342 | "Device does not support changing FEC configuration\n" ); |
5343 | return -EOPNOTSUPP; |
5344 | } |
5345 | |
5346 | /* Process any additional changes needed as a result of flag changes. |
5347 | * The changed_flags value reflects the list of bits that were |
5348 | * changed in the code above. |
5349 | */ |
5350 | |
5351 | /* Flush current ATR settings if ATR was disabled */ |
5352 | if ((changed_flags & I40E_FLAG_FD_ATR_ENABLED) && |
5353 | !(new_flags & I40E_FLAG_FD_ATR_ENABLED)) { |
5354 | set_bit(nr: __I40E_FD_ATR_AUTO_DISABLED, addr: pf->state); |
5355 | set_bit(nr: __I40E_FD_FLUSH_REQUESTED, addr: pf->state); |
5356 | } |
5357 | |
5358 | if (changed_flags & I40E_FLAG_TRUE_PROMISC_SUPPORT) { |
5359 | u16 sw_flags = 0, valid_flags = 0; |
5360 | int ret; |
5361 | |
5362 | if (!(new_flags & I40E_FLAG_TRUE_PROMISC_SUPPORT)) |
5363 | sw_flags = I40E_AQ_SET_SWITCH_CFG_PROMISC; |
5364 | valid_flags = I40E_AQ_SET_SWITCH_CFG_PROMISC; |
5365 | ret = i40e_aq_set_switch_config(hw: &pf->hw, flags: sw_flags, valid_flags, |
5366 | mode: 0, NULL); |
5367 | if (ret && pf->hw.aq.asq_last_status != I40E_AQ_RC_ESRCH) { |
5368 | dev_info(&pf->pdev->dev, |
5369 | "couldn't set switch config bits, err %pe aq_err %s\n" , |
5370 | ERR_PTR(ret), |
5371 | i40e_aq_str(&pf->hw, |
5372 | pf->hw.aq.asq_last_status)); |
5373 | /* not a fatal problem, just keep going */ |
5374 | } |
5375 | } |
5376 | |
5377 | if ((changed_flags & I40E_FLAG_RS_FEC) || |
5378 | (changed_flags & I40E_FLAG_BASE_R_FEC)) { |
5379 | u8 fec_cfg = 0; |
5380 | |
5381 | if (new_flags & I40E_FLAG_RS_FEC && |
5382 | new_flags & I40E_FLAG_BASE_R_FEC) { |
5383 | fec_cfg = I40E_AQ_SET_FEC_AUTO; |
5384 | } else if (new_flags & I40E_FLAG_RS_FEC) { |
5385 | fec_cfg = (I40E_AQ_SET_FEC_REQUEST_RS | |
5386 | I40E_AQ_SET_FEC_ABILITY_RS); |
5387 | } else if (new_flags & I40E_FLAG_BASE_R_FEC) { |
5388 | fec_cfg = (I40E_AQ_SET_FEC_REQUEST_KR | |
5389 | I40E_AQ_SET_FEC_ABILITY_KR); |
5390 | } |
5391 | if (i40e_set_fec_cfg(netdev: dev, fec_cfg)) |
5392 | dev_warn(&pf->pdev->dev, "Cannot change FEC config\n" ); |
5393 | } |
5394 | |
5395 | if ((changed_flags & I40E_FLAG_LINK_DOWN_ON_CLOSE_ENABLED) && |
5396 | (orig_flags & I40E_FLAG_TOTAL_PORT_SHUTDOWN_ENABLED)) { |
5397 | dev_err(&pf->pdev->dev, |
5398 | "Setting link-down-on-close not supported on this port (because total-port-shutdown is enabled)\n" ); |
5399 | return -EOPNOTSUPP; |
5400 | } |
5401 | |
5402 | if ((changed_flags & I40E_FLAG_VF_VLAN_PRUNING) && |
5403 | pf->num_alloc_vfs) { |
5404 | dev_warn(&pf->pdev->dev, |
5405 | "Changing vf-vlan-pruning flag while VF(s) are active is not supported\n" ); |
5406 | return -EOPNOTSUPP; |
5407 | } |
5408 | |
5409 | if ((changed_flags & I40E_FLAG_LEGACY_RX) && |
5410 | I40E_2K_TOO_SMALL_WITH_PADDING) { |
5411 | dev_warn(&pf->pdev->dev, |
5412 | "2k Rx buffer is too small to fit standard MTU and skb_shared_info\n" ); |
5413 | return -EOPNOTSUPP; |
5414 | } |
5415 | |
5416 | if ((changed_flags & new_flags & |
5417 | I40E_FLAG_LINK_DOWN_ON_CLOSE_ENABLED) && |
5418 | (new_flags & I40E_FLAG_MFP_ENABLED)) |
5419 | dev_warn(&pf->pdev->dev, |
5420 | "Turning on link-down-on-close flag may affect other partitions\n" ); |
5421 | |
5422 | if (changed_flags & I40E_FLAG_DISABLE_FW_LLDP) { |
5423 | if (new_flags & I40E_FLAG_DISABLE_FW_LLDP) { |
5424 | #ifdef CONFIG_I40E_DCB |
5425 | i40e_dcb_sw_default_config(pf); |
5426 | #endif /* CONFIG_I40E_DCB */ |
5427 | i40e_aq_cfg_lldp_mib_change_event(hw: &pf->hw, enable_update: false, NULL); |
5428 | i40e_aq_stop_lldp(hw: &pf->hw, shutdown_agent: true, persist: false, NULL); |
5429 | } else { |
5430 | status = i40e_aq_start_lldp(hw: &pf->hw, persist: false, NULL); |
5431 | if (status) { |
5432 | adq_err = pf->hw.aq.asq_last_status; |
5433 | switch (adq_err) { |
5434 | case I40E_AQ_RC_EEXIST: |
5435 | dev_warn(&pf->pdev->dev, |
5436 | "FW LLDP agent is already running\n" ); |
5437 | reset_needed = 0; |
5438 | break; |
5439 | case I40E_AQ_RC_EPERM: |
5440 | dev_warn(&pf->pdev->dev, |
5441 | "Device configuration forbids SW from starting the LLDP agent.\n" ); |
5442 | return -EINVAL; |
5443 | case I40E_AQ_RC_EAGAIN: |
5444 | dev_warn(&pf->pdev->dev, |
5445 | "Stop FW LLDP agent command is still being processed, please try again in a second.\n" ); |
5446 | return -EBUSY; |
5447 | default: |
5448 | dev_warn(&pf->pdev->dev, |
5449 | "Starting FW LLDP agent failed: error: %pe, %s\n" , |
5450 | ERR_PTR(status), |
5451 | i40e_aq_str(&pf->hw, |
5452 | adq_err)); |
5453 | return -EINVAL; |
5454 | } |
5455 | } |
5456 | } |
5457 | } |
5458 | |
5459 | /* Now that we've checked to ensure that the new flags are valid, load |
5460 | * them into place. Since we only modify flags either (a) during |
5461 | * initialization or (b) while holding the RTNL lock, we don't need |
5462 | * anything fancy here. |
5463 | */ |
5464 | pf->flags = new_flags; |
5465 | |
5466 | /* Issue reset to cause things to take effect, as additional bits |
5467 | * are added we will need to create a mask of bits requiring reset |
5468 | */ |
5469 | if (reset_needed) |
5470 | i40e_do_reset(pf, reset_flags: reset_needed, lock_acquired: true); |
5471 | |
5472 | return 0; |
5473 | } |
5474 | |
5475 | /** |
5476 | * i40e_get_module_info - get (Q)SFP+ module type info |
5477 | * @netdev: network interface device structure |
5478 | * @modinfo: module EEPROM size and layout information structure |
5479 | **/ |
5480 | static int i40e_get_module_info(struct net_device *netdev, |
5481 | struct ethtool_modinfo *modinfo) |
5482 | { |
5483 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
5484 | struct i40e_vsi *vsi = np->vsi; |
5485 | struct i40e_pf *pf = vsi->back; |
5486 | struct i40e_hw *hw = &pf->hw; |
5487 | u32 sff8472_comp = 0; |
5488 | u32 sff8472_swap = 0; |
5489 | u32 sff8636_rev = 0; |
5490 | u32 type = 0; |
5491 | int status; |
5492 | |
5493 | /* Check if firmware supports reading module EEPROM. */ |
5494 | if (!(hw->flags & I40E_HW_FLAG_AQ_PHY_ACCESS_CAPABLE)) { |
5495 | netdev_err(dev: vsi->netdev, format: "Module EEPROM memory read not supported. Please update the NVM image.\n" ); |
5496 | return -EINVAL; |
5497 | } |
5498 | |
5499 | status = i40e_update_link_info(hw); |
5500 | if (status) |
5501 | return -EIO; |
5502 | |
5503 | if (hw->phy.link_info.phy_type == I40E_PHY_TYPE_EMPTY) { |
5504 | netdev_err(dev: vsi->netdev, format: "Cannot read module EEPROM memory. No module connected.\n" ); |
5505 | return -EINVAL; |
5506 | } |
5507 | |
5508 | type = hw->phy.link_info.module_type[0]; |
5509 | |
5510 | switch (type) { |
5511 | case I40E_MODULE_TYPE_SFP: |
5512 | status = i40e_aq_get_phy_register(hw, |
5513 | I40E_AQ_PHY_REG_ACCESS_EXTERNAL_MODULE, |
5514 | I40E_I2C_EEPROM_DEV_ADDR, true, |
5515 | I40E_MODULE_SFF_8472_COMP, |
5516 | &sff8472_comp, NULL); |
5517 | if (status) |
5518 | return -EIO; |
5519 | |
5520 | status = i40e_aq_get_phy_register(hw, |
5521 | I40E_AQ_PHY_REG_ACCESS_EXTERNAL_MODULE, |
5522 | I40E_I2C_EEPROM_DEV_ADDR, true, |
5523 | I40E_MODULE_SFF_8472_SWAP, |
5524 | &sff8472_swap, NULL); |
5525 | if (status) |
5526 | return -EIO; |
5527 | |
5528 | /* Check if the module requires address swap to access |
5529 | * the other EEPROM memory page. |
5530 | */ |
5531 | if (sff8472_swap & I40E_MODULE_SFF_ADDR_MODE) { |
5532 | netdev_warn(dev: vsi->netdev, format: "Module address swap to access page 0xA2 is not supported.\n" ); |
5533 | modinfo->type = ETH_MODULE_SFF_8079; |
5534 | modinfo->eeprom_len = ETH_MODULE_SFF_8079_LEN; |
5535 | } else if (sff8472_comp == 0x00) { |
5536 | /* Module is not SFF-8472 compliant */ |
5537 | modinfo->type = ETH_MODULE_SFF_8079; |
5538 | modinfo->eeprom_len = ETH_MODULE_SFF_8079_LEN; |
5539 | } else if (!(sff8472_swap & I40E_MODULE_SFF_DDM_IMPLEMENTED)) { |
5540 | /* Module is SFF-8472 compliant but doesn't implement |
5541 | * Digital Diagnostic Monitoring (DDM). |
5542 | */ |
5543 | modinfo->type = ETH_MODULE_SFF_8079; |
5544 | modinfo->eeprom_len = ETH_MODULE_SFF_8079_LEN; |
5545 | } else { |
5546 | modinfo->type = ETH_MODULE_SFF_8472; |
5547 | modinfo->eeprom_len = ETH_MODULE_SFF_8472_LEN; |
5548 | } |
5549 | break; |
5550 | case I40E_MODULE_TYPE_QSFP_PLUS: |
5551 | /* Read from memory page 0. */ |
5552 | status = i40e_aq_get_phy_register(hw, |
5553 | I40E_AQ_PHY_REG_ACCESS_EXTERNAL_MODULE, |
5554 | 0, true, |
5555 | I40E_MODULE_REVISION_ADDR, |
5556 | &sff8636_rev, NULL); |
5557 | if (status) |
5558 | return -EIO; |
5559 | /* Determine revision compliance byte */ |
5560 | if (sff8636_rev > 0x02) { |
5561 | /* Module is SFF-8636 compliant */ |
5562 | modinfo->type = ETH_MODULE_SFF_8636; |
5563 | modinfo->eeprom_len = I40E_MODULE_QSFP_MAX_LEN; |
5564 | } else { |
5565 | modinfo->type = ETH_MODULE_SFF_8436; |
5566 | modinfo->eeprom_len = I40E_MODULE_QSFP_MAX_LEN; |
5567 | } |
5568 | break; |
5569 | case I40E_MODULE_TYPE_QSFP28: |
5570 | modinfo->type = ETH_MODULE_SFF_8636; |
5571 | modinfo->eeprom_len = I40E_MODULE_QSFP_MAX_LEN; |
5572 | break; |
5573 | default: |
5574 | netdev_err(dev: vsi->netdev, format: "Module type unrecognized\n" ); |
5575 | return -EINVAL; |
5576 | } |
5577 | return 0; |
5578 | } |
5579 | |
5580 | /** |
5581 | * i40e_get_module_eeprom - fills buffer with (Q)SFP+ module memory contents |
5582 | * @netdev: network interface device structure |
5583 | * @ee: EEPROM dump request structure |
5584 | * @data: buffer to be filled with EEPROM contents |
5585 | **/ |
5586 | static int i40e_get_module_eeprom(struct net_device *netdev, |
5587 | struct ethtool_eeprom *ee, |
5588 | u8 *data) |
5589 | { |
5590 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
5591 | struct i40e_vsi *vsi = np->vsi; |
5592 | struct i40e_pf *pf = vsi->back; |
5593 | struct i40e_hw *hw = &pf->hw; |
5594 | bool is_sfp = false; |
5595 | u32 value = 0; |
5596 | int status; |
5597 | int i; |
5598 | |
5599 | if (!ee || !ee->len || !data) |
5600 | return -EINVAL; |
5601 | |
5602 | if (hw->phy.link_info.module_type[0] == I40E_MODULE_TYPE_SFP) |
5603 | is_sfp = true; |
5604 | |
5605 | for (i = 0; i < ee->len; i++) { |
5606 | u32 offset = i + ee->offset; |
5607 | u32 addr = is_sfp ? I40E_I2C_EEPROM_DEV_ADDR : 0; |
5608 | |
5609 | /* Check if we need to access the other memory page */ |
5610 | if (is_sfp) { |
5611 | if (offset >= ETH_MODULE_SFF_8079_LEN) { |
5612 | offset -= ETH_MODULE_SFF_8079_LEN; |
5613 | addr = I40E_I2C_EEPROM_DEV_ADDR2; |
5614 | } |
5615 | } else { |
5616 | while (offset >= ETH_MODULE_SFF_8436_LEN) { |
5617 | /* Compute memory page number and offset. */ |
5618 | offset -= ETH_MODULE_SFF_8436_LEN / 2; |
5619 | addr++; |
5620 | } |
5621 | } |
5622 | |
5623 | status = i40e_aq_get_phy_register(hw, |
5624 | I40E_AQ_PHY_REG_ACCESS_EXTERNAL_MODULE, |
5625 | addr, true, offset, &value, NULL); |
5626 | if (status) |
5627 | return -EIO; |
5628 | data[i] = value; |
5629 | } |
5630 | return 0; |
5631 | } |
5632 | |
5633 | static int i40e_get_eee(struct net_device *netdev, struct ethtool_eee *edata) |
5634 | { |
5635 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
5636 | struct i40e_aq_get_phy_abilities_resp phy_cfg; |
5637 | struct i40e_vsi *vsi = np->vsi; |
5638 | struct i40e_pf *pf = vsi->back; |
5639 | struct i40e_hw *hw = &pf->hw; |
5640 | int status = 0; |
5641 | |
5642 | /* Get initial PHY capabilities */ |
5643 | status = i40e_aq_get_phy_capabilities(hw, qualified_modules: false, report_init: true, abilities: &phy_cfg, NULL); |
5644 | if (status) |
5645 | return -EAGAIN; |
5646 | |
5647 | /* Check whether NIC configuration is compatible with Energy Efficient |
5648 | * Ethernet (EEE) mode. |
5649 | */ |
5650 | if (phy_cfg.eee_capability == 0) |
5651 | return -EOPNOTSUPP; |
5652 | |
5653 | edata->supported = SUPPORTED_Autoneg; |
5654 | edata->lp_advertised = edata->supported; |
5655 | |
5656 | /* Get current configuration */ |
5657 | status = i40e_aq_get_phy_capabilities(hw, qualified_modules: false, report_init: false, abilities: &phy_cfg, NULL); |
5658 | if (status) |
5659 | return -EAGAIN; |
5660 | |
5661 | edata->advertised = phy_cfg.eee_capability ? SUPPORTED_Autoneg : 0U; |
5662 | edata->eee_enabled = !!edata->advertised; |
5663 | edata->tx_lpi_enabled = pf->stats.tx_lpi_status; |
5664 | |
5665 | edata->eee_active = pf->stats.tx_lpi_status && pf->stats.rx_lpi_status; |
5666 | |
5667 | return 0; |
5668 | } |
5669 | |
5670 | static int i40e_is_eee_param_supported(struct net_device *netdev, |
5671 | struct ethtool_eee *edata) |
5672 | { |
5673 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
5674 | struct i40e_vsi *vsi = np->vsi; |
5675 | struct i40e_pf *pf = vsi->back; |
5676 | struct i40e_ethtool_not_used { |
5677 | u32 value; |
5678 | const char *name; |
5679 | } param[] = { |
5680 | {edata->advertised & ~SUPPORTED_Autoneg, "advertise" }, |
5681 | {edata->tx_lpi_timer, "tx-timer" }, |
5682 | {edata->tx_lpi_enabled != pf->stats.tx_lpi_status, "tx-lpi" } |
5683 | }; |
5684 | int i; |
5685 | |
5686 | for (i = 0; i < ARRAY_SIZE(param); i++) { |
5687 | if (param[i].value) { |
5688 | netdev_info(dev: netdev, |
5689 | format: "EEE setting %s not supported\n" , |
5690 | param[i].name); |
5691 | return -EOPNOTSUPP; |
5692 | } |
5693 | } |
5694 | |
5695 | return 0; |
5696 | } |
5697 | |
5698 | static int i40e_set_eee(struct net_device *netdev, struct ethtool_eee *edata) |
5699 | { |
5700 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
5701 | struct i40e_aq_get_phy_abilities_resp abilities; |
5702 | struct i40e_aq_set_phy_config config; |
5703 | struct i40e_vsi *vsi = np->vsi; |
5704 | struct i40e_pf *pf = vsi->back; |
5705 | struct i40e_hw *hw = &pf->hw; |
5706 | __le16 eee_capability; |
5707 | int status = 0; |
5708 | |
5709 | /* Deny parameters we don't support */ |
5710 | if (i40e_is_eee_param_supported(netdev, edata)) |
5711 | return -EOPNOTSUPP; |
5712 | |
5713 | /* Get initial PHY capabilities */ |
5714 | status = i40e_aq_get_phy_capabilities(hw, qualified_modules: false, report_init: true, abilities: &abilities, |
5715 | NULL); |
5716 | if (status) |
5717 | return -EAGAIN; |
5718 | |
5719 | /* Check whether NIC configuration is compatible with Energy Efficient |
5720 | * Ethernet (EEE) mode. |
5721 | */ |
5722 | if (abilities.eee_capability == 0) |
5723 | return -EOPNOTSUPP; |
5724 | |
5725 | /* Cache initial EEE capability */ |
5726 | eee_capability = abilities.eee_capability; |
5727 | |
5728 | /* Get current PHY configuration */ |
5729 | status = i40e_aq_get_phy_capabilities(hw, qualified_modules: false, report_init: false, abilities: &abilities, |
5730 | NULL); |
5731 | if (status) |
5732 | return -EAGAIN; |
5733 | |
5734 | /* Cache current PHY configuration */ |
5735 | config.phy_type = abilities.phy_type; |
5736 | config.phy_type_ext = abilities.phy_type_ext; |
5737 | config.link_speed = abilities.link_speed; |
5738 | config.abilities = abilities.abilities | |
5739 | I40E_AQ_PHY_ENABLE_ATOMIC_LINK; |
5740 | config.eeer = abilities.eeer_val; |
5741 | config.low_power_ctrl = abilities.d3_lpan; |
5742 | config.fec_config = abilities.fec_cfg_curr_mod_ext_info & |
5743 | I40E_AQ_PHY_FEC_CONFIG_MASK; |
5744 | |
5745 | /* Set desired EEE state */ |
5746 | if (edata->eee_enabled) { |
5747 | config.eee_capability = eee_capability; |
5748 | config.eeer |= cpu_to_le32(I40E_PRTPM_EEER_TX_LPI_EN_MASK); |
5749 | } else { |
5750 | config.eee_capability = 0; |
5751 | config.eeer &= cpu_to_le32(~I40E_PRTPM_EEER_TX_LPI_EN_MASK); |
5752 | } |
5753 | |
5754 | /* Apply modified PHY configuration */ |
5755 | status = i40e_aq_set_phy_config(hw, config: &config, NULL); |
5756 | if (status) |
5757 | return -EAGAIN; |
5758 | |
5759 | return 0; |
5760 | } |
5761 | |
5762 | static const struct ethtool_ops i40e_ethtool_recovery_mode_ops = { |
5763 | .get_drvinfo = i40e_get_drvinfo, |
5764 | .set_eeprom = i40e_set_eeprom, |
5765 | .get_eeprom_len = i40e_get_eeprom_len, |
5766 | .get_eeprom = i40e_get_eeprom, |
5767 | }; |
5768 | |
5769 | static const struct ethtool_ops i40e_ethtool_ops = { |
5770 | .supported_coalesce_params = ETHTOOL_COALESCE_USECS | |
5771 | ETHTOOL_COALESCE_MAX_FRAMES_IRQ | |
5772 | ETHTOOL_COALESCE_USE_ADAPTIVE | |
5773 | ETHTOOL_COALESCE_RX_USECS_HIGH | |
5774 | ETHTOOL_COALESCE_TX_USECS_HIGH, |
5775 | .get_drvinfo = i40e_get_drvinfo, |
5776 | .get_regs_len = i40e_get_regs_len, |
5777 | .get_regs = i40e_get_regs, |
5778 | .nway_reset = i40e_nway_reset, |
5779 | .get_link = ethtool_op_get_link, |
5780 | .get_wol = i40e_get_wol, |
5781 | .set_wol = i40e_set_wol, |
5782 | .set_eeprom = i40e_set_eeprom, |
5783 | .get_eeprom_len = i40e_get_eeprom_len, |
5784 | .get_eeprom = i40e_get_eeprom, |
5785 | .get_ringparam = i40e_get_ringparam, |
5786 | .set_ringparam = i40e_set_ringparam, |
5787 | .get_pauseparam = i40e_get_pauseparam, |
5788 | .set_pauseparam = i40e_set_pauseparam, |
5789 | .get_msglevel = i40e_get_msglevel, |
5790 | .set_msglevel = i40e_set_msglevel, |
5791 | .get_rxnfc = i40e_get_rxnfc, |
5792 | .set_rxnfc = i40e_set_rxnfc, |
5793 | .self_test = i40e_diag_test, |
5794 | .get_strings = i40e_get_strings, |
5795 | .get_eee = i40e_get_eee, |
5796 | .set_eee = i40e_set_eee, |
5797 | .set_phys_id = i40e_set_phys_id, |
5798 | .get_sset_count = i40e_get_sset_count, |
5799 | .get_ethtool_stats = i40e_get_ethtool_stats, |
5800 | .get_coalesce = i40e_get_coalesce, |
5801 | .set_coalesce = i40e_set_coalesce, |
5802 | .get_rxfh_key_size = i40e_get_rxfh_key_size, |
5803 | .get_rxfh_indir_size = i40e_get_rxfh_indir_size, |
5804 | .get_rxfh = i40e_get_rxfh, |
5805 | .set_rxfh = i40e_set_rxfh, |
5806 | .get_channels = i40e_get_channels, |
5807 | .set_channels = i40e_set_channels, |
5808 | .get_module_info = i40e_get_module_info, |
5809 | .get_module_eeprom = i40e_get_module_eeprom, |
5810 | .get_ts_info = i40e_get_ts_info, |
5811 | .get_priv_flags = i40e_get_priv_flags, |
5812 | .set_priv_flags = i40e_set_priv_flags, |
5813 | .get_per_queue_coalesce = i40e_get_per_queue_coalesce, |
5814 | .set_per_queue_coalesce = i40e_set_per_queue_coalesce, |
5815 | .get_link_ksettings = i40e_get_link_ksettings, |
5816 | .set_link_ksettings = i40e_set_link_ksettings, |
5817 | .get_fecparam = i40e_get_fec_param, |
5818 | .set_fecparam = i40e_set_fec_param, |
5819 | .flash_device = i40e_ddp_flash, |
5820 | }; |
5821 | |
5822 | void i40e_set_ethtool_ops(struct net_device *netdev) |
5823 | { |
5824 | struct i40e_netdev_priv *np = netdev_priv(dev: netdev); |
5825 | struct i40e_pf *pf = np->vsi->back; |
5826 | |
5827 | if (!test_bit(__I40E_RECOVERY_MODE, pf->state)) |
5828 | netdev->ethtool_ops = &i40e_ethtool_ops; |
5829 | else |
5830 | netdev->ethtool_ops = &i40e_ethtool_recovery_mode_ops; |
5831 | } |
5832 | |