Blame - drivers/net/ethernet/intel/i40e/i40e_ethtool.c - kernel/msm-5.4

blob: 0cef8aa85c1da9de1b9e5bfafef5b4b61ec063ba [file] [log] [blame]

Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1	/*******************************************************************************
				2	*
				3	* Intel Ethernet Controller XL710 Family Linux Driver
Shannon Nelson	66fc360	2016-01-13 16:51:42 -0800	[diff] [blame]	4	* Copyright(c) 2013 - 2016 Intel Corporation.
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	5	*
				6	* This program is free software; you can redistribute it and/or modify it
				7	* under the terms and conditions of the GNU General Public License,
				8	* version 2, as published by the Free Software Foundation.
				9	*
				10	* This program is distributed in the hope it will be useful, but WITHOUT
				11	* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
				12	* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
				13	* more details.
				14	*
Greg Rose	dc641b7	2013-12-18 13:45:51 +0000	[diff] [blame]	15	* You should have received a copy of the GNU General Public License along
				16	* with this program. If not, see <http://www.gnu.org/licenses/>.
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	17	*
				18	* The full GNU General Public License is included in this distribution in
				19	* the file called "COPYING".
				20	*
				21	* Contact Information:
				22	* e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>
				23	* Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
				24	*
				25	******************************************************************************/
				26
				27	/* ethtool support for i40e */
				28
				29	#include "i40e.h"
				30	#include "i40e_diag.h"
				31
				32	struct i40e_stats {
				33	char stat_string[ETH_GSTRING_LEN];
				34	int sizeof_stat;
				35	int stat_offset;
				36	};
				37
				38	#define I40E_STAT(_type, _name, _stat) { \
				39	.stat_string = _name, \
				40	.sizeof_stat = FIELD_SIZEOF(_type, _stat), \
				41	.stat_offset = offsetof(_type, _stat) \
				42	}
Shannon Nelson	fad177d	2014-11-11 20:07:27 +0000	[diff] [blame]	43
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	44	#define I40E_NETDEV_STAT(_net_stat) \
Shannon Nelson	fad177d	2014-11-11 20:07:27 +0000	[diff] [blame]	45	I40E_STAT(struct rtnl_link_stats64, #_net_stat, _net_stat)
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	46	#define I40E_PF_STAT(_name, _stat) \
				47	I40E_STAT(struct i40e_pf, _name, _stat)
				48	#define I40E_VSI_STAT(_name, _stat) \
				49	I40E_STAT(struct i40e_vsi, _name, _stat)
Shannon Nelson	8eab9cf	2014-04-23 04:49:55 +0000	[diff] [blame]	50	#define I40E_VEB_STAT(_name, _stat) \
				51	I40E_STAT(struct i40e_veb, _name, _stat)
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	52
				53	static const struct i40e_stats i40e_gstrings_net_stats[] = {
				54	I40E_NETDEV_STAT(rx_packets),
				55	I40E_NETDEV_STAT(tx_packets),
				56	I40E_NETDEV_STAT(rx_bytes),
				57	I40E_NETDEV_STAT(tx_bytes),
				58	I40E_NETDEV_STAT(rx_errors),
				59	I40E_NETDEV_STAT(tx_errors),
				60	I40E_NETDEV_STAT(rx_dropped),
				61	I40E_NETDEV_STAT(tx_dropped),
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	62	I40E_NETDEV_STAT(collisions),
				63	I40E_NETDEV_STAT(rx_length_errors),
				64	I40E_NETDEV_STAT(rx_crc_errors),
				65	};
				66
Shannon Nelson	8eab9cf	2014-04-23 04:49:55 +0000	[diff] [blame]	67	static const struct i40e_stats i40e_gstrings_veb_stats[] = {
				68	I40E_VEB_STAT("rx_bytes", stats.rx_bytes),
				69	I40E_VEB_STAT("tx_bytes", stats.tx_bytes),
				70	I40E_VEB_STAT("rx_unicast", stats.rx_unicast),
				71	I40E_VEB_STAT("tx_unicast", stats.tx_unicast),
				72	I40E_VEB_STAT("rx_multicast", stats.rx_multicast),
				73	I40E_VEB_STAT("tx_multicast", stats.tx_multicast),
				74	I40E_VEB_STAT("rx_broadcast", stats.rx_broadcast),
				75	I40E_VEB_STAT("tx_broadcast", stats.tx_broadcast),
				76	I40E_VEB_STAT("rx_discards", stats.rx_discards),
				77	I40E_VEB_STAT("tx_discards", stats.tx_discards),
				78	I40E_VEB_STAT("tx_errors", stats.tx_errors),
				79	I40E_VEB_STAT("rx_unknown_protocol", stats.rx_unknown_protocol),
				80	};
				81
Shannon Nelson	41a9e55	2014-04-23 04:50:20 +0000	[diff] [blame]	82	static const struct i40e_stats i40e_gstrings_misc_stats[] = {
Shannon Nelson	418631d	2014-04-23 04:50:07 +0000	[diff] [blame]	83	I40E_VSI_STAT("rx_unicast", eth_stats.rx_unicast),
				84	I40E_VSI_STAT("tx_unicast", eth_stats.tx_unicast),
				85	I40E_VSI_STAT("rx_multicast", eth_stats.rx_multicast),
				86	I40E_VSI_STAT("tx_multicast", eth_stats.tx_multicast),
Shannon Nelson	41a9e55	2014-04-23 04:50:20 +0000	[diff] [blame]	87	I40E_VSI_STAT("rx_broadcast", eth_stats.rx_broadcast),
				88	I40E_VSI_STAT("tx_broadcast", eth_stats.tx_broadcast),
Shannon Nelson	418631d	2014-04-23 04:50:07 +0000	[diff] [blame]	89	I40E_VSI_STAT("rx_unknown_protocol", eth_stats.rx_unknown_protocol),
Anjali Singhai Jain	2fc3d71	2015-08-27 11:42:29 -0400	[diff] [blame]	90	I40E_VSI_STAT("tx_linearize", tx_linearize),
Anjali Singhai Jain	164c9f5	2015-10-21 19:47:08 -0400	[diff] [blame]	91	I40E_VSI_STAT("tx_force_wb", tx_force_wb),
Jesse Brandeburg	c40918c	2016-01-04 10:33:10 -0800	[diff] [blame]	92	I40E_VSI_STAT("rx_alloc_fail", rx_buf_failed),
				93	I40E_VSI_STAT("rx_pg_alloc_fail", rx_page_failed),
Shannon Nelson	41a9e55	2014-04-23 04:50:20 +0000	[diff] [blame]	94	};
				95
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	96	/* These PF_STATs might look like duplicates of some NETDEV_STATs,
				97	* but they are separate. This device supports Virtualization, and
				98	* as such might have several netdevs supporting VMDq and FCoE going
				99	* through a single port. The NETDEV_STATs are for individual netdevs
				100	* seen at the top of the stack, and the PF_STATs are for the physical
				101	* function at the bottom of the stack hosting those netdevs.
				102	*
				103	* The PF_STATs are appended to the netdev stats only when ethtool -S
				104	* is queried on the base PF netdev, not on the VMDq or FCoE netdev.
				105	*/
Joe Perches	fe180a5	2016-09-26 20:17:01 -0700	[diff] [blame]	106	static const struct i40e_stats i40e_gstrings_stats[] = {
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	107	I40E_PF_STAT("rx_bytes", stats.eth.rx_bytes),
				108	I40E_PF_STAT("tx_bytes", stats.eth.tx_bytes),
Shannon Nelson	532d283	2014-04-23 04:50:09 +0000	[diff] [blame]	109	I40E_PF_STAT("rx_unicast", stats.eth.rx_unicast),
				110	I40E_PF_STAT("tx_unicast", stats.eth.tx_unicast),
				111	I40E_PF_STAT("rx_multicast", stats.eth.rx_multicast),
				112	I40E_PF_STAT("tx_multicast", stats.eth.tx_multicast),
				113	I40E_PF_STAT("rx_broadcast", stats.eth.rx_broadcast),
				114	I40E_PF_STAT("tx_broadcast", stats.eth.tx_broadcast),
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	115	I40E_PF_STAT("tx_errors", stats.eth.tx_errors),
				116	I40E_PF_STAT("rx_dropped", stats.eth.rx_discards),
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	117	I40E_PF_STAT("tx_dropped_link_down", stats.tx_dropped_link_down),
Shannon Nelson	9f7c944	2015-07-10 19:35:57 -0400	[diff] [blame]	118	I40E_PF_STAT("rx_crc_errors", stats.crc_errors),
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	119	I40E_PF_STAT("illegal_bytes", stats.illegal_bytes),
				120	I40E_PF_STAT("mac_local_faults", stats.mac_local_faults),
				121	I40E_PF_STAT("mac_remote_faults", stats.mac_remote_faults),
Jesse Brandeburg	a47a15f	2014-02-06 05:51:09 +0000	[diff] [blame]	122	I40E_PF_STAT("tx_timeout", tx_timeout_count),
Jesse Brandeburg	8a3c91c	2014-05-20 08:01:43 +0000	[diff] [blame]	123	I40E_PF_STAT("rx_csum_bad", hw_csum_rx_error),
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	124	I40E_PF_STAT("rx_length_errors", stats.rx_length_errors),
				125	I40E_PF_STAT("link_xon_rx", stats.link_xon_rx),
				126	I40E_PF_STAT("link_xoff_rx", stats.link_xoff_rx),
				127	I40E_PF_STAT("link_xon_tx", stats.link_xon_tx),
				128	I40E_PF_STAT("link_xoff_tx", stats.link_xoff_tx),
				129	I40E_PF_STAT("rx_size_64", stats.rx_size_64),
				130	I40E_PF_STAT("rx_size_127", stats.rx_size_127),
				131	I40E_PF_STAT("rx_size_255", stats.rx_size_255),
				132	I40E_PF_STAT("rx_size_511", stats.rx_size_511),
				133	I40E_PF_STAT("rx_size_1023", stats.rx_size_1023),
				134	I40E_PF_STAT("rx_size_1522", stats.rx_size_1522),
				135	I40E_PF_STAT("rx_size_big", stats.rx_size_big),
				136	I40E_PF_STAT("tx_size_64", stats.tx_size_64),
				137	I40E_PF_STAT("tx_size_127", stats.tx_size_127),
				138	I40E_PF_STAT("tx_size_255", stats.tx_size_255),
				139	I40E_PF_STAT("tx_size_511", stats.tx_size_511),
				140	I40E_PF_STAT("tx_size_1023", stats.tx_size_1023),
				141	I40E_PF_STAT("tx_size_1522", stats.tx_size_1522),
				142	I40E_PF_STAT("tx_size_big", stats.tx_size_big),
				143	I40E_PF_STAT("rx_undersize", stats.rx_undersize),
				144	I40E_PF_STAT("rx_fragments", stats.rx_fragments),
				145	I40E_PF_STAT("rx_oversize", stats.rx_oversize),
				146	I40E_PF_STAT("rx_jabber", stats.rx_jabber),
				147	I40E_PF_STAT("VF_admin_queue_requests", vf_aq_requests),
Mitch Williams	1d0a4ad	2015-12-23 12:05:48 -0800	[diff] [blame]	148	I40E_PF_STAT("arq_overflows", arq_overflows),
Jacob Keller	beb0dff	2014-01-11 05:43:19 +0000	[diff] [blame]	149	I40E_PF_STAT("rx_hwtstamp_cleared", rx_hwtstamp_cleared),
Jacob Keller	2955fac	2017-05-03 10:28:58 -0700	[diff] [blame]	150	I40E_PF_STAT("tx_hwtstamp_skipped", tx_hwtstamp_skipped),
Anjali Singhai Jain	60793f4a	2014-07-09 07:46:23 +0000	[diff] [blame]	151	I40E_PF_STAT("fdir_flush_cnt", fd_flush_cnt),
Anjali Singhai Jain	433c47d	2014-05-22 06:32:17 +0000	[diff] [blame]	152	I40E_PF_STAT("fdir_atr_match", stats.fd_atr_match),
Anjali Singhai Jain	60ccd45	2015-04-16 20:06:01 -0400	[diff] [blame]	153	I40E_PF_STAT("fdir_atr_tunnel_match", stats.fd_atr_tunnel_match),
Anjali Singhai Jain	d0389e5	2015-04-22 19:34:05 -0400	[diff] [blame]	154	I40E_PF_STAT("fdir_atr_status", stats.fd_atr_status),
Anjali Singhai Jain	433c47d	2014-05-22 06:32:17 +0000	[diff] [blame]	155	I40E_PF_STAT("fdir_sb_match", stats.fd_sb_match),
Anjali Singhai Jain	d0389e5	2015-04-22 19:34:05 -0400	[diff] [blame]	156	I40E_PF_STAT("fdir_sb_status", stats.fd_sb_status),
Anjali Singhai Jain	433c47d	2014-05-22 06:32:17 +0000	[diff] [blame]	157
Anjali Singhai Jain	bee5af7	2014-03-06 08:59:50 +0000	[diff] [blame]	158	/* LPI stats */
				159	I40E_PF_STAT("tx_lpi_status", stats.tx_lpi_status),
				160	I40E_PF_STAT("rx_lpi_status", stats.rx_lpi_status),
				161	I40E_PF_STAT("tx_lpi_count", stats.tx_lpi_count),
				162	I40E_PF_STAT("rx_lpi_count", stats.rx_lpi_count),
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	163	};
				164
				165	#define I40E_QUEUE_STATS_LEN(n) \
Shannon Nelson	31cd840	2014-04-04 04:43:12 +0000	[diff] [blame]	166	(((struct i40e_netdev_priv *)netdev_priv((n)))->vsi->num_queue_pairs \
				167	* 2 /* Tx and Rx together */ \
				168	* (sizeof(struct i40e_queue_stats) / sizeof(u64)))
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	169	#define I40E_GLOBAL_STATS_LEN ARRAY_SIZE(i40e_gstrings_stats)
				170	#define I40E_NETDEV_STATS_LEN ARRAY_SIZE(i40e_gstrings_net_stats)
Shannon Nelson	41a9e55	2014-04-23 04:50:20 +0000	[diff] [blame]	171	#define I40E_MISC_STATS_LEN ARRAY_SIZE(i40e_gstrings_misc_stats)
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	172	#define I40E_VSI_STATS_LEN(n) (I40E_NETDEV_STATS_LEN + \
Shannon Nelson	41a9e55	2014-04-23 04:50:20 +0000	[diff] [blame]	173	I40E_MISC_STATS_LEN + \
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	174	I40E_QUEUE_STATS_LEN((n)))
				175	#define I40E_PFC_STATS_LEN ( \
				176	(FIELD_SIZEOF(struct i40e_pf, stats.priority_xoff_rx) + \
				177	FIELD_SIZEOF(struct i40e_pf, stats.priority_xon_rx) + \
				178	FIELD_SIZEOF(struct i40e_pf, stats.priority_xoff_tx) + \
				179	FIELD_SIZEOF(struct i40e_pf, stats.priority_xon_tx) + \
				180	FIELD_SIZEOF(struct i40e_pf, stats.priority_xon_2_xoff)) \
				181	/ sizeof(u64))
Neerav Parikh	fe860af	2015-07-10 19:36:02 -0400	[diff] [blame]	182	#define I40E_VEB_TC_STATS_LEN ( \
				183	(FIELD_SIZEOF(struct i40e_veb, tc_stats.tc_rx_packets) + \
				184	FIELD_SIZEOF(struct i40e_veb, tc_stats.tc_rx_bytes) + \
				185	FIELD_SIZEOF(struct i40e_veb, tc_stats.tc_tx_packets) + \
				186	FIELD_SIZEOF(struct i40e_veb, tc_stats.tc_tx_bytes)) \
				187	/ sizeof(u64))
Shannon Nelson	8eab9cf	2014-04-23 04:49:55 +0000	[diff] [blame]	188	#define I40E_VEB_STATS_LEN ARRAY_SIZE(i40e_gstrings_veb_stats)
Neerav Parikh	fe860af	2015-07-10 19:36:02 -0400	[diff] [blame]	189	#define I40E_VEB_STATS_TOTAL (I40E_VEB_STATS_LEN + I40E_VEB_TC_STATS_LEN)
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	190	#define I40E_PF_STATS_LEN(n) (I40E_GLOBAL_STATS_LEN + \
				191	I40E_PFC_STATS_LEN + \
				192	I40E_VSI_STATS_LEN((n)))
				193
				194	enum i40e_ethtool_test_id {
				195	I40E_ETH_TEST_REG = 0,
				196	I40E_ETH_TEST_EEPROM,
				197	I40E_ETH_TEST_INTR,
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	198	I40E_ETH_TEST_LINK,
				199	};
				200
				201	static const char i40e_gstrings_test[][ETH_GSTRING_LEN] = {
				202	"Register test (offline)",
				203	"Eeprom test (offline)",
				204	"Interrupt test (offline)",
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	205	"Link test (on/offline)"
				206	};
				207
				208	#define I40E_TEST_LEN (sizeof(i40e_gstrings_test) / ETH_GSTRING_LEN)
				209
Alexander Duyck	aca955d	2017-03-10 12:22:01 -0800	[diff] [blame]	210	struct i40e_priv_flags {
				211	char flag_string[ETH_GSTRING_LEN];
				212	u64 flag;
				213	bool read_only;
Greg Rose	7e45ab4	2015-02-06 08:52:19 +0000	[diff] [blame]	214	};
				215
Alexander Duyck	aca955d	2017-03-10 12:22:01 -0800	[diff] [blame]	216	#define I40E_PRIV_FLAG(_name, _flag, _read_only) { \
				217	.flag_string = _name, \
				218	.flag = _flag, \
				219	.read_only = _read_only, \
				220	}
				221
				222	static const struct i40e_priv_flags i40e_gstrings_priv_flags[] = {
				223	/* NOTE: MFP setting cannot be changed */
				224	I40E_PRIV_FLAG("MFP", I40E_FLAG_MFP_ENABLED, 1),
				225	I40E_PRIV_FLAG("LinkPolling", I40E_FLAG_LINK_POLLING_ENABLED, 0),
				226	I40E_PRIV_FLAG("flow-director-atr", I40E_FLAG_FD_ATR_ENABLED, 0),
				227	I40E_PRIV_FLAG("veb-stats", I40E_FLAG_VEB_STATS_ENABLED, 0),
Jacob Keller	6964e53	2017-06-12 15:38:36 -0700	[diff] [blame]	228	I40E_PRIV_FLAG("hw-atr-eviction", I40E_FLAG_HW_ATR_EVICT_ENABLED, 0),
Alexander Duyck	c424d4a	2017-03-14 10:15:26 -0700	[diff] [blame]	229	I40E_PRIV_FLAG("legacy-rx", I40E_FLAG_LEGACY_RX, 0),
Mitch Williams	64615b5	2017-08-29 05:32:30 -0400	[diff] [blame]	230	I40E_PRIV_FLAG("disable-source-pruning",
				231	I40E_FLAG_SOURCE_PRUNING_DISABLED, 0),
Alexander Duyck	aca955d	2017-03-10 12:22:01 -0800	[diff] [blame]	232	};
				233
				234	#define I40E_PRIV_FLAGS_STR_LEN ARRAY_SIZE(i40e_gstrings_priv_flags)
Greg Rose	7e45ab4	2015-02-06 08:52:19 +0000	[diff] [blame]	235
Jacob Keller	d182a5c	2016-10-25 16:08:50 -0700	[diff] [blame]	236	/* Private flags with a global effect, restricted to PF 0 */
Alexander Duyck	aca955d	2017-03-10 12:22:01 -0800	[diff] [blame]	237	static const struct i40e_priv_flags i40e_gl_gstrings_priv_flags[] = {
				238	I40E_PRIV_FLAG("vf-true-promisc-support",
				239	I40E_FLAG_TRUE_PROMISC_SUPPORT, 0),
Jacob Keller	d182a5c	2016-10-25 16:08:50 -0700	[diff] [blame]	240	};
				241
Alexander Duyck	aca955d	2017-03-10 12:22:01 -0800	[diff] [blame]	242	#define I40E_GL_PRIV_FLAGS_STR_LEN ARRAY_SIZE(i40e_gl_gstrings_priv_flags)
Jacob Keller	d182a5c	2016-10-25 16:08:50 -0700	[diff] [blame]	243
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	244	/**
Shannon Nelson	f0d8c73	2014-12-11 07:06:32 +0000	[diff] [blame]	245	* i40e_partition_setting_complaint - generic complaint for MFP restriction
				246	* @pf: the PF struct
				247	**/
				248	static void i40e_partition_setting_complaint(struct i40e_pf *pf)
				249	{
				250	dev_info(&pf->pdev->dev,
				251	"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");
				252	}
				253
				254	/**
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	255	* i40e_phy_type_to_ethtool - convert the phy_types to ethtool link modes
Alan Brady	52e2d02	2017-10-05 14:53:35 -0700	[diff] [blame]	256	* @pf: PF struct with phy_types
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	257	* @ks: ethtool link ksettings struct to fill out
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	258	*
				259	**/
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	260	static void i40e_phy_type_to_ethtool(struct i40e_pf *pf,
				261	struct ethtool_link_ksettings *ks)
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	262	{
Avinash Dayanand	2853704	2016-06-20 09:10:33 -0700	[diff] [blame]	263	struct i40e_link_status *hw_link_info = &pf->hw.phy.link_info;
Carolyn Wyborny	3123237	2016-11-21 13:03:48 -0800	[diff] [blame]	264	u64 phy_types = pf->hw.phy.phy_types;
				265
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	266	ethtool_link_ksettings_zero_link_mode(ks, supported);
				267	ethtool_link_ksettings_zero_link_mode(ks, advertising);
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	268
				269	if (phy_types & I40E_CAP_PHY_TYPE_SGMII) {
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	270	ethtool_link_ksettings_add_link_mode(ks, supported,
				271	1000baseT_Full);
Avinash Dayanand	2853704	2016-06-20 09:10:33 -0700	[diff] [blame]	272	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_1GB)
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	273	ethtool_link_ksettings_add_link_mode(ks, advertising,
				274	1000baseT_Full);
Jacob Keller	d36e41d	2017-06-23 04:24:46 -0400	[diff] [blame]	275	if (pf->hw_features & I40E_HW_100M_SGMII_CAPABLE) {
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	276	ethtool_link_ksettings_add_link_mode(ks, supported,
				277	100baseT_Full);
				278	ethtool_link_ksettings_add_link_mode(ks, advertising,
				279	100baseT_Full);
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	280	}
				281	}
				282	if (phy_types & I40E_CAP_PHY_TYPE_XAUI \|\|
				283	phy_types & I40E_CAP_PHY_TYPE_XFI \|\|
				284	phy_types & I40E_CAP_PHY_TYPE_SFI \|\|
				285	phy_types & I40E_CAP_PHY_TYPE_10GBASE_SFPP_CU \|\|
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	286	phy_types & I40E_CAP_PHY_TYPE_10GBASE_AOC) {
				287	ethtool_link_ksettings_add_link_mode(ks, supported,
				288	10000baseT_Full);
Avinash Dayanand	2853704	2016-06-20 09:10:33 -0700	[diff] [blame]	289	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_10GB)
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	290	ethtool_link_ksettings_add_link_mode(ks, advertising,
				291	10000baseT_Full);
				292	}
				293	if (phy_types & I40E_CAP_PHY_TYPE_10GBASE_T) {
				294	ethtool_link_ksettings_add_link_mode(ks, supported,
				295	10000baseT_Full);
				296	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_10GB)
				297	ethtool_link_ksettings_add_link_mode(ks, advertising,
				298	10000baseT_Full);
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	299	}
				300	if (phy_types & I40E_CAP_PHY_TYPE_XLAUI \|\|
				301	phy_types & I40E_CAP_PHY_TYPE_XLPPI \|\|
				302	phy_types & I40E_CAP_PHY_TYPE_40GBASE_AOC)
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	303	ethtool_link_ksettings_add_link_mode(ks, supported,
				304	40000baseCR4_Full);
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	305	if (phy_types & I40E_CAP_PHY_TYPE_40GBASE_CR4_CU \|\|
				306	phy_types & I40E_CAP_PHY_TYPE_40GBASE_CR4) {
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	307	ethtool_link_ksettings_add_link_mode(ks, supported,
				308	40000baseCR4_Full);
Avinash Dayanand	2853704	2016-06-20 09:10:33 -0700	[diff] [blame]	309	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_40GB)
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	310	ethtool_link_ksettings_add_link_mode(ks, advertising,
				311	40000baseCR4_Full);
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	312	}
Avinash Dayanand	01a7a9f	2016-05-16 10:26:40 -0700	[diff] [blame]	313	if (phy_types & I40E_CAP_PHY_TYPE_100BASE_TX) {
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	314	ethtool_link_ksettings_add_link_mode(ks, supported,
				315	100baseT_Full);
Avinash Dayanand	2853704	2016-06-20 09:10:33 -0700	[diff] [blame]	316	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_100MB)
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	317	ethtool_link_ksettings_add_link_mode(ks, advertising,
				318	100baseT_Full);
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	319	}
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	320	if (phy_types & I40E_CAP_PHY_TYPE_1000BASE_T) {
				321	ethtool_link_ksettings_add_link_mode(ks, supported,
				322	1000baseT_Full);
Avinash Dayanand	2853704	2016-06-20 09:10:33 -0700	[diff] [blame]	323	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_1GB)
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	324	ethtool_link_ksettings_add_link_mode(ks, advertising,
				325	1000baseT_Full);
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	326	}
				327	if (phy_types & I40E_CAP_PHY_TYPE_40GBASE_SR4)
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	328	ethtool_link_ksettings_add_link_mode(ks, supported,
				329	40000baseSR4_Full);
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	330	if (phy_types & I40E_CAP_PHY_TYPE_40GBASE_LR4)
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	331	ethtool_link_ksettings_add_link_mode(ks, supported,
				332	40000baseLR4_Full);
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	333	if (phy_types & I40E_CAP_PHY_TYPE_40GBASE_KR4) {
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	334	ethtool_link_ksettings_add_link_mode(ks, supported,
				335	40000baseLR4_Full);
				336	ethtool_link_ksettings_add_link_mode(ks, advertising,
				337	40000baseLR4_Full);
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	338	}
				339	if (phy_types & I40E_CAP_PHY_TYPE_20GBASE_KR2) {
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	340	ethtool_link_ksettings_add_link_mode(ks, supported,
				341	20000baseKR2_Full);
Avinash Dayanand	2853704	2016-06-20 09:10:33 -0700	[diff] [blame]	342	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_20GB)
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	343	ethtool_link_ksettings_add_link_mode(ks, advertising,
				344	20000baseKR2_Full);
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	345	}
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	346	if (phy_types & I40E_CAP_PHY_TYPE_10GBASE_KX4) {
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	347	ethtool_link_ksettings_add_link_mode(ks, supported,
				348	10000baseKX4_Full);
Avinash Dayanand	2853704	2016-06-20 09:10:33 -0700	[diff] [blame]	349	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_10GB)
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	350	ethtool_link_ksettings_add_link_mode(ks, advertising,
				351	10000baseKX4_Full);
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	352	}
Alan Brady	6987bd25	2017-10-05 14:53:38 -0700	[diff] [blame]	353	if (phy_types & I40E_CAP_PHY_TYPE_10GBASE_KR &&
				354	!(pf->hw_features & I40E_HW_HAVE_CRT_RETIMER)) {
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	355	ethtool_link_ksettings_add_link_mode(ks, supported,
				356	10000baseKR_Full);
Alan Brady	6987bd25	2017-10-05 14:53:38 -0700	[diff] [blame]	357	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_10GB)
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	358	ethtool_link_ksettings_add_link_mode(ks, advertising,
				359	10000baseKR_Full);
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	360	}
Alan Brady	6987bd25	2017-10-05 14:53:38 -0700	[diff] [blame]	361	if (phy_types & I40E_CAP_PHY_TYPE_1000BASE_KX &&
				362	!(pf->hw_features & I40E_HW_HAVE_CRT_RETIMER)) {
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	363	ethtool_link_ksettings_add_link_mode(ks, supported,
				364	1000baseKX_Full);
Alan Brady	6987bd25	2017-10-05 14:53:38 -0700	[diff] [blame]	365	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_1GB)
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	366	ethtool_link_ksettings_add_link_mode(ks, advertising,
				367	1000baseKX_Full);
				368	}
				369	/* need to add 25G PHY types */
				370	if (phy_types & I40E_CAP_PHY_TYPE_25GBASE_KR) {
				371	ethtool_link_ksettings_add_link_mode(ks, supported,
				372	25000baseKR_Full);
				373	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_25GB)
				374	ethtool_link_ksettings_add_link_mode(ks, advertising,
				375	25000baseKR_Full);
				376	}
				377	if (phy_types & I40E_CAP_PHY_TYPE_25GBASE_CR) {
				378	ethtool_link_ksettings_add_link_mode(ks, supported,
				379	25000baseCR_Full);
				380	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_25GB)
				381	ethtool_link_ksettings_add_link_mode(ks, advertising,
				382	25000baseCR_Full);
				383	}
				384	if (phy_types & I40E_CAP_PHY_TYPE_25GBASE_SR \|\|
				385	phy_types & I40E_CAP_PHY_TYPE_25GBASE_LR) {
				386	ethtool_link_ksettings_add_link_mode(ks, supported,
				387	25000baseSR_Full);
				388	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_25GB)
				389	ethtool_link_ksettings_add_link_mode(ks, advertising,
				390	25000baseSR_Full);
				391	}
				392	if (phy_types & I40E_CAP_PHY_TYPE_25GBASE_AOC \|\|
				393	phy_types & I40E_CAP_PHY_TYPE_25GBASE_ACC) {
				394	ethtool_link_ksettings_add_link_mode(ks, supported,
				395	25000baseCR_Full);
				396	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_25GB)
				397	ethtool_link_ksettings_add_link_mode(ks, advertising,
				398	25000baseCR_Full);
				399	}
				400	/* need to add new 10G PHY types */
				401	if (phy_types & I40E_CAP_PHY_TYPE_10GBASE_CR1 \|\|
				402	phy_types & I40E_CAP_PHY_TYPE_10GBASE_CR1_CU) {
				403	ethtool_link_ksettings_add_link_mode(ks, supported,
				404	10000baseCR_Full);
				405	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_10GB)
				406	ethtool_link_ksettings_add_link_mode(ks, advertising,
				407	10000baseCR_Full);
				408	}
				409	if (phy_types & I40E_CAP_PHY_TYPE_10GBASE_SR) {
				410	ethtool_link_ksettings_add_link_mode(ks, supported,
				411	10000baseSR_Full);
				412	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_10GB)
				413	ethtool_link_ksettings_add_link_mode(ks, advertising,
				414	10000baseSR_Full);
				415	}
				416	if (phy_types & I40E_CAP_PHY_TYPE_10GBASE_LR) {
				417	ethtool_link_ksettings_add_link_mode(ks, supported,
				418	10000baseLR_Full);
				419	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_10GB)
				420	ethtool_link_ksettings_add_link_mode(ks, advertising,
				421	10000baseLR_Full);
				422	}
				423	if (phy_types & I40E_CAP_PHY_TYPE_1000BASE_SX \|\|
				424	phy_types & I40E_CAP_PHY_TYPE_1000BASE_LX \|\|
				425	phy_types & I40E_CAP_PHY_TYPE_1000BASE_T_OPTICAL) {
				426	ethtool_link_ksettings_add_link_mode(ks, supported,
				427	1000baseX_Full);
				428	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_1GB)
				429	ethtool_link_ksettings_add_link_mode(ks, advertising,
				430	1000baseX_Full);
Alan Brady	6987bd25	2017-10-05 14:53:38 -0700	[diff] [blame]	431	}
				432	/* Autoneg PHY types */
				433	if (phy_types & I40E_CAP_PHY_TYPE_SGMII \|\|
				434	phy_types & I40E_CAP_PHY_TYPE_40GBASE_KR4 \|\|
				435	phy_types & I40E_CAP_PHY_TYPE_40GBASE_CR4_CU \|\|
				436	phy_types & I40E_CAP_PHY_TYPE_40GBASE_CR4 \|\|
Carolyn Wyborny	3123237	2016-11-21 13:03:48 -0800	[diff] [blame]	437	phy_types & I40E_CAP_PHY_TYPE_25GBASE_SR \|\|
Alan Brady	6987bd25	2017-10-05 14:53:38 -0700	[diff] [blame]	438	phy_types & I40E_CAP_PHY_TYPE_25GBASE_LR \|\|
				439	phy_types & I40E_CAP_PHY_TYPE_25GBASE_KR \|\|
				440	phy_types & I40E_CAP_PHY_TYPE_25GBASE_CR \|\|
				441	phy_types & I40E_CAP_PHY_TYPE_20GBASE_KR2 \|\|
				442	phy_types & I40E_CAP_PHY_TYPE_10GBASE_T \|\|
				443	phy_types & I40E_CAP_PHY_TYPE_10GBASE_SR \|\|
				444	phy_types & I40E_CAP_PHY_TYPE_10GBASE_LR \|\|
				445	phy_types & I40E_CAP_PHY_TYPE_10GBASE_KX4 \|\|
				446	phy_types & I40E_CAP_PHY_TYPE_10GBASE_KR \|\|
				447	phy_types & I40E_CAP_PHY_TYPE_10GBASE_CR1_CU \|\|
				448	phy_types & I40E_CAP_PHY_TYPE_10GBASE_CR1 \|\|
				449	phy_types & I40E_CAP_PHY_TYPE_1000BASE_T_OPTICAL \|\|
				450	phy_types & I40E_CAP_PHY_TYPE_1000BASE_T \|\|
				451	phy_types & I40E_CAP_PHY_TYPE_1000BASE_SX \|\|
				452	phy_types & I40E_CAP_PHY_TYPE_1000BASE_LX \|\|
				453	phy_types & I40E_CAP_PHY_TYPE_1000BASE_KX \|\|
				454	phy_types & I40E_CAP_PHY_TYPE_100BASE_TX) {
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	455	ethtool_link_ksettings_add_link_mode(ks, supported,
				456	Autoneg);
				457	ethtool_link_ksettings_add_link_mode(ks, advertising,
				458	Autoneg);
Carolyn Wyborny	3123237	2016-11-21 13:03:48 -0800	[diff] [blame]	459	}
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	460	}
				461
				462	/**
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	463	* i40e_get_settings_link_up - Get the Link settings for when link is up
				464	* @hw: hw structure
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	465	* @ks: ethtool ksettings to fill in
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	466	* @netdev: network interface device structure
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	467	* @pf: pointer to physical function struct
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	468	**/
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	469	static void i40e_get_settings_link_up(struct i40e_hw *hw,
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	470	struct ethtool_link_ksettings *ks,
Catherine Sullivan	3b6c217	2015-09-03 17:18:52 -0400	[diff] [blame]	471	struct net_device *netdev,
				472	struct i40e_pf *pf)
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	473	{
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	474	struct i40e_link_status *hw_link_info = &hw->phy.link_info;
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	475	struct ethtool_link_ksettings cap_ksettings;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	476	u32 link_speed = hw_link_info->link_speed;
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	477	u32 supported, advertising;
				478
				479	ethtool_convert_link_mode_to_legacy_u32(&supported,
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	480	ks->link_modes.supported);
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	481	ethtool_convert_link_mode_to_legacy_u32(&advertising,
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	482	ks->link_modes.advertising);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	483
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	484	/* Initialize supported and advertised settings based on phy settings */
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	485	switch (hw_link_info->phy_type) {
				486	case I40E_PHY_TYPE_40GBASE_CR4:
				487	case I40E_PHY_TYPE_40GBASE_CR4_CU:
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	488	supported = SUPPORTED_Autoneg \|
				489	SUPPORTED_40000baseCR4_Full;
				490	advertising = ADVERTISED_Autoneg \|
				491	ADVERTISED_40000baseCR4_Full;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	492	break;
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	493	case I40E_PHY_TYPE_XLAUI:
				494	case I40E_PHY_TYPE_XLPPI:
Catherine Sullivan	180204c	2015-02-26 16:14:58 +0000	[diff] [blame]	495	case I40E_PHY_TYPE_40GBASE_AOC:
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	496	supported = SUPPORTED_40000baseCR4_Full;
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	497	break;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	498	case I40E_PHY_TYPE_40GBASE_SR4:
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	499	supported = SUPPORTED_40000baseSR4_Full;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	500	break;
				501	case I40E_PHY_TYPE_40GBASE_LR4:
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	502	supported = SUPPORTED_40000baseLR4_Full;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	503	break;
Jesse Brandeburg	4e91bcd	2014-06-04 08:45:23 +0000	[diff] [blame]	504	case I40E_PHY_TYPE_10GBASE_SR:
				505	case I40E_PHY_TYPE_10GBASE_LR:
Catherine Sullivan	124ed15	2014-07-12 07:28:12 +0000	[diff] [blame]	506	case I40E_PHY_TYPE_1000BASE_SX:
				507	case I40E_PHY_TYPE_1000BASE_LX:
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	508	supported = SUPPORTED_10000baseT_Full;
Catherine Sullivan	0a862b4	2015-08-31 19:54:53 -0400	[diff] [blame]	509	if (hw_link_info->module_type[2] &
				510	I40E_MODULE_TYPE_1000BASE_SX \|\|
				511	hw_link_info->module_type[2] &
				512	I40E_MODULE_TYPE_1000BASE_LX) {
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	513	supported \|= SUPPORTED_1000baseT_Full;
Catherine Sullivan	0a862b4	2015-08-31 19:54:53 -0400	[diff] [blame]	514	if (hw_link_info->requested_speeds &
				515	I40E_LINK_SPEED_1GB)
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	516	advertising \|= ADVERTISED_1000baseT_Full;
Catherine Sullivan	0a862b4	2015-08-31 19:54:53 -0400	[diff] [blame]	517	}
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	518	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_10GB)
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	519	advertising \|= ADVERTISED_10000baseT_Full;
Jesse Brandeburg	4e91bcd	2014-06-04 08:45:23 +0000	[diff] [blame]	520	break;
Jesse Brandeburg	4e91bcd	2014-06-04 08:45:23 +0000	[diff] [blame]	521	case I40E_PHY_TYPE_10GBASE_T:
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	522	case I40E_PHY_TYPE_1000BASE_T:
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	523	case I40E_PHY_TYPE_100BASE_TX:
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	524	supported = SUPPORTED_Autoneg \|
				525	SUPPORTED_10000baseT_Full \|
				526	SUPPORTED_1000baseT_Full \|
				527	SUPPORTED_100baseT_Full;
				528	advertising = ADVERTISED_Autoneg;
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	529	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_10GB)
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	530	advertising \|= ADVERTISED_10000baseT_Full;
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	531	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_1GB)
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	532	advertising \|= ADVERTISED_1000baseT_Full;
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	533	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_100MB)
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	534	advertising \|= ADVERTISED_100baseT_Full;
Catherine Sullivan	3b6c217	2015-09-03 17:18:52 -0400	[diff] [blame]	535	break;
Catherine Sullivan	48becae	2015-09-28 14:12:41 -0400	[diff] [blame]	536	case I40E_PHY_TYPE_1000BASE_T_OPTICAL:
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	537	supported = SUPPORTED_Autoneg \|
				538	SUPPORTED_1000baseT_Full;
				539	advertising = ADVERTISED_Autoneg \|
				540	ADVERTISED_1000baseT_Full;
