[linux-2.6-block.git] / drivers / net / ethernet / mellanox / mlx5 / core / ipoib / ethtool.c

/*
 * Copyright (c) 2017, Mellanox Technologies. All rights reserved.
 *
 * This software is available to you under a choice of one of two
 * licenses.  You may choose to be licensed under the terms of the GNU
 * General Public License (GPL) Version 2, available from the file
 * COPYING in the main directory of this source tree, or the
 * OpenIB.org BSD license below:
 *
 *     Redistribution and use in source and binary forms, with or
 *     without modification, are permitted provided that the following
 *     conditions are met:
 *
 *      - Redistributions of source code must retain the above
 *        copyright notice, this list of conditions and the following
 *        disclaimer.
 *
 *      - Redistributions in binary form must reproduce the above
 *        copyright notice, this list of conditions and the following
 *        disclaimer in the documentation and/or other materials
 *        provided with the distribution.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
 * SOFTWARE.
 */

#include "en.h"
#include "ipoib.h"

static void mlx5i_get_drvinfo(struct net_device *dev,
			      struct ethtool_drvinfo *drvinfo)
{
	struct mlx5e_priv *priv = mlx5i_epriv(dev);

	mlx5e_ethtool_get_drvinfo(priv, drvinfo);
	strlcpy(drvinfo->driver, DRIVER_NAME "[ib_ipoib]",
		sizeof(drvinfo->driver));
}

static void mlx5i_get_strings(struct net_device *dev, u32 stringset, u8 *data)
{
	struct mlx5e_priv *priv  = mlx5i_epriv(dev);

	mlx5e_ethtool_get_strings(priv, stringset, data);
}

static int mlx5i_get_sset_count(struct net_device *dev, int sset)
{
	struct mlx5e_priv *priv = mlx5i_epriv(dev);

	return mlx5e_ethtool_get_sset_count(priv, sset);
}

static void mlx5i_get_ethtool_stats(struct net_device *dev,
				    struct ethtool_stats *stats,
				    u64 *data)
{
	struct mlx5e_priv *priv = mlx5i_epriv(dev);

	mlx5e_ethtool_get_ethtool_stats(priv, stats, data);
}

static int mlx5i_set_ringparam(struct net_device *dev,
			       struct ethtool_ringparam *param)
{
	struct mlx5e_priv *priv = mlx5i_epriv(dev);

	return mlx5e_ethtool_set_ringparam(priv, param);
}

static void mlx5i_get_ringparam(struct net_device *dev,
				struct ethtool_ringparam *param)
{
	struct mlx5e_priv *priv = mlx5i_epriv(dev);

	mlx5e_ethtool_get_ringparam(priv, param);
}

static int mlx5i_set_channels(struct net_device *dev,
			      struct ethtool_channels *ch)
{
	struct mlx5e_priv *priv = mlx5i_epriv(dev);

	return mlx5e_ethtool_set_channels(priv, ch);
}

static void mlx5i_get_channels(struct net_device *dev,
			       struct ethtool_channels *ch)
{
	struct mlx5e_priv *priv = mlx5i_epriv(dev);

	mlx5e_ethtool_get_channels(priv, ch);
}

static int mlx5i_set_coalesce(struct net_device *netdev,
			      struct ethtool_coalesce *coal)
{
	struct mlx5e_priv *priv = mlx5i_epriv(netdev);

	return mlx5e_ethtool_set_coalesce(priv, coal);
}

static int mlx5i_get_coalesce(struct net_device *netdev,
			      struct ethtool_coalesce *coal)
{
	struct mlx5e_priv *priv = mlx5i_epriv(netdev);

	return mlx5e_ethtool_get_coalesce(priv, coal);
}

static int mlx5i_get_ts_info(struct net_device *netdev,
			     struct ethtool_ts_info *info)
{
	struct mlx5e_priv *priv = mlx5i_epriv(netdev);

	return mlx5e_ethtool_get_ts_info(priv, info);
}

static int mlx5i_flash_device(struct net_device *netdev,
			      struct ethtool_flash *flash)
{
	struct mlx5e_priv *priv = mlx5i_epriv(netdev);

	return mlx5e_ethtool_flash_device(priv, flash);
}

