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);
42 	strlcpy(drvinfo->driver, DRIVER_NAME "[ib_ipoib]",
43 		sizeof(drvinfo->driver));
44 }
45 
46 static void mlx5i_get_strings(struct net_device *dev, u32 stringset, u8 *data)
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 
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 
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 
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 
237 const struct ethtool_ops mlx5i_ethtool_ops = {
238 	.get_drvinfo        = mlx5i_get_drvinfo,
239 	.get_strings        = mlx5i_get_strings,
240 	.get_sset_count     = mlx5i_get_sset_count,
241 	.get_ethtool_stats  = mlx5i_get_ethtool_stats,
242 	.get_ringparam      = mlx5i_get_ringparam,
243 	.set_ringparam      = mlx5i_set_ringparam,
244 	.flash_device       = mlx5i_flash_device,
245 	.get_channels       = mlx5i_get_channels,
246 	.set_channels       = mlx5i_set_channels,
247 	.get_coalesce       = mlx5i_get_coalesce,
248 	.set_coalesce       = mlx5i_set_coalesce,
249 	.get_ts_info        = mlx5i_get_ts_info,
250 	.get_link_ksettings = mlx5i_get_link_ksettings,
251 	.get_link           = ethtool_op_get_link,
252 };
253 
254 const struct ethtool_ops mlx5i_pkey_ethtool_ops = {
255 	.get_drvinfo        = mlx5i_get_drvinfo,
256 	.get_link           = ethtool_op_get_link,
257 	.get_ts_info        = mlx5i_get_ts_info,
258 };
259