Catherine Sullivan	48becae	2015-09-28 14:12:41 -0400	[diff] [blame]	541	break;
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	542	case I40E_PHY_TYPE_10GBASE_CR1_CU:
				543	case I40E_PHY_TYPE_10GBASE_CR1:
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	544	supported = SUPPORTED_Autoneg \|
				545	SUPPORTED_10000baseT_Full;
				546	advertising = ADVERTISED_Autoneg \|
				547	ADVERTISED_10000baseT_Full;
Jesse Brandeburg	4e91bcd	2014-06-04 08:45:23 +0000	[diff] [blame]	548	break;
				549	case I40E_PHY_TYPE_XAUI:
				550	case I40E_PHY_TYPE_XFI:
				551	case I40E_PHY_TYPE_SFI:
				552	case I40E_PHY_TYPE_10GBASE_SFPP_CU:
Catherine Sullivan	180204c	2015-02-26 16:14:58 +0000	[diff] [blame]	553	case I40E_PHY_TYPE_10GBASE_AOC:
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	554	supported = SUPPORTED_10000baseT_Full;
				555	advertising = SUPPORTED_10000baseT_Full;
Jesse Brandeburg	4e91bcd	2014-06-04 08:45:23 +0000	[diff] [blame]	556	break;
Jesse Brandeburg	4e91bcd	2014-06-04 08:45:23 +0000	[diff] [blame]	557	case I40E_PHY_TYPE_SGMII:
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	558	supported = SUPPORTED_Autoneg \|
				559	SUPPORTED_1000baseT_Full;
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	560	if (hw_link_info->requested_speeds & I40E_LINK_SPEED_1GB)
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	561	advertising \|= ADVERTISED_1000baseT_Full;
Jacob Keller	d36e41d	2017-06-23 04:24:46 -0400	[diff] [blame]	562	if (pf->hw_features & I40E_HW_100M_SGMII_CAPABLE) {
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	563	supported \|= SUPPORTED_100baseT_Full;
Catherine Sullivan	3b6c217	2015-09-03 17:18:52 -0400	[diff] [blame]	564	if (hw_link_info->requested_speeds &
				565	I40E_LINK_SPEED_100MB)
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	566	advertising \|= ADVERTISED_100baseT_Full;
Catherine Sullivan	3b6c217	2015-09-03 17:18:52 -0400	[diff] [blame]	567	}
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	568	break;
Catherine Sullivan	fc72dbc	2015-09-01 11:36:30 -0400	[diff] [blame]	569	case I40E_PHY_TYPE_40GBASE_KR4:
				570	case I40E_PHY_TYPE_20GBASE_KR2:
				571	case I40E_PHY_TYPE_10GBASE_KR:
				572	case I40E_PHY_TYPE_10GBASE_KX4:
				573	case I40E_PHY_TYPE_1000BASE_KX:
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	574	supported \|= SUPPORTED_40000baseKR4_Full \|
				575	SUPPORTED_20000baseKR2_Full \|
				576	SUPPORTED_10000baseKR_Full \|
				577	SUPPORTED_10000baseKX4_Full \|
				578	SUPPORTED_1000baseKX_Full \|
				579	SUPPORTED_Autoneg;
				580	advertising \|= ADVERTISED_40000baseKR4_Full \|
				581	ADVERTISED_20000baseKR2_Full \|
				582	ADVERTISED_10000baseKR_Full \|
				583	ADVERTISED_10000baseKX4_Full \|
				584	ADVERTISED_1000baseKX_Full \|
				585	ADVERTISED_Autoneg;
Catherine Sullivan	fc72dbc	2015-09-01 11:36:30 -0400	[diff] [blame]	586	break;
Carolyn Wyborny	3123237	2016-11-21 13:03:48 -0800	[diff] [blame]	587	case I40E_PHY_TYPE_25GBASE_KR:
				588	case I40E_PHY_TYPE_25GBASE_CR:
				589	case I40E_PHY_TYPE_25GBASE_SR:
				590	case I40E_PHY_TYPE_25GBASE_LR:
Sudheer Mogilappagari	211b4c1	2017-10-05 14:53:39 -0700	[diff] [blame]	591	case I40E_PHY_TYPE_25GBASE_AOC:
				592	case I40E_PHY_TYPE_25GBASE_ACC:
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	593	supported = SUPPORTED_Autoneg;
				594	advertising = ADVERTISED_Autoneg;
Carolyn Wyborny	3123237	2016-11-21 13:03:48 -0800	[diff] [blame]	595	/* TODO: add speeds when ethtool is ready to support*/
				596	break;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	597	default:
Jesse Brandeburg	4e91bcd	2014-06-04 08:45:23 +0000	[diff] [blame]	598	/* if we got here and link is up something bad is afoot */
Alan Brady	a03af69	2017-10-05 14:53:37 -0700	[diff] [blame]	599	netdev_info(netdev,
				600	"WARNING: Link is up but PHY type 0x%x is not recognized.\n",
Catherine Sullivan	124ed15	2014-07-12 07:28:12 +0000	[diff] [blame]	601	hw_link_info->phy_type);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	602	}
				603
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	604	/* Now that we've worked out everything that could be supported by the
Alan Brady	91a5c44	2017-10-05 14:53:36 -0700	[diff] [blame]	605	* current PHY type, get what is supported by the NVM and intersect
				606	* them to get what is truly supported
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	607	*/
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	608	ethtool_convert_legacy_u32_to_link_mode(ks->link_modes.supported,
				609	supported);
				610	ethtool_convert_legacy_u32_to_link_mode(ks->link_modes.advertising,
				611	advertising);
				612	memset(&cap_ksettings, 0, sizeof(struct ethtool_link_ksettings));
				613	i40e_phy_type_to_ethtool(pf, &cap_ksettings);
				614	ethtool_intersect_link_masks(ks, &cap_ksettings);
Catherine Sullivan	06566e5	2016-05-03 15:13:14 -0700	[diff] [blame]	615
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	616	/* Set speed and duplex */
				617	switch (link_speed) {
				618	case I40E_LINK_SPEED_40GB:
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	619	ks->base.speed = SPEED_40000;
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	620	break;
Carolyn Wyborny	3123237	2016-11-21 13:03:48 -0800	[diff] [blame]	621	case I40E_LINK_SPEED_25GB:
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	622	ks->base.speed = SPEED_25000;
Carolyn Wyborny	3123237	2016-11-21 13:03:48 -0800	[diff] [blame]	623	break;
Jesse Brandeburg	ae24b40	2015-03-27 00:12:09 -0700	[diff] [blame]	624	case I40E_LINK_SPEED_20GB:
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	625	ks->base.speed = SPEED_20000;
Jesse Brandeburg	ae24b40	2015-03-27 00:12:09 -0700	[diff] [blame]	626	break;
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	627	case I40E_LINK_SPEED_10GB:
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	628	ks->base.speed = SPEED_10000;
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	629	break;
				630	case I40E_LINK_SPEED_1GB:
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	631	ks->base.speed = SPEED_1000;
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	632	break;
				633	case I40E_LINK_SPEED_100MB:
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	634	ks->base.speed = SPEED_100;
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	635	break;
				636	default:
				637	break;
				638	}
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	639	ks->base.duplex = DUPLEX_FULL;
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	640	}
				641
				642	/**
				643	* i40e_get_settings_link_down - Get the Link settings for when link is down
				644	* @hw: hw structure
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	645	* @ks: ethtool ksettings to fill in
				646	* @pf: pointer to physical function struct
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	647	*
				648	* Reports link settings that can be determined when link is down
				649	**/
				650	static void i40e_get_settings_link_down(struct i40e_hw *hw,
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	651	struct ethtool_link_ksettings *ks,
Catherine Sullivan	3b6c217	2015-09-03 17:18:52 -0400	[diff] [blame]	652	struct i40e_pf *pf)
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	653	{
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	654	/* link is down and the driver needs to fall back on
Catherine Sullivan	fc72dbc	2015-09-01 11:36:30 -0400	[diff] [blame]	655	* supported phy types to figure out what info to display
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	656	*/
Alan Brady	1eaae51	2017-10-05 14:53:41 -0700	[diff] [blame^]	657	i40e_phy_type_to_ethtool(pf, ks);
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	658
				659	/* With no link speed and duplex are unknown */
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	660	ks->base.speed = SPEED_UNKNOWN;
				661	ks->base.duplex = DUPLEX_UNKNOWN;
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	662	}
				663
				664	/**
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	665	* i40e_get_link_ksettings - Get Link Speed and Duplex settings
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	666	* @netdev: network interface device structure
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	667	* @ks: ethtool ksettings
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	668	*
				669	* Reports speed/duplex settings based on media_type
				670	**/
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	671	static int i40e_get_link_ksettings(struct net_device *netdev,
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	672	struct ethtool_link_ksettings *ks)
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	673	{
				674	struct i40e_netdev_priv *np = netdev_priv(netdev);
				675	struct i40e_pf *pf = np->vsi->back;
				676	struct i40e_hw *hw = &pf->hw;
				677	struct i40e_link_status *hw_link_info = &hw->phy.link_info;
				678	bool link_up = hw_link_info->link_info & I40E_AQ_LINK_UP;
Alan Brady	5f43499	2017-10-05 14:53:34 -0700	[diff] [blame]	679
				680	ethtool_link_ksettings_zero_link_mode(ks, supported);
				681	ethtool_link_ksettings_zero_link_mode(ks, advertising);
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	682
				683	if (link_up)
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	684	i40e_get_settings_link_up(hw, ks, netdev, pf);
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	685	else
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	686	i40e_get_settings_link_down(hw, ks, pf);
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	687
				688	/* Now set the settings that don't rely on link being up/down */
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	689	/* Set autoneg settings */
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	690	ks->base.autoneg = ((hw_link_info->an_info & I40E_AQ_AN_COMPLETED) ?
				691	AUTONEG_ENABLE : AUTONEG_DISABLE);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	692
Alan Brady	a03af69	2017-10-05 14:53:37 -0700	[diff] [blame]	693	/* Set media type settings */
Jesse Brandeburg	c9a3d47	2013-11-26 10:49:10 +0000	[diff] [blame]	694	switch (hw->phy.media_type) {
				695	case I40E_MEDIA_TYPE_BACKPLANE:
Alan Brady	a03af69	2017-10-05 14:53:37 -0700	[diff] [blame]	696	ethtool_link_ksettings_add_link_mode(ks, supported, Autoneg);
				697	ethtool_link_ksettings_add_link_mode(ks, supported, Backplane);
				698	ethtool_link_ksettings_add_link_mode(ks, advertising, Autoneg);
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	699	ethtool_link_ksettings_add_link_mode(ks, advertising,
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	700	Backplane);
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	701	ks->base.port = PORT_NONE;
Jesse Brandeburg	c9a3d47	2013-11-26 10:49:10 +0000	[diff] [blame]	702	break;
				703	case I40E_MEDIA_TYPE_BASET:
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	704	ethtool_link_ksettings_add_link_mode(ks, supported, TP);
				705	ethtool_link_ksettings_add_link_mode(ks, advertising, TP);
				706	ks->base.port = PORT_TP;
Jesse Brandeburg	c9a3d47	2013-11-26 10:49:10 +0000	[diff] [blame]	707	break;
				708	case I40E_MEDIA_TYPE_DA:
				709	case I40E_MEDIA_TYPE_CX4:
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	710	ethtool_link_ksettings_add_link_mode(ks, supported, FIBRE);
				711	ethtool_link_ksettings_add_link_mode(ks, advertising, FIBRE);
				712	ks->base.port = PORT_DA;
Jesse Brandeburg	c9a3d47	2013-11-26 10:49:10 +0000	[diff] [blame]	713	break;
				714	case I40E_MEDIA_TYPE_FIBER:
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	715	ethtool_link_ksettings_add_link_mode(ks, supported, FIBRE);
				716	ks->base.port = PORT_FIBRE;
Jesse Brandeburg	c9a3d47	2013-11-26 10:49:10 +0000	[diff] [blame]	717	break;
				718	case I40E_MEDIA_TYPE_UNKNOWN:
				719	default:
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	720	ks->base.port = PORT_OTHER;
Jesse Brandeburg	c9a3d47	2013-11-26 10:49:10 +0000	[diff] [blame]	721	break;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	722	}
				723
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	724	/* Set flow control settings */
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	725	ethtool_link_ksettings_add_link_mode(ks, supported, Pause);
Jesse Brandeburg	4e91bcd	2014-06-04 08:45:23 +0000	[diff] [blame]	726
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	727	switch (hw->fc.requested_mode) {
Jesse Brandeburg	4e91bcd	2014-06-04 08:45:23 +0000	[diff] [blame]	728	case I40E_FC_FULL:
Alan Brady	a03af69	2017-10-05 14:53:37 -0700	[diff] [blame]	729	ethtool_link_ksettings_add_link_mode(ks, advertising, Pause);
Jesse Brandeburg	4e91bcd	2014-06-04 08:45:23 +0000	[diff] [blame]	730	break;
				731	case I40E_FC_TX_PAUSE:
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	732	ethtool_link_ksettings_add_link_mode(ks, advertising,
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	733	Asym_Pause);
Jesse Brandeburg	4e91bcd	2014-06-04 08:45:23 +0000	[diff] [blame]	734	break;
				735	case I40E_FC_RX_PAUSE:
Alan Brady	a03af69	2017-10-05 14:53:37 -0700	[diff] [blame]	736	ethtool_link_ksettings_add_link_mode(ks, advertising, Pause);
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	737	ethtool_link_ksettings_add_link_mode(ks, advertising,
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	738	Asym_Pause);
Jesse Brandeburg	4e91bcd	2014-06-04 08:45:23 +0000	[diff] [blame]	739	break;
				740	default:
Alan Brady	5f43499	2017-10-05 14:53:34 -0700	[diff] [blame]	741	ethtool_link_ksettings_del_link_mode(ks, advertising, Pause);
				742	ethtool_link_ksettings_del_link_mode(ks, advertising,
				743	Asym_Pause);
Jesse Brandeburg	4e91bcd	2014-06-04 08:45:23 +0000	[diff] [blame]	744	break;
				745	}
				746
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	747	return 0;
				748	}
				749
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	750	/**
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	751	* i40e_set_link_ksettings - Set Speed and Duplex
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	752	* @netdev: network interface device structure
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	753	* @ks: ethtool ksettings
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	754	*
				755	* Set speed/duplex per media_types advertised/forced
				756	**/
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	757	static int i40e_set_link_ksettings(struct net_device *netdev,
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	758	const struct ethtool_link_ksettings *ks)
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	759	{
				760	struct i40e_netdev_priv *np = netdev_priv(netdev);
				761	struct i40e_aq_get_phy_abilities_resp abilities;
				762	struct i40e_aq_set_phy_config config;
				763	struct i40e_pf *pf = np->vsi->back;
				764	struct i40e_vsi *vsi = np->vsi;
				765	struct i40e_hw *hw = &pf->hw;
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	766	struct ethtool_link_ksettings safe_ks;
				767	struct ethtool_link_ksettings copy_ks;
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	768	i40e_status status = 0;
				769	bool change = false;
Jacob Keller	e8d2f4c	2017-04-13 04:45:48 -0400	[diff] [blame]	770	int timeout = 50;
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	771	int err = 0;
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	772	u32 autoneg;
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	773	u32 advertise;
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	774	u32 tmp;
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	775
Shannon Nelson	f0d8c73	2014-12-11 07:06:32 +0000	[diff] [blame]	776	/* Changing port settings is not supported if this isn't the
				777	* port's controlling PF
				778	*/
				779	if (hw->partition_id != 1) {
				780	i40e_partition_setting_complaint(pf);
				781	return -EOPNOTSUPP;
				782	}
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	783	if (vsi != pf->vsi[pf->lan_vsi])
				784	return -EOPNOTSUPP;
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	785	if (hw->phy.media_type != I40E_MEDIA_TYPE_BASET &&
				786	hw->phy.media_type != I40E_MEDIA_TYPE_FIBER &&
Catherine Sullivan	c57e9f1	2014-07-12 07:28:13 +0000	[diff] [blame]	787	hw->phy.media_type != I40E_MEDIA_TYPE_BACKPLANE &&
Serey Kong	6536227	2016-05-16 10:26:39 -0700	[diff] [blame]	788	hw->phy.media_type != I40E_MEDIA_TYPE_DA &&
Catherine Sullivan	c57e9f1	2014-07-12 07:28:13 +0000	[diff] [blame]	789	hw->phy.link_info.link_info & I40E_AQ_LINK_UP)
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	790	return -EOPNOTSUPP;
Catherine Sullivan	fc72dbc	2015-09-01 11:36:30 -0400	[diff] [blame]	791	if (hw->device_id == I40E_DEV_ID_KX_B \|\|
				792	hw->device_id == I40E_DEV_ID_KX_C \|\|
				793	hw->device_id == I40E_DEV_ID_20G_KR2 \|\|
				794	hw->device_id == I40E_DEV_ID_20G_KR2_A) {
				795	netdev_info(netdev, "Changing settings is not supported on backplane.\n");
				796	return -EOPNOTSUPP;
				797	}
				798
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	799	/* copy the ksettings to copy_ks to avoid modifying the origin */
				800	memcpy(&copy_ks, ks, sizeof(struct ethtool_link_ksettings));
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	801
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	802	/* get our own copy of the bits to check against */
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	803	memset(&safe_ks, 0, sizeof(struct ethtool_link_ksettings));
				804	i40e_get_link_ksettings(netdev, &safe_ks);
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	805
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	806	/* save autoneg and speed out of ksettings */
				807	autoneg = ks->base.autoneg;
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	808	ethtool_convert_link_mode_to_legacy_u32(&advertise,
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	809	ks->link_modes.advertising);
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	810
				811	/* set autoneg and speed back to what they currently are */
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	812	copy_ks.base.autoneg = safe_ks.base.autoneg;
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	813	ethtool_convert_link_mode_to_legacy_u32(
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	814	&tmp, safe_ks.link_modes.advertising);
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	815	ethtool_convert_legacy_u32_to_link_mode(
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	816	copy_ks.link_modes.advertising, tmp);
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	817
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	818	copy_ks.base.cmd = safe_ks.base.cmd;
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	819
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	820	/* If copy_ks and safe_ks are not the same now, then they are
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	821	* trying to set something that we do not support
				822	*/
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	823	if (memcmp(&copy_ks, &safe_ks, sizeof(struct ethtool_link_ksettings)))
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	824	return -EOPNOTSUPP;
				825
Jacob Keller	0da36b9	2017-04-19 09:25:55 -0400	[diff] [blame]	826	while (test_and_set_bit(__I40E_CONFIG_BUSY, pf->state)) {
Jacob Keller	e8d2f4c	2017-04-13 04:45:48 -0400	[diff] [blame]	827	timeout--;
				828	if (!timeout)
				829	return -EBUSY;
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	830	usleep_range(1000, 2000);
Jacob Keller	e8d2f4c	2017-04-13 04:45:48 -0400	[diff] [blame]	831	}
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	832
				833	/* Get the current phy config */
				834	status = i40e_aq_get_phy_capabilities(hw, false, false, &abilities,
				835	NULL);
Jacob Keller	e8d2f4c	2017-04-13 04:45:48 -0400	[diff] [blame]	836	if (status) {
				837	err = -EAGAIN;
				838	goto done;
				839	}
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	840
Catherine Sullivan	124ed15	2014-07-12 07:28:12 +0000	[diff] [blame]	841	/* Copy abilities to config in case autoneg is not
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	842	* set below
				843	*/
				844	memset(&config, 0, sizeof(struct i40e_aq_set_phy_config));
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	845	config.abilities = abilities.abilities;
				846
				847	/* Check autoneg */
				848	if (autoneg == AUTONEG_ENABLE) {
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	849	/* If autoneg was not already enabled */
				850	if (!(hw->phy.link_info.an_info & I40E_AQ_AN_COMPLETED)) {
Catherine Sullivan	3ce12ee	2015-09-28 14:16:58 -0400	[diff] [blame]	851	/* If autoneg is not supported, return error */
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	852	if (!ethtool_link_ksettings_test_link_mode(&safe_ks,
				853	supported,
				854	Autoneg)) {
Catherine Sullivan	3ce12ee	2015-09-28 14:16:58 -0400	[diff] [blame]	855	netdev_info(netdev, "Autoneg not supported on this phy\n");
Jacob Keller	e8d2f4c	2017-04-13 04:45:48 -0400	[diff] [blame]	856	err = -EINVAL;
				857	goto done;
Catherine Sullivan	3ce12ee	2015-09-28 14:16:58 -0400	[diff] [blame]	858	}
				859	/* Autoneg is allowed to change */
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	860	config.abilities = abilities.abilities \|
				861	I40E_AQ_PHY_ENABLE_AN;
				862	change = true;
				863	}
				864	} else {
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	865	/* If autoneg is currently enabled */
				866	if (hw->phy.link_info.an_info & I40E_AQ_AN_COMPLETED) {
Catherine Sullivan	3ce12ee	2015-09-28 14:16:58 -0400	[diff] [blame]	867	/* If autoneg is supported 10GBASE_T is the only PHY
				868	* that can disable it, so otherwise return error
				869	*/
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	870	if (ethtool_link_ksettings_test_link_mode(&safe_ks,
				871	supported,
				872	Autoneg) &&
Catherine Sullivan	3ce12ee	2015-09-28 14:16:58 -0400	[diff] [blame]	873	hw->phy.link_info.phy_type !=
				874	I40E_PHY_TYPE_10GBASE_T) {
				875	netdev_info(netdev, "Autoneg cannot be disabled on this phy\n");
Jacob Keller	e8d2f4c	2017-04-13 04:45:48 -0400	[diff] [blame]	876	err = -EINVAL;
				877	goto done;
Catherine Sullivan	3ce12ee	2015-09-28 14:16:58 -0400	[diff] [blame]	878	}
				879	/* Autoneg is allowed to change */
Mitch Williams	5960d33	2014-09-13 07:40:47 +0000	[diff] [blame]	880	config.abilities = abilities.abilities &
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	881	~I40E_AQ_PHY_ENABLE_AN;
				882	change = true;
				883	}
				884	}
				885
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	886	ethtool_convert_link_mode_to_legacy_u32(&tmp,
Alan Brady	1c142e1	2017-10-05 14:53:31 -0700	[diff] [blame]	887	safe_ks.link_modes.supported);
Jacob Keller	e8d2f4c	2017-04-13 04:45:48 -0400	[diff] [blame]	888	if (advertise & ~tmp) {
				889	err = -EINVAL;
				890	goto done;
				891	}
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	892
				893	if (advertise & ADVERTISED_100baseT_Full)
Catherine Sullivan	124ed15	2014-07-12 07:28:12 +0000	[diff] [blame]	894	config.link_speed \|= I40E_LINK_SPEED_100MB;
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	895	if (advertise & ADVERTISED_1000baseT_Full \|\|
				896	advertise & ADVERTISED_1000baseKX_Full)
Catherine Sullivan	124ed15	2014-07-12 07:28:12 +0000	[diff] [blame]	897	config.link_speed \|= I40E_LINK_SPEED_1GB;
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	898	if (advertise & ADVERTISED_10000baseT_Full \|\|
				899	advertise & ADVERTISED_10000baseKX4_Full \|\|
				900	advertise & ADVERTISED_10000baseKR_Full)
Catherine Sullivan	124ed15	2014-07-12 07:28:12 +0000	[diff] [blame]	901	config.link_speed \|= I40E_LINK_SPEED_10GB;
Jesse Brandeburg	ae24b40	2015-03-27 00:12:09 -0700	[diff] [blame]	902	if (advertise & ADVERTISED_20000baseKR2_Full)
				903	config.link_speed \|= I40E_LINK_SPEED_20GB;
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	904	if (advertise & ADVERTISED_40000baseKR4_Full \|\|
				905	advertise & ADVERTISED_40000baseCR4_Full \|\|
				906	advertise & ADVERTISED_40000baseSR4_Full \|\|
				907	advertise & ADVERTISED_40000baseLR4_Full)
Catherine Sullivan	124ed15	2014-07-12 07:28:12 +0000	[diff] [blame]	908	config.link_speed \|= I40E_LINK_SPEED_40GB;
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	909
Catherine Sullivan	0002e11	2015-08-26 15:14:16 -0400	[diff] [blame]	910	/* If speed didn't get set, set it to what it currently is.
				911	* This is needed because if advertise is 0 (as it is when autoneg
				912	* is disabled) then speed won't get set.
				913	*/
				914	if (!config.link_speed)
				915	config.link_speed = abilities.link_speed;
Catherine Sullivan	124ed15	2014-07-12 07:28:12 +0000	[diff] [blame]	916	if (change \|\| (abilities.link_speed != config.link_speed)) {
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	917	/* copy over the rest of the abilities */
				918	config.phy_type = abilities.phy_type;
Henry Tieman	b7eaf8f	2016-12-02 12:33:01 -0800	[diff] [blame]	919	config.phy_type_ext = abilities.phy_type_ext;
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	920	config.eee_capability = abilities.eee_capability;
				921	config.eeer = abilities.eeer_val;
				922	config.low_power_ctrl = abilities.d3_lpan;
Henry Tieman	b7eaf8f	2016-12-02 12:33:01 -0800	[diff] [blame]	923	config.fec_config = abilities.fec_cfg_curr_mod_ext_info &
				924	I40E_AQ_PHY_FEC_CONFIG_MASK;
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	925
Catherine Sullivan	e827845	2015-02-06 08:52:08 +0000	[diff] [blame]	926	/* save the requested speeds */
				927	hw->phy.link_info.requested_speeds = config.link_speed;
Catherine Sullivan	9412851	2014-07-12 07:28:16 +0000	[diff] [blame]	928	/* set link and auto negotiation so changes take effect */
				929	config.abilities \|= I40E_AQ_PHY_ENABLE_ATOMIC_LINK;
				930	/* If link is up put link down */
				931	if (hw->phy.link_info.link_info & I40E_AQ_LINK_UP) {
				932	/* Tell the OS link is going down, the link will go
				933	* back up when fw says it is ready asynchronously
				934	*/
Matt Jared	c156f85	2015-08-27 11:42:39 -0400	[diff] [blame]	935	i40e_print_link_message(vsi, false);
Catherine Sullivan	9412851	2014-07-12 07:28:16 +0000	[diff] [blame]	936	netif_carrier_off(netdev);
				937	netif_tx_stop_all_queues(netdev);
				938	}
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	939
				940	/* make the aq call */
				941	status = i40e_aq_set_phy_config(hw, &config, NULL);
				942	if (status) {
Alan Brady	a03af69	2017-10-05 14:53:37 -0700	[diff] [blame]	943	netdev_info(netdev,
				944	"Set phy config failed, err %s aq_err %s\n",
Shannon Nelson	f1c7e72	2015-06-04 16:24:01 -0400	[diff] [blame]	945	i40e_stat_str(hw, status),
				946	i40e_aq_str(hw, hw->aq.asq_last_status));
Jacob Keller	e8d2f4c	2017-04-13 04:45:48 -0400	[diff] [blame]	947	err = -EAGAIN;
				948	goto done;
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	949	}
				950
Catherine Sullivan	0a862b4	2015-08-31 19:54:53 -0400	[diff] [blame]	951	status = i40e_update_link_info(hw);
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	952	if (status)
Alan Brady	a03af69	2017-10-05 14:53:37 -0700	[diff] [blame]	953	netdev_dbg(netdev,
				954	"Updating link info failed with err %s aq_err %s\n",
Catherine Sullivan	52e9689	2015-09-28 14:16:59 -0400	[diff] [blame]	955	i40e_stat_str(hw, status),
				956	i40e_aq_str(hw, hw->aq.asq_last_status));
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	957
				958	} else {
				959	netdev_info(netdev, "Nothing changed, exiting without setting anything.\n");
				960	}
				961
Jacob Keller	e8d2f4c	2017-04-13 04:45:48 -0400	[diff] [blame]	962	done:
Jacob Keller	0da36b9	2017-04-19 09:25:55 -0400	[diff] [blame]	963	clear_bit(__I40E_CONFIG_BUSY, pf->state);
Jacob Keller	e8d2f4c	2017-04-13 04:45:48 -0400	[diff] [blame]	964
Catherine Sullivan	bf9c714	2014-06-04 08:45:28 +0000	[diff] [blame]	965	return err;
				966	}
				967
Jesse Brandeburg	a659972	2014-06-04 08:45:25 +0000	[diff] [blame]	968	static int i40e_nway_reset(struct net_device *netdev)
				969	{
				970	/* restart autonegotiation */
				971	struct i40e_netdev_priv *np = netdev_priv(netdev);
				972	struct i40e_pf *pf = np->vsi->back;
				973	struct i40e_hw *hw = &pf->hw;
				974	bool link_up = hw->phy.link_info.link_info & I40E_AQ_LINK_UP;
				975	i40e_status ret = 0;
				976
				977	ret = i40e_aq_set_link_restart_an(hw, link_up, NULL);
				978	if (ret) {
Shannon Nelson	f1c7e72	2015-06-04 16:24:01 -0400	[diff] [blame]	979	netdev_info(netdev, "link restart failed, err %s aq_err %s\n",
				980	i40e_stat_str(hw, ret),
				981	i40e_aq_str(hw, hw->aq.asq_last_status));
Jesse Brandeburg	a659972	2014-06-04 08:45:25 +0000	[diff] [blame]	982	return -EIO;
				983	}
				984
				985	return 0;
				986	}
				987
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	988	/**
				989	* i40e_get_pauseparam - Get Flow Control status
				990	* Return tx/rx-pause status
				991	**/
				992	static void i40e_get_pauseparam(struct net_device *netdev,
				993	struct ethtool_pauseparam *pause)
				994	{
				995	struct i40e_netdev_priv *np = netdev_priv(netdev);
				996	struct i40e_pf *pf = np->vsi->back;
				997	struct i40e_hw *hw = &pf->hw;
				998	struct i40e_link_status *hw_link_info = &hw->phy.link_info;
Neerav Parikh	4b7698c	2014-11-12 00:18:57 +0000	[diff] [blame]	999	struct i40e_dcbx_config *dcbx_cfg = &hw->local_dcbx_config;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1000
				1001	pause->autoneg =
				1002	((hw_link_info->an_info & I40E_AQ_AN_COMPLETED) ?
				1003	AUTONEG_ENABLE : AUTONEG_DISABLE);
				1004
Neerav Parikh	4b7698c	2014-11-12 00:18:57 +0000	[diff] [blame]	1005	/* PFC enabled so report LFC as off */
				1006	if (dcbx_cfg->pfc.pfcenable) {
				1007	pause->rx_pause = 0;
				1008	pause->tx_pause = 0;
				1009	return;
				1010	}
				1011
Jesse Brandeburg	d52c20b	2013-11-26 10:49:15 +0000	[diff] [blame]	1012	if (hw->fc.current_mode == I40E_FC_RX_PAUSE) {
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1013	pause->rx_pause = 1;
Jesse Brandeburg	d52c20b	2013-11-26 10:49:15 +0000	[diff] [blame]	1014	} else if (hw->fc.current_mode == I40E_FC_TX_PAUSE) {
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1015	pause->tx_pause = 1;
Jesse Brandeburg	d52c20b	2013-11-26 10:49:15 +0000	[diff] [blame]	1016	} else if (hw->fc.current_mode == I40E_FC_FULL) {
				1017	pause->rx_pause = 1;
				1018	pause->tx_pause = 1;
				1019	}
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1020	}
				1021