enum mlx5_ptys_width {
	MLX5_PTYS_WIDTH_1X	= 1 << 0,
	MLX5_PTYS_WIDTH_2X	= 1 << 1,
	MLX5_PTYS_WIDTH_4X	= 1 << 2,
	MLX5_PTYS_WIDTH_8X	= 1 << 3,
	MLX5_PTYS_WIDTH_12X	= 1 << 4,
};

static inline int mlx5_ptys_width_enum_to_int(enum mlx5_ptys_width width)
{
	switch (width) {
	case MLX5_PTYS_WIDTH_1X:  return  1;
	case MLX5_PTYS_WIDTH_2X:  return  2;
	case MLX5_PTYS_WIDTH_4X:  return  4;
	case MLX5_PTYS_WIDTH_8X:  return  8;
	case MLX5_PTYS_WIDTH_12X: return 12;
	default:		  return -1;
	}
}

enum mlx5_ptys_rate {
	MLX5_PTYS_RATE_SDR	= 1 << 0,
	MLX5_PTYS_RATE_DDR	= 1 << 1,
	MLX5_PTYS_RATE_QDR	= 1 << 2,
	MLX5_PTYS_RATE_FDR10	= 1 << 3,
	MLX5_PTYS_RATE_FDR	= 1 << 4,
	MLX5_PTYS_RATE_EDR	= 1 << 5,
	MLX5_PTYS_RATE_HDR	= 1 << 6,
};

static inline int mlx5_ptys_rate_enum_to_int(enum mlx5_ptys_rate rate)
{
	switch (rate) {
	case MLX5_PTYS_RATE_SDR:   return 2500;
	case MLX5_PTYS_RATE_DDR:   return 5000;
	case MLX5_PTYS_RATE_QDR:
	case MLX5_PTYS_RATE_FDR10: return 10000;
	case MLX5_PTYS_RATE_FDR:   return 14000;
	case MLX5_PTYS_RATE_EDR:   return 25000;
	case MLX5_PTYS_RATE_HDR:   return 50000;
	default:		   return -1;
	}
}

static int mlx5i_get_port_settings(struct net_device *netdev,
				   u16 *ib_link_width_oper, u16 *ib_proto_oper)
{
	struct mlx5e_priv *priv    = mlx5i_epriv(netdev);
	struct mlx5_core_dev *mdev = priv->mdev;
	u32 out[MLX5_ST_SZ_DW(ptys_reg)] = {0};
	int ret;

	ret = mlx5_query_port_ptys(mdev, out, sizeof(out), MLX5_PTYS_IB, 1);
	if (ret)
		return ret;

	*ib_link_width_oper = MLX5_GET(ptys_reg, out, ib_link_width_oper);
	*ib_proto_oper      = MLX5_GET(ptys_reg, out, ib_proto_oper);

	return 0;
}

static int mlx5i_get_speed_settings(u16 ib_link_width_oper, u16 ib_proto_oper)
{
	int rate, width;

	rate = mlx5_ptys_rate_enum_to_int(ib_proto_oper);
	if (rate < 0)
		return -EINVAL;
	width = mlx5_ptys_width_enum_to_int(ib_link_width_oper);
	if (width < 0)
		return -EINVAL;

	return rate * width;
}

static int mlx5i_get_link_ksettings(struct net_device *netdev,
				    struct ethtool_link_ksettings *link_ksettings)
{
	u16 ib_link_width_oper;
	u16 ib_proto_oper;
	int speed, ret;

	ret = mlx5i_get_port_settings(netdev, &ib_link_width_oper, &ib_proto_oper);
	if (ret)
		return ret;

	ethtool_link_ksettings_zero_link_mode(link_ksettings, supported);
	ethtool_link_ksettings_zero_link_mode(link_ksettings, advertising);

	speed = mlx5i_get_speed_settings(ib_link_width_oper, ib_proto_oper);
	if (speed < 0)
		return -EINVAL;

	link_ksettings->base.duplex = DUPLEX_FULL;
	link_ksettings->base.port = PORT_OTHER;

	link_ksettings->base.autoneg = AUTONEG_DISABLE;

	link_ksettings->base.speed = speed;

	return 0;
}

