net/mlx5e: IPoIB, Add support for get_link_ksettings in ethtool
[sfrench/cifs-2.6.git] / drivers / net / ethernet / mellanox / mlx5 / core / ipoib / ethtool.c
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,
47                               uint32_t stringset, uint8_t *data)
48 {
49         struct mlx5e_priv *priv  = mlx5i_epriv(dev);
50
51         mlx5e_ethtool_get_strings(priv, stringset, data);
52 }
53
54 static int mlx5i_get_sset_count(struct net_device *dev, int sset)
55 {
56         struct mlx5e_priv *priv = mlx5i_epriv(dev);
57
58         return mlx5e_ethtool_get_sset_count(priv, sset);
59 }
60
61 static void mlx5i_get_ethtool_stats(struct net_device *dev,
62                                     struct ethtool_stats *stats,
63                                     u64 *data)
64 {
65         struct mlx5e_priv *priv = mlx5i_epriv(dev);
66
67         mlx5e_ethtool_get_ethtool_stats(priv, stats, data);
68 }
69
70 static int mlx5i_set_ringparam(struct net_device *dev,
71                                struct ethtool_ringparam *param)
72 {
73         struct mlx5e_priv *priv = mlx5i_epriv(dev);
74
75         return mlx5e_ethtool_set_ringparam(priv, param);
76 }
77
78 static void mlx5i_get_ringparam(struct net_device *dev,
79                                 struct ethtool_ringparam *param)
80 {
81         struct mlx5e_priv *priv = mlx5i_epriv(dev);
82
83         mlx5e_ethtool_get_ringparam(priv, param);
84 }
85
86 static int mlx5i_set_channels(struct net_device *dev,
87                               struct ethtool_channels *ch)
88 {
89         struct mlx5e_priv *priv = mlx5i_epriv(dev);
90
91         return mlx5e_ethtool_set_channels(priv, ch);
92 }
93
94 static void mlx5i_get_channels(struct net_device *dev,
95                                struct ethtool_channels *ch)
96 {
97         struct mlx5e_priv *priv = mlx5i_epriv(dev);
98
99         mlx5e_ethtool_get_channels(priv, ch);
100 }
101
102 static int mlx5i_set_coalesce(struct net_device *netdev,
103                               struct ethtool_coalesce *coal)
104 {
105         struct mlx5e_priv *priv = mlx5i_epriv(netdev);
106
107         return mlx5e_ethtool_set_coalesce(priv, coal);
108 }
109
110 static int mlx5i_get_coalesce(struct net_device *netdev,
111                               struct ethtool_coalesce *coal)
112 {
113         struct mlx5e_priv *priv = mlx5i_epriv(netdev);
114
115         return mlx5e_ethtool_get_coalesce(priv, coal);
116 }
117
118 static int mlx5i_get_ts_info(struct net_device *netdev,
119                              struct ethtool_ts_info *info)
120 {
121         struct mlx5e_priv *priv = mlx5i_epriv(netdev);
122
123         return mlx5e_ethtool_get_ts_info(priv, info);
124 }
125
126 static int mlx5i_flash_device(struct net_device *netdev,
127                               struct ethtool_flash *flash)
128 {
129         struct mlx5e_priv *priv = mlx5i_epriv(netdev);
130
131         return mlx5e_ethtool_flash_device(priv, flash);
132 }
133
134 enum mlx5_ptys_width {
135         MLX5_PTYS_WIDTH_1X      = 1 << 0,
136         MLX5_PTYS_WIDTH_2X      = 1 << 1,
137         MLX5_PTYS_WIDTH_4X      = 1 << 2,
138         MLX5_PTYS_WIDTH_8X      = 1 << 3,
139         MLX5_PTYS_WIDTH_12X     = 1 << 4,
140 };
141
142 static inline int mlx5_ptys_width_enum_to_int(enum mlx5_ptys_width width)
143 {
144         switch (width) {
145         case MLX5_PTYS_WIDTH_1X:  return  1;
146         case MLX5_PTYS_WIDTH_2X:  return  2;
147         case MLX5_PTYS_WIDTH_4X:  return  4;
148         case MLX5_PTYS_WIDTH_8X:  return  8;
149         case MLX5_PTYS_WIDTH_12X: return 12;
150         default:                  return -1;
151         }
152 }
153
154 enum mlx5_ptys_rate {
155         MLX5_PTYS_RATE_SDR      = 1 << 0,
156         MLX5_PTYS_RATE_DDR      = 1 << 1,
157         MLX5_PTYS_RATE_QDR      = 1 << 2,
158         MLX5_PTYS_RATE_FDR10    = 1 << 3,
159         MLX5_PTYS_RATE_FDR      = 1 << 4,
160         MLX5_PTYS_RATE_EDR      = 1 << 5,
161         MLX5_PTYS_RATE_HDR      = 1 << 6,
162 };
163
164 static inline int mlx5_ptys_rate_enum_to_int(enum mlx5_ptys_rate rate)
165 {
166         switch (rate) {
167         case MLX5_PTYS_RATE_SDR:   return 2500;
168         case MLX5_PTYS_RATE_DDR:   return 5000;
169         case MLX5_PTYS_RATE_QDR:
170         case MLX5_PTYS_RATE_FDR10: return 10000;
171         case MLX5_PTYS_RATE_FDR:   return 14000;
172         case MLX5_PTYS_RATE_EDR:   return 25000;
173         case MLX5_PTYS_RATE_HDR:   return 50000;
174         default:                   return -1;
175         }
176 }
177
178 static int mlx5i_get_port_settings(struct net_device *netdev,
179                                    u16 *ib_link_width_oper, u16 *ib_proto_oper)
180 {
181         struct mlx5e_priv *priv    = mlx5i_epriv(netdev);
182         struct mlx5_core_dev *mdev = priv->mdev;
183         u32 out[MLX5_ST_SZ_DW(ptys_reg)] = {0};
184         int ret;
185
186         ret = mlx5_query_port_ptys(mdev, out, sizeof(out), MLX5_PTYS_IB, 1);
187         if (ret)
188                 return ret;
189
190         *ib_link_width_oper = MLX5_GET(ptys_reg, out, ib_link_width_oper);
191         *ib_proto_oper      = MLX5_GET(ptys_reg, out, ib_proto_oper);
192
193         return 0;
194 }
195
196 static int mlx5i_get_speed_settings(u16 ib_link_width_oper, u16 ib_proto_oper)
197 {
198         int rate, width;
199
200         rate = mlx5_ptys_rate_enum_to_int(ib_proto_oper);
201         if (rate < 0)
202                 return -EINVAL;
203         width = mlx5_ptys_width_enum_to_int(ib_link_width_oper);
204         if (width < 0)
205                 return -EINVAL;
206
207         return rate * width;
208 }
209
210 static int mlx5i_get_link_ksettings(struct net_device *netdev,
211                                     struct ethtool_link_ksettings *link_ksettings)
212 {
213         u16 ib_link_width_oper;
214         u16 ib_proto_oper;
215         int speed, ret;
216
217         ret = mlx5i_get_port_settings(netdev, &ib_link_width_oper, &ib_proto_oper);
218         if (ret)
219                 return ret;
220
221         ethtool_link_ksettings_zero_link_mode(link_ksettings, supported);
222         ethtool_link_ksettings_zero_link_mode(link_ksettings, advertising);
223
224         speed = mlx5i_get_speed_settings(ib_link_width_oper, ib_proto_oper);
225         if (speed < 0)
226                 return -EINVAL;
227
228         link_ksettings->base.duplex = DUPLEX_FULL;
229         link_ksettings->base.port = PORT_OTHER;
230
231         link_ksettings->base.autoneg = AUTONEG_DISABLE;
232
233         link_ksettings->base.speed = speed;
234
235         return 0;
236 }
237
238 const struct ethtool_ops mlx5i_ethtool_ops = {
239         .get_drvinfo        = mlx5i_get_drvinfo,
240         .get_strings        = mlx5i_get_strings,
241         .get_sset_count     = mlx5i_get_sset_count,
242         .get_ethtool_stats  = mlx5i_get_ethtool_stats,
243         .get_ringparam      = mlx5i_get_ringparam,
244         .set_ringparam      = mlx5i_set_ringparam,
245         .flash_device       = mlx5i_flash_device,
246         .get_channels       = mlx5i_get_channels,
247         .set_channels       = mlx5i_set_channels,
248         .get_coalesce       = mlx5i_get_coalesce,
249         .set_coalesce       = mlx5i_set_coalesce,
250         .get_ts_info        = mlx5i_get_ts_info,
251         .get_link_ksettings = mlx5i_get_link_ksettings,
252         .get_link           = ethtool_op_get_link,
253 };