Catherine Sullivan	2becc35	2014-06-04 08:45:27 +0000	[diff] [blame]	1022	/**
				1023	* i40e_set_pauseparam - Set Flow Control parameter
				1024	* @netdev: network interface device structure
				1025	* @pause: return tx/rx flow control status
				1026	**/
				1027	static int i40e_set_pauseparam(struct net_device *netdev,
				1028	struct ethtool_pauseparam *pause)
				1029	{
				1030	struct i40e_netdev_priv *np = netdev_priv(netdev);
				1031	struct i40e_pf *pf = np->vsi->back;
				1032	struct i40e_vsi *vsi = np->vsi;
				1033	struct i40e_hw *hw = &pf->hw;
				1034	struct i40e_link_status *hw_link_info = &hw->phy.link_info;
Neerav Parikh	4b7698c	2014-11-12 00:18:57 +0000	[diff] [blame]	1035	struct i40e_dcbx_config *dcbx_cfg = &hw->local_dcbx_config;
Catherine Sullivan	2becc35	2014-06-04 08:45:27 +0000	[diff] [blame]	1036	bool link_up = hw_link_info->link_info & I40E_AQ_LINK_UP;
				1037	i40e_status status;
				1038	u8 aq_failures;
Catherine Sullivan	7d62dac	2014-07-09 07:46:18 +0000	[diff] [blame]	1039	int err = 0;
Catherine Sullivan	2becc35	2014-06-04 08:45:27 +0000	[diff] [blame]	1040
Shannon Nelson	f0d8c73	2014-12-11 07:06:32 +0000	[diff] [blame]	1041	/* Changing the port's flow control is not supported if this isn't the
				1042	* port's controlling PF
				1043	*/
				1044	if (hw->partition_id != 1) {
				1045	i40e_partition_setting_complaint(pf);
				1046	return -EOPNOTSUPP;
				1047	}
				1048
Catherine Sullivan	2becc35	2014-06-04 08:45:27 +0000	[diff] [blame]	1049	if (vsi != pf->vsi[pf->lan_vsi])
				1050	return -EOPNOTSUPP;
				1051
				1052	if (pause->autoneg != ((hw_link_info->an_info & I40E_AQ_AN_COMPLETED) ?
				1053	AUTONEG_ENABLE : AUTONEG_DISABLE)) {
				1054	netdev_info(netdev, "To change autoneg please use: ethtool -s <dev> autoneg <on\|off>\n");
				1055	return -EOPNOTSUPP;
				1056	}
				1057
				1058	/* If we have link and don't have autoneg */
Jacob Keller	0da36b9	2017-04-19 09:25:55 -0400	[diff] [blame]	1059	if (!test_bit(__I40E_DOWN, pf->state) &&
Catherine Sullivan	2becc35	2014-06-04 08:45:27 +0000	[diff] [blame]	1060	!(hw_link_info->an_info & I40E_AQ_AN_COMPLETED)) {
				1061	/* Send message that it might not necessarily work*/
				1062	netdev_info(netdev, "Autoneg did not complete so changing settings may not result in an actual change.\n");
				1063	}
				1064
Neerav Parikh	4b7698c	2014-11-12 00:18:57 +0000	[diff] [blame]	1065	if (dcbx_cfg->pfc.pfcenable) {
				1066	netdev_info(netdev,
				1067	"Priority flow control enabled. Cannot set link flow control.\n");
Catherine Sullivan	2becc35	2014-06-04 08:45:27 +0000	[diff] [blame]	1068	return -EOPNOTSUPP;
				1069	}
				1070
				1071	if (pause->rx_pause && pause->tx_pause)
				1072	hw->fc.requested_mode = I40E_FC_FULL;
				1073	else if (pause->rx_pause && !pause->tx_pause)
				1074	hw->fc.requested_mode = I40E_FC_RX_PAUSE;
				1075	else if (!pause->rx_pause && pause->tx_pause)
				1076	hw->fc.requested_mode = I40E_FC_TX_PAUSE;
				1077	else if (!pause->rx_pause && !pause->tx_pause)
				1078	hw->fc.requested_mode = I40E_FC_NONE;
				1079	else
				1080	return -EINVAL;
				1081
Catherine Sullivan	9412851	2014-07-12 07:28:16 +0000	[diff] [blame]	1082	/* Tell the OS link is going down, the link will go back up when fw
				1083	* says it is ready asynchronously
				1084	*/
Matt Jared	c156f85	2015-08-27 11:42:39 -0400	[diff] [blame]	1085	i40e_print_link_message(vsi, false);
Catherine Sullivan	9412851	2014-07-12 07:28:16 +0000	[diff] [blame]	1086	netif_carrier_off(netdev);
				1087	netif_tx_stop_all_queues(netdev);
				1088
Catherine Sullivan	2becc35	2014-06-04 08:45:27 +0000	[diff] [blame]	1089	/* Set the fc mode and only restart an if link is up*/
				1090	status = i40e_set_fc(hw, &aq_failures, link_up);
				1091
				1092	if (aq_failures & I40E_SET_FC_AQ_FAIL_GET) {
Shannon Nelson	f1c7e72	2015-06-04 16:24:01 -0400	[diff] [blame]	1093	netdev_info(netdev, "Set fc failed on the get_phy_capabilities call with err %s aq_err %s\n",
				1094	i40e_stat_str(hw, status),
				1095	i40e_aq_str(hw, hw->aq.asq_last_status));
Catherine Sullivan	2becc35	2014-06-04 08:45:27 +0000	[diff] [blame]	1096	err = -EAGAIN;
				1097	}
				1098	if (aq_failures & I40E_SET_FC_AQ_FAIL_SET) {
Shannon Nelson	f1c7e72	2015-06-04 16:24:01 -0400	[diff] [blame]	1099	netdev_info(netdev, "Set fc failed on the set_phy_config call with err %s aq_err %s\n",
				1100	i40e_stat_str(hw, status),
				1101	i40e_aq_str(hw, hw->aq.asq_last_status));
Catherine Sullivan	2becc35	2014-06-04 08:45:27 +0000	[diff] [blame]	1102	err = -EAGAIN;
				1103	}
				1104	if (aq_failures & I40E_SET_FC_AQ_FAIL_UPDATE) {
Shannon Nelson	f1c7e72	2015-06-04 16:24:01 -0400	[diff] [blame]	1105	netdev_info(netdev, "Set fc failed on the get_link_info call with err %s aq_err %s\n",
				1106	i40e_stat_str(hw, status),
				1107	i40e_aq_str(hw, hw->aq.asq_last_status));
Catherine Sullivan	2becc35	2014-06-04 08:45:27 +0000	[diff] [blame]	1108	err = -EAGAIN;
				1109	}
				1110
Jacob Keller	0da36b9	2017-04-19 09:25:55 -0400	[diff] [blame]	1111	if (!test_bit(__I40E_DOWN, pf->state)) {
Catherine Sullivan	7d62dac	2014-07-09 07:46:18 +0000	[diff] [blame]	1112	/* Give it a little more time to try to come back */
				1113	msleep(75);
Jacob Keller	0da36b9	2017-04-19 09:25:55 -0400	[diff] [blame]	1114	if (!test_bit(__I40E_DOWN, pf->state))
Catherine Sullivan	7d62dac	2014-07-09 07:46:18 +0000	[diff] [blame]	1115	return i40e_nway_reset(netdev);
				1116	}
Catherine Sullivan	2becc35	2014-06-04 08:45:27 +0000	[diff] [blame]	1117
				1118	return err;
				1119	}
				1120
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1121	static u32 i40e_get_msglevel(struct net_device *netdev)
				1122	{
				1123	struct i40e_netdev_priv *np = netdev_priv(netdev);
				1124	struct i40e_pf *pf = np->vsi->back;
Alexander Duyck	5d4ca23	2016-09-30 08:21:46 -0400	[diff] [blame]	1125	u32 debug_mask = pf->hw.debug_mask;
				1126
				1127	if (debug_mask)
				1128	netdev_info(netdev, "i40e debug_mask: 0x%08X\n", debug_mask);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1129
				1130	return pf->msg_enable;
				1131	}
				1132
				1133	static void i40e_set_msglevel(struct net_device *netdev, u32 data)
				1134	{
				1135	struct i40e_netdev_priv *np = netdev_priv(netdev);
				1136	struct i40e_pf *pf = np->vsi->back;
				1137
				1138	if (I40E_DEBUG_USER & data)
				1139	pf->hw.debug_mask = data;
Alexander Duyck	5d4ca23	2016-09-30 08:21:46 -0400	[diff] [blame]	1140	else
				1141	pf->msg_enable = data;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1142	}
				1143
				1144	static int i40e_get_regs_len(struct net_device *netdev)
				1145	{
				1146	int reg_count = 0;
				1147	int i;
				1148
				1149	for (i = 0; i40e_reg_list[i].offset != 0; i++)
				1150	reg_count += i40e_reg_list[i].elements;
				1151
				1152	return reg_count * sizeof(u32);
				1153	}
				1154
				1155	static void i40e_get_regs(struct net_device netdev, struct ethtool_regs regs,
				1156	void *p)
				1157	{
				1158	struct i40e_netdev_priv *np = netdev_priv(netdev);
				1159	struct i40e_pf *pf = np->vsi->back;
				1160	struct i40e_hw *hw = &pf->hw;
				1161	u32 *reg_buf = p;
Jesse Brandeburg	b85c94b	2017-06-20 15:16:59 -0700	[diff] [blame]	1162	unsigned int i, j, ri;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1163	u32 reg;
				1164
				1165	/* Tell ethtool which driver-version-specific regs output we have.
				1166	*
				1167	* At some point, if we have ethtool doing special formatting of
				1168	* this data, it will rely on this version number to know how to
				1169	* interpret things. Hence, this needs to be updated if/when the
				1170	* diags register table is changed.
				1171	*/
				1172	regs->version = 1;
				1173
				1174	/* loop through the diags reg table for what to print */
				1175	ri = 0;
				1176	for (i = 0; i40e_reg_list[i].offset != 0; i++) {
				1177	for (j = 0; j < i40e_reg_list[i].elements; j++) {
				1178	reg = i40e_reg_list[i].offset
				1179	+ (j * i40e_reg_list[i].stride);
				1180	reg_buf[ri++] = rd32(hw, reg);
				1181	}
				1182	}
				1183
				1184	}
				1185
				1186	static int i40e_get_eeprom(struct net_device *netdev,
				1187	struct ethtool_eeprom eeprom, u8 bytes)
				1188	{
				1189	struct i40e_netdev_priv *np = netdev_priv(netdev);
				1190	struct i40e_hw *hw = &np->vsi->back->hw;
Anjali Singhai Jain	e5e0a5d	2013-11-28 06:39:28 +0000	[diff] [blame]	1191	struct i40e_pf *pf = np->vsi->back;
Shannon Nelson	c150a50	2014-11-13 08:23:13 +0000	[diff] [blame]	1192	int ret_val = 0, len, offset;
Anjali Singhai Jain	e5e0a5d	2013-11-28 06:39:28 +0000	[diff] [blame]	1193	u8 *eeprom_buff;
				1194	u16 i, sectors;
				1195	bool last;
Shannon Nelson	cd552cb	2014-07-09 07:46:09 +0000	[diff] [blame]	1196	u32 magic;
				1197
Anjali Singhai Jain	e5e0a5d	2013-11-28 06:39:28 +0000	[diff] [blame]	1198	#define I40E_NVM_SECTOR_SIZE 4096
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1199	if (eeprom->len == 0)
				1200	return -EINVAL;
				1201
Shannon Nelson	cd552cb	2014-07-09 07:46:09 +0000	[diff] [blame]	1202	/* check for NVMUpdate access method */
				1203	magic = hw->vendor_id \| (hw->device_id << 16);
				1204	if (eeprom->magic && eeprom->magic != magic) {
Shannon Nelson	6e93d0c	2016-01-15 14:33:18 -0800	[diff] [blame]	1205	struct i40e_nvm_access cmd = (struct i40e_nvm_access )eeprom;
				1206	int errno = 0;
Shannon Nelson	cd552cb	2014-07-09 07:46:09 +0000	[diff] [blame]	1207
				1208	/* make sure it is the right magic for NVMUpdate */
				1209	if ((eeprom->magic >> 16) != hw->device_id)
Shannon Nelson	6e93d0c	2016-01-15 14:33:18 -0800	[diff] [blame]	1210	errno = -EINVAL;
Jacob Keller	0da36b9	2017-04-19 09:25:55 -0400	[diff] [blame]	1211	else if (test_bit(__I40E_RESET_RECOVERY_PENDING, pf->state) \|\|
				1212	test_bit(__I40E_RESET_INTR_RECEIVED, pf->state))
Shannon Nelson	6e93d0c	2016-01-15 14:33:18 -0800	[diff] [blame]	1213	errno = -EBUSY;
				1214	else
				1215	ret_val = i40e_nvmupd_command(hw, cmd, bytes, &errno);
Shannon Nelson	cd552cb	2014-07-09 07:46:09 +0000	[diff] [blame]	1216
Shannon Nelson	6e93d0c	2016-01-15 14:33:18 -0800	[diff] [blame]	1217	if ((errno \|\| ret_val) && (hw->debug_mask & I40E_DEBUG_NVM))
Shannon Nelson	cd552cb	2014-07-09 07:46:09 +0000	[diff] [blame]	1218	dev_info(&pf->pdev->dev,
Shannon Nelson	c150a50	2014-11-13 08:23:13 +0000	[diff] [blame]	1219	"NVMUpdate read failed err=%d status=0x%x errno=%d module=%d offset=0x%x size=%d\n",
				1220	ret_val, hw->aq.asq_last_status, errno,
				1221	(u8)(cmd->config & I40E_NVM_MOD_PNT_MASK),
				1222	cmd->offset, cmd->data_size);
Shannon Nelson	cd552cb	2014-07-09 07:46:09 +0000	[diff] [blame]	1223
				1224	return errno;
				1225	}
				1226
				1227	/* normal ethtool get_eeprom support */
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1228	eeprom->magic = hw->vendor_id \| (hw->device_id << 16);
				1229
Anjali Singhai Jain	e5e0a5d	2013-11-28 06:39:28 +0000	[diff] [blame]	1230	eeprom_buff = kzalloc(eeprom->len, GFP_KERNEL);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1231	if (!eeprom_buff)
				1232	return -ENOMEM;
				1233
Anjali Singhai Jain	e5e0a5d	2013-11-28 06:39:28 +0000	[diff] [blame]	1234	ret_val = i40e_acquire_nvm(hw, I40E_RESOURCE_READ);
				1235	if (ret_val) {
				1236	dev_info(&pf->pdev->dev,
				1237	"Failed Acquiring NVM resource for read err=%d status=0x%x\n",
				1238	ret_val, hw->aq.asq_last_status);
				1239	goto free_buff;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1240	}
				1241
Anjali Singhai Jain	e5e0a5d	2013-11-28 06:39:28 +0000	[diff] [blame]	1242	sectors = eeprom->len / I40E_NVM_SECTOR_SIZE;
				1243	sectors += (eeprom->len % I40E_NVM_SECTOR_SIZE) ? 1 : 0;
				1244	len = I40E_NVM_SECTOR_SIZE;
				1245	last = false;
				1246	for (i = 0; i < sectors; i++) {
				1247	if (i == (sectors - 1)) {
				1248	len = eeprom->len - (I40E_NVM_SECTOR_SIZE * i);
				1249	last = true;
				1250	}
Shannon Nelson	c150a50	2014-11-13 08:23:13 +0000	[diff] [blame]	1251	offset = eeprom->offset + (I40E_NVM_SECTOR_SIZE * i),
				1252	ret_val = i40e_aq_read_nvm(hw, 0x0, offset, len,
Shannon Nelson	cd552cb	2014-07-09 07:46:09 +0000	[diff] [blame]	1253	(u8 )eeprom_buff + (I40E_NVM_SECTOR_SIZE i),
Anjali Singhai Jain	e5e0a5d	2013-11-28 06:39:28 +0000	[diff] [blame]	1254	last, NULL);
Shannon Nelson	c150a50	2014-11-13 08:23:13 +0000	[diff] [blame]	1255	if (ret_val && hw->aq.asq_last_status == I40E_AQ_RC_EPERM) {
Anjali Singhai Jain	e5e0a5d	2013-11-28 06:39:28 +0000	[diff] [blame]	1256	dev_info(&pf->pdev->dev,
Shannon Nelson	c150a50	2014-11-13 08:23:13 +0000	[diff] [blame]	1257	"read NVM failed, invalid offset 0x%x\n",
				1258	offset);
				1259	break;
				1260	} else if (ret_val &&
				1261	hw->aq.asq_last_status == I40E_AQ_RC_EACCES) {
				1262	dev_info(&pf->pdev->dev,
				1263	"read NVM failed, access, offset 0x%x\n",
				1264	offset);
				1265	break;
				1266	} else if (ret_val) {
				1267	dev_info(&pf->pdev->dev,
				1268	"read NVM failed offset %d err=%d status=0x%x\n",
				1269	offset, ret_val, hw->aq.asq_last_status);
				1270	break;
Anjali Singhai Jain	e5e0a5d	2013-11-28 06:39:28 +0000	[diff] [blame]	1271	}
				1272	}
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1273
Anjali Singhai Jain	e5e0a5d	2013-11-28 06:39:28 +0000	[diff] [blame]	1274	i40e_release_nvm(hw);
Shannon Nelson	cd552cb	2014-07-09 07:46:09 +0000	[diff] [blame]	1275	memcpy(bytes, (u8 *)eeprom_buff, eeprom->len);
Anjali Singhai Jain	e5e0a5d	2013-11-28 06:39:28 +0000	[diff] [blame]	1276	free_buff:
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1277	kfree(eeprom_buff);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1278	return ret_val;
				1279	}
				1280
				1281	static int i40e_get_eeprom_len(struct net_device *netdev)
				1282	{
				1283	struct i40e_netdev_priv *np = netdev_priv(netdev);
				1284	struct i40e_hw *hw = &np->vsi->back->hw;
Anjali Singhai Jain	e5e0a5d	2013-11-28 06:39:28 +0000	[diff] [blame]	1285	u32 val;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1286
Lihong Yang	c271dd6	2017-01-30 12:29:32 -0800	[diff] [blame]	1287	#define X722_EEPROM_SCOPE_LIMIT 0x5B9FFF
				1288	if (hw->mac.type == I40E_MAC_X722) {
				1289	val = X722_EEPROM_SCOPE_LIMIT + 1;
				1290	return val;
				1291	}
Anjali Singhai Jain	e5e0a5d	2013-11-28 06:39:28 +0000	[diff] [blame]	1292	val = (rd32(hw, I40E_GLPCI_LBARCTRL)
				1293	& I40E_GLPCI_LBARCTRL_FL_SIZE_MASK)
				1294	>> I40E_GLPCI_LBARCTRL_FL_SIZE_SHIFT;
				1295	/* register returns value in power of 2, 64Kbyte chunks. */
Jesse Brandeburg	41a1d04	2015-06-04 16:24:02 -0400	[diff] [blame]	1296	val = (64 * 1024) * BIT(val);
Anjali Singhai Jain	e5e0a5d	2013-11-28 06:39:28 +0000	[diff] [blame]	1297	return val;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1298	}
				1299
Shannon Nelson	cd552cb	2014-07-09 07:46:09 +0000	[diff] [blame]	1300	static int i40e_set_eeprom(struct net_device *netdev,
				1301	struct ethtool_eeprom eeprom, u8 bytes)
				1302	{
				1303	struct i40e_netdev_priv *np = netdev_priv(netdev);
				1304	struct i40e_hw *hw = &np->vsi->back->hw;
				1305	struct i40e_pf *pf = np->vsi->back;
Shannon Nelson	6e93d0c	2016-01-15 14:33:18 -0800	[diff] [blame]	1306	struct i40e_nvm_access cmd = (struct i40e_nvm_access )eeprom;
Shannon Nelson	cd552cb	2014-07-09 07:46:09 +0000	[diff] [blame]	1307	int ret_val = 0;
Shannon Nelson	6e93d0c	2016-01-15 14:33:18 -0800	[diff] [blame]	1308	int errno = 0;
Shannon Nelson	cd552cb	2014-07-09 07:46:09 +0000	[diff] [blame]	1309	u32 magic;
				1310
				1311	/* normal ethtool set_eeprom is not supported */
				1312	magic = hw->vendor_id \| (hw->device_id << 16);
				1313	if (eeprom->magic == magic)
Shannon Nelson	6e93d0c	2016-01-15 14:33:18 -0800	[diff] [blame]	1314	errno = -EOPNOTSUPP;
Shannon Nelson	cd552cb	2014-07-09 07:46:09 +0000	[diff] [blame]	1315	/* check for NVMUpdate access method */
Shannon Nelson	6e93d0c	2016-01-15 14:33:18 -0800	[diff] [blame]	1316	else if (!eeprom->magic \|\| (eeprom->magic >> 16) != hw->device_id)
				1317	errno = -EINVAL;
Jacob Keller	0da36b9	2017-04-19 09:25:55 -0400	[diff] [blame]	1318	else if (test_bit(__I40E_RESET_RECOVERY_PENDING, pf->state) \|\|
				1319	test_bit(__I40E_RESET_INTR_RECEIVED, pf->state))
Shannon Nelson	6e93d0c	2016-01-15 14:33:18 -0800	[diff] [blame]	1320	errno = -EBUSY;
				1321	else
				1322	ret_val = i40e_nvmupd_command(hw, cmd, bytes, &errno);
Shannon Nelson	cd552cb	2014-07-09 07:46:09 +0000	[diff] [blame]	1323
Shannon Nelson	6e93d0c	2016-01-15 14:33:18 -0800	[diff] [blame]	1324	if ((errno \|\| ret_val) && (hw->debug_mask & I40E_DEBUG_NVM))
Shannon Nelson	cd552cb	2014-07-09 07:46:09 +0000	[diff] [blame]	1325	dev_info(&pf->pdev->dev,
Shannon Nelson	c150a50	2014-11-13 08:23:13 +0000	[diff] [blame]	1326	"NVMUpdate write failed err=%d status=0x%x errno=%d module=%d offset=0x%x size=%d\n",
				1327	ret_val, hw->aq.asq_last_status, errno,
				1328	(u8)(cmd->config & I40E_NVM_MOD_PNT_MASK),
				1329	cmd->offset, cmd->data_size);
Shannon Nelson	cd552cb	2014-07-09 07:46:09 +0000	[diff] [blame]	1330
				1331	return errno;
				1332	}
				1333
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1334	static void i40e_get_drvinfo(struct net_device *netdev,
				1335	struct ethtool_drvinfo *drvinfo)
				1336	{
				1337	struct i40e_netdev_priv *np = netdev_priv(netdev);
				1338	struct i40e_vsi *vsi = np->vsi;
				1339	struct i40e_pf *pf = vsi->back;
				1340
				1341	strlcpy(drvinfo->driver, i40e_driver_name, sizeof(drvinfo->driver));
				1342	strlcpy(drvinfo->version, i40e_driver_version_str,
				1343	sizeof(drvinfo->version));
Shannon Nelson	6dec101	2015-09-28 14:12:30 -0400	[diff] [blame]	1344	strlcpy(drvinfo->fw_version, i40e_nvm_version_str(&pf->hw),
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1345	sizeof(drvinfo->fw_version));
				1346	strlcpy(drvinfo->bus_info, pci_name(pf->pdev),
				1347	sizeof(drvinfo->bus_info));
Jacob Keller	d182a5c	2016-10-25 16:08:50 -0700	[diff] [blame]	1348	drvinfo->n_priv_flags = I40E_PRIV_FLAGS_STR_LEN;
Anjali Singhai Jain	b556989	2016-05-03 15:13:12 -0700	[diff] [blame]	1349	if (pf->hw.pf_id == 0)
Jacob Keller	d182a5c	2016-10-25 16:08:50 -0700	[diff] [blame]	1350	drvinfo->n_priv_flags += I40E_GL_PRIV_FLAGS_STR_LEN;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1351	}
				1352
				1353	static void i40e_get_ringparam(struct net_device *netdev,
				1354	struct ethtool_ringparam *ring)
				1355	{
				1356	struct i40e_netdev_priv *np = netdev_priv(netdev);
				1357	struct i40e_pf *pf = np->vsi->back;
				1358	struct i40e_vsi *vsi = pf->vsi[pf->lan_vsi];
				1359
				1360	ring->rx_max_pending = I40E_MAX_NUM_DESCRIPTORS;
				1361	ring->tx_max_pending = I40E_MAX_NUM_DESCRIPTORS;
				1362	ring->rx_mini_max_pending = 0;
				1363	ring->rx_jumbo_max_pending = 0;
Alexander Duyck	9f65e15	2013-09-28 06:00:58 +0000	[diff] [blame]	1364	ring->rx_pending = vsi->rx_rings[0]->count;
				1365	ring->tx_pending = vsi->tx_rings[0]->count;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1366	ring->rx_mini_pending = 0;
				1367	ring->rx_jumbo_pending = 0;
				1368	}
				1369