const struct ethtool_ops mlx5i_ethtool_ops = {
	.supported_coalesce_params = ETHTOOL_COALESCE_USECS |
				     ETHTOOL_COALESCE_MAX_FRAMES |
				     ETHTOOL_COALESCE_USE_ADAPTIVE,
	.get_drvinfo        = mlx5i_get_drvinfo,
	.get_strings        = mlx5i_get_strings,
	.get_sset_count     = mlx5i_get_sset_count,
	.get_ethtool_stats  = mlx5i_get_ethtool_stats,
	.get_ringparam      = mlx5i_get_ringparam,
	.set_ringparam      = mlx5i_set_ringparam,
	.flash_device       = mlx5i_flash_device,
	.get_channels       = mlx5i_get_channels,
	.set_channels       = mlx5i_set_channels,
	.get_coalesce       = mlx5i_get_coalesce,
	.set_coalesce       = mlx5i_set_coalesce,
	.get_ts_info        = mlx5i_get_ts_info,
	.get_link_ksettings = mlx5i_get_link_ksettings,
	.get_link           = ethtool_op_get_link,
};

const struct ethtool_ops mlx5i_pkey_ethtool_ops = {
	.get_drvinfo        = mlx5i_get_drvinfo,
	.get_link           = ethtool_op_get_link,
	.get_ts_info        = mlx5i_get_ts_info,
};
Commit	Line	Data
076b0936 ES	1	/*
	2	* Copyright (c) 2017, Mellanox Technologies. All rights reserved.
	3	*
	4	* This software is available to you under a choice of one of two
	5	* licenses. You may choose to be licensed under the terms of the GNU
	6	* General Public License (GPL) Version 2, available from the file
	7	* COPYING in the main directory of this source tree, or the
	8	* OpenIB.org BSD license below:
	9	*
	10	* Redistribution and use in source and binary forms, with or
	11	* without modification, are permitted provided that the following
	12	* conditions are met:
	13	*
	14	* - Redistributions of source code must retain the above
	15	* copyright notice, this list of conditions and the following
	16	* disclaimer.
	17	*
	18	* - Redistributions in binary form must reproduce the above
	19	* copyright notice, this list of conditions and the following
	20	* disclaimer in the documentation and/or other materials
	21	* provided with the distribution.
	22	*
	23	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
	24	* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
	25	* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
	26	* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
	27	* BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
	28	* ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
	29	* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
	30	* SOFTWARE.
	31	*/
	32
	33	#include "en.h"
	34	#include "ipoib.h"
	35
	36	static void mlx5i_get_drvinfo(struct net_device *dev,
	37	struct ethtool_drvinfo *drvinfo)
	38	{
	39	struct mlx5e_priv *priv = mlx5i_epriv(dev);
	40
	41	mlx5e_ethtool_get_drvinfo(priv, drvinfo);
1d1c3436 FD	42	strlcpy(drvinfo->driver, DRIVER_NAME "[ib_ipoib]",
1d1c3436 FD	43	sizeof(drvinfo->driver));
076b0936 ES	44	}
076b0936 ES	45
c045deef	46	static void mlx5i_get_strings(struct net_device dev, u32 stringset, u8 data)
076b0936 ES	47	{
	48	struct mlx5e_priv *priv = mlx5i_epriv(dev);
	49
	50	mlx5e_ethtool_get_strings(priv, stringset, data);
	51	}
	52
	53	static int mlx5i_get_sset_count(struct net_device *dev, int sset)
	54	{
	55	struct mlx5e_priv *priv = mlx5i_epriv(dev);
	56
	57	return mlx5e_ethtool_get_sset_count(priv, sset);
	58	}
	59
	60	static void mlx5i_get_ethtool_stats(struct net_device *dev,
	61	struct ethtool_stats *stats,
	62	u64 *data)
	63	{
	64	struct mlx5e_priv *priv = mlx5i_epriv(dev);
	65
	66	mlx5e_ethtool_get_ethtool_stats(priv, stats, data);
	67	}
	68
	69	static int mlx5i_set_ringparam(struct net_device *dev,
	70	struct ethtool_ringparam *param)
	71	{
	72	struct mlx5e_priv *priv = mlx5i_epriv(dev);
	73
	74	return mlx5e_ethtool_set_ringparam(priv, param);
	75	}
	76
	77	static void mlx5i_get_ringparam(struct net_device *dev,
	78	struct ethtool_ringparam *param)
	79	{
	80	struct mlx5e_priv *priv = mlx5i_epriv(dev);
	81
	82	mlx5e_ethtool_get_ringparam(priv, param);
	83	}
	84
	85	static int mlx5i_set_channels(struct net_device *dev,
	86	struct ethtool_channels *ch)
	87	{
	88	struct mlx5e_priv *priv = mlx5i_epriv(dev);
	89
	90	return mlx5e_ethtool_set_channels(priv, ch);
	91	}
	92
	93	static void mlx5i_get_channels(struct net_device *dev,
	94	struct ethtool_channels *ch)
	95	{
	96	struct mlx5e_priv *priv = mlx5i_epriv(dev);
	97
	98	mlx5e_ethtool_get_channels(priv, ch);
	99	}
	100
	101	static int mlx5i_set_coalesce(struct net_device *netdev,
	102	struct ethtool_coalesce *coal)
	103	{
	104	struct mlx5e_priv *priv = mlx5i_epriv(netdev);
	105
	106	return mlx5e_ethtool_set_coalesce(priv, coal);
	107	}
	108
	109	static int mlx5i_get_coalesce(struct net_device *netdev,
	110	struct ethtool_coalesce *coal)