Björn Töpel	74608d1	2017-05-24 07:55:35 +0200	[diff] [blame]	1370	static bool i40e_active_tx_ring_index(struct i40e_vsi *vsi, u16 index)
				1371	{
				1372	if (i40e_enabled_xdp_vsi(vsi)) {
				1373	return index < vsi->num_queue_pairs \|\|
				1374	(index >= vsi->alloc_queue_pairs &&
				1375	index < vsi->alloc_queue_pairs + vsi->num_queue_pairs);
				1376	}
				1377
				1378	return index < vsi->num_queue_pairs;
				1379	}
				1380
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1381	static int i40e_set_ringparam(struct net_device *netdev,
				1382	struct ethtool_ringparam *ring)
				1383	{
				1384	struct i40e_ring tx_rings = NULL, rx_rings = NULL;
				1385	struct i40e_netdev_priv *np = netdev_priv(netdev);
Tushar Dave	2f7679e	2016-10-26 10:49:27 -0700	[diff] [blame]	1386	struct i40e_hw *hw = &np->vsi->back->hw;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1387	struct i40e_vsi *vsi = np->vsi;
				1388	struct i40e_pf *pf = vsi->back;
				1389	u32 new_rx_count, new_tx_count;
Björn Töpel	74608d1	2017-05-24 07:55:35 +0200	[diff] [blame]	1390	u16 tx_alloc_queue_pairs;
Jacob Keller	e8d2f4c	2017-04-13 04:45:48 -0400	[diff] [blame]	1391	int timeout = 50;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1392	int i, err = 0;
				1393
				1394	if ((ring->rx_mini_pending) \|\| (ring->rx_jumbo_pending))
				1395	return -EINVAL;
				1396
Shannon Nelson	1fa1837	2013-11-20 10:03:08 +0000	[diff] [blame]	1397	if (ring->tx_pending > I40E_MAX_NUM_DESCRIPTORS \|\|
				1398	ring->tx_pending < I40E_MIN_NUM_DESCRIPTORS \|\|
				1399	ring->rx_pending > I40E_MAX_NUM_DESCRIPTORS \|\|
				1400	ring->rx_pending < I40E_MIN_NUM_DESCRIPTORS) {
				1401	netdev_info(netdev,
				1402	"Descriptors requested (Tx: %d / Rx: %d) out of range [%d-%d]\n",
				1403	ring->tx_pending, ring->rx_pending,
				1404	I40E_MIN_NUM_DESCRIPTORS, I40E_MAX_NUM_DESCRIPTORS);
				1405	return -EINVAL;
				1406	}
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1407
Shannon Nelson	1fa1837	2013-11-20 10:03:08 +0000	[diff] [blame]	1408	new_tx_count = ALIGN(ring->tx_pending, I40E_REQ_DESCRIPTOR_MULTIPLE);
				1409	new_rx_count = ALIGN(ring->rx_pending, I40E_REQ_DESCRIPTOR_MULTIPLE);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1410
				1411	/* if nothing to do return success */
Alexander Duyck	9f65e15	2013-09-28 06:00:58 +0000	[diff] [blame]	1412	if ((new_tx_count == vsi->tx_rings[0]->count) &&
				1413	(new_rx_count == vsi->rx_rings[0]->count))
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1414	return 0;
				1415
Jacob Keller	0da36b9	2017-04-19 09:25:55 -0400	[diff] [blame]	1416	while (test_and_set_bit(__I40E_CONFIG_BUSY, pf->state)) {
Jacob Keller	e8d2f4c	2017-04-13 04:45:48 -0400	[diff] [blame]	1417	timeout--;
				1418	if (!timeout)
				1419	return -EBUSY;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1420	usleep_range(1000, 2000);
Jacob Keller	e8d2f4c	2017-04-13 04:45:48 -0400	[diff] [blame]	1421	}
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1422
				1423	if (!netif_running(vsi->netdev)) {
				1424	/* simple case - set for the next time the netdev is started */
				1425	for (i = 0; i < vsi->num_queue_pairs; i++) {
Alexander Duyck	9f65e15	2013-09-28 06:00:58 +0000	[diff] [blame]	1426	vsi->tx_rings[i]->count = new_tx_count;
				1427	vsi->rx_rings[i]->count = new_rx_count;
Björn Töpel	74608d1	2017-05-24 07:55:35 +0200	[diff] [blame]	1428	if (i40e_enabled_xdp_vsi(vsi))
				1429	vsi->xdp_rings[i]->count = new_tx_count;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1430	}
				1431	goto done;
				1432	}
				1433
				1434	/* We can't just free everything and then setup again,
				1435	* because the ISRs in MSI-X mode get passed pointers
				1436	* to the Tx and Rx ring structs.
				1437	*/
				1438
Björn Töpel	74608d1	2017-05-24 07:55:35 +0200	[diff] [blame]	1439	/* alloc updated Tx and XDP Tx resources */
				1440	tx_alloc_queue_pairs = vsi->alloc_queue_pairs *
				1441	(i40e_enabled_xdp_vsi(vsi) ? 2 : 1);
Alexander Duyck	9f65e15	2013-09-28 06:00:58 +0000	[diff] [blame]	1442	if (new_tx_count != vsi->tx_rings[0]->count) {
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1443	netdev_info(netdev,
				1444	"Changing Tx descriptor count from %d to %d.\n",
Alexander Duyck	9f65e15	2013-09-28 06:00:58 +0000	[diff] [blame]	1445	vsi->tx_rings[0]->count, new_tx_count);
Björn Töpel	74608d1	2017-05-24 07:55:35 +0200	[diff] [blame]	1446	tx_rings = kcalloc(tx_alloc_queue_pairs,
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1447	sizeof(struct i40e_ring), GFP_KERNEL);
				1448	if (!tx_rings) {
				1449	err = -ENOMEM;
				1450	goto done;
				1451	}
				1452
Björn Töpel	74608d1	2017-05-24 07:55:35 +0200	[diff] [blame]	1453	for (i = 0; i < tx_alloc_queue_pairs; i++) {
				1454	if (!i40e_active_tx_ring_index(vsi, i))
				1455	continue;
				1456
Alexander Duyck	9f65e15	2013-09-28 06:00:58 +0000	[diff] [blame]	1457	tx_rings[i] = *vsi->tx_rings[i];
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1458	tx_rings[i].count = new_tx_count;
Jesse Brandeburg	1e8efb4	2015-08-27 11:42:33 -0400	[diff] [blame]	1459	/* the desc and bi pointers will be reallocated in the
				1460	* setup call
				1461	*/
				1462	tx_rings[i].desc = NULL;
				1463	tx_rings[i].rx_bi = NULL;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1464	err = i40e_setup_tx_descriptors(&tx_rings[i]);
				1465	if (err) {
				1466	while (i) {
				1467	i--;
Björn Töpel	74608d1	2017-05-24 07:55:35 +0200	[diff] [blame]	1468	if (!i40e_active_tx_ring_index(vsi, i))
				1469	continue;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1470	i40e_free_tx_resources(&tx_rings[i]);
				1471	}
				1472	kfree(tx_rings);
				1473	tx_rings = NULL;
				1474
				1475	goto done;
				1476	}
				1477	}
				1478	}
				1479
				1480	/* alloc updated Rx resources */
Alexander Duyck	9f65e15	2013-09-28 06:00:58 +0000	[diff] [blame]	1481	if (new_rx_count != vsi->rx_rings[0]->count) {
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1482	netdev_info(netdev,
				1483	"Changing Rx descriptor count from %d to %d\n",
Alexander Duyck	9f65e15	2013-09-28 06:00:58 +0000	[diff] [blame]	1484	vsi->rx_rings[0]->count, new_rx_count);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1485	rx_rings = kcalloc(vsi->alloc_queue_pairs,
				1486	sizeof(struct i40e_ring), GFP_KERNEL);
				1487	if (!rx_rings) {
				1488	err = -ENOMEM;
				1489	goto free_tx;
				1490	}
				1491
				1492	for (i = 0; i < vsi->num_queue_pairs; i++) {
Jesse Brandeburg	147e81e	2016-04-18 11:33:49 -0700	[diff] [blame]	1493	struct i40e_ring *ring;
				1494	u16 unused;
				1495
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1496	/* clone ring and setup updated count */
Alexander Duyck	9f65e15	2013-09-28 06:00:58 +0000	[diff] [blame]	1497	rx_rings[i] = *vsi->rx_rings[i];
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1498	rx_rings[i].count = new_rx_count;
Jesse Brandeburg	1e8efb4	2015-08-27 11:42:33 -0400	[diff] [blame]	1499	/* the desc and bi pointers will be reallocated in the
				1500	* setup call
				1501	*/
				1502	rx_rings[i].desc = NULL;
				1503	rx_rings[i].rx_bi = NULL;
Tushar Dave	2f7679e	2016-10-26 10:49:27 -0700	[diff] [blame]	1504	/* this is to allow wr32 to have something to write to
				1505	* during early allocation of Rx buffers
				1506	*/
				1507	rx_rings[i].tail = hw->hw_addr + I40E_PRTGEN_STATUS;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1508	err = i40e_setup_rx_descriptors(&rx_rings[i]);
Jesse Brandeburg	147e81e	2016-04-18 11:33:49 -0700	[diff] [blame]	1509	if (err)
				1510	goto rx_unwind;
				1511
				1512	/* now allocate the Rx buffers to make sure the OS
				1513	* has enough memory, any failure here means abort
				1514	*/
				1515	ring = &rx_rings[i];
				1516	unused = I40E_DESC_UNUSED(ring);
				1517	err = i40e_alloc_rx_buffers(ring, unused);
				1518	rx_unwind:
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1519	if (err) {
Jesse Brandeburg	147e81e	2016-04-18 11:33:49 -0700	[diff] [blame]	1520	do {
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1521	i40e_free_rx_resources(&rx_rings[i]);
Jesse Brandeburg	147e81e	2016-04-18 11:33:49 -0700	[diff] [blame]	1522	} while (i--);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1523	kfree(rx_rings);
				1524	rx_rings = NULL;
				1525
				1526	goto free_tx;
				1527	}
				1528	}
				1529	}
				1530
				1531	/* Bring interface down, copy in the new ring info,
				1532	* then restore the interface
				1533	*/
				1534	i40e_down(vsi);
				1535
				1536	if (tx_rings) {
Björn Töpel	74608d1	2017-05-24 07:55:35 +0200	[diff] [blame]	1537	for (i = 0; i < tx_alloc_queue_pairs; i++) {
				1538	if (i40e_active_tx_ring_index(vsi, i)) {
				1539	i40e_free_tx_resources(vsi->tx_rings[i]);
				1540	*vsi->tx_rings[i] = tx_rings[i];
				1541	}
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1542	}
				1543	kfree(tx_rings);
				1544	tx_rings = NULL;
				1545	}
				1546
				1547	if (rx_rings) {
				1548	for (i = 0; i < vsi->num_queue_pairs; i++) {
Alexander Duyck	9f65e15	2013-09-28 06:00:58 +0000	[diff] [blame]	1549	i40e_free_rx_resources(vsi->rx_rings[i]);
Jesse Brandeburg	147e81e	2016-04-18 11:33:49 -0700	[diff] [blame]	1550	/* get the real tail offset */
				1551	rx_rings[i].tail = vsi->rx_rings[i]->tail;
				1552	/* this is to fake out the allocation routine
				1553	* into thinking it has to realloc everything
				1554	* but the recycling logic will let us re-use
				1555	* the buffers allocated above
				1556	*/
				1557	rx_rings[i].next_to_use = 0;
				1558	rx_rings[i].next_to_clean = 0;
				1559	rx_rings[i].next_to_alloc = 0;
				1560	/* do a struct copy */
Alexander Duyck	9f65e15	2013-09-28 06:00:58 +0000	[diff] [blame]	1561	*vsi->rx_rings[i] = rx_rings[i];
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1562	}
				1563	kfree(rx_rings);
				1564	rx_rings = NULL;
				1565	}
				1566
				1567	i40e_up(vsi);
				1568
				1569	free_tx:
				1570	/* error cleanup if the Rx allocations failed after getting Tx */
				1571	if (tx_rings) {
Björn Töpel	74608d1	2017-05-24 07:55:35 +0200	[diff] [blame]	1572	for (i = 0; i < tx_alloc_queue_pairs; i++) {
				1573	if (i40e_active_tx_ring_index(vsi, i))
				1574	i40e_free_tx_resources(vsi->tx_rings[i]);
				1575	}
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1576	kfree(tx_rings);
				1577	tx_rings = NULL;
				1578	}
				1579
				1580	done:
Jacob Keller	0da36b9	2017-04-19 09:25:55 -0400	[diff] [blame]	1581	clear_bit(__I40E_CONFIG_BUSY, pf->state);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1582
				1583	return err;
				1584	}
				1585
				1586	static int i40e_get_sset_count(struct net_device *netdev, int sset)
				1587	{
				1588	struct i40e_netdev_priv *np = netdev_priv(netdev);
				1589	struct i40e_vsi *vsi = np->vsi;
				1590	struct i40e_pf *pf = vsi->back;
				1591
				1592	switch (sset) {
				1593	case ETH_SS_TEST:
				1594	return I40E_TEST_LEN;
				1595	case ETH_SS_STATS:
Shannon Nelson	58ce517	2015-02-27 09:15:26 +0000	[diff] [blame]	1596	if (vsi == pf->vsi[pf->lan_vsi] && pf->hw.partition_id == 1) {
Shannon Nelson	8eab9cf	2014-04-23 04:49:55 +0000	[diff] [blame]	1597	int len = I40E_PF_STATS_LEN(netdev);
				1598
Anjali Singhai Jain	d1a8d27	2015-07-23 16:54:40 -0400	[diff] [blame]	1599	if ((pf->lan_veb != I40E_NO_VEB) &&
				1600	(pf->flags & I40E_FLAG_VEB_STATS_ENABLED))
Neerav Parikh	fe860af	2015-07-10 19:36:02 -0400	[diff] [blame]	1601	len += I40E_VEB_STATS_TOTAL;
Shannon Nelson	8eab9cf	2014-04-23 04:49:55 +0000	[diff] [blame]	1602	return len;
				1603	} else {
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1604	return I40E_VSI_STATS_LEN(netdev);
Shannon Nelson	8eab9cf	2014-04-23 04:49:55 +0000	[diff] [blame]	1605	}
Greg Rose	7e45ab4	2015-02-06 08:52:19 +0000	[diff] [blame]	1606	case ETH_SS_PRIV_FLAGS:
Jacob Keller	d182a5c	2016-10-25 16:08:50 -0700	[diff] [blame]	1607	return I40E_PRIV_FLAGS_STR_LEN +
				1608	(pf->hw.pf_id == 0 ? I40E_GL_PRIV_FLAGS_STR_LEN : 0);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1609	default:
				1610	return -EOPNOTSUPP;
				1611	}
				1612	}
				1613
				1614	static void i40e_get_ethtool_stats(struct net_device *netdev,
				1615	struct ethtool_stats stats, u64 data)
				1616	{
				1617	struct i40e_netdev_priv *np = netdev_priv(netdev);
Akeem G Abodunrin	e7046ee	2014-04-09 05:58:58 +0000	[diff] [blame]	1618	struct i40e_ring tx_ring, rx_ring;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1619	struct i40e_vsi *vsi = np->vsi;
				1620	struct i40e_pf *pf = vsi->back;
Jesse Brandeburg	b85c94b	2017-06-20 15:16:59 -0700	[diff] [blame]	1621	unsigned int j;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1622	int i = 0;
				1623	char *p;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1624	struct rtnl_link_stats64 *net_stats = i40e_get_vsi_stats_struct(vsi);
Alexander Duyck	980e9b1	2013-09-28 06:01:03 +0000	[diff] [blame]	1625	unsigned int start;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1626
				1627	i40e_update_stats(vsi);
				1628
				1629	for (j = 0; j < I40E_NETDEV_STATS_LEN; j++) {
				1630	p = (char *)net_stats + i40e_gstrings_net_stats[j].stat_offset;
				1631	data[i++] = (i40e_gstrings_net_stats[j].sizeof_stat ==
				1632	sizeof(u64)) ? (u64 )p : (u32 )p;
				1633	}
Shannon Nelson	41a9e55	2014-04-23 04:50:20 +0000	[diff] [blame]	1634	for (j = 0; j < I40E_MISC_STATS_LEN; j++) {
				1635	p = (char *)vsi + i40e_gstrings_misc_stats[j].stat_offset;
				1636	data[i++] = (i40e_gstrings_misc_stats[j].sizeof_stat ==
				1637	sizeof(u64)) ? (u64 )p : (u32 )p;
				1638	}
Alexander Duyck	980e9b1	2013-09-28 06:01:03 +0000	[diff] [blame]	1639	rcu_read_lock();
Catherine Sullivan	99c472a	2014-03-14 07:32:30 +0000	[diff] [blame]	1640	for (j = 0; j < vsi->num_queue_pairs; j++) {
Akeem G Abodunrin	e7046ee	2014-04-09 05:58:58 +0000	[diff] [blame]	1641	tx_ring = ACCESS_ONCE(vsi->tx_rings[j]);
Alexander Duyck	980e9b1	2013-09-28 06:01:03 +0000	[diff] [blame]	1642
				1643	if (!tx_ring)
				1644	continue;
				1645
				1646	/* process Tx ring statistics */
				1647	do {
Eric W. Biederman	57a7744	2014-03-13 21:26:42 -0700	[diff] [blame]	1648	start = u64_stats_fetch_begin_irq(&tx_ring->syncp);
Alexander Duyck	980e9b1	2013-09-28 06:01:03 +0000	[diff] [blame]	1649	data[i] = tx_ring->stats.packets;
				1650	data[i + 1] = tx_ring->stats.bytes;
Eric W. Biederman	57a7744	2014-03-13 21:26:42 -0700	[diff] [blame]	1651	} while (u64_stats_fetch_retry_irq(&tx_ring->syncp, start));
Catherine Sullivan	99c472a	2014-03-14 07:32:30 +0000	[diff] [blame]	1652	i += 2;
Alexander Duyck	980e9b1	2013-09-28 06:01:03 +0000	[diff] [blame]	1653
				1654	/* Rx ring is the 2nd half of the queue pair */
				1655	rx_ring = &tx_ring[1];
				1656	do {
Eric W. Biederman	57a7744	2014-03-13 21:26:42 -0700	[diff] [blame]	1657	start = u64_stats_fetch_begin_irq(&rx_ring->syncp);
Catherine Sullivan	99c472a	2014-03-14 07:32:30 +0000	[diff] [blame]	1658	data[i] = rx_ring->stats.packets;
				1659	data[i + 1] = rx_ring->stats.bytes;
Eric W. Biederman	57a7744	2014-03-13 21:26:42 -0700	[diff] [blame]	1660	} while (u64_stats_fetch_retry_irq(&rx_ring->syncp, start));
Catherine Sullivan	99c472a	2014-03-14 07:32:30 +0000	[diff] [blame]	1661	i += 2;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1662	}
Alexander Duyck	980e9b1	2013-09-28 06:01:03 +0000	[diff] [blame]	1663	rcu_read_unlock();
Shannon Nelson	58ce517	2015-02-27 09:15:26 +0000	[diff] [blame]	1664	if (vsi != pf->vsi[pf->lan_vsi] \|\| pf->hw.partition_id != 1)
Shannon Nelson	8eab9cf	2014-04-23 04:49:55 +0000	[diff] [blame]	1665	return;
				1666
Anjali Singhai Jain	d1a8d27	2015-07-23 16:54:40 -0400	[diff] [blame]	1667	if ((pf->lan_veb != I40E_NO_VEB) &&
				1668	(pf->flags & I40E_FLAG_VEB_STATS_ENABLED)) {
Shannon Nelson	8eab9cf	2014-04-23 04:49:55 +0000	[diff] [blame]	1669	struct i40e_veb *veb = pf->veb[pf->lan_veb];
Jesse Brandeburg	6995b36	2015-08-28 17:55:54 -0400	[diff] [blame]	1670
Shannon Nelson	8eab9cf	2014-04-23 04:49:55 +0000	[diff] [blame]	1671	for (j = 0; j < I40E_VEB_STATS_LEN; j++) {
				1672	p = (char *)veb;
				1673	p += i40e_gstrings_veb_stats[j].stat_offset;
				1674	data[i++] = (i40e_gstrings_veb_stats[j].sizeof_stat ==
				1675	sizeof(u64)) ? (u64 )p : (u32 )p;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1676	}
Jesse Brandeburg	74a6c66	2015-10-02 19:09:34 -0700	[diff] [blame]	1677	for (j = 0; j < I40E_MAX_TRAFFIC_CLASS; j++) {
				1678	data[i++] = veb->tc_stats.tc_tx_packets[j];
				1679	data[i++] = veb->tc_stats.tc_tx_bytes[j];
				1680	data[i++] = veb->tc_stats.tc_rx_packets[j];
				1681	data[i++] = veb->tc_stats.tc_rx_bytes[j];
				1682	}
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1683	}
Shannon Nelson	8eab9cf	2014-04-23 04:49:55 +0000	[diff] [blame]	1684	for (j = 0; j < I40E_GLOBAL_STATS_LEN; j++) {
				1685	p = (char *)pf + i40e_gstrings_stats[j].stat_offset;
				1686	data[i++] = (i40e_gstrings_stats[j].sizeof_stat ==
				1687	sizeof(u64)) ? (u64 )p : (u32 )p;
				1688	}
				1689	for (j = 0; j < I40E_MAX_USER_PRIORITY; j++) {
				1690	data[i++] = pf->stats.priority_xon_tx[j];
				1691	data[i++] = pf->stats.priority_xoff_tx[j];
				1692	}
				1693	for (j = 0; j < I40E_MAX_USER_PRIORITY; j++) {
				1694	data[i++] = pf->stats.priority_xon_rx[j];
				1695	data[i++] = pf->stats.priority_xoff_rx[j];
				1696	}
				1697	for (j = 0; j < I40E_MAX_USER_PRIORITY; j++)
				1698	data[i++] = pf->stats.priority_xon_2_xoff[j];
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1699	}
				1700
				1701	static void i40e_get_strings(struct net_device *netdev, u32 stringset,
				1702	u8 *data)
				1703	{
				1704	struct i40e_netdev_priv *np = netdev_priv(netdev);
				1705	struct i40e_vsi *vsi = np->vsi;
				1706	struct i40e_pf *pf = vsi->back;
				1707	char p = (char )data;
Jesse Brandeburg	b85c94b	2017-06-20 15:16:59 -0700	[diff] [blame]	1708	unsigned int i;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1709
				1710	switch (stringset) {
				1711	case ETH_SS_TEST:
Jacob Keller	e5d3220	2016-11-08 13:05:11 -0800	[diff] [blame]	1712	memcpy(data, i40e_gstrings_test,
				1713	I40E_TEST_LEN * ETH_GSTRING_LEN);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1714	break;
				1715	case ETH_SS_STATS:
				1716	for (i = 0; i < I40E_NETDEV_STATS_LEN; i++) {
				1717	snprintf(p, ETH_GSTRING_LEN, "%s",
				1718	i40e_gstrings_net_stats[i].stat_string);
				1719	p += ETH_GSTRING_LEN;
				1720	}
Shannon Nelson	41a9e55	2014-04-23 04:50:20 +0000	[diff] [blame]	1721	for (i = 0; i < I40E_MISC_STATS_LEN; i++) {
				1722	snprintf(p, ETH_GSTRING_LEN, "%s",
				1723	i40e_gstrings_misc_stats[i].stat_string);
				1724	p += ETH_GSTRING_LEN;
				1725	}
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1726	for (i = 0; i < vsi->num_queue_pairs; i++) {
Heinrich Schuchardt	fbcfac3	2016-08-11 01:07:22 +0200	[diff] [blame]	1727	snprintf(p, ETH_GSTRING_LEN, "tx-%d.tx_packets", i);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1728	p += ETH_GSTRING_LEN;
Heinrich Schuchardt	fbcfac3	2016-08-11 01:07:22 +0200	[diff] [blame]	1729	snprintf(p, ETH_GSTRING_LEN, "tx-%d.tx_bytes", i);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1730	p += ETH_GSTRING_LEN;
Heinrich Schuchardt	fbcfac3	2016-08-11 01:07:22 +0200	[diff] [blame]	1731	snprintf(p, ETH_GSTRING_LEN, "rx-%d.rx_packets", i);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1732	p += ETH_GSTRING_LEN;
Heinrich Schuchardt	fbcfac3	2016-08-11 01:07:22 +0200	[diff] [blame]	1733	snprintf(p, ETH_GSTRING_LEN, "rx-%d.rx_bytes", i);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1734	p += ETH_GSTRING_LEN;
				1735	}
Shannon Nelson	58ce517	2015-02-27 09:15:26 +0000	[diff] [blame]	1736	if (vsi != pf->vsi[pf->lan_vsi] \|\| pf->hw.partition_id != 1)
Shannon Nelson	8eab9cf	2014-04-23 04:49:55 +0000	[diff] [blame]	1737	return;
				1738
Anjali Singhai Jain	d1a8d27	2015-07-23 16:54:40 -0400	[diff] [blame]	1739	if ((pf->lan_veb != I40E_NO_VEB) &&
				1740	(pf->flags & I40E_FLAG_VEB_STATS_ENABLED)) {
Shannon Nelson	8eab9cf	2014-04-23 04:49:55 +0000	[diff] [blame]	1741	for (i = 0; i < I40E_VEB_STATS_LEN; i++) {
				1742	snprintf(p, ETH_GSTRING_LEN, "veb.%s",
				1743	i40e_gstrings_veb_stats[i].stat_string);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1744	p += ETH_GSTRING_LEN;
				1745	}
Neerav Parikh	fe860af	2015-07-10 19:36:02 -0400	[diff] [blame]	1746	for (i = 0; i < I40E_MAX_TRAFFIC_CLASS; i++) {
				1747	snprintf(p, ETH_GSTRING_LEN,
Heinrich Schuchardt	fbcfac3	2016-08-11 01:07:22 +0200	[diff] [blame]	1748	"veb.tc_%d_tx_packets", i);
Neerav Parikh	fe860af	2015-07-10 19:36:02 -0400	[diff] [blame]	1749	p += ETH_GSTRING_LEN;
				1750	snprintf(p, ETH_GSTRING_LEN,
Heinrich Schuchardt	fbcfac3	2016-08-11 01:07:22 +0200	[diff] [blame]	1751	"veb.tc_%d_tx_bytes", i);
Neerav Parikh	fe860af	2015-07-10 19:36:02 -0400	[diff] [blame]	1752	p += ETH_GSTRING_LEN;
				1753	snprintf(p, ETH_GSTRING_LEN,
Heinrich Schuchardt	fbcfac3	2016-08-11 01:07:22 +0200	[diff] [blame]	1754	"veb.tc_%d_rx_packets", i);
Neerav Parikh	fe860af	2015-07-10 19:36:02 -0400	[diff] [blame]	1755	p += ETH_GSTRING_LEN;
				1756	snprintf(p, ETH_GSTRING_LEN,
Heinrich Schuchardt	fbcfac3	2016-08-11 01:07:22 +0200	[diff] [blame]	1757	"veb.tc_%d_rx_bytes", i);
Neerav Parikh	fe860af	2015-07-10 19:36:02 -0400	[diff] [blame]	1758	p += ETH_GSTRING_LEN;
				1759	}
Shannon Nelson	8eab9cf	2014-04-23 04:49:55 +0000	[diff] [blame]	1760	}
				1761	for (i = 0; i < I40E_GLOBAL_STATS_LEN; i++) {
				1762	snprintf(p, ETH_GSTRING_LEN, "port.%s",
				1763	i40e_gstrings_stats[i].stat_string);
				1764	p += ETH_GSTRING_LEN;
				1765	}
				1766	for (i = 0; i < I40E_MAX_USER_PRIORITY; i++) {
				1767	snprintf(p, ETH_GSTRING_LEN,
Heinrich Schuchardt	fbcfac3	2016-08-11 01:07:22 +0200	[diff] [blame]	1768	"port.tx_priority_%d_xon", i);
Shannon Nelson	8eab9cf	2014-04-23 04:49:55 +0000	[diff] [blame]	1769	p += ETH_GSTRING_LEN;
				1770	snprintf(p, ETH_GSTRING_LEN,
Heinrich Schuchardt	fbcfac3	2016-08-11 01:07:22 +0200	[diff] [blame]	1771	"port.tx_priority_%d_xoff", i);
Shannon Nelson	8eab9cf	2014-04-23 04:49:55 +0000	[diff] [blame]	1772	p += ETH_GSTRING_LEN;
				1773	}
				1774	for (i = 0; i < I40E_MAX_USER_PRIORITY; i++) {
				1775	snprintf(p, ETH_GSTRING_LEN,
Heinrich Schuchardt	fbcfac3	2016-08-11 01:07:22 +0200	[diff] [blame]	1776	"port.rx_priority_%d_xon", i);
Shannon Nelson	8eab9cf	2014-04-23 04:49:55 +0000	[diff] [blame]	1777	p += ETH_GSTRING_LEN;
				1778	snprintf(p, ETH_GSTRING_LEN,
Heinrich Schuchardt	fbcfac3	2016-08-11 01:07:22 +0200	[diff] [blame]	1779	"port.rx_priority_%d_xoff", i);
Shannon Nelson	8eab9cf	2014-04-23 04:49:55 +0000	[diff] [blame]	1780	p += ETH_GSTRING_LEN;
				1781	}
				1782	for (i = 0; i < I40E_MAX_USER_PRIORITY; i++) {
				1783	snprintf(p, ETH_GSTRING_LEN,
Heinrich Schuchardt	fbcfac3	2016-08-11 01:07:22 +0200	[diff] [blame]	1784	"port.rx_priority_%d_xon_2_xoff", i);
Shannon Nelson	8eab9cf	2014-04-23 04:49:55 +0000	[diff] [blame]	1785	p += ETH_GSTRING_LEN;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1786	}
				1787	/* BUG_ON(p - data != I40E_STATS_LEN * ETH_GSTRING_LEN); */
				1788	break;
Greg Rose	7e45ab4	2015-02-06 08:52:19 +0000	[diff] [blame]	1789	case ETH_SS_PRIV_FLAGS:
Alexander Duyck	aca955d	2017-03-10 12:22:01 -0800	[diff] [blame]	1790	for (i = 0; i < I40E_PRIV_FLAGS_STR_LEN; i++) {
				1791	snprintf(p, ETH_GSTRING_LEN, "%s",
				1792	i40e_gstrings_priv_flags[i].flag_string);
				1793	p += ETH_GSTRING_LEN;
				1794	}
				1795	if (pf->hw.pf_id != 0)
				1796	break;
				1797	for (i = 0; i < I40E_GL_PRIV_FLAGS_STR_LEN; i++) {
				1798	snprintf(p, ETH_GSTRING_LEN, "%s",
				1799	i40e_gl_gstrings_priv_flags[i].flag_string);
				1800	p += ETH_GSTRING_LEN;
				1801	}
Greg Rose	7e45ab4	2015-02-06 08:52:19 +0000	[diff] [blame]	1802	break;
Akeem G Abodunrin	579b23d	2015-02-24 06:58:42 +0000	[diff] [blame]	1803	default:
				1804	break;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1805	}
				1806	}
				1807
				1808	static int i40e_get_ts_info(struct net_device *dev,
				1809	struct ethtool_ts_info *info)
				1810	{
Jacob Keller	beb0dff	2014-01-11 05:43:19 +0000	[diff] [blame]	1811	struct i40e_pf *pf = i40e_netdev_to_pf(dev);
				1812
Jacob Keller	fe88bda	2014-11-11 20:05:58 +0000	[diff] [blame]	1813	/* only report HW timestamping if PTP is enabled */
				1814	if (!(pf->flags & I40E_FLAG_PTP))
				1815	return ethtool_op_get_ts_info(dev, info);
				1816
Jacob Keller	beb0dff	2014-01-11 05:43:19 +0000	[diff] [blame]	1817	info->so_timestamping = SOF_TIMESTAMPING_TX_SOFTWARE \|
				1818	SOF_TIMESTAMPING_RX_SOFTWARE \|
				1819	SOF_TIMESTAMPING_SOFTWARE \|
				1820	SOF_TIMESTAMPING_TX_HARDWARE \|
				1821	SOF_TIMESTAMPING_RX_HARDWARE \|
				1822	SOF_TIMESTAMPING_RAW_HARDWARE;
				1823
				1824	if (pf->ptp_clock)
				1825	info->phc_index = ptp_clock_index(pf->ptp_clock);
				1826	else
				1827	info->phc_index = -1;
				1828
Jesse Brandeburg	41a1d04	2015-06-04 16:24:02 -0400	[diff] [blame]	1829	info->tx_types = BIT(HWTSTAMP_TX_OFF) \| BIT(HWTSTAMP_TX_ON);
Jacob Keller	beb0dff	2014-01-11 05:43:19 +0000	[diff] [blame]	1830
Jesse Brandeburg	41a1d04	2015-06-04 16:24:02 -0400	[diff] [blame]	1831	info->rx_filters = BIT(HWTSTAMP_FILTER_NONE) \|
Jacob Keller	1e28e86	2016-11-11 12:39:25 -0800	[diff] [blame]	1832	BIT(HWTSTAMP_FILTER_PTP_V2_L2_EVENT) \|
				1833	BIT(HWTSTAMP_FILTER_PTP_V2_L2_SYNC) \|
				1834	BIT(HWTSTAMP_FILTER_PTP_V2_L2_DELAY_REQ);
				1835
Jacob Keller	d36e41d	2017-06-23 04:24:46 -0400	[diff] [blame]	1836	if (pf->hw_features & I40E_HW_PTP_L4_CAPABLE)
Jacob Keller	1e28e86	2016-11-11 12:39:25 -0800	[diff] [blame]	1837	info->rx_filters \|= BIT(HWTSTAMP_FILTER_PTP_V1_L4_SYNC) \|
				1838	BIT(HWTSTAMP_FILTER_PTP_V1_L4_DELAY_REQ) \|
				1839	BIT(HWTSTAMP_FILTER_PTP_V2_EVENT) \|
				1840	BIT(HWTSTAMP_FILTER_PTP_V2_L4_EVENT) \|
				1841	BIT(HWTSTAMP_FILTER_PTP_V2_SYNC) \|
				1842	BIT(HWTSTAMP_FILTER_PTP_V2_L4_SYNC) \|
				1843	BIT(HWTSTAMP_FILTER_PTP_V2_DELAY_REQ) \|
				1844	BIT(HWTSTAMP_FILTER_PTP_V2_L4_DELAY_REQ);
Jacob Keller	beb0dff	2014-01-11 05:43:19 +0000	[diff] [blame]	1845
				1846	return 0;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1847	}
				1848
Shannon Nelson	7b08639	2013-11-20 10:02:59 +0000	[diff] [blame]	1849	static int i40e_link_test(struct net_device netdev, u64 data)
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1850	{
Shannon Nelson	7b08639	2013-11-20 10:02:59 +0000	[diff] [blame]	1851	struct i40e_netdev_priv *np = netdev_priv(netdev);
				1852	struct i40e_pf *pf = np->vsi->back;
Jesse Brandeburg	a72a5abc	2015-08-26 15:14:19 -0400	[diff] [blame]	1853	i40e_status status;
				1854	bool link_up = false;
Shannon Nelson	7b08639	2013-11-20 10:02:59 +0000	[diff] [blame]	1855
Shannon Nelson	b03aaa9	2013-11-20 10:03:06 +0000	[diff] [blame]	1856	netif_info(pf, hw, netdev, "link test\n");
Jesse Brandeburg	a72a5abc	2015-08-26 15:14:19 -0400	[diff] [blame]	1857	status = i40e_get_link_status(&pf->hw, &link_up);
				1858	if (status) {
				1859	netif_err(pf, drv, netdev, "link query timed out, please retry test\n");
				1860	*data = 1;
				1861	return *data;
				1862	}
				1863
				1864	if (link_up)
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1865	*data = 0;
				1866	else
				1867	*data = 1;
				1868
				1869	return *data;
				1870	}
				1871
Shannon Nelson	7b08639	2013-11-20 10:02:59 +0000	[diff] [blame]	1872	static int i40e_reg_test(struct net_device netdev, u64 data)
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1873	{
Shannon Nelson	7b08639	2013-11-20 10:02:59 +0000	[diff] [blame]	1874	struct i40e_netdev_priv *np = netdev_priv(netdev);
				1875	struct i40e_pf *pf = np->vsi->back;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1876
Shannon Nelson	b03aaa9	2013-11-20 10:03:06 +0000	[diff] [blame]	1877	netif_info(pf, hw, netdev, "register test\n");
Shannon Nelson	7b08639	2013-11-20 10:02:59 +0000	[diff] [blame]	1878	*data = i40e_diag_reg_test(&pf->hw);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1879
Shannon Nelson	7b08639	2013-11-20 10:02:59 +0000	[diff] [blame]	1880	return *data;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1881	}
				1882
Shannon Nelson	7b08639	2013-11-20 10:02:59 +0000	[diff] [blame]	1883	static int i40e_eeprom_test(struct net_device netdev, u64 data)
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1884	{
Shannon Nelson	7b08639	2013-11-20 10:02:59 +0000	[diff] [blame]	1885	struct i40e_netdev_priv *np = netdev_priv(netdev);
				1886	struct i40e_pf *pf = np->vsi->back;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1887
Shannon Nelson	b03aaa9	2013-11-20 10:03:06 +0000	[diff] [blame]	1888	netif_info(pf, hw, netdev, "eeprom test\n");
Shannon Nelson	7b08639	2013-11-20 10:02:59 +0000	[diff] [blame]	1889	*data = i40e_diag_eeprom_test(&pf->hw);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1890
Shannon Nelson	4443ec9	2014-11-13 08:23:12 +0000	[diff] [blame]	1891	/* forcebly clear the NVM Update state machine */
				1892	pf->hw.nvmupd_state = I40E_NVMUPD_STATE_INIT;
				1893
Shannon Nelson	7b08639	2013-11-20 10:02:59 +0000	[diff] [blame]	1894	return *data;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1895	}
				1896
Shannon Nelson	7b08639	2013-11-20 10:02:59 +0000	[diff] [blame]	1897	static int i40e_intr_test(struct net_device netdev, u64 data)
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1898	{
Shannon Nelson	7b08639	2013-11-20 10:02:59 +0000	[diff] [blame]	1899	struct i40e_netdev_priv *np = netdev_priv(netdev);
				1900	struct i40e_pf *pf = np->vsi->back;
Shannon Nelson	cd92e72	2013-11-16 10:00:44 +0000	[diff] [blame]	1901	u16 swc_old = pf->sw_int_count;
				1902
Shannon Nelson	b03aaa9	2013-11-20 10:03:06 +0000	[diff] [blame]	1903	netif_info(pf, hw, netdev, "interrupt test\n");
Shannon Nelson	cd92e72	2013-11-16 10:00:44 +0000	[diff] [blame]	1904	wr32(&pf->hw, I40E_PFINT_DYN_CTL0,
				1905	(I40E_PFINT_DYN_CTL0_INTENA_MASK \|
Shannon Nelson	5d1ff106	2014-11-11 20:04:35 +0000	[diff] [blame]	1906	I40E_PFINT_DYN_CTL0_SWINT_TRIG_MASK \|
				1907	I40E_PFINT_DYN_CTL0_ITR_INDX_MASK \|
				1908	I40E_PFINT_DYN_CTL0_SW_ITR_INDX_ENA_MASK \|
				1909	I40E_PFINT_DYN_CTL0_SW_ITR_INDX_MASK));
Shannon Nelson	cd92e72	2013-11-16 10:00:44 +0000	[diff] [blame]	1910	usleep_range(1000, 2000);
				1911	*data = (swc_old == pf->sw_int_count);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1912
				1913	return *data;
				1914	}
				1915
Greg Rose	e17bc41	2015-04-16 20:05:59 -0400	[diff] [blame]	1916	static inline bool i40e_active_vfs(struct i40e_pf *pf)
				1917	{
				1918	struct i40e_vf *vfs = pf->vf;
				1919	int i;
				1920
				1921	for (i = 0; i < pf->num_alloc_vfs; i++)
Jacob Keller	6322e63	2017-04-13 04:45:54 -0400	[diff] [blame]	1922	if (test_bit(I40E_VF_STATE_ACTIVE, &vfs[i].vf_states))
Greg Rose	e17bc41	2015-04-16 20:05:59 -0400	[diff] [blame]	1923	return true;
				1924	return false;
				1925	}
				1926
Greg Rose	510efb2	2015-07-10 19:36:01 -0400	[diff] [blame]	1927	static inline bool i40e_active_vmdqs(struct i40e_pf *pf)
				1928	{
Alexander Duyck	4b81644	2016-10-11 15:26:53 -0700	[diff] [blame]	1929	return !!i40e_find_vsi_by_type(pf, I40E_VSI_VMDQ2);
Greg Rose	510efb2	2015-07-10 19:36:01 -0400	[diff] [blame]	1930	}
				1931
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1932	static void i40e_diag_test(struct net_device *netdev,
				1933	struct ethtool_test eth_test, u64 data)
				1934	{
				1935	struct i40e_netdev_priv *np = netdev_priv(netdev);
Greg Rose	5b86c5c	2015-02-26 16:14:35 +0000	[diff] [blame]	1936	bool if_running = netif_running(netdev);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1937	struct i40e_pf *pf = np->vsi->back;
				1938
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1939	if (eth_test->flags == ETH_TEST_FL_OFFLINE) {
				1940	/* Offline tests */
Shannon Nelson	b03aaa9	2013-11-20 10:03:06 +0000	[diff] [blame]	1941	netif_info(pf, drv, netdev, "offline testing starting\n");
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1942
Jacob Keller	0da36b9	2017-04-19 09:25:55 -0400	[diff] [blame]	1943	set_bit(__I40E_TESTING, pf->state);
Greg Rose	e17bc41	2015-04-16 20:05:59 -0400	[diff] [blame]	1944
Greg Rose	510efb2	2015-07-10 19:36:01 -0400	[diff] [blame]	1945	if (i40e_active_vfs(pf) \|\| i40e_active_vmdqs(pf)) {
Greg Rose	e17bc41	2015-04-16 20:05:59 -0400	[diff] [blame]	1946	dev_warn(&pf->pdev->dev,
Greg Rose	510efb2	2015-07-10 19:36:01 -0400	[diff] [blame]	1947	"Please take active VFs and Netqueues offline and restart the adapter before running NIC diagnostics\n");
Greg Rose	e17bc41	2015-04-16 20:05:59 -0400	[diff] [blame]	1948	data[I40E_ETH_TEST_REG] = 1;
				1949	data[I40E_ETH_TEST_EEPROM] = 1;
				1950	data[I40E_ETH_TEST_INTR] = 1;
Greg Rose	e17bc41	2015-04-16 20:05:59 -0400	[diff] [blame]	1951	data[I40E_ETH_TEST_LINK] = 1;
				1952	eth_test->flags \|= ETH_TEST_FL_FAILED;
Jacob Keller	0da36b9	2017-04-19 09:25:55 -0400	[diff] [blame]	1953	clear_bit(__I40E_TESTING, pf->state);
Greg Rose	e17bc41	2015-04-16 20:05:59 -0400	[diff] [blame]	1954	goto skip_ol_tests;
				1955	}
				1956
Greg Rose	5b86c5c	2015-02-26 16:14:35 +0000	[diff] [blame]	1957	/* If the device is online then take it offline */
				1958	if (if_running)
				1959	/* indicate we're in test mode */
Stefan Assmann	08ca387	2016-02-03 09:20:47 +0100	[diff] [blame]	1960	i40e_close(netdev);
Greg Rose	5b86c5c	2015-02-26 16:14:35 +0000	[diff] [blame]	1961	else
Greg Rose	b4e53f0	2015-07-10 19:36:03 -0400	[diff] [blame]	1962	/* This reset does not affect link - if it is
				1963	* changed to a type of reset that does affect
				1964	* link then the following link test would have
				1965	* to be moved to before the reset
				1966	*/
Maciej Sosin	373149f	2017-04-05 07:50:55 -0400	[diff] [blame]	1967	i40e_do_reset(pf, BIT(__I40E_PF_RESET_REQUESTED), true);
Shannon Nelson	f551b43	2013-11-26 10:49:12 +0000	[diff] [blame]	1968
Shannon Nelson	7b08639	2013-11-20 10:02:59 +0000	[diff] [blame]	1969	if (i40e_link_test(netdev, &data[I40E_ETH_TEST_LINK]))
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1970	eth_test->flags \|= ETH_TEST_FL_FAILED;
				1971
Shannon Nelson	7b08639	2013-11-20 10:02:59 +0000	[diff] [blame]	1972	if (i40e_eeprom_test(netdev, &data[I40E_ETH_TEST_EEPROM]))
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1973	eth_test->flags \|= ETH_TEST_FL_FAILED;
				1974
Shannon Nelson	7b08639	2013-11-20 10:02:59 +0000	[diff] [blame]	1975	if (i40e_intr_test(netdev, &data[I40E_ETH_TEST_INTR]))
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1976	eth_test->flags \|= ETH_TEST_FL_FAILED;
				1977
Shannon Nelson	f551b43	2013-11-26 10:49:12 +0000	[diff] [blame]	1978	/* run reg test last, a reset is required after it */
				1979	if (i40e_reg_test(netdev, &data[I40E_ETH_TEST_REG]))
				1980	eth_test->flags \|= ETH_TEST_FL_FAILED;
				1981
Jacob Keller	0da36b9	2017-04-19 09:25:55 -0400	[diff] [blame]	1982	clear_bit(__I40E_TESTING, pf->state);
Maciej Sosin	373149f	2017-04-05 07:50:55 -0400	[diff] [blame]	1983	i40e_do_reset(pf, BIT(__I40E_PF_RESET_REQUESTED), true);
Greg Rose	5b86c5c	2015-02-26 16:14:35 +0000	[diff] [blame]	1984
				1985	if (if_running)
Stefan Assmann	08ca387	2016-02-03 09:20:47 +0100	[diff] [blame]	1986	i40e_open(netdev);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1987	} else {
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1988	/* Online tests */
Shannon Nelson	b03aaa9	2013-11-20 10:03:06 +0000	[diff] [blame]	1989	netif_info(pf, drv, netdev, "online testing starting\n");
				1990
Shannon Nelson	7b08639	2013-11-20 10:02:59 +0000	[diff] [blame]	1991	if (i40e_link_test(netdev, &data[I40E_ETH_TEST_LINK]))
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1992	eth_test->flags \|= ETH_TEST_FL_FAILED;
				1993
				1994	/* Offline only tests, not run in online; pass by default */
				1995	data[I40E_ETH_TEST_REG] = 0;
				1996	data[I40E_ETH_TEST_EEPROM] = 0;
				1997	data[I40E_ETH_TEST_INTR] = 0;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	1998	}
Shannon Nelson	c140c17	2013-11-20 10:02:58 +0000	[diff] [blame]	1999
Greg Rose	e17bc41	2015-04-16 20:05:59 -0400	[diff] [blame]	2000	skip_ol_tests:
				2001
Shannon Nelson	b03aaa9	2013-11-20 10:03:06 +0000	[diff] [blame]	2002	netif_info(pf, drv, netdev, "testing finished\n");
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2003	}
				2004
				2005	static void i40e_get_wol(struct net_device *netdev,
				2006	struct ethtool_wolinfo *wol)
				2007	{
Shannon Nelson	8e2773a	2013-11-28 06:39:22 +0000	[diff] [blame]	2008	struct i40e_netdev_priv *np = netdev_priv(netdev);
				2009	struct i40e_pf *pf = np->vsi->back;
				2010	struct i40e_hw *hw = &pf->hw;
				2011	u16 wol_nvm_bits;
				2012
				2013	/* NVM bit on means WoL disabled for the port */
				2014	i40e_read_nvm_word(hw, I40E_SR_NVM_WAKE_ON_LAN, &wol_nvm_bits);
Jesse Brandeburg	41a1d04	2015-06-04 16:24:02 -0400	[diff] [blame]	2015	if ((BIT(hw->port) & wol_nvm_bits) \|\| (hw->partition_id != 1)) {
Shannon Nelson	8e2773a	2013-11-28 06:39:22 +0000	[diff] [blame]	2016	wol->supported = 0;
				2017	wol->wolopts = 0;
				2018	} else {
				2019	wol->supported = WAKE_MAGIC;
				2020	wol->wolopts = (pf->wol_en ? WAKE_MAGIC : 0);
				2021	}
				2022	}
				2023
Shannon Nelson	f0d8c73	2014-12-11 07:06:32 +0000	[diff] [blame]	2024	/**
				2025	* i40e_set_wol - set the WakeOnLAN configuration
				2026	* @netdev: the netdev in question
				2027	* @wol: the ethtool WoL setting data
				2028	**/
Shannon Nelson	8e2773a	2013-11-28 06:39:22 +0000	[diff] [blame]	2029	static int i40e_set_wol(struct net_device netdev, struct ethtool_wolinfo wol)
				2030	{
				2031	struct i40e_netdev_priv *np = netdev_priv(netdev);
				2032	struct i40e_pf *pf = np->vsi->back;
Shannon Nelson	f0d8c73	2014-12-11 07:06:32 +0000	[diff] [blame]	2033	struct i40e_vsi *vsi = np->vsi;
Shannon Nelson	8e2773a	2013-11-28 06:39:22 +0000	[diff] [blame]	2034	struct i40e_hw *hw = &pf->hw;
				2035	u16 wol_nvm_bits;
				2036
Shannon Nelson	f0d8c73	2014-12-11 07:06:32 +0000	[diff] [blame]	2037	/* WoL not supported if this isn't the controlling PF on the port */
				2038	if (hw->partition_id != 1) {
				2039	i40e_partition_setting_complaint(pf);
				2040	return -EOPNOTSUPP;
				2041	}
				2042
				2043	if (vsi != pf->vsi[pf->lan_vsi])
				2044	return -EOPNOTSUPP;
				2045
Shannon Nelson	8e2773a	2013-11-28 06:39:22 +0000	[diff] [blame]	2046	/* NVM bit on means WoL disabled for the port */
				2047	i40e_read_nvm_word(hw, I40E_SR_NVM_WAKE_ON_LAN, &wol_nvm_bits);
Jesse Brandeburg	41a1d04	2015-06-04 16:24:02 -0400	[diff] [blame]	2048	if (BIT(hw->port) & wol_nvm_bits)
Shannon Nelson	8e2773a	2013-11-28 06:39:22 +0000	[diff] [blame]	2049	return -EOPNOTSUPP;
				2050
				2051	/* only magic packet is supported */
				2052	if (wol->wolopts && (wol->wolopts != WAKE_MAGIC))
				2053	return -EOPNOTSUPP;
				2054
				2055	/* is this a new value? */
				2056	if (pf->wol_en != !!wol->wolopts) {
				2057	pf->wol_en = !!wol->wolopts;
				2058	device_set_wakeup_enable(&pf->pdev->dev, pf->wol_en);
				2059	}
				2060
				2061	return 0;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2062	}
				2063
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2064	static int i40e_set_phys_id(struct net_device *netdev,
				2065	enum ethtool_phys_id_state state)
				2066	{
				2067	struct i40e_netdev_priv *np = netdev_priv(netdev);
Carolyn Wyborny	31b606d	2016-02-17 16:12:12 -0800	[diff] [blame]	2068	i40e_status ret = 0;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2069	struct i40e_pf *pf = np->vsi->back;
				2070	struct i40e_hw *hw = &pf->hw;
				2071	int blink_freq = 2;
Carolyn Wyborny	31b606d	2016-02-17 16:12:12 -0800	[diff] [blame]	2072	u16 temp_status;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2073
				2074	switch (state) {
				2075	case ETHTOOL_ID_ACTIVE:
Jacob Keller	d36e41d	2017-06-23 04:24:46 -0400	[diff] [blame]	2076	if (!(pf->hw_features & I40E_HW_PHY_CONTROLS_LEDS)) {
Carolyn Wyborny	31b606d	2016-02-17 16:12:12 -0800	[diff] [blame]	2077	pf->led_status = i40e_led_get(hw);
				2078	} else {
Mariusz Stachura	052b93d	2017-08-29 05:32:40 -0400	[diff] [blame]	2079	if (!(hw->flags & I40E_HW_FLAG_AQ_PHY_ACCESS_CAPABLE))
				2080	i40e_aq_set_phy_debug(hw, I40E_PHY_DEBUG_ALL,
				2081	NULL);
Carolyn Wyborny	31b606d	2016-02-17 16:12:12 -0800	[diff] [blame]	2082	ret = i40e_led_get_phy(hw, &temp_status,
				2083	&pf->phy_led_val);
				2084	pf->led_status = temp_status;
				2085	}
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2086	return blink_freq;
				2087	case ETHTOOL_ID_ON:
Jacob Keller	d36e41d	2017-06-23 04:24:46 -0400	[diff] [blame]	2088	if (!(pf->hw_features & I40E_HW_PHY_CONTROLS_LEDS))
Carolyn Wyborny	31b606d	2016-02-17 16:12:12 -0800	[diff] [blame]	2089	i40e_led_set(hw, 0xf, false);
				2090	else
				2091	ret = i40e_led_set_phy(hw, true, pf->led_status, 0);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2092	break;
				2093	case ETHTOOL_ID_OFF:
Jacob Keller	d36e41d	2017-06-23 04:24:46 -0400	[diff] [blame]	2094	if (!(pf->hw_features & I40E_HW_PHY_CONTROLS_LEDS))
Carolyn Wyborny	31b606d	2016-02-17 16:12:12 -0800	[diff] [blame]	2095	i40e_led_set(hw, 0x0, false);
				2096	else
				2097	ret = i40e_led_set_phy(hw, false, pf->led_status, 0);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2098	break;
				2099	case ETHTOOL_ID_INACTIVE:
Jacob Keller	d36e41d	2017-06-23 04:24:46 -0400	[diff] [blame]	2100	if (!(pf->hw_features & I40E_HW_PHY_CONTROLS_LEDS)) {
Henry Tieman	4f9b430	2016-11-08 13:05:18 -0800	[diff] [blame]	2101	i40e_led_set(hw, pf->led_status, false);
Carolyn Wyborny	31b606d	2016-02-17 16:12:12 -0800	[diff] [blame]	2102	} else {
				2103	ret = i40e_led_set_phy(hw, false, pf->led_status,
				2104	(pf->phy_led_val \|
				2105	I40E_PHY_LED_MODE_ORIG));
Mariusz Stachura	052b93d	2017-08-29 05:32:40 -0400	[diff] [blame]	2106	if (!(hw->flags & I40E_HW_FLAG_AQ_PHY_ACCESS_CAPABLE))
				2107	i40e_aq_set_phy_debug(hw, 0, NULL);
Carolyn Wyborny	31b606d	2016-02-17 16:12:12 -0800	[diff] [blame]	2108	}
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2109	break;
Akeem G Abodunrin	579b23d	2015-02-24 06:58:42 +0000	[diff] [blame]	2110	default:
				2111	break;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2112	}
Carolyn Wyborny	31b606d	2016-02-17 16:12:12 -0800	[diff] [blame]	2113	if (ret)
				2114	return -ENOENT;
				2115	else
				2116	return 0;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2117	}
				2118
				2119	/* NOTE: i40e hardware uses a conversion factor of 2 for Interrupt
				2120	* Throttle Rate (ITR) ie. ITR(1) = 2us ITR(10) = 20 us, and also
				2121	* 125us (8000 interrupts per second) == ITR(62)
				2122	*/
				2123
Jacob Keller	65e87c0	2016-09-12 14:18:44 -0700	[diff] [blame]	2124	/**
				2125	* __i40e_get_coalesce - get per-queue coalesce settings
				2126	* @netdev: the netdev to check
				2127	* @ec: ethtool coalesce data structure
				2128	* @queue: which queue to pick
				2129	*
				2130	* Gets the per-queue settings for coalescence. Specifically Rx and Tx usecs
				2131	* are per queue. If queue is <0 then we default to queue 0 as the
				2132	* representative value.
				2133	**/
Kan Liang	a75e800	2016-02-19 09:24:04 -0500	[diff] [blame]	2134	static int __i40e_get_coalesce(struct net_device *netdev,
				2135	struct ethtool_coalesce *ec,
				2136	int queue)
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2137	{
				2138	struct i40e_netdev_priv *np = netdev_priv(netdev);
Jacob Keller	65e87c0	2016-09-12 14:18:44 -0700	[diff] [blame]	2139	struct i40e_ring rx_ring, tx_ring;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2140	struct i40e_vsi *vsi = np->vsi;
				2141
				2142	ec->tx_max_coalesced_frames_irq = vsi->work_limit;
				2143	ec->rx_max_coalesced_frames_irq = vsi->work_limit;
				2144
Alan Brady	a03af69	2017-10-05 14:53:37 -0700	[diff] [blame]	2145	/* rx and tx usecs has per queue value. If user doesn't specify the
				2146	* queue, return queue 0's value to represent.
Kan Liang	a75e800	2016-02-19 09:24:04 -0500	[diff] [blame]	2147	*/
Alan Brady	a03af69	2017-10-05 14:53:37 -0700	[diff] [blame]	2148	if (queue < 0)
Kan Liang	a75e800	2016-02-19 09:24:04 -0500	[diff] [blame]	2149	queue = 0;
Alan Brady	a03af69	2017-10-05 14:53:37 -0700	[diff] [blame]	2150	else if (queue >= vsi->num_queue_pairs)
Kan Liang	a75e800	2016-02-19 09:24:04 -0500	[diff] [blame]	2151	return -EINVAL;
Kan Liang	a75e800	2016-02-19 09:24:04 -0500	[diff] [blame]	2152
Jacob Keller	65e87c0	2016-09-12 14:18:44 -0700	[diff] [blame]	2153	rx_ring = vsi->rx_rings[queue];
				2154	tx_ring = vsi->tx_rings[queue];
				2155
				2156	if (ITR_IS_DYNAMIC(rx_ring->rx_itr_setting))
Mitch Williams	32f5f54	2014-04-04 04:43:10 +0000	[diff] [blame]	2157	ec->use_adaptive_rx_coalesce = 1;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2158
Jacob Keller	65e87c0	2016-09-12 14:18:44 -0700	[diff] [blame]	2159	if (ITR_IS_DYNAMIC(tx_ring->tx_itr_setting))
Mitch Williams	32f5f54	2014-04-04 04:43:10 +0000	[diff] [blame]	2160	ec->use_adaptive_tx_coalesce = 1;
				2161
Jacob Keller	65e87c0	2016-09-12 14:18:44 -0700	[diff] [blame]	2162	ec->rx_coalesce_usecs = rx_ring->rx_itr_setting & ~I40E_ITR_DYNAMIC;
				2163	ec->tx_coalesce_usecs = tx_ring->tx_itr_setting & ~I40E_ITR_DYNAMIC;
				2164
Jesse Brandeburg	ac26fc1	2015-09-28 14:12:37 -0400	[diff] [blame]	2165	/* we use the _usecs_high to store/set the interrupt rate limit
				2166	* that the hardware supports, that almost but not quite
				2167	* fits the original intent of the ethtool variable,
				2168	* the rx_coalesce_usecs_high limits total interrupts
				2169	* per second from both tx/rx sources.
				2170	*/
				2171	ec->rx_coalesce_usecs_high = vsi->int_rate_limit;
				2172	ec->tx_coalesce_usecs_high = vsi->int_rate_limit;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2173
				2174	return 0;
				2175	}
				2176
Jacob Keller	65e87c0	2016-09-12 14:18:44 -0700	[diff] [blame]	2177	/**
				2178	* i40e_get_coalesce - get a netdev's coalesce settings
				2179	* @netdev: the netdev to check
				2180	* @ec: ethtool coalesce data structure
				2181	*
				2182	* Gets the coalesce settings for a particular netdev. Note that if user has
				2183	* modified per-queue settings, this only guarantees to represent queue 0. See
				2184	* __i40e_get_coalesce for more details.
				2185	**/
Kan Liang	a75e800	2016-02-19 09:24:04 -0500	[diff] [blame]	2186	static int i40e_get_coalesce(struct net_device *netdev,
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2187	struct ethtool_coalesce *ec)
				2188	{
Kan Liang	a75e800	2016-02-19 09:24:04 -0500	[diff] [blame]	2189	return __i40e_get_coalesce(netdev, ec, -1);
				2190	}
				2191
Jacob Keller	65e87c0	2016-09-12 14:18:44 -0700	[diff] [blame]	2192	/**
				2193	* i40e_get_per_queue_coalesce - gets coalesce settings for particular queue
				2194	* @netdev: netdev structure
				2195	* @ec: ethtool's coalesce settings
				2196	* @queue: the particular queue to read
				2197	*
				2198	* Will read a specific queue's coalesce settings
				2199	**/
Kan Liang	be280ba	2016-02-19 09:24:05 -0500	[diff] [blame]	2200	static int i40e_get_per_queue_coalesce(struct net_device *netdev, u32 queue,
				2201	struct ethtool_coalesce *ec)
				2202	{
				2203	return __i40e_get_coalesce(netdev, ec, queue);
				2204	}
				2205
Jacob Keller	65e87c0	2016-09-12 14:18:44 -0700	[diff] [blame]	2206	/**
				2207	* i40e_set_itr_per_queue - set ITR values for specific queue
				2208	* @vsi: the VSI to set values for
				2209	* @ec: coalesce settings from ethtool
				2210	* @queue: the queue to modify
				2211	*
				2212	* Change the ITR settings for a specific queue.
				2213	**/
Kan Liang	a75e800	2016-02-19 09:24:04 -0500	[diff] [blame]	2214	static void i40e_set_itr_per_queue(struct i40e_vsi *vsi,
				2215	struct ethtool_coalesce *ec,
				2216	int queue)
				2217	{
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2218	struct i40e_pf *pf = vsi->back;
				2219	struct i40e_hw *hw = &pf->hw;
Kan Liang	a75e800	2016-02-19 09:24:04 -0500	[diff] [blame]	2220	struct i40e_q_vector *q_vector;
				2221	u16 vector, intrl;
				2222
Alan Brady	1c0e6a3	2016-11-28 16:06:02 -0800	[diff] [blame]	2223	intrl = i40e_intrl_usec_to_reg(vsi->int_rate_limit);
Kan Liang	a75e800	2016-02-19 09:24:04 -0500	[diff] [blame]	2224
				2225	vsi->rx_rings[queue]->rx_itr_setting = ec->rx_coalesce_usecs;
				2226	vsi->tx_rings[queue]->tx_itr_setting = ec->tx_coalesce_usecs;
				2227
				2228	if (ec->use_adaptive_rx_coalesce)
				2229	vsi->rx_rings[queue]->rx_itr_setting \|= I40E_ITR_DYNAMIC;
				2230	else
				2231	vsi->rx_rings[queue]->rx_itr_setting &= ~I40E_ITR_DYNAMIC;
				2232
				2233	if (ec->use_adaptive_tx_coalesce)
				2234	vsi->tx_rings[queue]->tx_itr_setting \|= I40E_ITR_DYNAMIC;
				2235	else
				2236	vsi->tx_rings[queue]->tx_itr_setting &= ~I40E_ITR_DYNAMIC;
				2237
				2238	q_vector = vsi->rx_rings[queue]->q_vector;
				2239	q_vector->rx.itr = ITR_TO_REG(vsi->rx_rings[queue]->rx_itr_setting);
				2240	vector = vsi->base_vector + q_vector->v_idx;
				2241	wr32(hw, I40E_PFINT_ITRN(I40E_RX_ITR, vector - 1), q_vector->rx.itr);
				2242
				2243	q_vector = vsi->tx_rings[queue]->q_vector;
				2244	q_vector->tx.itr = ITR_TO_REG(vsi->tx_rings[queue]->tx_itr_setting);
				2245	vector = vsi->base_vector + q_vector->v_idx;
				2246	wr32(hw, I40E_PFINT_ITRN(I40E_TX_ITR, vector - 1), q_vector->tx.itr);
				2247
				2248	wr32(hw, I40E_PFINT_RATEN(vector - 1), intrl);
				2249	i40e_flush(hw);
				2250	}
				2251
Jacob Keller	65e87c0	2016-09-12 14:18:44 -0700	[diff] [blame]	2252	/**
				2253	* __i40e_set_coalesce - set coalesce settings for particular queue
				2254	* @netdev: the netdev to change
				2255	* @ec: ethtool coalesce settings
				2256	* @queue: the queue to change
				2257	*
				2258	* Sets the coalesce settings for a particular queue.
				2259	**/
Kan Liang	a75e800	2016-02-19 09:24:04 -0500	[diff] [blame]	2260	static int __i40e_set_coalesce(struct net_device *netdev,
				2261	struct ethtool_coalesce *ec,
				2262	int queue)
				2263	{
				2264	struct i40e_netdev_priv *np = netdev_priv(netdev);
Alan Brady	06b2dec	2017-07-12 05:46:06 -0400	[diff] [blame]	2265	u16 intrl_reg, cur_rx_itr, cur_tx_itr;
Kan Liang	a75e800	2016-02-19 09:24:04 -0500	[diff] [blame]	2266	struct i40e_vsi *vsi = np->vsi;
				2267	struct i40e_pf *pf = vsi->back;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2268	int i;
				2269
				2270	if (ec->tx_max_coalesced_frames_irq \|\| ec->rx_max_coalesced_frames_irq)
				2271	vsi->work_limit = ec->tx_max_coalesced_frames_irq;
				2272
Alan Brady	06b2dec	2017-07-12 05:46:06 -0400	[diff] [blame]	2273	if (queue < 0) {
				2274	cur_rx_itr = vsi->rx_rings[0]->rx_itr_setting;
				2275	cur_tx_itr = vsi->tx_rings[0]->tx_itr_setting;
				2276	} else if (queue < vsi->num_queue_pairs) {
				2277	cur_rx_itr = vsi->rx_rings[queue]->rx_itr_setting;
				2278	cur_tx_itr = vsi->tx_rings[queue]->tx_itr_setting;
				2279	} else {
				2280	netif_info(pf, drv, netdev, "Invalid queue value, queue range is 0 - %d\n",
				2281	vsi->num_queue_pairs - 1);
				2282	return -EINVAL;
				2283	}
				2284
				2285	cur_tx_itr &= ~I40E_ITR_DYNAMIC;
				2286	cur_rx_itr &= ~I40E_ITR_DYNAMIC;
				2287
Jesse Brandeburg	ac26fc1	2015-09-28 14:12:37 -0400	[diff] [blame]	2288	/* tx_coalesce_usecs_high is ignored, use rx-usecs-high instead */
				2289	if (ec->tx_coalesce_usecs_high != vsi->int_rate_limit) {
				2290	netif_info(pf, drv, netdev, "tx-usecs-high is not used, please program rx-usecs-high\n");
				2291	return -EINVAL;
				2292	}
				2293
Alan Brady	3308406	2016-11-28 16:06:03 -0800	[diff] [blame]	2294	if (ec->rx_coalesce_usecs_high > INTRL_REG_TO_USEC(I40E_MAX_INTRL)) {
				2295	netif_info(pf, drv, netdev, "Invalid value, rx-usecs-high range is 0-%lu\n",
				2296	INTRL_REG_TO_USEC(I40E_MAX_INTRL));
Jesse Brandeburg	ac26fc1	2015-09-28 14:12:37 -0400	[diff] [blame]	2297	return -EINVAL;
				2298	}
				2299
Alan Brady	06b2dec	2017-07-12 05:46:06 -0400	[diff] [blame]	2300	if (ec->rx_coalesce_usecs != cur_rx_itr &&
				2301	ec->use_adaptive_rx_coalesce) {
				2302	netif_info(pf, drv, netdev, "RX interrupt moderation cannot be changed if adaptive-rx is enabled.\n");
				2303	return -EINVAL;
Carolyn Wyborny	5c2cebd	2014-06-04 01:23:18 +0000	[diff] [blame]	2304	}
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2305
Alan Brady	06b2dec	2017-07-12 05:46:06 -0400	[diff] [blame]	2306	if (ec->rx_coalesce_usecs > (I40E_MAX_ITR << 1)) {
				2307	netif_info(pf, drv, netdev, "Invalid value, rx-usecs range is 0-8160\n");
				2308	return -EINVAL;
				2309	}
				2310
				2311	if (ec->tx_coalesce_usecs != cur_tx_itr &&
				2312	ec->use_adaptive_tx_coalesce) {
				2313	netif_info(pf, drv, netdev, "TX interrupt moderation cannot be changed if adaptive-tx is enabled.\n");
				2314	return -EINVAL;
				2315	}
				2316
				2317	if (ec->tx_coalesce_usecs > (I40E_MAX_ITR << 1)) {
				2318	netif_info(pf, drv, netdev, "Invalid value, tx-usecs range is 0-8160\n");
				2319	return -EINVAL;
				2320	}
				2321
				2322	if (ec->use_adaptive_rx_coalesce && !cur_rx_itr)
				2323	ec->rx_coalesce_usecs = I40E_MIN_ITR << 1;
				2324
				2325	if (ec->use_adaptive_tx_coalesce && !cur_tx_itr)
				2326	ec->tx_coalesce_usecs = I40E_MIN_ITR << 1;
				2327
Alan Brady	3308406	2016-11-28 16:06:03 -0800	[diff] [blame]	2328	intrl_reg = i40e_intrl_usec_to_reg(ec->rx_coalesce_usecs_high);
				2329	vsi->int_rate_limit = INTRL_REG_TO_USEC(intrl_reg);
				2330	if (vsi->int_rate_limit != ec->rx_coalesce_usecs_high) {
				2331	netif_info(pf, drv, netdev, "Interrupt rate limit rounded down to %d\n",
				2332	vsi->int_rate_limit);
				2333	}
Jesse Brandeburg	ac26fc1	2015-09-28 14:12:37 -0400	[diff] [blame]	2334
Alan Brady	a03af69	2017-10-05 14:53:37 -0700	[diff] [blame]	2335	/* rx and tx usecs has per queue value. If user doesn't specify the
				2336	* queue, apply to all queues.
Kan Liang	a75e800	2016-02-19 09:24:04 -0500	[diff] [blame]	2337	*/
				2338	if (queue < 0) {
				2339	for (i = 0; i < vsi->num_queue_pairs; i++)
				2340	i40e_set_itr_per_queue(vsi, ec, i);
Carolyn Wyborny	5c2cebd	2014-06-04 01:23:18 +0000	[diff] [blame]	2341	} else {
Alan Brady	06b2dec	2017-07-12 05:46:06 -0400	[diff] [blame]	2342	i40e_set_itr_per_queue(vsi, ec, queue);
Carolyn Wyborny	5c2cebd	2014-06-04 01:23:18 +0000	[diff] [blame]	2343	}
Mitch Williams	32f5f54	2014-04-04 04:43:10 +0000	[diff] [blame]	2344
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2345	return 0;
				2346	}
				2347
Jacob Keller	65e87c0	2016-09-12 14:18:44 -0700	[diff] [blame]	2348	/**
				2349	* i40e_set_coalesce - set coalesce settings for every queue on the netdev
				2350	* @netdev: the netdev to change
				2351	* @ec: ethtool coalesce settings
				2352	*
				2353	* This will set each queue to the same coalesce settings.
				2354	**/
Kan Liang	a75e800	2016-02-19 09:24:04 -0500	[diff] [blame]	2355	static int i40e_set_coalesce(struct net_device *netdev,
				2356	struct ethtool_coalesce *ec)
				2357	{
				2358	return __i40e_set_coalesce(netdev, ec, -1);
				2359	}
				2360
Jacob Keller	65e87c0	2016-09-12 14:18:44 -0700	[diff] [blame]	2361	/**
				2362	* i40e_set_per_queue_coalesce - set specific queue's coalesce settings
				2363	* @netdev: the netdev to change
				2364	* @ec: ethtool's coalesce settings
				2365	* @queue: the queue to change
				2366	*
				2367	* Sets the specified queue's coalesce settings.
				2368	**/