111	{
112	struct mlx5e_priv *priv = mlx5i_epriv(netdev);
113
114	return mlx5e_ethtool_get_coalesce(priv, coal);
115	}
116
3844b07e FD	117	static int mlx5i_get_ts_info(struct net_device *netdev,
	118	struct ethtool_ts_info *info)
	119	{
	120	struct mlx5e_priv *priv = mlx5i_epriv(netdev);
	121
	122	return mlx5e_ethtool_get_ts_info(priv, info);
	123	}
	124
f43d48d1 EBE	125	static int mlx5i_flash_device(struct net_device *netdev,
	126	struct ethtool_flash *flash)
	127	{
	128	struct mlx5e_priv *priv = mlx5i_epriv(netdev);
	129
	130	return mlx5e_ethtool_flash_device(priv, flash);
	131	}
	132
eb234ee9 SL	133	enum mlx5_ptys_width {
	134	MLX5_PTYS_WIDTH_1X = 1 << 0,
	135	MLX5_PTYS_WIDTH_2X = 1 << 1,
	136	MLX5_PTYS_WIDTH_4X = 1 << 2,
	137	MLX5_PTYS_WIDTH_8X = 1 << 3,
	138	MLX5_PTYS_WIDTH_12X = 1 << 4,
	139	};
	140
	141	static inline int mlx5_ptys_width_enum_to_int(enum mlx5_ptys_width width)
	142	{
	143	switch (width) {
	144	case MLX5_PTYS_WIDTH_1X: return 1;
	145	case MLX5_PTYS_WIDTH_2X: return 2;
	146	case MLX5_PTYS_WIDTH_4X: return 4;
	147	case MLX5_PTYS_WIDTH_8X: return 8;
	148	case MLX5_PTYS_WIDTH_12X: return 12;
	149	default: return -1;
	150	}
	151	}
	152
	153	enum mlx5_ptys_rate {
	154	MLX5_PTYS_RATE_SDR = 1 << 0,
	155	MLX5_PTYS_RATE_DDR = 1 << 1,
	156	MLX5_PTYS_RATE_QDR = 1 << 2,
	157	MLX5_PTYS_RATE_FDR10 = 1 << 3,
	158	MLX5_PTYS_RATE_FDR = 1 << 4,
	159	MLX5_PTYS_RATE_EDR = 1 << 5,
	160	MLX5_PTYS_RATE_HDR = 1 << 6,
	161	};
	162
	163	static inline int mlx5_ptys_rate_enum_to_int(enum mlx5_ptys_rate rate)
	164	{
	165	switch (rate) {
	166	case MLX5_PTYS_RATE_SDR: return 2500;
	167	case MLX5_PTYS_RATE_DDR: return 5000;
	168	case MLX5_PTYS_RATE_QDR:
	169	case MLX5_PTYS_RATE_FDR10: return 10000;
	170	case MLX5_PTYS_RATE_FDR: return 14000;
	171	case MLX5_PTYS_RATE_EDR: return 25000;
	172	case MLX5_PTYS_RATE_HDR: return 50000;
	173	default: return -1;
	174	}
	175	}
	176
	177	static int mlx5i_get_port_settings(struct net_device *netdev,
	178	u16 ib_link_width_oper, u16 ib_proto_oper)
	179	{
	180	struct mlx5e_priv *priv = mlx5i_epriv(netdev);
	181	struct mlx5_core_dev *mdev = priv->mdev;
	182	u32 out[MLX5_ST_SZ_DW(ptys_reg)] = {0};
	183	int ret;
	184
	185	ret = mlx5_query_port_ptys(mdev, out, sizeof(out), MLX5_PTYS_IB, 1);
	186	if (ret)
	187	return ret;
	188
	189	*ib_link_width_oper = MLX5_GET(ptys_reg, out, ib_link_width_oper);
	190	*ib_proto_oper = MLX5_GET(ptys_reg, out, ib_proto_oper);
	191
	192	return 0;
	193	}
	194
	195	static int mlx5i_get_speed_settings(u16 ib_link_width_oper, u16 ib_proto_oper)
	196	{
197	int rate, width;
198
199	rate = mlx5_ptys_rate_enum_to_int(ib_proto_oper);
200	if (rate < 0)
201	return -EINVAL;
202	width = mlx5_ptys_width_enum_to_int(ib_link_width_oper);
203	if (width < 0)
204	return -EINVAL;
205
206	return rate * width;
207	}
208
209	static int mlx5i_get_link_ksettings(struct net_device *netdev,
210	struct ethtool_link_ksettings *link_ksettings)
211	{
212	u16 ib_link_width_oper;
213	u16 ib_proto_oper;
214	int speed, ret;
215
216	ret = mlx5i_get_port_settings(netdev, &ib_link_width_oper, &ib_proto_oper);
217	if (ret)
218	return ret;
219
220	ethtool_link_ksettings_zero_link_mode(link_ksettings, supported);
221	ethtool_link_ksettings_zero_link_mode(link_ksettings, advertising);
222
223	speed = mlx5i_get_speed_settings(ib_link_width_oper, ib_proto_oper);
224	if (speed < 0)
225	return -EINVAL;
226
227	link_ksettings->base.duplex = DUPLEX_FULL;
228	link_ksettings->base.port = PORT_OTHER;
229
230	link_ksettings->base.autoneg = AUTONEG_DISABLE;
231
232	link_ksettings->base.speed = speed;
233
234	return 0;
235	}
236
076b0936	237	const struct ethtool_ops mlx5i_ethtool_ops = {
55808762 JK	238	.supported_coalesce_params = ETHTOOL_COALESCE_USECS \|
	239	ETHTOOL_COALESCE_MAX_FRAMES \|
	240	ETHTOOL_COALESCE_USE_ADAPTIVE,
eb234ee9 SL	241	.get_drvinfo = mlx5i_get_drvinfo,
	242	.get_strings = mlx5i_get_strings,
	243	.get_sset_count = mlx5i_get_sset_count,
	244	.get_ethtool_stats = mlx5i_get_ethtool_stats,
	245	.get_ringparam = mlx5i_get_ringparam,
	246	.set_ringparam = mlx5i_set_ringparam,
f43d48d1	247	.flash_device = mlx5i_flash_device,
eb234ee9 SL	248	.get_channels = mlx5i_get_channels,
	249	.set_channels = mlx5i_set_channels,
	250	.get_coalesce = mlx5i_get_coalesce,
	251	.set_coalesce = mlx5i_set_coalesce,
	252	.get_ts_info = mlx5i_get_ts_info,
	253	.get_link_ksettings = mlx5i_get_link_ksettings,
	254	.get_link = ethtool_op_get_link,
076b0936	255	};
6a910233 AV	256
	257	const struct ethtool_ops mlx5i_pkey_ethtool_ops = {
	258	.get_drvinfo = mlx5i_get_drvinfo,
	259	.get_link = ethtool_op_get_link,
93b66472	260	.get_ts_info = mlx5i_get_ts_info,
6a910233	261	};