Kan Liang	f3757a4	2016-02-19 09:24:06 -0500	[diff] [blame]	2369	static int i40e_set_per_queue_coalesce(struct net_device *netdev, u32 queue,
				2370	struct ethtool_coalesce *ec)
				2371	{
				2372	return __i40e_set_coalesce(netdev, ec, queue);
				2373	}
				2374
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2375	/**
				2376	* i40e_get_rss_hash_opts - Get RSS hash Input Set for each flow type
				2377	* @pf: pointer to the physical function struct
				2378	* @cmd: ethtool rxnfc command
				2379	*
				2380	* Returns Success if the flow is supported, else Invalid Input.
				2381	**/
				2382	static int i40e_get_rss_hash_opts(struct i40e_pf pf, struct ethtool_rxnfc cmd)
				2383	{
Carolyn Wyborny	eb0dd6e	2016-07-27 12:02:40 -0700	[diff] [blame]	2384	struct i40e_hw *hw = &pf->hw;
				2385	u8 flow_pctype = 0;
				2386	u64 i_set = 0;
				2387
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2388	cmd->data = 0;
				2389
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2390	switch (cmd->flow_type) {
				2391	case TCP_V4_FLOW:
Carolyn Wyborny	eb0dd6e	2016-07-27 12:02:40 -0700	[diff] [blame]	2392	flow_pctype = I40E_FILTER_PCTYPE_NONF_IPV4_TCP;
				2393	break;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2394	case UDP_V4_FLOW:
Carolyn Wyborny	eb0dd6e	2016-07-27 12:02:40 -0700	[diff] [blame]	2395	flow_pctype = I40E_FILTER_PCTYPE_NONF_IPV4_UDP;
				2396	break;
				2397	case TCP_V6_FLOW:
				2398	flow_pctype = I40E_FILTER_PCTYPE_NONF_IPV6_TCP;
				2399	break;
				2400	case UDP_V6_FLOW:
				2401	flow_pctype = I40E_FILTER_PCTYPE_NONF_IPV6_UDP;
				2402	break;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2403	case SCTP_V4_FLOW:
				2404	case AH_ESP_V4_FLOW:
				2405	case AH_V4_FLOW:
				2406	case ESP_V4_FLOW:
				2407	case IPV4_FLOW:
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2408	case SCTP_V6_FLOW:
				2409	case AH_ESP_V6_FLOW:
				2410	case AH_V6_FLOW:
				2411	case ESP_V6_FLOW:
				2412	case IPV6_FLOW:
Carolyn Wyborny	eb0dd6e	2016-07-27 12:02:40 -0700	[diff] [blame]	2413	/* Default is src/dest for IP, no matter the L4 hashing */
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2414	cmd->data \|= RXH_IP_SRC \| RXH_IP_DST;
				2415	break;
				2416	default:
				2417	return -EINVAL;
				2418	}
				2419
Carolyn Wyborny	eb0dd6e	2016-07-27 12:02:40 -0700	[diff] [blame]	2420	/* Read flow based hash input set register */
				2421	if (flow_pctype) {
				2422	i_set = (u64)i40e_read_rx_ctl(hw, I40E_GLQF_HASH_INSET(0,
				2423	flow_pctype)) \|
				2424	((u64)i40e_read_rx_ctl(hw, I40E_GLQF_HASH_INSET(1,
				2425	flow_pctype)) << 32);
				2426	}
				2427
				2428	/* Process bits of hash input set */
				2429	if (i_set) {
				2430	if (i_set & I40E_L4_SRC_MASK)
				2431	cmd->data \|= RXH_L4_B_0_1;
				2432	if (i_set & I40E_L4_DST_MASK)
				2433	cmd->data \|= RXH_L4_B_2_3;
				2434
				2435	if (cmd->flow_type == TCP_V4_FLOW \|\|
				2436	cmd->flow_type == UDP_V4_FLOW) {
				2437	if (i_set & I40E_L3_SRC_MASK)
				2438	cmd->data \|= RXH_IP_SRC;
				2439	if (i_set & I40E_L3_DST_MASK)
				2440	cmd->data \|= RXH_IP_DST;
				2441	} else if (cmd->flow_type == TCP_V6_FLOW \|\|
				2442	cmd->flow_type == UDP_V6_FLOW) {
				2443	if (i_set & I40E_L3_V6_SRC_MASK)
				2444	cmd->data \|= RXH_IP_SRC;
				2445	if (i_set & I40E_L3_V6_DST_MASK)
				2446	cmd->data \|= RXH_IP_DST;
				2447	}
				2448	}
				2449
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2450	return 0;
				2451	}
				2452
				2453	/**
Jacob Keller	e793095	2017-02-06 14:38:49 -0800	[diff] [blame]	2454	* i40e_check_mask - Check whether a mask field is set
				2455	* @mask: the full mask value
				2456	* @field; mask of the field to check
				2457	*
				2458	* If the given mask is fully set, return positive value. If the mask for the
				2459	* field is fully unset, return zero. Otherwise return a negative error code.
				2460	**/
				2461	static int i40e_check_mask(u64 mask, u64 field)
				2462	{
				2463	u64 value = mask & field;
				2464
				2465	if (value == field)
				2466	return 1;
				2467	else if (!value)
				2468	return 0;
				2469	else
				2470	return -1;
				2471	}
				2472
				2473	/**
				2474	* i40e_parse_rx_flow_user_data - Deconstruct user-defined data
				2475	* @fsp: pointer to rx flow specification
				2476	* @data: pointer to userdef data structure for storage
				2477	*
				2478	* Read the user-defined data and deconstruct the value into a structure. No
				2479	* other code should read the user-defined data, so as to ensure that every
				2480	* place consistently reads the value correctly.
				2481	*
				2482	* The user-defined field is a 64bit Big Endian format value, which we
				2483	* deconstruct by reading bits or bit fields from it. Single bit flags shall
				2484	* be defined starting from the highest bits, while small bit field values
				2485	* shall be defined starting from the lowest bits.
				2486	*
				2487	* Returns 0 if the data is valid, and non-zero if the userdef data is invalid
				2488	* and the filter should be rejected. The data structure will always be
				2489	* modified even if FLOW_EXT is not set.
				2490	*
				2491	**/
				2492	static int i40e_parse_rx_flow_user_data(struct ethtool_rx_flow_spec *fsp,
				2493	struct i40e_rx_flow_userdef *data)
				2494	{
				2495	u64 value, mask;
				2496	int valid;
				2497
				2498	/* Zero memory first so it's always consistent. */
				2499	memset(data, 0, sizeof(*data));
				2500
				2501	if (!(fsp->flow_type & FLOW_EXT))
				2502	return 0;
				2503
				2504	value = be64_to_cpu(((__be64 )fsp->h_ext.data));
				2505	mask = be64_to_cpu(((__be64 )fsp->m_ext.data));
				2506
				2507	#define I40E_USERDEF_FLEX_WORD GENMASK_ULL(15, 0)
				2508	#define I40E_USERDEF_FLEX_OFFSET GENMASK_ULL(31, 16)
				2509	#define I40E_USERDEF_FLEX_FILTER GENMASK_ULL(31, 0)
				2510
				2511	valid = i40e_check_mask(mask, I40E_USERDEF_FLEX_FILTER);
				2512	if (valid < 0) {
				2513	return -EINVAL;
				2514	} else if (valid) {
				2515	data->flex_word = value & I40E_USERDEF_FLEX_WORD;
				2516	data->flex_offset =
				2517	(value & I40E_USERDEF_FLEX_OFFSET) >> 16;
				2518	data->flex_filter = true;
				2519	}
				2520
				2521	return 0;
				2522	}
				2523
				2524	/**
				2525	* i40e_fill_rx_flow_user_data - Fill in user-defined data field
				2526	* @fsp: pointer to rx_flow specification
				2527	*
				2528	* Reads the userdef data structure and properly fills in the user defined
				2529	* fields of the rx_flow_spec.
				2530	**/
				2531	static void i40e_fill_rx_flow_user_data(struct ethtool_rx_flow_spec *fsp,
				2532	struct i40e_rx_flow_userdef *data)
				2533	{
				2534	u64 value = 0, mask = 0;
				2535
				2536	if (data->flex_filter) {
				2537	value \|= data->flex_word;
				2538	value \|= (u64)data->flex_offset << 16;
				2539	mask \|= I40E_USERDEF_FLEX_FILTER;
				2540	}
				2541
				2542	if (value \|\| mask)
				2543	fsp->flow_type \|= FLOW_EXT;
				2544
				2545	((__be64 )fsp->h_ext.data) = cpu_to_be64(value);
				2546	((__be64 )fsp->m_ext.data) = cpu_to_be64(mask);
				2547	}
				2548
				2549	/**
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	2550	* i40e_get_ethtool_fdir_all - Populates the rule count of a command
				2551	* @pf: Pointer to the physical function struct
				2552	* @cmd: The command to get or set Rx flow classification rules
				2553	* @rule_locs: Array of used rule locations
				2554	*
				2555	* This function populates both the total and actual rule count of
				2556	* the ethtool flow classification command
				2557	*
				2558	* Returns 0 on success or -EMSGSIZE if entry not found
				2559	**/
				2560	static int i40e_get_ethtool_fdir_all(struct i40e_pf *pf,
				2561	struct ethtool_rxnfc *cmd,
				2562	u32 *rule_locs)
				2563	{
				2564	struct i40e_fdir_filter *rule;
				2565	struct hlist_node *node2;
				2566	int cnt = 0;
				2567
				2568	/* report total rule count */
Anjali Singhai Jain	082def1	2014-04-09 05:59:00 +0000	[diff] [blame]	2569	cmd->data = i40e_get_fd_cnt_all(pf);
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	2570
				2571	hlist_for_each_entry_safe(rule, node2,
				2572	&pf->fdir_filter_list, fdir_node) {
				2573	if (cnt == cmd->rule_cnt)
				2574	return -EMSGSIZE;
				2575
				2576	rule_locs[cnt] = rule->fd_id;
				2577	cnt++;
				2578	}
				2579
				2580	cmd->rule_cnt = cnt;
				2581
				2582	return 0;
				2583	}
				2584
				2585	/**
				2586	* i40e_get_ethtool_fdir_entry - Look up a filter based on Rx flow
				2587	* @pf: Pointer to the physical function struct
				2588	* @cmd: The command to get or set Rx flow classification rules
				2589	*
				2590	* This function looks up a filter based on the Rx flow classification
				2591	* command and fills the flow spec info for it if found
				2592	*
				2593	* Returns 0 on success or -EINVAL if filter not found
				2594	**/
				2595	static int i40e_get_ethtool_fdir_entry(struct i40e_pf *pf,
				2596	struct ethtool_rxnfc *cmd)
				2597	{
				2598	struct ethtool_rx_flow_spec *fsp =
				2599	(struct ethtool_rx_flow_spec *)&cmd->fs;
Jacob Keller	e793095	2017-02-06 14:38:49 -0800	[diff] [blame]	2600	struct i40e_rx_flow_userdef userdef = {0};
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	2601	struct i40e_fdir_filter *rule = NULL;
				2602	struct hlist_node *node2;
Jacob Keller	36777d9	2017-03-07 15:05:23 -0800	[diff] [blame]	2603	u64 input_set;
				2604	u16 index;
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	2605
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	2606	hlist_for_each_entry_safe(rule, node2,
				2607	&pf->fdir_filter_list, fdir_node) {
				2608	if (fsp->location <= rule->fd_id)
				2609	break;
				2610	}
				2611
				2612	if (!rule \|\| fsp->location != rule->fd_id)
				2613	return -EINVAL;
				2614
				2615	fsp->flow_type = rule->flow_type;
Anjali Singhai Jain	7d54eb2	2014-03-14 07:32:21 +0000	[diff] [blame]	2616	if (fsp->flow_type == IP_USER_FLOW) {
				2617	fsp->h_u.usr_ip4_spec.ip_ver = ETH_RX_NFC_IP4;
				2618	fsp->h_u.usr_ip4_spec.proto = 0;
				2619	fsp->m_u.usr_ip4_spec.proto = 0;
				2620	}
				2621
Anjali Singhai Jain	04b73bd	2014-05-22 06:31:41 +0000	[diff] [blame]	2622	/* Reverse the src and dest notion, since the HW views them from
				2623	* Tx perspective where as the user expects it from Rx filter view.
				2624	*/
				2625	fsp->h_u.tcp_ip4_spec.psrc = rule->dst_port;
				2626	fsp->h_u.tcp_ip4_spec.pdst = rule->src_port;
Jacob Keller	8ce43dc	2017-02-06 14:38:39 -0800	[diff] [blame]	2627	fsp->h_u.tcp_ip4_spec.ip4src = rule->dst_ip;
				2628	fsp->h_u.tcp_ip4_spec.ip4dst = rule->src_ip;
Anjali Singhai Jain	387ce1a	2014-05-22 06:32:23 +0000	[diff] [blame]	2629
Jacob Keller	36777d9	2017-03-07 15:05:23 -0800	[diff] [blame]	2630	switch (rule->flow_type) {
Jacob Keller	f223c87	2017-02-06 14:38:51 -0800	[diff] [blame]	2631	case SCTP_V4_FLOW:
				2632	index = I40E_FILTER_PCTYPE_NONF_IPV4_SCTP;
				2633	break;
Jacob Keller	36777d9	2017-03-07 15:05:23 -0800	[diff] [blame]	2634	case TCP_V4_FLOW:
				2635	index = I40E_FILTER_PCTYPE_NONF_IPV4_TCP;
				2636	break;
				2637	case UDP_V4_FLOW:
				2638	index = I40E_FILTER_PCTYPE_NONF_IPV4_UDP;
				2639	break;
				2640	case IP_USER_FLOW:
				2641	index = I40E_FILTER_PCTYPE_NONF_IPV4_OTHER;
				2642	break;
				2643	default:
				2644	/* If we have stored a filter with a flow type not listed here
				2645	* it is almost certainly a driver bug. WARN(), and then
				2646	* assign the input_set as if all fields are enabled to avoid
				2647	* reading unassigned memory.
				2648	*/
				2649	WARN(1, "Missing input set index for flow_type %d\n",
				2650	rule->flow_type);
				2651	input_set = 0xFFFFFFFFFFFFFFFFULL;
				2652	goto no_input_set;
				2653	}
				2654
				2655	input_set = i40e_read_fd_input_set(pf, index);
				2656
				2657	no_input_set:
				2658	if (input_set & I40E_L3_SRC_MASK)
				2659	fsp->m_u.tcp_ip4_spec.ip4src = htonl(0xFFFF);
				2660
				2661	if (input_set & I40E_L3_DST_MASK)
				2662	fsp->m_u.tcp_ip4_spec.ip4dst = htonl(0xFFFF);
				2663
				2664	if (input_set & I40E_L4_SRC_MASK)
				2665	fsp->m_u.tcp_ip4_spec.psrc = htons(0xFFFFFFFF);
				2666
				2667	if (input_set & I40E_L4_DST_MASK)
				2668	fsp->m_u.tcp_ip4_spec.pdst = htons(0xFFFFFFFF);
Jacob Keller	faa16e0	2017-03-07 15:05:22 -0800	[diff] [blame]	2669
Anjali Singhai Jain	387ce1a	2014-05-22 06:32:23 +0000	[diff] [blame]	2670	if (rule->dest_ctl == I40E_FILTER_PROGRAM_DESC_DEST_DROP_PACKET)
				2671	fsp->ring_cookie = RX_CLS_FLOW_DISC;
				2672	else
				2673	fsp->ring_cookie = rule->q_index;
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	2674
Anjali Singhai Jain	e7c8c60	2015-04-07 19:45:31 -0400	[diff] [blame]	2675	if (rule->dest_vsi != pf->vsi[pf->lan_vsi]->id) {
				2676	struct i40e_vsi *vsi;
				2677
				2678	vsi = i40e_find_vsi_from_id(pf, rule->dest_vsi);
				2679	if (vsi && vsi->type == I40E_VSI_SRIOV) {
Jacob Keller	43b1569	2017-02-06 14:38:48 -0800	[diff] [blame]	2680	/* VFs are zero-indexed by the driver, but ethtool
				2681	* expects them to be one-indexed, so add one here
				2682	*/
				2683	u64 ring_vf = vsi->vf_id + 1;
				2684
				2685	ring_vf <<= ETHTOOL_RX_FLOW_SPEC_RING_VF_OFF;
				2686	fsp->ring_cookie \|= ring_vf;
Anjali Singhai Jain	e7c8c60	2015-04-07 19:45:31 -0400	[diff] [blame]	2687	}
				2688	}
				2689
Jacob Keller	0e588de	2017-02-06 14:38:50 -0800	[diff] [blame]	2690	if (rule->flex_filter) {
				2691	userdef.flex_filter = true;
				2692	userdef.flex_word = be16_to_cpu(rule->flex_word);
				2693	userdef.flex_offset = rule->flex_offset;
				2694	}
				2695
Jacob Keller	e793095	2017-02-06 14:38:49 -0800	[diff] [blame]	2696	i40e_fill_rx_flow_user_data(fsp, &userdef);
				2697
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	2698	return 0;
				2699	}
				2700
				2701	/**
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2702	* i40e_get_rxnfc - command to get RX flow classification rules
				2703	* @netdev: network interface device structure
				2704	* @cmd: ethtool rxnfc command
				2705	*
				2706	* Returns Success if the command is supported.
				2707	**/
				2708	static int i40e_get_rxnfc(struct net_device netdev, struct ethtool_rxnfc cmd,
				2709	u32 *rule_locs)
				2710	{
				2711	struct i40e_netdev_priv *np = netdev_priv(netdev);
				2712	struct i40e_vsi *vsi = np->vsi;
				2713	struct i40e_pf *pf = vsi->back;
				2714	int ret = -EOPNOTSUPP;
				2715
				2716	switch (cmd->cmd) {
				2717	case ETHTOOL_GRXRINGS:
Amritha Nambiar	a9ce82f	2017-09-07 04:00:22 -0700	[diff] [blame]	2718	cmd->data = vsi->rss_size;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2719	ret = 0;
				2720	break;
				2721	case ETHTOOL_GRXFH:
				2722	ret = i40e_get_rss_hash_opts(pf, cmd);
				2723	break;
				2724	case ETHTOOL_GRXCLSRLCNT:
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	2725	cmd->rule_cnt = pf->fdir_pf_active_filters;
Anjali Singhai Jain	082def1	2014-04-09 05:59:00 +0000	[diff] [blame]	2726	/* report total rule count */
				2727	cmd->data = i40e_get_fd_cnt_all(pf);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2728	ret = 0;
				2729	break;
				2730	case ETHTOOL_GRXCLSRULE:
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	2731	ret = i40e_get_ethtool_fdir_entry(pf, cmd);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2732	break;
				2733	case ETHTOOL_GRXCLSRLALL:
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	2734	ret = i40e_get_ethtool_fdir_all(pf, cmd, rule_locs);
				2735	break;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2736	default:
				2737	break;
				2738	}
				2739
				2740	return ret;
				2741	}
				2742
				2743	/**
Carolyn Wyborny	eb0dd6e	2016-07-27 12:02:40 -0700	[diff] [blame]	2744	* i40e_get_rss_hash_bits - Read RSS Hash bits from register
				2745	* @nfc: pointer to user request
				2746	* @i_setc bits currently set
				2747	*
				2748	* Returns value of bits to be set per user request
				2749	**/
				2750	static u64 i40e_get_rss_hash_bits(struct ethtool_rxnfc *nfc, u64 i_setc)
				2751	{
				2752	u64 i_set = i_setc;
				2753	u64 src_l3 = 0, dst_l3 = 0;
				2754
				2755	if (nfc->data & RXH_L4_B_0_1)
				2756	i_set \|= I40E_L4_SRC_MASK;
				2757	else
				2758	i_set &= ~I40E_L4_SRC_MASK;
				2759	if (nfc->data & RXH_L4_B_2_3)
				2760	i_set \|= I40E_L4_DST_MASK;
				2761	else
				2762	i_set &= ~I40E_L4_DST_MASK;
				2763
				2764	if (nfc->flow_type == TCP_V6_FLOW \|\| nfc->flow_type == UDP_V6_FLOW) {
				2765	src_l3 = I40E_L3_V6_SRC_MASK;
				2766	dst_l3 = I40E_L3_V6_DST_MASK;
				2767	} else if (nfc->flow_type == TCP_V4_FLOW \|\|
				2768	nfc->flow_type == UDP_V4_FLOW) {
				2769	src_l3 = I40E_L3_SRC_MASK;
				2770	dst_l3 = I40E_L3_DST_MASK;
				2771	} else {
				2772	/* Any other flow type are not supported here */
				2773	return i_set;
				2774	}
				2775
				2776	if (nfc->data & RXH_IP_SRC)
				2777	i_set \|= src_l3;
				2778	else
				2779	i_set &= ~src_l3;
				2780	if (nfc->data & RXH_IP_DST)
				2781	i_set \|= dst_l3;
				2782	else
				2783	i_set &= ~dst_l3;
				2784
				2785	return i_set;
				2786	}
				2787
				2788	/**
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2789	* i40e_set_rss_hash_opt - Enable/Disable flow types for RSS hash
				2790	* @pf: pointer to the physical function struct
				2791	* @cmd: ethtool rxnfc command
				2792	*
				2793	* Returns Success if the flow input set is supported.
				2794	**/
				2795	static int i40e_set_rss_hash_opt(struct i40e_pf pf, struct ethtool_rxnfc nfc)
				2796	{
				2797	struct i40e_hw *hw = &pf->hw;
Shannon Nelson	272cdaf2	2016-02-17 16:12:21 -0800	[diff] [blame]	2798	u64 hena = (u64)i40e_read_rx_ctl(hw, I40E_PFQF_HENA(0)) \|
				2799	((u64)i40e_read_rx_ctl(hw, I40E_PFQF_HENA(1)) << 32);
Carolyn Wyborny	eb0dd6e	2016-07-27 12:02:40 -0700	[diff] [blame]	2800	u8 flow_pctype = 0;
				2801	u64 i_set, i_setc;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2802
Carolyn Wyborny	83d14c5	2017-06-07 05:43:07 -0400	[diff] [blame]	2803	if (pf->flags & I40E_FLAG_MFP_ENABLED) {
				2804	dev_err(&pf->pdev->dev,
				2805	"Change of RSS hash input set is not supported when MFP mode is enabled\n");
				2806	return -EOPNOTSUPP;
				2807	}
				2808
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2809	/* RSS does not support anything other than hashing
				2810	* to queues on src and dst IPs and ports
				2811	*/
				2812	if (nfc->data & ~(RXH_IP_SRC \| RXH_IP_DST \|
				2813	RXH_L4_B_0_1 \| RXH_L4_B_2_3))
				2814	return -EINVAL;
				2815
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2816	switch (nfc->flow_type) {
				2817	case TCP_V4_FLOW:
Carolyn Wyborny	eb0dd6e	2016-07-27 12:02:40 -0700	[diff] [blame]	2818	flow_pctype = I40E_FILTER_PCTYPE_NONF_IPV4_TCP;
Jacob Keller	d36e41d	2017-06-23 04:24:46 -0400	[diff] [blame]	2819	if (pf->hw_features & I40E_HW_MULTIPLE_TCP_UDP_RSS_PCTYPE)
Carolyn Wyborny	eb0dd6e	2016-07-27 12:02:40 -0700	[diff] [blame]	2820	hena \|=
				2821	BIT_ULL(I40E_FILTER_PCTYPE_NONF_IPV4_TCP_SYN_NO_ACK);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2822	break;
				2823	case TCP_V6_FLOW:
Carolyn Wyborny	eb0dd6e	2016-07-27 12:02:40 -0700	[diff] [blame]	2824	flow_pctype = I40E_FILTER_PCTYPE_NONF_IPV6_TCP;
Jacob Keller	d36e41d	2017-06-23 04:24:46 -0400	[diff] [blame]	2825	if (pf->hw_features & I40E_HW_MULTIPLE_TCP_UDP_RSS_PCTYPE)
Carolyn Wyborny	eb0dd6e	2016-07-27 12:02:40 -0700	[diff] [blame]	2826	hena \|=
				2827	BIT_ULL(I40E_FILTER_PCTYPE_NONF_IPV4_TCP_SYN_NO_ACK);
Jacob Keller	d36e41d	2017-06-23 04:24:46 -0400	[diff] [blame]	2828	if (pf->hw_features & I40E_HW_MULTIPLE_TCP_UDP_RSS_PCTYPE)
Carolyn Wyborny	eb0dd6e	2016-07-27 12:02:40 -0700	[diff] [blame]	2829	hena \|=
				2830	BIT_ULL(I40E_FILTER_PCTYPE_NONF_IPV6_TCP_SYN_NO_ACK);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2831	break;
				2832	case UDP_V4_FLOW:
Carolyn Wyborny	eb0dd6e	2016-07-27 12:02:40 -0700	[diff] [blame]	2833	flow_pctype = I40E_FILTER_PCTYPE_NONF_IPV4_UDP;
Jacob Keller	d36e41d	2017-06-23 04:24:46 -0400	[diff] [blame]	2834	if (pf->hw_features & I40E_HW_MULTIPLE_TCP_UDP_RSS_PCTYPE)
Carolyn Wyborny	eb0dd6e	2016-07-27 12:02:40 -0700	[diff] [blame]	2835	hena \|=
				2836	BIT_ULL(I40E_FILTER_PCTYPE_NONF_UNICAST_IPV4_UDP) \|
				2837	BIT_ULL(I40E_FILTER_PCTYPE_NONF_MULTICAST_IPV4_UDP);
Anjali Singhai Jain	3d0da5b	2015-12-22 14:25:05 -0800	[diff] [blame]	2838
Carolyn Wyborny	eb0dd6e	2016-07-27 12:02:40 -0700	[diff] [blame]	2839	hena \|= BIT_ULL(I40E_FILTER_PCTYPE_FRAG_IPV4);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2840	break;
				2841	case UDP_V6_FLOW:
Carolyn Wyborny	eb0dd6e	2016-07-27 12:02:40 -0700	[diff] [blame]	2842	flow_pctype = I40E_FILTER_PCTYPE_NONF_IPV6_UDP;
Jacob Keller	d36e41d	2017-06-23 04:24:46 -0400	[diff] [blame]	2843	if (pf->hw_features & I40E_HW_MULTIPLE_TCP_UDP_RSS_PCTYPE)
Carolyn Wyborny	eb0dd6e	2016-07-27 12:02:40 -0700	[diff] [blame]	2844	hena \|=
				2845	BIT_ULL(I40E_FILTER_PCTYPE_NONF_UNICAST_IPV6_UDP) \|
				2846	BIT_ULL(I40E_FILTER_PCTYPE_NONF_MULTICAST_IPV6_UDP);
Anjali Singhai Jain	3d0da5b	2015-12-22 14:25:05 -0800	[diff] [blame]	2847
Carolyn Wyborny	eb0dd6e	2016-07-27 12:02:40 -0700	[diff] [blame]	2848	hena \|= BIT_ULL(I40E_FILTER_PCTYPE_FRAG_IPV6);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2849	break;
				2850	case AH_ESP_V4_FLOW:
				2851	case AH_V4_FLOW:
				2852	case ESP_V4_FLOW:
				2853	case SCTP_V4_FLOW:
				2854	if ((nfc->data & RXH_L4_B_0_1) \|\|
				2855	(nfc->data & RXH_L4_B_2_3))
				2856	return -EINVAL;
Jesse Brandeburg	41a1d04	2015-06-04 16:24:02 -0400	[diff] [blame]	2857	hena \|= BIT_ULL(I40E_FILTER_PCTYPE_NONF_IPV4_OTHER);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2858	break;
				2859	case AH_ESP_V6_FLOW:
				2860	case AH_V6_FLOW:
				2861	case ESP_V6_FLOW:
				2862	case SCTP_V6_FLOW:
				2863	if ((nfc->data & RXH_L4_B_0_1) \|\|
				2864	(nfc->data & RXH_L4_B_2_3))
				2865	return -EINVAL;
Jesse Brandeburg	41a1d04	2015-06-04 16:24:02 -0400	[diff] [blame]	2866	hena \|= BIT_ULL(I40E_FILTER_PCTYPE_NONF_IPV6_OTHER);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2867	break;
				2868	case IPV4_FLOW:
Jesse Brandeburg	41a1d04	2015-06-04 16:24:02 -0400	[diff] [blame]	2869	hena \|= BIT_ULL(I40E_FILTER_PCTYPE_NONF_IPV4_OTHER) \|
				2870	BIT_ULL(I40E_FILTER_PCTYPE_FRAG_IPV4);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2871	break;
				2872	case IPV6_FLOW:
Jesse Brandeburg	41a1d04	2015-06-04 16:24:02 -0400	[diff] [blame]	2873	hena \|= BIT_ULL(I40E_FILTER_PCTYPE_NONF_IPV6_OTHER) \|
				2874	BIT_ULL(I40E_FILTER_PCTYPE_FRAG_IPV6);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2875	break;
				2876	default:
				2877	return -EINVAL;
				2878	}
				2879
Carolyn Wyborny	eb0dd6e	2016-07-27 12:02:40 -0700	[diff] [blame]	2880	if (flow_pctype) {
				2881	i_setc = (u64)i40e_read_rx_ctl(hw, I40E_GLQF_HASH_INSET(0,
				2882	flow_pctype)) \|
				2883	((u64)i40e_read_rx_ctl(hw, I40E_GLQF_HASH_INSET(1,
				2884	flow_pctype)) << 32);
				2885	i_set = i40e_get_rss_hash_bits(nfc, i_setc);
				2886	i40e_write_rx_ctl(hw, I40E_GLQF_HASH_INSET(0, flow_pctype),
				2887	(u32)i_set);
				2888	i40e_write_rx_ctl(hw, I40E_GLQF_HASH_INSET(1, flow_pctype),
				2889	(u32)(i_set >> 32));
				2890	hena \|= BIT_ULL(flow_pctype);
				2891	}
				2892
Shannon Nelson	272cdaf2	2016-02-17 16:12:21 -0800	[diff] [blame]	2893	i40e_write_rx_ctl(hw, I40E_PFQF_HENA(0), (u32)hena);
				2894	i40e_write_rx_ctl(hw, I40E_PFQF_HENA(1), (u32)(hena >> 32));
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2895	i40e_flush(hw);
				2896
				2897	return 0;
				2898	}
				2899
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2900	/**
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	2901	* i40e_update_ethtool_fdir_entry - Updates the fdir filter entry
				2902	* @vsi: Pointer to the targeted VSI
				2903	* @input: The filter to update or NULL to indicate deletion
				2904	* @sw_idx: Software index to the filter
				2905	* @cmd: The command to get or set Rx flow classification rules
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2906	*
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	2907	* This function updates (or deletes) a Flow Director entry from
				2908	* the hlist of the corresponding PF
				2909	*
				2910	* Returns 0 on success
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2911	**/
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	2912	static int i40e_update_ethtool_fdir_entry(struct i40e_vsi *vsi,
				2913	struct i40e_fdir_filter *input,
				2914	u16 sw_idx,
				2915	struct ethtool_rxnfc *cmd)
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2916	{
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	2917	struct i40e_fdir_filter rule, parent;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2918	struct i40e_pf *pf = vsi->back;
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	2919	struct hlist_node *node2;
				2920	int err = -EINVAL;
Jesse Brandeburg	c35a1d7	2013-12-18 13:46:02 +0000	[diff] [blame]	2921
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	2922	parent = NULL;
				2923	rule = NULL;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2924
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	2925	hlist_for_each_entry_safe(rule, node2,
				2926	&pf->fdir_filter_list, fdir_node) {
				2927	/* hash found, or no matching entry */
				2928	if (rule->fd_id >= sw_idx)
				2929	break;
				2930	parent = rule;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2931	}
				2932
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	2933	/* if there is an old rule occupying our place remove it */
				2934	if (rule && (rule->fd_id == sw_idx)) {
Jacob Keller	c6da525	2017-02-06 14:39:13 -0800	[diff] [blame]	2935	/* Remove this rule, since we're either deleting it, or
				2936	* replacing it.
				2937	*/
				2938	err = i40e_add_del_fdir(vsi, rule, false);
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	2939	hlist_del(&rule->fdir_node);
				2940	kfree(rule);
				2941	pf->fdir_pf_active_filters--;
				2942	}
				2943
Jacob Keller	c6da525	2017-02-06 14:39:13 -0800	[diff] [blame]	2944	/* If we weren't given an input, this is a delete, so just return the
				2945	* error code indicating if there was an entry at the requested slot
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	2946	*/
				2947	if (!input)
				2948	return err;
				2949
Jacob Keller	c6da525	2017-02-06 14:39:13 -0800	[diff] [blame]	2950	/* Otherwise, install the new rule as requested */
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	2951	INIT_HLIST_NODE(&input->fdir_node);
				2952
				2953	/* add filter to the list */
				2954	if (parent)
Ken Helias	1d02328	2014-08-06 16:09:16 -0700	[diff] [blame]	2955	hlist_add_behind(&input->fdir_node, &parent->fdir_node);
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	2956	else
				2957	hlist_add_head(&input->fdir_node,
				2958	&pf->fdir_filter_list);
				2959
				2960	/* update counts */
				2961	pf->fdir_pf_active_filters++;
				2962
				2963	return 0;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	2964	}
				2965
				2966	/**
Jacob Keller	0e588de	2017-02-06 14:38:50 -0800	[diff] [blame]	2967	* i40e_prune_flex_pit_list - Cleanup unused entries in FLX_PIT table
				2968	* @pf: pointer to PF structure
				2969	*
				2970	* This function searches the list of filters and determines which FLX_PIT
				2971	* entries are still required. It will prune any entries which are no longer
				2972	* in use after the deletion.
				2973	**/
				2974	static void i40e_prune_flex_pit_list(struct i40e_pf *pf)
				2975	{
				2976	struct i40e_flex_pit entry, tmp;
				2977	struct i40e_fdir_filter *rule;
				2978
				2979	/* First, we'll check the l3 table */
				2980	list_for_each_entry_safe(entry, tmp, &pf->l3_flex_pit_list, list) {
				2981	bool found = false;
				2982
				2983	hlist_for_each_entry(rule, &pf->fdir_filter_list, fdir_node) {
				2984	if (rule->flow_type != IP_USER_FLOW)
				2985	continue;
				2986	if (rule->flex_filter &&
				2987	rule->flex_offset == entry->src_offset) {
				2988	found = true;
				2989	break;
				2990	}
				2991	}
				2992
				2993	/* If we didn't find the filter, then we can prune this entry
				2994	* from the list.
				2995	*/
				2996	if (!found) {
				2997	list_del(&entry->list);
				2998	kfree(entry);
				2999	}
				3000	}
				3001
				3002	/* Followed by the L4 table */
				3003	list_for_each_entry_safe(entry, tmp, &pf->l4_flex_pit_list, list) {
				3004	bool found = false;
				3005
				3006	hlist_for_each_entry(rule, &pf->fdir_filter_list, fdir_node) {
				3007	/* Skip this filter if it's L3, since we already
				3008	* checked those in the above loop
				3009	*/
				3010	if (rule->flow_type == IP_USER_FLOW)
				3011	continue;
				3012	if (rule->flex_filter &&
				3013	rule->flex_offset == entry->src_offset) {
				3014	found = true;
				3015	break;
				3016	}
				3017	}
				3018
				3019	/* If we didn't find the filter, then we can prune this entry
				3020	* from the list.
				3021	*/
				3022	if (!found) {
				3023	list_del(&entry->list);
				3024	kfree(entry);
				3025	}
				3026	}
				3027	}
				3028
				3029	/**
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	3030	* i40e_del_fdir_entry - Deletes a Flow Director filter entry
				3031	* @vsi: Pointer to the targeted VSI
				3032	* @cmd: The command to get or set Rx flow classification rules
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	3033	*
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	3034	* The function removes a Flow Director filter entry from the
				3035	* hlist of the corresponding PF
				3036	*
				3037	* Returns 0 on success
				3038	*/
				3039	static int i40e_del_fdir_entry(struct i40e_vsi *vsi,
				3040	struct ethtool_rxnfc *cmd)
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	3041	{
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	3042	struct ethtool_rx_flow_spec *fsp =
				3043	(struct ethtool_rx_flow_spec *)&cmd->fs;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	3044	struct i40e_pf *pf = vsi->back;
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	3045	int ret = 0;
Jesse Brandeburg	c35a1d7	2013-12-18 13:46:02 +0000	[diff] [blame]	3046
Jacob Keller	0da36b9	2017-04-19 09:25:55 -0400	[diff] [blame]	3047	if (test_bit(__I40E_RESET_RECOVERY_PENDING, pf->state) \|\|
				3048	test_bit(__I40E_RESET_INTR_RECEIVED, pf->state))
Anjali Singhai Jain	60793f4a	2014-07-09 07:46:23 +0000	[diff] [blame]	3049	return -EBUSY;
				3050
Jacob Keller	0da36b9	2017-04-19 09:25:55 -0400	[diff] [blame]	3051	if (test_bit(__I40E_FD_FLUSH_REQUESTED, pf->state))
Anjali Singhai Jain	1e1be8f	2014-07-10 08:03:26 +0000	[diff] [blame]	3052	return -EBUSY;
				3053
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	3054	ret = i40e_update_ethtool_fdir_entry(vsi, NULL, fsp->location, cmd);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	3055
Jacob Keller	0e588de	2017-02-06 14:38:50 -0800	[diff] [blame]	3056	i40e_prune_flex_pit_list(pf);
				3057
Anjali Singhai Jain	55a5e60	2014-02-12 06:33:25 +0000	[diff] [blame]	3058	i40e_fdir_check_and_reenable(pf);
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	3059	return ret;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	3060	}
				3061
				3062	/**
Jacob Keller	0e588de	2017-02-06 14:38:50 -0800	[diff] [blame]	3063	* i40e_unused_pit_index - Find an unused PIT index for given list
				3064	* @pf: the PF data structure
				3065	*
				3066	* Find the first unused flexible PIT index entry. We search both the L3 and
				3067	* L4 flexible PIT lists so that the returned index is unique and unused by
				3068	* either currently programmed L3 or L4 filters. We use a bit field as storage
				3069	* to track which indexes are already used.
				3070	**/
				3071	static u8 i40e_unused_pit_index(struct i40e_pf *pf)
				3072	{
				3073	unsigned long available_index = 0xFF;
				3074	struct i40e_flex_pit *entry;
				3075
				3076	/* We need to make sure that the new index isn't in use by either L3
				3077	* or L4 filters so that IP_USER_FLOW filters can program both L3 and
				3078	* L4 to use the same index.
				3079	*/
				3080
				3081	list_for_each_entry(entry, &pf->l4_flex_pit_list, list)
				3082	clear_bit(entry->pit_index, &available_index);
				3083
				3084	list_for_each_entry(entry, &pf->l3_flex_pit_list, list)
				3085	clear_bit(entry->pit_index, &available_index);
				3086
				3087	return find_first_bit(&available_index, 8);
				3088	}
				3089
				3090	/**
				3091	* i40e_find_flex_offset - Find an existing flex src_offset
				3092	* @flex_pit_list: L3 or L4 flex PIT list
				3093	* @src_offset: new src_offset to find
				3094	*
				3095	* Searches the flex_pit_list for an existing offset. If no offset is
				3096	* currently programmed, then this will return an ERR_PTR if there is no space
				3097	* to add a new offset, otherwise it returns NULL.
				3098	**/
				3099	static
				3100	struct i40e_flex_pit i40e_find_flex_offset(struct list_head flex_pit_list,
				3101	u16 src_offset)
				3102	{
				3103	struct i40e_flex_pit *entry;
				3104	int size = 0;
				3105
				3106	/* Search for the src_offset first. If we find a matching entry
				3107	* already programmed, we can simply re-use it.
				3108	*/
				3109	list_for_each_entry(entry, flex_pit_list, list) {
				3110	size++;
				3111	if (entry->src_offset == src_offset)
				3112	return entry;
				3113	}
				3114
				3115	/* If we haven't found an entry yet, then the provided src offset has
				3116	* not yet been programmed. We will program the src offset later on,
				3117	* but we need to indicate whether there is enough space to do so
				3118	* here. We'll make use of ERR_PTR for this purpose.
				3119	*/
				3120	if (size >= I40E_FLEX_PIT_TABLE_SIZE)
				3121	return ERR_PTR(-ENOSPC);
				3122
				3123	return NULL;
				3124	}
				3125
				3126	/**
				3127	* i40e_add_flex_offset - Add src_offset to flex PIT table list
				3128	* @flex_pit_list: L3 or L4 flex PIT list
				3129	* @src_offset: new src_offset to add
				3130	* @pit_index: the PIT index to program
				3131	*
				3132	* This function programs the new src_offset to the list. It is expected that
				3133	* i40e_find_flex_offset has already been tried and returned NULL, indicating
				3134	* that this offset is not programmed, and that the list has enough space to
				3135	* store another offset.
				3136	*
				3137	* Returns 0 on success, and negative value on error.
				3138	**/
				3139	static int i40e_add_flex_offset(struct list_head *flex_pit_list,
				3140	u16 src_offset,
				3141	u8 pit_index)
				3142	{
				3143	struct i40e_flex_pit new_pit, entry;
				3144
				3145	new_pit = kzalloc(sizeof(*entry), GFP_KERNEL);
				3146	if (!new_pit)
				3147	return -ENOMEM;
				3148
				3149	new_pit->src_offset = src_offset;
				3150	new_pit->pit_index = pit_index;
				3151
				3152	/* We need to insert this item such that the list is sorted by
				3153	* src_offset in ascending order.
				3154	*/
				3155	list_for_each_entry(entry, flex_pit_list, list) {
				3156	if (new_pit->src_offset < entry->src_offset) {
				3157	list_add_tail(&new_pit->list, &entry->list);
				3158	return 0;
				3159	}
				3160
				3161	/* If we found an entry with our offset already programmed we
				3162	* can simply return here, after freeing the memory. However,
				3163	* if the pit_index does not match we need to report an error.
				3164	*/
				3165	if (new_pit->src_offset == entry->src_offset) {
				3166	int err = 0;
				3167
				3168	/* If the PIT index is not the same we can't re-use
				3169	* the entry, so we must report an error.
				3170	*/
				3171	if (new_pit->pit_index != entry->pit_index)
				3172	err = -EINVAL;
				3173
				3174	kfree(new_pit);
				3175	return err;
				3176	}
				3177	}
				3178
				3179	/* If we reached here, then we haven't yet added the item. This means
				3180	* that we should add the item at the end of the list.
				3181	*/
				3182	list_add_tail(&new_pit->list, flex_pit_list);
				3183	return 0;
				3184	}
				3185
				3186	/**
				3187	* __i40e_reprogram_flex_pit - Re-program specific FLX_PIT table
				3188	* @pf: Pointer to the PF structure
				3189	* @flex_pit_list: list of flexible src offsets in use
				3190	* #flex_pit_start: index to first entry for this section of the table
				3191	*
				3192	* In order to handle flexible data, the hardware uses a table of values
				3193	* called the FLX_PIT table. This table is used to indicate which sections of
				3194	* the input correspond to what PIT index values. Unfortunately, hardware is
				3195	* very restrictive about programming this table. Entries must be ordered by
				3196	* src_offset in ascending order, without duplicates. Additionally, unused
				3197	* entries must be set to the unused index value, and must have valid size and
				3198	* length according to the src_offset ordering.
				3199	*
				3200	* This function will reprogram the FLX_PIT register from a book-keeping
				3201	* structure that we guarantee is already ordered correctly, and has no more
				3202	* than 3 entries.
				3203	*
				3204	* To make things easier, we only support flexible values of one word length,
				3205	* rather than allowing variable length flexible values.
				3206	**/
				3207	static void __i40e_reprogram_flex_pit(struct i40e_pf *pf,
				3208	struct list_head *flex_pit_list,
				3209	int flex_pit_start)
				3210	{
				3211	struct i40e_flex_pit *entry = NULL;
				3212	u16 last_offset = 0;
				3213	int i = 0, j = 0;
				3214
				3215	/* First, loop over the list of flex PIT entries, and reprogram the
				3216	* registers.
				3217	*/
				3218	list_for_each_entry(entry, flex_pit_list, list) {
				3219	/* We have to be careful when programming values for the
				3220	* largest SRC_OFFSET value. It is possible that adding
				3221	* additional empty values at the end would overflow the space
				3222	* for the SRC_OFFSET in the FLX_PIT register. To avoid this,
				3223	* we check here and add the empty values prior to adding the
				3224	* largest value.
				3225	*
				3226	* To determine this, we will use a loop from i+1 to 3, which
				3227	* will determine whether the unused entries would have valid
				3228	* SRC_OFFSET. Note that there cannot be extra entries past
				3229	* this value, because the only valid values would have been
				3230	* larger than I40E_MAX_FLEX_SRC_OFFSET, and thus would not
				3231	* have been added to the list in the first place.
				3232	*/
				3233	for (j = i + 1; j < 3; j++) {
				3234	u16 offset = entry->src_offset + j;
				3235	int index = flex_pit_start + i;
				3236	u32 value = I40E_FLEX_PREP_VAL(I40E_FLEX_DEST_UNUSED,
				3237	1,
				3238	offset - 3);
				3239
				3240	if (offset > I40E_MAX_FLEX_SRC_OFFSET) {
				3241	i40e_write_rx_ctl(&pf->hw,
				3242	I40E_PRTQF_FLX_PIT(index),
				3243	value);
				3244	i++;
				3245	}
				3246	}
				3247
				3248	/* Now, we can program the actual value into the table */
				3249	i40e_write_rx_ctl(&pf->hw,
				3250	I40E_PRTQF_FLX_PIT(flex_pit_start + i),
				3251	I40E_FLEX_PREP_VAL(entry->pit_index + 50,
				3252	1,
				3253	entry->src_offset));
				3254	i++;
				3255	}
				3256
				3257	/* In order to program the last entries in the table, we need to
				3258	* determine the valid offset. If the list is empty, we'll just start
				3259	* with 0. Otherwise, we'll start with the last item offset and add 1.
				3260	* This ensures that all entries have valid sizes. If we don't do this
				3261	* correctly, the hardware will disable flexible field parsing.
				3262	*/
				3263	if (!list_empty(flex_pit_list))
				3264	last_offset = list_prev_entry(entry, list)->src_offset + 1;
				3265
				3266	for (; i < 3; i++, last_offset++) {
				3267	i40e_write_rx_ctl(&pf->hw,
				3268	I40E_PRTQF_FLX_PIT(flex_pit_start + i),
				3269	I40E_FLEX_PREP_VAL(I40E_FLEX_DEST_UNUSED,
				3270	1,
				3271	last_offset));
				3272	}
				3273	}
				3274
				3275	/**
				3276	* i40e_reprogram_flex_pit - Reprogram all FLX_PIT tables after input set change
				3277	* @pf: pointer to the PF structure
				3278	*
				3279	* This function reprograms both the L3 and L4 FLX_PIT tables. See the
				3280	* internal helper function for implementation details.
				3281	**/
				3282	static void i40e_reprogram_flex_pit(struct i40e_pf *pf)
				3283	{
				3284	__i40e_reprogram_flex_pit(pf, &pf->l3_flex_pit_list,
				3285	I40E_FLEX_PIT_IDX_START_L3);
				3286
				3287	__i40e_reprogram_flex_pit(pf, &pf->l4_flex_pit_list,
				3288	I40E_FLEX_PIT_IDX_START_L4);
				3289
				3290	/* We also need to program the L3 and L4 GLQF ORT register */
				3291	i40e_write_rx_ctl(&pf->hw,
				3292	I40E_GLQF_ORT(I40E_L3_GLQF_ORT_IDX),
				3293	I40E_ORT_PREP_VAL(I40E_FLEX_PIT_IDX_START_L3,
				3294	3, 1));
				3295
				3296	i40e_write_rx_ctl(&pf->hw,
				3297	I40E_GLQF_ORT(I40E_L4_GLQF_ORT_IDX),
				3298	I40E_ORT_PREP_VAL(I40E_FLEX_PIT_IDX_START_L4,
				3299	3, 1));
				3300	}
				3301
				3302	/**
Jacob Keller	9229e99	2017-02-06 14:38:47 -0800	[diff] [blame]	3303	* i40e_flow_str - Converts a flow_type into a human readable string
				3304	* @flow_type: the flow type from a flow specification
				3305	*
				3306	* Currently only flow types we support are included here, and the string
				3307	* value attempts to match what ethtool would use to configure this flow type.
				3308	**/
				3309	static const char i40e_flow_str(struct ethtool_rx_flow_spec fsp)
				3310	{
				3311	switch (fsp->flow_type & ~FLOW_EXT) {
				3312	case TCP_V4_FLOW:
				3313	return "tcp4";
				3314	case UDP_V4_FLOW:
				3315	return "udp4";
				3316	case SCTP_V4_FLOW:
				3317	return "sctp4";
				3318	case IP_USER_FLOW:
				3319	return "ip4";
				3320	default:
				3321	return "unknown";
				3322	}
				3323	}
				3324
				3325	/**
Jacob Keller	0e588de	2017-02-06 14:38:50 -0800	[diff] [blame]	3326	* i40e_pit_index_to_mask - Return the FLEX mask for a given PIT index
				3327	* @pit_index: PIT index to convert
				3328	*
				3329	* Returns the mask for a given PIT index. Will return 0 if the pit_index is
				3330	* of range.
				3331	**/
				3332	static u64 i40e_pit_index_to_mask(int pit_index)
				3333	{
				3334	switch (pit_index) {
				3335	case 0:
				3336	return I40E_FLEX_50_MASK;
				3337	case 1:
				3338	return I40E_FLEX_51_MASK;
				3339	case 2:
				3340	return I40E_FLEX_52_MASK;
				3341	case 3:
				3342	return I40E_FLEX_53_MASK;
				3343	case 4:
				3344	return I40E_FLEX_54_MASK;
				3345	case 5:
				3346	return I40E_FLEX_55_MASK;
				3347	case 6:
				3348	return I40E_FLEX_56_MASK;
				3349	case 7:
				3350	return I40E_FLEX_57_MASK;
				3351	default:
				3352	return 0;
				3353	}
				3354	}
				3355
				3356	/**
Jacob Keller	9229e99	2017-02-06 14:38:47 -0800	[diff] [blame]	3357	* i40e_print_input_set - Show changes between two input sets
				3358	* @vsi: the vsi being configured
				3359	* @old: the old input set
				3360	* @new: the new input set
				3361	*
				3362	* Print the difference between old and new input sets by showing which series
				3363	* of words are toggled on or off. Only displays the bits we actually support
				3364	* changing.
				3365	**/
				3366	static void i40e_print_input_set(struct i40e_vsi *vsi, u64 old, u64 new)
				3367	{
				3368	struct i40e_pf *pf = vsi->back;
				3369	bool old_value, new_value;
Jacob Keller	0e588de	2017-02-06 14:38:50 -0800	[diff] [blame]	3370	int i;
Jacob Keller	9229e99	2017-02-06 14:38:47 -0800	[diff] [blame]	3371
				3372	old_value = !!(old & I40E_L3_SRC_MASK);
				3373	new_value = !!(new & I40E_L3_SRC_MASK);
				3374	if (old_value != new_value)
				3375	netif_info(pf, drv, vsi->netdev, "L3 source address: %s -> %s\n",
				3376	old_value ? "ON" : "OFF",
				3377	new_value ? "ON" : "OFF");
				3378
				3379	old_value = !!(old & I40E_L3_DST_MASK);
				3380	new_value = !!(new & I40E_L3_DST_MASK);
				3381	if (old_value != new_value)
				3382	netif_info(pf, drv, vsi->netdev, "L3 destination address: %s -> %s\n",
				3383	old_value ? "ON" : "OFF",
				3384	new_value ? "ON" : "OFF");
				3385
				3386	old_value = !!(old & I40E_L4_SRC_MASK);
				3387	new_value = !!(new & I40E_L4_SRC_MASK);
				3388	if (old_value != new_value)
				3389	netif_info(pf, drv, vsi->netdev, "L4 source port: %s -> %s\n",
				3390	old_value ? "ON" : "OFF",
				3391	new_value ? "ON" : "OFF");
				3392
				3393	old_value = !!(old & I40E_L4_DST_MASK);
				3394	new_value = !!(new & I40E_L4_DST_MASK);
				3395	if (old_value != new_value)
				3396	netif_info(pf, drv, vsi->netdev, "L4 destination port: %s -> %s\n",
				3397	old_value ? "ON" : "OFF",
				3398	new_value ? "ON" : "OFF");
				3399
				3400	old_value = !!(old & I40E_VERIFY_TAG_MASK);
				3401	new_value = !!(new & I40E_VERIFY_TAG_MASK);
				3402	if (old_value != new_value)
				3403	netif_info(pf, drv, vsi->netdev, "SCTP verification tag: %s -> %s\n",
				3404	old_value ? "ON" : "OFF",
				3405	new_value ? "ON" : "OFF");
				3406
Jacob Keller	0e588de	2017-02-06 14:38:50 -0800	[diff] [blame]	3407	/* Show change of flexible filter entries */
				3408	for (i = 0; i < I40E_FLEX_INDEX_ENTRIES; i++) {
				3409	u64 flex_mask = i40e_pit_index_to_mask(i);
				3410
				3411	old_value = !!(old & flex_mask);
				3412	new_value = !!(new & flex_mask);
				3413	if (old_value != new_value)
				3414	netif_info(pf, drv, vsi->netdev, "FLEX index %d: %s -> %s\n",
				3415	i,
				3416	old_value ? "ON" : "OFF",
				3417	new_value ? "ON" : "OFF");
				3418	}
				3419
Jacob Keller	9229e99	2017-02-06 14:38:47 -0800	[diff] [blame]	3420	netif_info(pf, drv, vsi->netdev, " Current input set: %0llx\n",
				3421	old);
				3422	netif_info(pf, drv, vsi->netdev, "Requested input set: %0llx\n",
				3423	new);
				3424	}
				3425
				3426	/**
Jacob Keller	faa16e0	2017-03-07 15:05:22 -0800	[diff] [blame]	3427	* i40e_check_fdir_input_set - Check that a given rx_flow_spec mask is valid
Jacob Keller	36777d9	2017-03-07 15:05:23 -0800	[diff] [blame]	3428	* @vsi: pointer to the targeted VSI
Jacob Keller	faa16e0	2017-03-07 15:05:22 -0800	[diff] [blame]	3429	* @fsp: pointer to Rx flow specification
Jacob Keller	0e588de	2017-02-06 14:38:50 -0800	[diff] [blame]	3430	* @userdef: userdefined data from flow specification
Jacob Keller	faa16e0	2017-03-07 15:05:22 -0800	[diff] [blame]	3431	*
Jacob Keller	9229e99	2017-02-06 14:38:47 -0800	[diff] [blame]	3432	* Ensures that a given ethtool_rx_flow_spec has a valid mask. Some support
				3433	* for partial matches exists with a few limitations. First, hardware only
				3434	* supports masking by word boundary (2 bytes) and not per individual bit.
				3435	* Second, hardware is limited to using one mask for a flow type and cannot
				3436	* use a separate mask for each filter.
				3437	*
				3438	* To support these limitations, if we already have a configured filter for
				3439	* the specified type, this function enforces that new filters of the type
				3440	* match the configured input set. Otherwise, if we do not have a filter of
				3441	* the specified type, we allow the input set to be updated to match the
				3442	* desired filter.
				3443	*
				3444	* To help ensure that administrators understand why filters weren't displayed
				3445	* as supported, we print a diagnostic message displaying how the input set
				3446	* would change and warning to delete the preexisting filters if required.
				3447	*
				3448	* Returns 0 on successful input set match, and a negative return code on
				3449	* failure.
Jacob Keller	faa16e0	2017-03-07 15:05:22 -0800	[diff] [blame]	3450	**/
Jacob Keller	36777d9	2017-03-07 15:05:23 -0800	[diff] [blame]	3451	static int i40e_check_fdir_input_set(struct i40e_vsi *vsi,
Jacob Keller	0e588de	2017-02-06 14:38:50 -0800	[diff] [blame]	3452	struct ethtool_rx_flow_spec *fsp,
				3453	struct i40e_rx_flow_userdef *userdef)
Jacob Keller	faa16e0	2017-03-07 15:05:22 -0800	[diff] [blame]	3454	{
Jacob Keller	36777d9	2017-03-07 15:05:23 -0800	[diff] [blame]	3455	struct i40e_pf *pf = vsi->back;
Jacob Keller	faa16e0	2017-03-07 15:05:22 -0800	[diff] [blame]	3456	struct ethtool_tcpip4_spec *tcp_ip4_spec;
				3457	struct ethtool_usrip4_spec *usr_ip4_spec;
Jacob Keller	36777d9	2017-03-07 15:05:23 -0800	[diff] [blame]	3458	u64 current_mask, new_mask;
Jacob Keller	0e588de	2017-02-06 14:38:50 -0800	[diff] [blame]	3459	bool new_flex_offset = false;
				3460	bool flex_l3 = false;
Jacob Keller	9229e99	2017-02-06 14:38:47 -0800	[diff] [blame]	3461	u16 *fdir_filter_count;
Jacob Keller	0e588de	2017-02-06 14:38:50 -0800	[diff] [blame]	3462	u16 index, src_offset = 0;
				3463	u8 pit_index = 0;
				3464	int err;
Jacob Keller	36777d9	2017-03-07 15:05:23 -0800	[diff] [blame]	3465
				3466	switch (fsp->flow_type & ~FLOW_EXT) {
Jacob Keller	f223c87	2017-02-06 14:38:51 -0800	[diff] [blame]	3467	case SCTP_V4_FLOW:
				3468	index = I40E_FILTER_PCTYPE_NONF_IPV4_SCTP;
				3469	fdir_filter_count = &pf->fd_sctp4_filter_cnt;
				3470	break;
Jacob Keller	36777d9	2017-03-07 15:05:23 -0800	[diff] [blame]	3471	case TCP_V4_FLOW:
				3472	index = I40E_FILTER_PCTYPE_NONF_IPV4_TCP;
Jacob Keller	9229e99	2017-02-06 14:38:47 -0800	[diff] [blame]	3473	fdir_filter_count = &pf->fd_tcp4_filter_cnt;
Jacob Keller	36777d9	2017-03-07 15:05:23 -0800	[diff] [blame]	3474	break;
				3475	case UDP_V4_FLOW:
				3476	index = I40E_FILTER_PCTYPE_NONF_IPV4_UDP;
Jacob Keller	9229e99	2017-02-06 14:38:47 -0800	[diff] [blame]	3477	fdir_filter_count = &pf->fd_udp4_filter_cnt;
Jacob Keller	36777d9	2017-03-07 15:05:23 -0800	[diff] [blame]	3478	break;
				3479	case IP_USER_FLOW:
				3480	index = I40E_FILTER_PCTYPE_NONF_IPV4_OTHER;
Jacob Keller	9229e99	2017-02-06 14:38:47 -0800	[diff] [blame]	3481	fdir_filter_count = &pf->fd_ip4_filter_cnt;
Jacob Keller	0e588de	2017-02-06 14:38:50 -0800	[diff] [blame]	3482	flex_l3 = true;
Jacob Keller	36777d9	2017-03-07 15:05:23 -0800	[diff] [blame]	3483	break;
				3484	default:
				3485	return -EOPNOTSUPP;
				3486	}
				3487
				3488	/* Read the current input set from register memory. */
				3489	current_mask = i40e_read_fd_input_set(pf, index);
				3490	new_mask = current_mask;
Jacob Keller	faa16e0	2017-03-07 15:05:22 -0800	[diff] [blame]	3491
Jacob Keller	9229e99	2017-02-06 14:38:47 -0800	[diff] [blame]	3492	/* Determine, if any, the required changes to the input set in order
				3493	* to support the provided mask.
				3494	*
				3495	* Hardware only supports masking at word (2 byte) granularity and does
				3496	* not support full bitwise masking. This implementation simplifies
				3497	* even further and only supports fully enabled or fully disabled
				3498	* masks for each field, even though we could split the ip4src and
				3499	* ip4dst fields.
				3500	*/
Jacob Keller	faa16e0	2017-03-07 15:05:22 -0800	[diff] [blame]	3501	switch (fsp->flow_type & ~FLOW_EXT) {
Jacob Keller	f223c87	2017-02-06 14:38:51 -0800	[diff] [blame]	3502	case SCTP_V4_FLOW:
				3503	new_mask &= ~I40E_VERIFY_TAG_MASK;
				3504	/* Fall through */
Jacob Keller	faa16e0	2017-03-07 15:05:22 -0800	[diff] [blame]	3505	case TCP_V4_FLOW:
				3506	case UDP_V4_FLOW:
				3507	tcp_ip4_spec = &fsp->m_u.tcp_ip4_spec;
				3508
				3509	/* IPv4 source address */
Jacob Keller	36777d9	2017-03-07 15:05:23 -0800	[diff] [blame]	3510	if (tcp_ip4_spec->ip4src == htonl(0xFFFFFFFF))
				3511	new_mask \|= I40E_L3_SRC_MASK;
				3512	else if (!tcp_ip4_spec->ip4src)
				3513	new_mask &= ~I40E_L3_SRC_MASK;
				3514	else
Jacob Keller	faa16e0	2017-03-07 15:05:22 -0800	[diff] [blame]	3515	return -EOPNOTSUPP;
				3516
				3517	/* IPv4 destination address */
Jacob Keller	36777d9	2017-03-07 15:05:23 -0800	[diff] [blame]	3518	if (tcp_ip4_spec->ip4dst == htonl(0xFFFFFFFF))
				3519	new_mask \|= I40E_L3_DST_MASK;
				3520	else if (!tcp_ip4_spec->ip4dst)
				3521	new_mask &= ~I40E_L3_DST_MASK;
				3522	else
Jacob Keller	faa16e0	2017-03-07 15:05:22 -0800	[diff] [blame]	3523	return -EOPNOTSUPP;
				3524
				3525	/* L4 source port */
Jacob Keller	36777d9	2017-03-07 15:05:23 -0800	[diff] [blame]	3526	if (tcp_ip4_spec->psrc == htons(0xFFFF))
				3527	new_mask \|= I40E_L4_SRC_MASK;
				3528	else if (!tcp_ip4_spec->psrc)
				3529	new_mask &= ~I40E_L4_SRC_MASK;
				3530	else
Jacob Keller	faa16e0	2017-03-07 15:05:22 -0800	[diff] [blame]	3531	return -EOPNOTSUPP;
				3532
				3533	/* L4 destination port */
Jacob Keller	36777d9	2017-03-07 15:05:23 -0800	[diff] [blame]	3534	if (tcp_ip4_spec->pdst == htons(0xFFFF))
				3535	new_mask \|= I40E_L4_DST_MASK;
				3536	else if (!tcp_ip4_spec->pdst)
				3537	new_mask &= ~I40E_L4_DST_MASK;
				3538	else
Jacob Keller	faa16e0	2017-03-07 15:05:22 -0800	[diff] [blame]	3539	return -EOPNOTSUPP;
				3540
				3541	/* Filtering on Type of Service is not supported. */
				3542	if (tcp_ip4_spec->tos)
				3543	return -EOPNOTSUPP;
				3544
				3545	break;
				3546	case IP_USER_FLOW:
				3547	usr_ip4_spec = &fsp->m_u.usr_ip4_spec;
				3548
				3549	/* IPv4 source address */
Jacob Keller	36777d9	2017-03-07 15:05:23 -0800	[diff] [blame]	3550	if (usr_ip4_spec->ip4src == htonl(0xFFFFFFFF))
				3551	new_mask \|= I40E_L3_SRC_MASK;
				3552	else if (!usr_ip4_spec->ip4src)
				3553	new_mask &= ~I40E_L3_SRC_MASK;
				3554	else
Jacob Keller	faa16e0	2017-03-07 15:05:22 -0800	[diff] [blame]	3555	return -EOPNOTSUPP;
				3556
				3557	/* IPv4 destination address */
Jacob Keller	36777d9	2017-03-07 15:05:23 -0800	[diff] [blame]	3558	if (usr_ip4_spec->ip4dst == htonl(0xFFFFFFFF))
				3559	new_mask \|= I40E_L3_DST_MASK;
				3560	else if (!usr_ip4_spec->ip4dst)
				3561	new_mask &= ~I40E_L3_DST_MASK;
				3562	else
Jacob Keller	faa16e0	2017-03-07 15:05:22 -0800	[diff] [blame]	3563	return -EOPNOTSUPP;
				3564
				3565	/* First 4 bytes of L4 header */
Jacob Keller	36777d9	2017-03-07 15:05:23 -0800	[diff] [blame]	3566	if (usr_ip4_spec->l4_4_bytes == htonl(0xFFFFFFFF))
				3567	new_mask \|= I40E_L4_SRC_MASK \| I40E_L4_DST_MASK;
				3568	else if (!usr_ip4_spec->l4_4_bytes)
				3569	new_mask &= ~(I40E_L4_SRC_MASK \| I40E_L4_DST_MASK);
				3570	else
Jacob Keller	faa16e0	2017-03-07 15:05:22 -0800	[diff] [blame]	3571	return -EOPNOTSUPP;
				3572
				3573	/* Filtering on Type of Service is not supported. */
				3574	if (usr_ip4_spec->tos)
				3575	return -EOPNOTSUPP;
				3576
Jacob Keller	0e588de	2017-02-06 14:38:50 -0800	[diff] [blame]	3577	/* Filtering on IP version is not supported */
Jacob Keller	faa16e0	2017-03-07 15:05:22 -0800	[diff] [blame]	3578	if (usr_ip4_spec->ip_ver)
				3579	return -EINVAL;
				3580
Jacob Keller	0e588de	2017-02-06 14:38:50 -0800	[diff] [blame]	3581	/* Filtering on L4 protocol is not supported */
Jacob Keller	faa16e0	2017-03-07 15:05:22 -0800	[diff] [blame]	3582	if (usr_ip4_spec->proto)
				3583	return -EINVAL;
Jacob Keller	36777d9	2017-03-07 15:05:23 -0800	[diff] [blame]	3584
Jacob Keller	faa16e0	2017-03-07 15:05:22 -0800	[diff] [blame]	3585	break;
				3586	default:
				3587	return -EOPNOTSUPP;
				3588	}
				3589
Jacob Keller	0e588de	2017-02-06 14:38:50 -0800	[diff] [blame]	3590	/* First, clear all flexible filter entries */
				3591	new_mask &= ~I40E_FLEX_INPUT_MASK;
				3592
				3593	/* If we have a flexible filter, try to add this offset to the correct
				3594	* flexible filter PIT list. Once finished, we can update the mask.
				3595	* If the src_offset changed, we will get a new mask value which will
				3596	* trigger an input set change.
Jacob Keller	9229e99	2017-02-06 14:38:47 -0800	[diff] [blame]	3597	*/
Jacob Keller	0e588de	2017-02-06 14:38:50 -0800	[diff] [blame]	3598	if (userdef->flex_filter) {
				3599	struct i40e_flex_pit l3_flex_pit = NULL, flex_pit = NULL;
				3600
				3601	/* Flexible offset must be even, since the flexible payload
				3602	* must be aligned on 2-byte boundary.
				3603	*/
				3604	if (userdef->flex_offset & 0x1) {
				3605	dev_warn(&pf->pdev->dev,
				3606	"Flexible data offset must be 2-byte aligned\n");
				3607	return -EINVAL;
				3608	}
				3609
				3610	src_offset = userdef->flex_offset >> 1;
				3611
				3612	/* FLX_PIT source offset value is only so large */
				3613	if (src_offset > I40E_MAX_FLEX_SRC_OFFSET) {
				3614	dev_warn(&pf->pdev->dev,
				3615	"Flexible data must reside within first 64 bytes of the packet payload\n");
				3616	return -EINVAL;
				3617	}
				3618
				3619	/* See if this offset has already been programmed. If we get
				3620	* an ERR_PTR, then the filter is not safe to add. Otherwise,
				3621	* if we get a NULL pointer, this means we will need to add
				3622	* the offset.
				3623	*/
				3624	flex_pit = i40e_find_flex_offset(&pf->l4_flex_pit_list,
				3625	src_offset);
				3626	if (IS_ERR(flex_pit))
				3627	return PTR_ERR(flex_pit);
				3628
				3629	/* IP_USER_FLOW filters match both L4 (ICMP) and L3 (unknown)
				3630	* packet types, and thus we need to program both L3 and L4
				3631	* flexible values. These must have identical flexible index,
				3632	* as otherwise we can't correctly program the input set. So
				3633	* we'll find both an L3 and L4 index and make sure they are
				3634	* the same.
				3635	*/
				3636	if (flex_l3) {
				3637	l3_flex_pit =
				3638	i40e_find_flex_offset(&pf->l3_flex_pit_list,
				3639	src_offset);
				3640	if (IS_ERR(l3_flex_pit))
				3641	return PTR_ERR(l3_flex_pit);
				3642
				3643	if (flex_pit) {
				3644	/* If we already had a matching L4 entry, we
				3645	* need to make sure that the L3 entry we
				3646	* obtained uses the same index.
				3647	*/
				3648	if (l3_flex_pit) {
				3649	if (l3_flex_pit->pit_index !=
				3650	flex_pit->pit_index) {
				3651	return -EINVAL;
				3652	}
				3653	} else {
				3654	new_flex_offset = true;
				3655	}
				3656	} else {
				3657	flex_pit = l3_flex_pit;
				3658	}
				3659	}
				3660
				3661	/* If we didn't find an existing flex offset, we need to
				3662	* program a new one. However, we don't immediately program it
				3663	* here because we will wait to program until after we check
				3664	* that it is safe to change the input set.
				3665	*/
				3666	if (!flex_pit) {
				3667	new_flex_offset = true;
				3668	pit_index = i40e_unused_pit_index(pf);
				3669	} else {
				3670	pit_index = flex_pit->pit_index;
				3671	}
				3672
				3673	/* Update the mask with the new offset */
				3674	new_mask \|= i40e_pit_index_to_mask(pit_index);
				3675	}
				3676
				3677	/* If the mask and flexible filter offsets for this filter match the
				3678	* currently programmed values we don't need any input set change, so
				3679	* this filter is safe to install.
				3680	*/
				3681	if (new_mask == current_mask && !new_flex_offset)
Jacob Keller	9229e99	2017-02-06 14:38:47 -0800	[diff] [blame]	3682	return 0;
				3683
				3684	netif_info(pf, drv, vsi->netdev, "Input set change requested for %s flows:\n",
				3685	i40e_flow_str(fsp));
				3686	i40e_print_input_set(vsi, current_mask, new_mask);
Jacob Keller	0e588de	2017-02-06 14:38:50 -0800	[diff] [blame]	3687	if (new_flex_offset) {
				3688	netif_info(pf, drv, vsi->netdev, "FLEX index %d: Offset -> %d",
				3689	pit_index, src_offset);
				3690	}
Jacob Keller	9229e99	2017-02-06 14:38:47 -0800	[diff] [blame]	3691
				3692	/* Hardware input sets are global across multiple ports, so even the
				3693	* main port cannot change them when in MFP mode as this would impact
				3694	* any filters on the other ports.
				3695	*/
				3696	if (pf->flags & I40E_FLAG_MFP_ENABLED) {
				3697	netif_err(pf, drv, vsi->netdev, "Cannot change Flow Director input sets while MFP is enabled\n");
Jacob Keller	36777d9	2017-03-07 15:05:23 -0800	[diff] [blame]	3698	return -EOPNOTSUPP;
Jacob Keller	9229e99	2017-02-06 14:38:47 -0800	[diff] [blame]	3699	}
				3700
				3701	/* This filter requires us to update the input set. However, hardware
				3702	* only supports one input set per flow type, and does not support
				3703	* separate masks for each filter. This means that we can only support
				3704	* a single mask for all filters of a specific type.
				3705	*
				3706	* If we have preexisting filters, they obviously depend on the
				3707	* current programmed input set. Display a diagnostic message in this
				3708	* case explaining why the filter could not be accepted.
				3709	*/
				3710	if (*fdir_filter_count) {
				3711	netif_err(pf, drv, vsi->netdev, "Cannot change input set for %s flows until %d preexisting filters are removed\n",
				3712	i40e_flow_str(fsp),
				3713	*fdir_filter_count);
				3714	return -EOPNOTSUPP;
				3715	}
				3716
				3717	i40e_write_fd_input_set(pf, index, new_mask);
Jacob Keller	36777d9	2017-03-07 15:05:23 -0800	[diff] [blame]	3718
Jacob Keller	0e588de	2017-02-06 14:38:50 -0800	[diff] [blame]	3719	/* Add the new offset and update table, if necessary */
				3720	if (new_flex_offset) {
				3721	err = i40e_add_flex_offset(&pf->l4_flex_pit_list, src_offset,
				3722	pit_index);
				3723	if (err)
				3724	return err;
				3725
				3726	if (flex_l3) {
				3727	err = i40e_add_flex_offset(&pf->l3_flex_pit_list,
				3728	src_offset,
				3729	pit_index);
				3730	if (err)
				3731	return err;
				3732	}
				3733
				3734	i40e_reprogram_flex_pit(pf);
				3735	}
				3736
Jacob Keller	faa16e0	2017-03-07 15:05:22 -0800	[diff] [blame]	3737	return 0;
				3738	}
				3739
				3740	/**
Anjali Singhai Jain	1eaa384	2014-03-06 08:59:59 +0000	[diff] [blame]	3741	* i40e_add_fdir_ethtool - Add/Remove Flow Director filters
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	3742	* @vsi: pointer to the targeted VSI
				3743	* @cmd: command to get or set RX flow classification rules
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	3744	*
Anjali Singhai Jain	1eaa384	2014-03-06 08:59:59 +0000	[diff] [blame]	3745	* Add Flow Director filters for a specific flow spec based on their
				3746	* protocol. Returns 0 if the filters were successfully added.
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	3747	**/
Anjali Singhai Jain	1eaa384	2014-03-06 08:59:59 +0000	[diff] [blame]	3748	static int i40e_add_fdir_ethtool(struct i40e_vsi *vsi,
				3749	struct ethtool_rxnfc *cmd)
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	3750	{
Jacob Keller	e793095	2017-02-06 14:38:49 -0800	[diff] [blame]	3751	struct i40e_rx_flow_userdef userdef;
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	3752	struct ethtool_rx_flow_spec *fsp;
				3753	struct i40e_fdir_filter *input;
Jacob Keller	43b1569	2017-02-06 14:38:48 -0800	[diff] [blame]	3754	u16 dest_vsi = 0, q_index = 0;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	3755	struct i40e_pf *pf;
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	3756	int ret = -EINVAL;
Jacob Keller	43b1569	2017-02-06 14:38:48 -0800	[diff] [blame]	3757	u8 dest_ctl;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	3758
				3759	if (!vsi)
				3760	return -EINVAL;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	3761	pf = vsi->back;
				3762
Anjali Singhai Jain	55a5e60	2014-02-12 06:33:25 +0000	[diff] [blame]	3763	if (!(pf->flags & I40E_FLAG_FD_SB_ENABLED))
				3764	return -EOPNOTSUPP;
				3765
Jacob Keller	47994c1	2017-04-19 09:25:57 -0400	[diff] [blame]	3766	if (pf->flags & I40E_FLAG_FD_SB_AUTO_DISABLED)
Anjali Singhai Jain	55a5e60	2014-02-12 06:33:25 +0000	[diff] [blame]	3767	return -ENOSPC;
				3768
Jacob Keller	0da36b9	2017-04-19 09:25:55 -0400	[diff] [blame]	3769	if (test_bit(__I40E_RESET_RECOVERY_PENDING, pf->state) \|\|
				3770	test_bit(__I40E_RESET_INTR_RECEIVED, pf->state))
Anjali Singhai Jain	60793f4a	2014-07-09 07:46:23 +0000	[diff] [blame]	3771	return -EBUSY;
				3772
Jacob Keller	0da36b9	2017-04-19 09:25:55 -0400	[diff] [blame]	3773	if (test_bit(__I40E_FD_FLUSH_REQUESTED, pf->state))
Anjali Singhai Jain	1e1be8f	2014-07-10 08:03:26 +0000	[diff] [blame]	3774	return -EBUSY;
				3775
Anjali Singhai Jain	55a5e60	2014-02-12 06:33:25 +0000	[diff] [blame]	3776	fsp = (struct ethtool_rx_flow_spec *)&cmd->fs;
				3777
Jacob Keller	e793095	2017-02-06 14:38:49 -0800	[diff] [blame]	3778	/* Parse the user-defined field */
				3779	if (i40e_parse_rx_flow_user_data(fsp, &userdef))
				3780	return -EINVAL;
				3781
Jacob Keller	1ec8dea	2017-02-06 14:39:12 -0800	[diff] [blame]	3782	/* Extended MAC field is not supported */
				3783	if (fsp->flow_type & FLOW_MAC_EXT)
				3784	return -EINVAL;
				3785
Jacob Keller	0e588de	2017-02-06 14:38:50 -0800	[diff] [blame]	3786	ret = i40e_check_fdir_input_set(vsi, fsp, &userdef);
Jacob Keller	faa16e0	2017-03-07 15:05:22 -0800	[diff] [blame]	3787	if (ret)
				3788	return ret;
				3789
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	3790	if (fsp->location >= (pf->hw.func_caps.fd_filters_best_effort +
				3791	pf->hw.func_caps.fd_filters_guaranteed)) {
				3792	return -EINVAL;
				3793	}
				3794
Jacob Keller	43b1569	2017-02-06 14:38:48 -0800	[diff] [blame]	3795	/* ring_cookie is either the drop index, or is a mask of the queue
				3796	* index and VF id we wish to target.
				3797	*/
				3798	if (fsp->ring_cookie == RX_CLS_FLOW_DISC) {
				3799	dest_ctl = I40E_FILTER_PROGRAM_DESC_DEST_DROP_PACKET;
				3800	} else {
				3801	u32 ring = ethtool_get_flow_spec_ring(fsp->ring_cookie);
				3802	u8 vf = ethtool_get_flow_spec_ring_vf(fsp->ring_cookie);
				3803
				3804	if (!vf) {
				3805	if (ring >= vsi->num_queue_pairs)
				3806	return -EINVAL;
				3807	dest_vsi = vsi->id;
				3808	} else {
				3809	/* VFs are zero-indexed, so we subtract one here */
				3810	vf--;
				3811
				3812	if (vf >= pf->num_alloc_vfs)
				3813	return -EINVAL;
				3814	if (ring >= pf->vf[vf].num_queue_pairs)
				3815	return -EINVAL;
				3816	dest_vsi = pf->vf[vf].lan_vsi_id;
				3817	}
				3818	dest_ctl = I40E_FILTER_PROGRAM_DESC_DEST_DIRECT_PACKET_QINDEX;
				3819	q_index = ring;
				3820	}
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	3821
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	3822	input = kzalloc(sizeof(*input), GFP_KERNEL);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	3823
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	3824	if (!input)
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	3825	return -ENOMEM;
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	3826
				3827	input->fd_id = fsp->location;
Jacob Keller	43b1569	2017-02-06 14:38:48 -0800	[diff] [blame]	3828	input->q_index = q_index;
				3829	input->dest_vsi = dest_vsi;
				3830	input->dest_ctl = dest_ctl;
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	3831	input->fd_status = I40E_FILTER_PROGRAM_DESC_FD_STATUS_FD_ID;
Anjali Singhai Jain	0bf4b1b	2015-04-16 20:06:02 -0400	[diff] [blame]	3832	input->cnt_index = I40E_FD_SB_STAT_IDX(pf->hw.pf_id);
Jacob Keller	43b1569	2017-02-06 14:38:48 -0800	[diff] [blame]	3833	input->dst_ip = fsp->h_u.tcp_ip4_spec.ip4src;
				3834	input->src_ip = fsp->h_u.tcp_ip4_spec.ip4dst;
Jacob Keller	e793095	2017-02-06 14:38:49 -0800	[diff] [blame]	3835	input->flow_type = fsp->flow_type & ~FLOW_EXT;
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	3836	input->ip4_proto = fsp->h_u.usr_ip4_spec.proto;
Anjali Singhai Jain	04b73bd	2014-05-22 06:31:41 +0000	[diff] [blame]	3837
				3838	/* Reverse the src and dest notion, since the HW expects them to be from
				3839	* Tx perspective where as the input from user is from Rx filter view.
				3840	*/
				3841	input->dst_port = fsp->h_u.tcp_ip4_spec.psrc;
				3842	input->src_port = fsp->h_u.tcp_ip4_spec.pdst;
Jacob Keller	8ce43dc	2017-02-06 14:38:39 -0800	[diff] [blame]	3843	input->dst_ip = fsp->h_u.tcp_ip4_spec.ip4src;
				3844	input->src_ip = fsp->h_u.tcp_ip4_spec.ip4dst;
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	3845
Jacob Keller	0e588de	2017-02-06 14:38:50 -0800	[diff] [blame]	3846	if (userdef.flex_filter) {
				3847	input->flex_filter = true;
				3848	input->flex_word = cpu_to_be16(userdef.flex_word);
				3849	input->flex_offset = userdef.flex_offset;
				3850	}
				3851
Anjali Singhai Jain	1eaa384	2014-03-06 08:59:59 +0000	[diff] [blame]	3852	ret = i40e_add_del_fdir(vsi, input, true);
				3853	if (ret)
Jacob Keller	01016da	2017-02-06 14:38:40 -0800	[diff] [blame]	3854	goto free_input;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	3855
Jacob Keller	01016da	2017-02-06 14:38:40 -0800	[diff] [blame]	3856	/* Add the input filter to the fdir_input_list, possibly replacing
				3857	* a previous filter. Do not free the input structure after adding it
				3858	* to the list as this would cause a use-after-free bug.
				3859	*/
				3860	i40e_update_ethtool_fdir_entry(vsi, input, fsp->location, NULL);
				3861
				3862	return 0;
				3863
				3864	free_input:
				3865	kfree(input);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	3866	return ret;
				3867	}
Jesse Brandeburg	8fb905b	2014-01-17 15:36:33 -0800	[diff] [blame]	3868
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	3869	/**
				3870	* i40e_set_rxnfc - command to set RX flow classification rules
				3871	* @netdev: network interface device structure
				3872	* @cmd: ethtool rxnfc command
				3873	*
				3874	* Returns Success if the command is supported.
				3875	**/
				3876	static int i40e_set_rxnfc(struct net_device netdev, struct ethtool_rxnfc cmd)
				3877	{
				3878	struct i40e_netdev_priv *np = netdev_priv(netdev);
				3879	struct i40e_vsi *vsi = np->vsi;
				3880	struct i40e_pf *pf = vsi->back;
				3881	int ret = -EOPNOTSUPP;
				3882
				3883	switch (cmd->cmd) {
				3884	case ETHTOOL_SRXFH:
				3885	ret = i40e_set_rss_hash_opt(pf, cmd);
				3886	break;
				3887	case ETHTOOL_SRXCLSRLINS:
Anjali Singhai Jain	1eaa384	2014-03-06 08:59:59 +0000	[diff] [blame]	3888	ret = i40e_add_fdir_ethtool(vsi, cmd);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	3889	break;
				3890	case ETHTOOL_SRXCLSRLDEL:
Joseph Gasparakis	17a73f6	2014-02-12 01:45:30 +0000	[diff] [blame]	3891	ret = i40e_del_fdir_entry(vsi, cmd);
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	3892	break;
				3893	default:
				3894	break;
				3895	}
				3896
				3897	return ret;
				3898	}
				3899
Anjali Singhai Jain	4b7820c	2013-11-26 11:59:30 +0000	[diff] [blame]	3900	/**
				3901	* i40e_max_channels - get Max number of combined channels supported
				3902	* @vsi: vsi pointer
				3903	**/
				3904	static unsigned int i40e_max_channels(struct i40e_vsi *vsi)
				3905	{
				3906	/* TODO: This code assumes DCB and FD is disabled for now. */
				3907	return vsi->alloc_queue_pairs;
				3908	}
				3909
				3910	/**
				3911	* i40e_get_channels - Get the current channels enabled and max supported etc.
				3912	* @netdev: network interface device structure
				3913	* @ch: ethtool channels structure
				3914	*
				3915	* We don't support separate tx and rx queues as channels. The other count
				3916	* represents how many queues are being used for control. max_combined counts
				3917	* how many queue pairs we can support. They may not be mapped 1 to 1 with
				3918	* q_vectors since we support a lot more queue pairs than q_vectors.
				3919	**/
				3920	static void i40e_get_channels(struct net_device *dev,
				3921	struct ethtool_channels *ch)
				3922	{
				3923	struct i40e_netdev_priv *np = netdev_priv(dev);
				3924	struct i40e_vsi *vsi = np->vsi;
				3925	struct i40e_pf *pf = vsi->back;
				3926
				3927	/* report maximum channels */
				3928	ch->max_combined = i40e_max_channels(vsi);
				3929
				3930	/* report info for other vector */
Jesse Brandeburg	60ea5f8	2014-01-17 15:36:34 -0800	[diff] [blame]	3931	ch->other_count = (pf->flags & I40E_FLAG_FD_SB_ENABLED) ? 1 : 0;
Anjali Singhai Jain	4b7820c	2013-11-26 11:59:30 +0000	[diff] [blame]	3932	ch->max_other = ch->other_count;
				3933
				3934	/* Note: This code assumes DCB is disabled for now. */
				3935	ch->combined_count = vsi->num_queue_pairs;
				3936	}
				3937
				3938	/**
				3939	* i40e_set_channels - Set the new channels count.
				3940	* @netdev: network interface device structure
				3941	* @ch: ethtool channels structure
				3942	*
				3943	* The new channels count may not be the same as requested by the user
				3944	* since it gets rounded down to a power of 2 value.
				3945	**/
				3946	static int i40e_set_channels(struct net_device *dev,
				3947	struct ethtool_channels *ch)
				3948	{
Jacob Keller	59826d9	2016-07-27 12:02:35 -0700	[diff] [blame]	3949	const u8 drop = I40E_FILTER_PROGRAM_DESC_DEST_DROP_PACKET;
Anjali Singhai Jain	4b7820c	2013-11-26 11:59:30 +0000	[diff] [blame]	3950	struct i40e_netdev_priv *np = netdev_priv(dev);
				3951	unsigned int count = ch->combined_count;
				3952	struct i40e_vsi *vsi = np->vsi;
				3953	struct i40e_pf *pf = vsi->back;
Jacob Keller	59826d9	2016-07-27 12:02:35 -0700	[diff] [blame]	3954	struct i40e_fdir_filter *rule;
				3955	struct hlist_node *node2;
Anjali Singhai Jain	4b7820c	2013-11-26 11:59:30 +0000	[diff] [blame]	3956	int new_count;
Jacob Keller	59826d9	2016-07-27 12:02:35 -0700	[diff] [blame]	3957	int err = 0;
Anjali Singhai Jain	4b7820c	2013-11-26 11:59:30 +0000	[diff] [blame]	3958
				3959	/* We do not support setting channels for any other VSI at present */
				3960	if (vsi->type != I40E_VSI_MAIN)
				3961	return -EINVAL;
				3962
Amritha Nambiar	a9ce82f	2017-09-07 04:00:22 -0700	[diff] [blame]	3963	/* We do not support setting channels via ethtool when TCs are
				3964	* configured through mqprio
				3965	*/
				3966	if (pf->flags & I40E_FLAG_TC_MQPRIO)
				3967	return -EINVAL;
				3968
Anjali Singhai Jain	4b7820c	2013-11-26 11:59:30 +0000	[diff] [blame]	3969	/* verify they are not requesting separate vectors */
				3970	if (!count \|\| ch->rx_count \|\| ch->tx_count)
				3971	return -EINVAL;
				3972
				3973	/* verify other_count has not changed */
Jesse Brandeburg	60ea5f8	2014-01-17 15:36:34 -0800	[diff] [blame]	3974	if (ch->other_count != ((pf->flags & I40E_FLAG_FD_SB_ENABLED) ? 1 : 0))
Anjali Singhai Jain	4b7820c	2013-11-26 11:59:30 +0000	[diff] [blame]	3975	return -EINVAL;
				3976
				3977	/* verify the number of channels does not exceed hardware limits */
				3978	if (count > i40e_max_channels(vsi))
				3979	return -EINVAL;
				3980
Jacob Keller	59826d9	2016-07-27 12:02:35 -0700	[diff] [blame]	3981	/* verify that the number of channels does not invalidate any current
				3982	* flow director rules
				3983	*/
				3984	hlist_for_each_entry_safe(rule, node2,
				3985	&pf->fdir_filter_list, fdir_node) {
				3986	if (rule->dest_ctl != drop && count <= rule->q_index) {
				3987	dev_warn(&pf->pdev->dev,
				3988	"Existing user defined filter %d assigns flow to queue %d\n",
				3989	rule->fd_id, rule->q_index);
				3990	err = -EINVAL;
				3991	}
				3992	}
				3993
				3994	if (err) {
				3995	dev_err(&pf->pdev->dev,
				3996	"Existing filter rules must be deleted to reduce combined channel count to %d\n",
				3997	count);
				3998	return err;
				3999	}
				4000
Anjali Singhai Jain	4b7820c	2013-11-26 11:59:30 +0000	[diff] [blame]	4001	/* update feature limits from largest to smallest supported values */
				4002	/* TODO: Flow director limit, DCB etc */
				4003
Anjali Singhai Jain	4b7820c	2013-11-26 11:59:30 +0000	[diff] [blame]	4004	/* use rss_reconfig to rebuild with new queue count and update traffic
				4005	* class queue mapping
				4006	*/
				4007	new_count = i40e_reconfig_rss_queues(pf, count);
Anjali Singhai Jain	5f90f42	2013-12-21 05:44:43 +0000	[diff] [blame]	4008	if (new_count > 0)
Anjali Singhai Jain	4b7820c	2013-11-26 11:59:30 +0000	[diff] [blame]	4009	return 0;
				4010	else
				4011	return -EINVAL;
				4012	}
				4013
Mitch A Williams	b29e13b	2015-03-05 04:14:40 +0000	[diff] [blame]	4014	/**
				4015	* i40e_get_rxfh_key_size - get the RSS hash key size
				4016	* @netdev: network interface device structure
				4017	*
				4018	* Returns the table size.
				4019	**/
				4020	static u32 i40e_get_rxfh_key_size(struct net_device *netdev)
				4021	{
				4022	return I40E_HKEY_ARRAY_SIZE;
				4023	}
				4024
				4025	/**
				4026	* i40e_get_rxfh_indir_size - get the rx flow hash indirection table size
				4027	* @netdev: network interface device structure
				4028	*
				4029	* Returns the table size.
				4030	**/
				4031	static u32 i40e_get_rxfh_indir_size(struct net_device *netdev)
				4032	{
				4033	return I40E_HLUT_ARRAY_SIZE;
				4034	}
				4035
Alan Brady	21675bd	2017-10-05 14:53:33 -0700	[diff] [blame]	4036	/**
				4037	* i40e_get_rxfh - get the rx flow hash indirection table
				4038	* @netdev: network interface device structure
				4039	* @indir: indirection table
				4040	* @key: hash key
				4041	* @hfunc: hash function
				4042	*
				4043	* Reads the indirection table directly from the hardware. Returns 0 on
				4044	* success.
				4045	**/
Mitch A Williams	b29e13b	2015-03-05 04:14:40 +0000	[diff] [blame]	4046	static int i40e_get_rxfh(struct net_device netdev, u32 indir, u8 *key,
				4047	u8 *hfunc)
				4048	{
				4049	struct i40e_netdev_priv *np = netdev_priv(netdev);
				4050	struct i40e_vsi *vsi = np->vsi;
Helin Zhang	043dd65	2015-10-21 19:56:23 -0400	[diff] [blame]	4051	u8 lut, seed = NULL;
				4052	int ret;
				4053	u16 i;
Mitch A Williams	b29e13b	2015-03-05 04:14:40 +0000	[diff] [blame]	4054
				4055	if (hfunc)
				4056	*hfunc = ETH_RSS_HASH_TOP;
				4057
				4058	if (!indir)
				4059	return 0;
				4060
Helin Zhang	043dd65	2015-10-21 19:56:23 -0400	[diff] [blame]	4061	seed = key;
				4062	lut = kzalloc(I40E_HLUT_ARRAY_SIZE, GFP_KERNEL);
				4063	if (!lut)
				4064	return -ENOMEM;
				4065	ret = i40e_get_rss(vsi, seed, lut, I40E_HLUT_ARRAY_SIZE);
				4066	if (ret)
				4067	goto out;
				4068	for (i = 0; i < I40E_HLUT_ARRAY_SIZE; i++)
				4069	indir[i] = (u32)(lut[i]);
Mitch A Williams	b29e13b	2015-03-05 04:14:40 +0000	[diff] [blame]	4070
Helin Zhang	043dd65	2015-10-21 19:56:23 -0400	[diff] [blame]	4071	out:
				4072	kfree(lut);
				4073
				4074	return ret;
Mitch A Williams	b29e13b	2015-03-05 04:14:40 +0000	[diff] [blame]	4075	}
				4076
				4077	/**
				4078	* i40e_set_rxfh - set the rx flow hash indirection table
				4079	* @netdev: network interface device structure
				4080	* @indir: indirection table
				4081	* @key: hash key
				4082	*
Mitch Williams	cd494fb	2015-07-10 19:36:04 -0400	[diff] [blame]	4083	* Returns -EINVAL if the table specifies an invalid queue id, otherwise
Mitch A Williams	b29e13b	2015-03-05 04:14:40 +0000	[diff] [blame]	4084	* returns 0 after programming the table.
				4085	**/
				4086	static int i40e_set_rxfh(struct net_device netdev, const u32 indir,
				4087	const u8 *key, const u8 hfunc)
				4088	{
				4089	struct i40e_netdev_priv *np = netdev_priv(netdev);
				4090	struct i40e_vsi *vsi = np->vsi;
Alan Brady	f158235	2016-08-24 11:33:46 -0700	[diff] [blame]	4091	struct i40e_pf *pf = vsi->back;
Helin Zhang	28c5869	2015-10-26 19:44:27 -0400	[diff] [blame]	4092	u8 *seed = NULL;
Helin Zhang	043dd65	2015-10-21 19:56:23 -0400	[diff] [blame]	4093	u16 i;
Mitch A Williams	b29e13b	2015-03-05 04:14:40 +0000	[diff] [blame]	4094
				4095	if (hfunc != ETH_RSS_HASH_NO_CHANGE && hfunc != ETH_RSS_HASH_TOP)
				4096	return -EOPNOTSUPP;
				4097
Mitch A Williams	b29e13b	2015-03-05 04:14:40 +0000	[diff] [blame]	4098	if (key) {
Helin Zhang	28c5869	2015-10-26 19:44:27 -0400	[diff] [blame]	4099	if (!vsi->rss_hkey_user) {
				4100	vsi->rss_hkey_user = kzalloc(I40E_HKEY_ARRAY_SIZE,
				4101	GFP_KERNEL);
				4102	if (!vsi->rss_hkey_user)
				4103	return -ENOMEM;
				4104	}
				4105	memcpy(vsi->rss_hkey_user, key, I40E_HKEY_ARRAY_SIZE);
				4106	seed = vsi->rss_hkey_user;
Mitch A Williams	b29e13b	2015-03-05 04:14:40 +0000	[diff] [blame]	4107	}
Helin Zhang	28c5869	2015-10-26 19:44:27 -0400	[diff] [blame]	4108	if (!vsi->rss_lut_user) {
				4109	vsi->rss_lut_user = kzalloc(I40E_HLUT_ARRAY_SIZE, GFP_KERNEL);
				4110	if (!vsi->rss_lut_user)
				4111	return -ENOMEM;
				4112	}
Helin Zhang	043dd65	2015-10-21 19:56:23 -0400	[diff] [blame]	4113
Helin Zhang	28c5869	2015-10-26 19:44:27 -0400	[diff] [blame]	4114	/* Each 32 bits pointed by 'indir' is stored with a lut entry */
Alan Brady	f158235	2016-08-24 11:33:46 -0700	[diff] [blame]	4115	if (indir)
				4116	for (i = 0; i < I40E_HLUT_ARRAY_SIZE; i++)
				4117	vsi->rss_lut_user[i] = (u8)(indir[i]);
				4118	else
				4119	i40e_fill_rss_lut(pf, vsi->rss_lut_user, I40E_HLUT_ARRAY_SIZE,
				4120	vsi->rss_size);
Helin Zhang	28c5869	2015-10-26 19:44:27 -0400	[diff] [blame]	4121
				4122	return i40e_config_rss(vsi, seed, vsi->rss_lut_user,
				4123	I40E_HLUT_ARRAY_SIZE);
Mitch A Williams	b29e13b	2015-03-05 04:14:40 +0000	[diff] [blame]	4124	}
				4125
Greg Rose	7e45ab4	2015-02-06 08:52:19 +0000	[diff] [blame]	4126	/**
				4127	* i40e_get_priv_flags - report device private flags
				4128	* @dev: network interface device structure
				4129	*
				4130	* The get string set count and the string set should be matched for each
Alexander Duyck	aca955d	2017-03-10 12:22:01 -0800	[diff] [blame]	4131	* flag returned. Add new strings for each flag to the i40e_gstrings_priv_flags
Greg Rose	7e45ab4	2015-02-06 08:52:19 +0000	[diff] [blame]	4132	* array.
				4133	*
				4134	* Returns a u32 bitmap of flags.
				4135	**/
Jesse Brandeburg	5bbc330	2015-02-26 16:15:20 +0000	[diff] [blame]	4136	static u32 i40e_get_priv_flags(struct net_device *dev)
Greg Rose	7e45ab4	2015-02-06 08:52:19 +0000	[diff] [blame]	4137	{
				4138	struct i40e_netdev_priv *np = netdev_priv(dev);
				4139	struct i40e_vsi *vsi = np->vsi;
				4140	struct i40e_pf *pf = vsi->back;
Alexander Duyck	aca955d	2017-03-10 12:22:01 -0800	[diff] [blame]	4141	u32 i, j, ret_flags = 0;
Greg Rose	7e45ab4	2015-02-06 08:52:19 +0000	[diff] [blame]	4142
Alexander Duyck	aca955d	2017-03-10 12:22:01 -0800	[diff] [blame]	4143	for (i = 0; i < I40E_PRIV_FLAGS_STR_LEN; i++) {
				4144	const struct i40e_priv_flags *priv_flags;
				4145
				4146	priv_flags = &i40e_gstrings_priv_flags[i];
				4147
				4148	if (priv_flags->flag & pf->flags)
				4149	ret_flags \|= BIT(i);
				4150	}
				4151
				4152	if (pf->hw.pf_id != 0)
				4153	return ret_flags;
				4154
				4155	for (j = 0; j < I40E_GL_PRIV_FLAGS_STR_LEN; j++) {
				4156	const struct i40e_priv_flags *priv_flags;
				4157
				4158	priv_flags = &i40e_gl_gstrings_priv_flags[j];
				4159
				4160	if (priv_flags->flag & pf->flags)
				4161	ret_flags \|= BIT(i + j);
Anjali Singhai Jain	b556989	2016-05-03 15:13:12 -0700	[diff] [blame]	4162	}
Greg Rose	7e45ab4	2015-02-06 08:52:19 +0000	[diff] [blame]	4163
				4164	return ret_flags;
				4165	}
				4166
Shannon Nelson	9ac7726	2015-08-27 11:42:40 -0400	[diff] [blame]	4167	/**
				4168	* i40e_set_priv_flags - set private flags
				4169	* @dev: network interface device structure
				4170	* @flags: bit flags to be set
				4171	**/
				4172	static int i40e_set_priv_flags(struct net_device *dev, u32 flags)
				4173	{
				4174	struct i40e_netdev_priv *np = netdev_priv(dev);
				4175	struct i40e_vsi *vsi = np->vsi;
				4176	struct i40e_pf *pf = vsi->back;
Jacob Keller	b74f571	2017-09-01 13:54:07 -0700	[diff] [blame]	4177	u32 orig_flags, new_flags, changed_flags;
Alexander Duyck	aca955d	2017-03-10 12:22:01 -0800	[diff] [blame]	4178	u32 i, j;
Jesse Brandeburg	827de39	2015-11-06 15:26:07 -0800	[diff] [blame]	4179
Jacob Keller	841c950	2017-06-23 04:24:50 -0400	[diff] [blame]	4180	orig_flags = READ_ONCE(pf->flags);
				4181	new_flags = orig_flags;
Jesse Brandeburg	827de39	2015-11-06 15:26:07 -0800	[diff] [blame]	4182
Alexander Duyck	aca955d	2017-03-10 12:22:01 -0800	[diff] [blame]	4183	for (i = 0; i < I40E_PRIV_FLAGS_STR_LEN; i++) {
				4184	const struct i40e_priv_flags *priv_flags;
Shannon Nelson	9ac7726	2015-08-27 11:42:40 -0400	[diff] [blame]	4185
Alexander Duyck	aca955d	2017-03-10 12:22:01 -0800	[diff] [blame]	4186	priv_flags = &i40e_gstrings_priv_flags[i];
				4187
Alexander Duyck	aca955d	2017-03-10 12:22:01 -0800	[diff] [blame]	4188	if (flags & BIT(i))
Jacob Keller	841c950	2017-06-23 04:24:50 -0400	[diff] [blame]	4189	new_flags \|= priv_flags->flag;
Alexander Duyck	aca955d	2017-03-10 12:22:01 -0800	[diff] [blame]	4190	else
Jacob Keller	841c950	2017-06-23 04:24:50 -0400	[diff] [blame]	4191	new_flags &= ~(priv_flags->flag);
				4192
				4193	/* If this is a read-only flag, it can't be changed */
				4194	if (priv_flags->read_only &&
				4195	((orig_flags ^ new_flags) & ~BIT(i)))
				4196	return -EOPNOTSUPP;
Alexander Duyck	aca955d	2017-03-10 12:22:01 -0800	[diff] [blame]	4197	}
				4198
				4199	if (pf->hw.pf_id != 0)
				4200	goto flags_complete;
				4201
				4202	for (j = 0; j < I40E_GL_PRIV_FLAGS_STR_LEN; j++) {
				4203	const struct i40e_priv_flags *priv_flags;
				4204
				4205	priv_flags = &i40e_gl_gstrings_priv_flags[j];
				4206
Alexander Duyck	aca955d	2017-03-10 12:22:01 -0800	[diff] [blame]	4207	if (flags & BIT(i + j))
Jacob Keller	841c950	2017-06-23 04:24:50 -0400	[diff] [blame]	4208	new_flags \|= priv_flags->flag;
Alexander Duyck	aca955d	2017-03-10 12:22:01 -0800	[diff] [blame]	4209	else
Jacob Keller	841c950	2017-06-23 04:24:50 -0400	[diff] [blame]	4210	new_flags &= ~(priv_flags->flag);
				4211
				4212	/* If this is a read-only flag, it can't be changed */
				4213	if (priv_flags->read_only &&
				4214	((orig_flags ^ new_flags) & ~BIT(i)))
				4215	return -EOPNOTSUPP;
Alexander Duyck	aca955d	2017-03-10 12:22:01 -0800	[diff] [blame]	4216	}
				4217
				4218	flags_complete:
Jacob Keller	841c950	2017-06-23 04:24:50 -0400	[diff] [blame]	4219	/* Before we finalize any flag changes, we need to perform some
				4220	* checks to ensure that the changes are supported and safe.
				4221	*/
				4222
				4223	/* ATR eviction is not supported on all devices */
				4224	if ((new_flags & I40E_FLAG_HW_ATR_EVICT_ENABLED) &&
				4225	!(pf->hw_features & I40E_HW_ATR_EVICT_CAPABLE))
				4226	return -EOPNOTSUPP;
				4227
				4228	/* Compare and exchange the new flags into place. If we failed, that
Jacob Keller	b74f571	2017-09-01 13:54:07 -0700	[diff] [blame]	4229	* is if cmpxchg returns anything but the old value, this means that
Jacob Keller	841c950	2017-06-23 04:24:50 -0400	[diff] [blame]	4230	* something else has modified the flags variable since we copied it
				4231	* originally. We'll just punt with an error and log something in the
				4232	* message buffer.
				4233	*/
Jacob Keller	b74f571	2017-09-01 13:54:07 -0700	[diff] [blame]	4234	if (cmpxchg(&pf->flags, orig_flags, new_flags) != orig_flags) {
Jacob Keller	841c950	2017-06-23 04:24:50 -0400	[diff] [blame]	4235	dev_warn(&pf->pdev->dev,
				4236	"Unable to update pf->flags as it was modified by another thread...\n");
				4237	return -EAGAIN;
				4238	}
				4239
				4240	changed_flags = orig_flags ^ new_flags;
Alexander Duyck	aca955d	2017-03-10 12:22:01 -0800	[diff] [blame]	4241
				4242	/* Process any additional changes needed as a result of flag changes.
				4243	* The changed_flags value reflects the list of bits that were
				4244	* changed in the code above.
Jesse Brandeburg	ef17178	2015-09-03 17:18:49 -0400	[diff] [blame]	4245	*/
Jacob Keller	234dc4e	2016-09-06 18:05:09 -0700	[diff] [blame]	4246
Alexander Duyck	aca955d	2017-03-10 12:22:01 -0800	[diff] [blame]	4247	/* Flush current ATR settings if ATR was disabled */
				4248	if ((changed_flags & I40E_FLAG_FD_ATR_ENABLED) &&
				4249	!(pf->flags & I40E_FLAG_FD_ATR_ENABLED)) {
Jacob Keller	47994c1	2017-04-19 09:25:57 -0400	[diff] [blame]	4250	pf->flags \|= I40E_FLAG_FD_ATR_AUTO_DISABLED;
Jacob Keller	0da36b9	2017-04-19 09:25:55 -0400	[diff] [blame]	4251	set_bit(__I40E_FD_FLUSH_REQUESTED, pf->state);
Jesse Brandeburg	ef17178	2015-09-03 17:18:49 -0400	[diff] [blame]	4252	}
				4253
Alexander Duyck	aca955d	2017-03-10 12:22:01 -0800	[diff] [blame]	4254	if (changed_flags & I40E_FLAG_TRUE_PROMISC_SUPPORT) {
				4255	u16 sw_flags = 0, valid_flags = 0;
				4256	int ret;
				4257
Anjali Singhai Jain	b556989	2016-05-03 15:13:12 -0700	[diff] [blame]	4258	if (!(pf->flags & I40E_FLAG_TRUE_PROMISC_SUPPORT))
				4259	sw_flags = I40E_AQ_SET_SWITCH_CFG_PROMISC;
				4260	valid_flags = I40E_AQ_SET_SWITCH_CFG_PROMISC;
				4261	ret = i40e_aq_set_switch_config(&pf->hw, sw_flags, valid_flags,
				4262	NULL);
				4263	if (ret && pf->hw.aq.asq_last_status != I40E_AQ_RC_ESRCH) {
				4264	dev_info(&pf->pdev->dev,
				4265	"couldn't set switch config bits, err %s aq_err %s\n",
				4266	i40e_stat_str(&pf->hw, ret),
				4267	i40e_aq_str(&pf->hw,
				4268	pf->hw.aq.asq_last_status));
				4269	/* not a fatal problem, just keep going */
				4270	}
				4271	}
				4272
Alexander Duyck	aca955d	2017-03-10 12:22:01 -0800	[diff] [blame]	4273	/* Issue reset to cause things to take effect, as additional bits
				4274	* are added we will need to create a mask of bits requiring reset
				4275	*/
Mitch Williams	64615b5	2017-08-29 05:32:30 -0400	[diff] [blame]	4276	if (changed_flags & (I40E_FLAG_VEB_STATS_ENABLED \|
				4277	I40E_FLAG_LEGACY_RX \|
				4278	I40E_FLAG_SOURCE_PRUNING_DISABLED))
Maciej Sosin	373149f	2017-04-05 07:50:55 -0400	[diff] [blame]	4279	i40e_do_reset(pf, BIT(__I40E_PF_RESET_REQUESTED), true);
Jesse Brandeburg	827de39	2015-11-06 15:26:07 -0800	[diff] [blame]	4280
Shannon Nelson	9ac7726	2015-08-27 11:42:40 -0400	[diff] [blame]	4281	return 0;
				4282	}
				4283
Filip Sadowski	9c0e5ca	2017-08-22 06:57:44 -0400	[diff] [blame]	4284	/**
				4285	* i40e_get_module_info - get (Q)SFP+ module type info
				4286	* @netdev: network interface device structure
				4287	* @modinfo: module EEPROM size and layout information structure
				4288	**/
				4289	static int i40e_get_module_info(struct net_device *netdev,
				4290	struct ethtool_modinfo *modinfo)
				4291	{
				4292	struct i40e_netdev_priv *np = netdev_priv(netdev);
				4293	struct i40e_vsi *vsi = np->vsi;
				4294	struct i40e_pf *pf = vsi->back;
				4295	struct i40e_hw *hw = &pf->hw;
				4296	u32 sff8472_comp = 0;
				4297	u32 sff8472_swap = 0;
				4298	u32 sff8636_rev = 0;
				4299	i40e_status status;
				4300	u32 type = 0;
				4301
				4302	/* Check if firmware supports reading module EEPROM. */
				4303	if (!(hw->flags & I40E_HW_FLAG_AQ_PHY_ACCESS_CAPABLE)) {
				4304	netdev_err(vsi->netdev, "Module EEPROM memory read not supported. Please update the NVM image.\n");
				4305	return -EINVAL;
				4306	}
				4307
				4308	status = i40e_update_link_info(hw);
				4309	if (status)
				4310	return -EIO;
				4311
				4312	if (hw->phy.link_info.phy_type == I40E_PHY_TYPE_EMPTY) {
				4313	netdev_err(vsi->netdev, "Cannot read module EEPROM memory. No module connected.\n");
				4314	return -EINVAL;
				4315	}
				4316
				4317	type = hw->phy.link_info.module_type[0];
				4318
				4319	switch (type) {
				4320	case I40E_MODULE_TYPE_SFP:
				4321	status = i40e_aq_get_phy_register(hw,
				4322	I40E_AQ_PHY_REG_ACCESS_EXTERNAL_MODULE,
				4323	I40E_I2C_EEPROM_DEV_ADDR,
				4324	I40E_MODULE_SFF_8472_COMP,
				4325	&sff8472_comp, NULL);
				4326	if (status)
				4327	return -EIO;
				4328
				4329	status = i40e_aq_get_phy_register(hw,
				4330	I40E_AQ_PHY_REG_ACCESS_EXTERNAL_MODULE,
				4331	I40E_I2C_EEPROM_DEV_ADDR,
				4332	I40E_MODULE_SFF_8472_SWAP,
				4333	&sff8472_swap, NULL);
				4334	if (status)
				4335	return -EIO;
				4336
				4337	/* Check if the module requires address swap to access
				4338	* the other EEPROM memory page.
				4339	*/
				4340	if (sff8472_swap & I40E_MODULE_SFF_ADDR_MODE) {
				4341	netdev_warn(vsi->netdev, "Module address swap to access page 0xA2 is not supported.\n");
				4342	modinfo->type = ETH_MODULE_SFF_8079;
				4343	modinfo->eeprom_len = ETH_MODULE_SFF_8079_LEN;
				4344	} else if (sff8472_comp == 0x00) {
				4345	/* Module is not SFF-8472 compliant */
				4346	modinfo->type = ETH_MODULE_SFF_8079;
				4347	modinfo->eeprom_len = ETH_MODULE_SFF_8079_LEN;
				4348	} else {
				4349	modinfo->type = ETH_MODULE_SFF_8472;
				4350	modinfo->eeprom_len = ETH_MODULE_SFF_8472_LEN;
				4351	}
				4352	break;
				4353	case I40E_MODULE_TYPE_QSFP_PLUS:
				4354	/* Read from memory page 0. */
				4355	status = i40e_aq_get_phy_register(hw,
				4356	I40E_AQ_PHY_REG_ACCESS_EXTERNAL_MODULE,
				4357	0,
				4358	I40E_MODULE_REVISION_ADDR,
				4359	&sff8636_rev, NULL);
				4360	if (status)
				4361	return -EIO;
				4362	/* Determine revision compliance byte */
				4363	if (sff8636_rev > 0x02) {
				4364	/* Module is SFF-8636 compliant */
				4365	modinfo->type = ETH_MODULE_SFF_8636;
				4366	modinfo->eeprom_len = I40E_MODULE_QSFP_MAX_LEN;
				4367	} else {
				4368	modinfo->type = ETH_MODULE_SFF_8436;
				4369	modinfo->eeprom_len = I40E_MODULE_QSFP_MAX_LEN;
				4370	}
				4371	break;
				4372	case I40E_MODULE_TYPE_QSFP28:
				4373	modinfo->type = ETH_MODULE_SFF_8636;
				4374	modinfo->eeprom_len = I40E_MODULE_QSFP_MAX_LEN;
				4375	break;
				4376	default:
				4377	netdev_err(vsi->netdev, "Module type unrecognized\n");
				4378	return -EINVAL;
				4379	}
				4380	return 0;
				4381	}
				4382
				4383	/**
				4384	* i40e_get_module_eeprom - fills buffer with (Q)SFP+ module memory contents
				4385	* @netdev: network interface device structure
				4386	* @ee: EEPROM dump request structure
				4387	* @data: buffer to be filled with EEPROM contents
				4388	**/
				4389	static int i40e_get_module_eeprom(struct net_device *netdev,
				4390	struct ethtool_eeprom *ee,
				4391	u8 *data)
				4392	{
				4393	struct i40e_netdev_priv *np = netdev_priv(netdev);
				4394	struct i40e_vsi *vsi = np->vsi;
				4395	struct i40e_pf *pf = vsi->back;
				4396	struct i40e_hw *hw = &pf->hw;
				4397	bool is_sfp = false;
				4398	i40e_status status;
				4399	u32 value = 0;
				4400	int i;
				4401
				4402	if (!ee \|\| !ee->len \|\| !data)
				4403	return -EINVAL;
				4404
				4405	if (hw->phy.link_info.module_type[0] == I40E_MODULE_TYPE_SFP)
				4406	is_sfp = true;
				4407
				4408	for (i = 0; i < ee->len; i++) {
				4409	u32 offset = i + ee->offset;
				4410	u32 addr = is_sfp ? I40E_I2C_EEPROM_DEV_ADDR : 0;
				4411
				4412	/* Check if we need to access the other memory page */
				4413	if (is_sfp) {
				4414	if (offset >= ETH_MODULE_SFF_8079_LEN) {
				4415	offset -= ETH_MODULE_SFF_8079_LEN;
				4416	addr = I40E_I2C_EEPROM_DEV_ADDR2;
				4417	}
				4418	} else {
				4419	while (offset >= ETH_MODULE_SFF_8436_LEN) {
				4420	/* Compute memory page number and offset. */
				4421	offset -= ETH_MODULE_SFF_8436_LEN / 2;
				4422	addr++;
				4423	}
				4424	}
				4425
				4426	status = i40e_aq_get_phy_register(hw,
				4427	I40E_AQ_PHY_REG_ACCESS_EXTERNAL_MODULE,
				4428	addr, offset, &value, NULL);
				4429	if (status)
				4430	return -EIO;
				4431	data[i] = value;
				4432	}
				4433	return 0;
				4434	}
				4435
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	4436	static const struct ethtool_ops i40e_ethtool_ops = {
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	4437	.get_drvinfo = i40e_get_drvinfo,
				4438	.get_regs_len = i40e_get_regs_len,
				4439	.get_regs = i40e_get_regs,
				4440	.nway_reset = i40e_nway_reset,
				4441	.get_link = ethtool_op_get_link,
				4442	.get_wol = i40e_get_wol,
Shannon Nelson	8e2773a	2013-11-28 06:39:22 +0000	[diff] [blame]	4443	.set_wol = i40e_set_wol,
Shannon Nelson	cd552cb	2014-07-09 07:46:09 +0000	[diff] [blame]	4444	.set_eeprom = i40e_set_eeprom,
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	4445	.get_eeprom_len = i40e_get_eeprom_len,
				4446	.get_eeprom = i40e_get_eeprom,
				4447	.get_ringparam = i40e_get_ringparam,
				4448	.set_ringparam = i40e_set_ringparam,
				4449	.get_pauseparam = i40e_get_pauseparam,
Catherine Sullivan	2becc35	2014-06-04 08:45:27 +0000	[diff] [blame]	4450	.set_pauseparam = i40e_set_pauseparam,
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	4451	.get_msglevel = i40e_get_msglevel,
				4452	.set_msglevel = i40e_set_msglevel,
				4453	.get_rxnfc = i40e_get_rxnfc,
				4454	.set_rxnfc = i40e_set_rxnfc,
				4455	.self_test = i40e_diag_test,
				4456	.get_strings = i40e_get_strings,
				4457	.set_phys_id = i40e_set_phys_id,
				4458	.get_sset_count = i40e_get_sset_count,
				4459	.get_ethtool_stats = i40e_get_ethtool_stats,
				4460	.get_coalesce = i40e_get_coalesce,
				4461	.set_coalesce = i40e_set_coalesce,
Mitch A Williams	b29e13b	2015-03-05 04:14:40 +0000	[diff] [blame]	4462	.get_rxfh_key_size = i40e_get_rxfh_key_size,
				4463	.get_rxfh_indir_size = i40e_get_rxfh_indir_size,
				4464	.get_rxfh = i40e_get_rxfh,
				4465	.set_rxfh = i40e_set_rxfh,
Anjali Singhai Jain	4b7820c	2013-11-26 11:59:30 +0000	[diff] [blame]	4466	.get_channels = i40e_get_channels,
				4467	.set_channels = i40e_set_channels,
Filip Sadowski	9c0e5ca	2017-08-22 06:57:44 -0400	[diff] [blame]	4468	.get_module_info = i40e_get_module_info,
				4469	.get_module_eeprom = i40e_get_module_eeprom,
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	4470	.get_ts_info = i40e_get_ts_info,
Greg Rose	7e45ab4	2015-02-06 08:52:19 +0000	[diff] [blame]	4471	.get_priv_flags = i40e_get_priv_flags,
Shannon Nelson	9ac7726	2015-08-27 11:42:40 -0400	[diff] [blame]	4472	.set_priv_flags = i40e_set_priv_flags,
Kan Liang	be280ba	2016-02-19 09:24:05 -0500	[diff] [blame]	4473	.get_per_queue_coalesce = i40e_get_per_queue_coalesce,
Kan Liang	f3757a4	2016-02-19 09:24:06 -0500	[diff] [blame]	4474	.set_per_queue_coalesce = i40e_set_per_queue_coalesce,
Philippe Reynes	a7f9094	2017-02-04 22:05:06 +0100	[diff] [blame]	4475	.get_link_ksettings = i40e_get_link_ksettings,
				4476	.set_link_ksettings = i40e_set_link_ksettings,
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	4477	};
				4478
				4479	void i40e_set_ethtool_ops(struct net_device *netdev)
				4480	{
Wilfried Klaebe	7ad24ea	2014-05-11 00:12:32 +0000	[diff] [blame]	4481	netdev->ethtool_ops = &i40e_ethtool_ops;
Jesse Brandeburg	c7d05ca	2013-09-11 08:39:56 +0000	[diff] [blame]	4482	}