1  /*
2   * Copyright (c) 2004, 2005 Topspin Communications.  All rights reserved.
3   * Copyright (c) 2005 Mellanox Technologies Ltd.  All rights reserved.
4   * Copyright (c) 2005 Sun Microsystems, Inc. All rights reserved.
5   *
6   * This software is available to you under a choice of one of two
7   * licenses.  You may choose to be licensed under the terms of the GNU
8   * General Public License (GPL) Version 2, available from the file
9   * COPYING in the main directory of this source tree, or the
10   * OpenIB.org BSD license below:
11   *
12   *     Redistribution and use in source and binary forms, with or
13   *     without modification, are permitted provided that the following
14   *     conditions are met:
15   *
16   *      - Redistributions of source code must retain the above
17   *        copyright notice, this list of conditions and the following
18   *        disclaimer.
19   *
20   *      - Redistributions in binary form must reproduce the above
21   *        copyright notice, this list of conditions and the following
22   *        disclaimer in the documentation and/or other materials
23   *        provided with the distribution.
24   *
25   * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
26   * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
27   * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
28   * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
29   * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
30   * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
31   * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
32   * SOFTWARE.
33   */
34  
35  #include "core_priv.h"
36  
37  #include <linux/slab.h>
38  #include <linux/stat.h>
39  #include <linux/string.h>
40  #include <linux/netdevice.h>
41  #include <linux/ethtool.h>
42  
43  #include <rdma/ib_mad.h>
44  #include <rdma/ib_pma.h>
45  #include <rdma/ib_cache.h>
46  #include <rdma/rdma_counter.h>
47  #include <rdma/ib_sysfs.h>
48  
49  struct port_table_attribute {
50  	struct ib_port_attribute attr;
51  	char			name[8];
52  	int			index;
53  	__be16			attr_id;
54  };
55  
56  struct gid_attr_group {
57  	struct ib_port *port;
58  	struct kobject kobj;
59  	struct attribute_group groups[2];
60  	const struct attribute_group *groups_list[3];
61  	struct port_table_attribute attrs_list[];
62  };
63  
64  struct ib_port {
65  	struct kobject kobj;
66  	struct ib_device *ibdev;
67  	struct gid_attr_group *gid_attr_group;
68  	struct hw_stats_port_data *hw_stats_data;
69  
70  	struct attribute_group groups[3];
71  	const struct attribute_group *groups_list[5];
72  	u32 port_num;
73  	struct port_table_attribute attrs_list[];
74  };
75  
76  struct hw_stats_device_attribute {
77  	struct device_attribute attr;
78  	ssize_t (*show)(struct ib_device *ibdev, struct rdma_hw_stats *stats,
79  			unsigned int index, unsigned int port_num, char *buf);
80  	ssize_t (*store)(struct ib_device *ibdev, struct rdma_hw_stats *stats,
81  			 unsigned int index, unsigned int port_num,
82  			 const char *buf, size_t count);
83  };
84  
85  struct hw_stats_port_attribute {
86  	struct ib_port_attribute attr;
87  	ssize_t (*show)(struct ib_device *ibdev, struct rdma_hw_stats *stats,
88  			unsigned int index, unsigned int port_num, char *buf);
89  	ssize_t (*store)(struct ib_device *ibdev, struct rdma_hw_stats *stats,
90  			 unsigned int index, unsigned int port_num,
91  			 const char *buf, size_t count);
92  };
93  
94  struct hw_stats_device_data {
95  	struct attribute_group group;
96  	struct rdma_hw_stats *stats;
97  	struct hw_stats_device_attribute attrs[];
98  };
99  
100  struct hw_stats_port_data {
101  	struct rdma_hw_stats *stats;
102  	struct hw_stats_port_attribute attrs[];
103  };
104  
port_attr_show(struct kobject * kobj,struct attribute * attr,char * buf)105  static ssize_t port_attr_show(struct kobject *kobj,
106  			      struct attribute *attr, char *buf)
107  {
108  	struct ib_port_attribute *port_attr =
109  		container_of(attr, struct ib_port_attribute, attr);
110  	struct ib_port *p = container_of(kobj, struct ib_port, kobj);
111  
112  	if (!port_attr->show)
113  		return -EIO;
114  
115  	return port_attr->show(p->ibdev, p->port_num, port_attr, buf);
116  }
117  
port_attr_store(struct kobject * kobj,struct attribute * attr,const char * buf,size_t count)118  static ssize_t port_attr_store(struct kobject *kobj,
119  			       struct attribute *attr,
120  			       const char *buf, size_t count)
121  {
122  	struct ib_port_attribute *port_attr =
123  		container_of(attr, struct ib_port_attribute, attr);
124  	struct ib_port *p = container_of(kobj, struct ib_port, kobj);
125  
126  	if (!port_attr->store)
127  		return -EIO;
128  	return port_attr->store(p->ibdev, p->port_num, port_attr, buf, count);
129  }
130  
ib_port_sysfs_get_ibdev_kobj(struct kobject * kobj,u32 * port_num)131  struct ib_device *ib_port_sysfs_get_ibdev_kobj(struct kobject *kobj,
132  					       u32 *port_num)
133  {
134  	struct ib_port *port = container_of(kobj, struct ib_port, kobj);
135  
136  	*port_num = port->port_num;
137  	return port->ibdev;
138  }
139  EXPORT_SYMBOL(ib_port_sysfs_get_ibdev_kobj);
140  
141  static const struct sysfs_ops port_sysfs_ops = {
142  	.show	= port_attr_show,
143  	.store	= port_attr_store
144  };
145  
hw_stat_device_show(struct device * dev,struct device_attribute * attr,char * buf)146  static ssize_t hw_stat_device_show(struct device *dev,
147  				   struct device_attribute *attr, char *buf)
148  {
149  	struct hw_stats_device_attribute *stat_attr =
150  		container_of(attr, struct hw_stats_device_attribute, attr);
151  	struct ib_device *ibdev = container_of(dev, struct ib_device, dev);
152  
153  	return stat_attr->show(ibdev, ibdev->hw_stats_data->stats,
154  			       stat_attr - ibdev->hw_stats_data->attrs, 0, buf);
155  }
156  
hw_stat_device_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)157  static ssize_t hw_stat_device_store(struct device *dev,
158  				    struct device_attribute *attr,
159  				    const char *buf, size_t count)
160  {
161  	struct hw_stats_device_attribute *stat_attr =
162  		container_of(attr, struct hw_stats_device_attribute, attr);
163  	struct ib_device *ibdev = container_of(dev, struct ib_device, dev);
164  
165  	return stat_attr->store(ibdev, ibdev->hw_stats_data->stats,
166  				stat_attr - ibdev->hw_stats_data->attrs, 0, buf,
167  				count);
168  }
169  
hw_stat_port_show(struct ib_device * ibdev,u32 port_num,struct ib_port_attribute * attr,char * buf)170  static ssize_t hw_stat_port_show(struct ib_device *ibdev, u32 port_num,
171  				 struct ib_port_attribute *attr, char *buf)
172  {
173  	struct hw_stats_port_attribute *stat_attr =
174  		container_of(attr, struct hw_stats_port_attribute, attr);
175  	struct ib_port *port = ibdev->port_data[port_num].sysfs;
176  
177  	return stat_attr->show(ibdev, port->hw_stats_data->stats,
178  			       stat_attr - port->hw_stats_data->attrs,
179  			       port->port_num, buf);
180  }
181  
hw_stat_port_store(struct ib_device * ibdev,u32 port_num,struct ib_port_attribute * attr,const char * buf,size_t count)182  static ssize_t hw_stat_port_store(struct ib_device *ibdev, u32 port_num,
183  				  struct ib_port_attribute *attr,
184  				  const char *buf, size_t count)
185  {
186  	struct hw_stats_port_attribute *stat_attr =
187  		container_of(attr, struct hw_stats_port_attribute, attr);
188  	struct ib_port *port = ibdev->port_data[port_num].sysfs;
189  
190  	return stat_attr->store(ibdev, port->hw_stats_data->stats,
191  				stat_attr - port->hw_stats_data->attrs,
192  				port->port_num, buf, count);
193  }
194  
gid_attr_show(struct kobject * kobj,struct attribute * attr,char * buf)195  static ssize_t gid_attr_show(struct kobject *kobj,
196  			     struct attribute *attr, char *buf)
197  {
198  	struct ib_port_attribute *port_attr =
199  		container_of(attr, struct ib_port_attribute, attr);
200  	struct ib_port *p = container_of(kobj, struct gid_attr_group,
201  					 kobj)->port;
202  
203  	if (!port_attr->show)
204  		return -EIO;
205  
206  	return port_attr->show(p->ibdev, p->port_num, port_attr, buf);
207  }
208  
209  static const struct sysfs_ops gid_attr_sysfs_ops = {
210  	.show = gid_attr_show
211  };
212  
state_show(struct ib_device * ibdev,u32 port_num,struct ib_port_attribute * unused,char * buf)213  static ssize_t state_show(struct ib_device *ibdev, u32 port_num,
214  			  struct ib_port_attribute *unused, char *buf)
215  {
216  	struct ib_port_attr attr;
217  	ssize_t ret;
218  
219  	static const char *state_name[] = {
220  		[IB_PORT_NOP]		= "NOP",
221  		[IB_PORT_DOWN]		= "DOWN",
222  		[IB_PORT_INIT]		= "INIT",
223  		[IB_PORT_ARMED]		= "ARMED",
224  		[IB_PORT_ACTIVE]	= "ACTIVE",
225  		[IB_PORT_ACTIVE_DEFER]	= "ACTIVE_DEFER"
226  	};
227  
228  	ret = ib_query_port(ibdev, port_num, &attr);
229  	if (ret)
230  		return ret;
231  
232  	return sysfs_emit(buf, "%d: %s\n", attr.state,
233  			  attr.state >= 0 &&
234  					  attr.state < ARRAY_SIZE(state_name) ?
235  				  state_name[attr.state] :
236  				  "UNKNOWN");
237  }
238  
lid_show(struct ib_device * ibdev,u32 port_num,struct ib_port_attribute * unused,char * buf)239  static ssize_t lid_show(struct ib_device *ibdev, u32 port_num,
240  			struct ib_port_attribute *unused, char *buf)
241  {
242  	struct ib_port_attr attr;
243  	ssize_t ret;
244  
245  	ret = ib_query_port(ibdev, port_num, &attr);
246  	if (ret)
247  		return ret;
248  
249  	return sysfs_emit(buf, "0x%x\n", attr.lid);
250  }
251  
lid_mask_count_show(struct ib_device * ibdev,u32 port_num,struct ib_port_attribute * unused,char * buf)252  static ssize_t lid_mask_count_show(struct ib_device *ibdev, u32 port_num,
253  				   struct ib_port_attribute *unused, char *buf)
254  {
255  	struct ib_port_attr attr;
256  	ssize_t ret;
257  
258  	ret = ib_query_port(ibdev, port_num, &attr);
259  	if (ret)
260  		return ret;
261  
262  	return sysfs_emit(buf, "%u\n", attr.lmc);
263  }
264  
sm_lid_show(struct ib_device * ibdev,u32 port_num,struct ib_port_attribute * unused,char * buf)265  static ssize_t sm_lid_show(struct ib_device *ibdev, u32 port_num,
266  			   struct ib_port_attribute *unused, char *buf)
267  {
268  	struct ib_port_attr attr;
269  	ssize_t ret;
270  
271  	ret = ib_query_port(ibdev, port_num, &attr);
272  	if (ret)
273  		return ret;
274  
275  	return sysfs_emit(buf, "0x%x\n", attr.sm_lid);
276  }
277  
sm_sl_show(struct ib_device * ibdev,u32 port_num,struct ib_port_attribute * unused,char * buf)278  static ssize_t sm_sl_show(struct ib_device *ibdev, u32 port_num,
279  			  struct ib_port_attribute *unused, char *buf)
280  {
281  	struct ib_port_attr attr;
282  	ssize_t ret;
283  
284  	ret = ib_query_port(ibdev, port_num, &attr);
285  	if (ret)
286  		return ret;
287  
288  	return sysfs_emit(buf, "%u\n", attr.sm_sl);
289  }
290  
cap_mask_show(struct ib_device * ibdev,u32 port_num,struct ib_port_attribute * unused,char * buf)291  static ssize_t cap_mask_show(struct ib_device *ibdev, u32 port_num,
292  			     struct ib_port_attribute *unused, char *buf)
293  {
294  	struct ib_port_attr attr;
295  	ssize_t ret;
296  
297  	ret = ib_query_port(ibdev, port_num, &attr);
298  	if (ret)
299  		return ret;
300  
301  	return sysfs_emit(buf, "0x%08x\n", attr.port_cap_flags);
302  }
303  
rate_show(struct ib_device * ibdev,u32 port_num,struct ib_port_attribute * unused,char * buf)304  static ssize_t rate_show(struct ib_device *ibdev, u32 port_num,
305  			 struct ib_port_attribute *unused, char *buf)
306  {
307  	struct ib_port_attr attr;
308  	char *speed = "";
309  	int rate;		/* in deci-Gb/sec */
310  	ssize_t ret;
311  
312  	ret = ib_query_port(ibdev, port_num, &attr);
313  	if (ret)
314  		return ret;
315  
316  	switch (attr.active_speed) {
317  	case IB_SPEED_DDR:
318  		speed = " DDR";
319  		rate = 50;
320  		break;
321  	case IB_SPEED_QDR:
322  		speed = " QDR";
323  		rate = 100;
324  		break;
325  	case IB_SPEED_FDR10:
326  		speed = " FDR10";
327  		rate = 100;
328  		break;
329  	case IB_SPEED_FDR:
330  		speed = " FDR";
331  		rate = 140;
332  		break;
333  	case IB_SPEED_EDR:
334  		speed = " EDR";
335  		rate = 250;
336  		break;
337  	case IB_SPEED_HDR:
338  		speed = " HDR";
339  		rate = 500;
340  		break;
341  	case IB_SPEED_NDR:
342  		speed = " NDR";
343  		rate = 1000;
344  		break;
345  	case IB_SPEED_XDR:
346  		speed = " XDR";
347  		rate = 2000;
348  		break;
349  	case IB_SPEED_SDR:
350  	default:		/* default to SDR for invalid rates */
351  		speed = " SDR";
352  		rate = 25;
353  		break;
354  	}
355  
356  	rate *= ib_width_enum_to_int(attr.active_width);
357  	if (rate < 0)
358  		return -EINVAL;
359  
360  	return sysfs_emit(buf, "%d%s Gb/sec (%dX%s)\n", rate / 10,
361  			  rate % 10 ? ".5" : "",
362  			  ib_width_enum_to_int(attr.active_width), speed);
363  }
364  
phys_state_to_str(enum ib_port_phys_state phys_state)365  static const char *phys_state_to_str(enum ib_port_phys_state phys_state)
366  {
367  	static const char *phys_state_str[] = {
368  		"<unknown>",
369  		"Sleep",
370  		"Polling",
371  		"Disabled",
372  		"PortConfigurationTraining",
373  		"LinkUp",
374  		"LinkErrorRecovery",
375  		"Phy Test",
376  	};
377  
378  	if (phys_state < ARRAY_SIZE(phys_state_str))
379  		return phys_state_str[phys_state];
380  	return "<unknown>";
381  }
382  
phys_state_show(struct ib_device * ibdev,u32 port_num,struct ib_port_attribute * unused,char * buf)383  static ssize_t phys_state_show(struct ib_device *ibdev, u32 port_num,
384  			       struct ib_port_attribute *unused, char *buf)
385  {
386  	struct ib_port_attr attr;
387  
388  	ssize_t ret;
389  
390  	ret = ib_query_port(ibdev, port_num, &attr);
391  	if (ret)
392  		return ret;
393  
394  	return sysfs_emit(buf, "%u: %s\n", attr.phys_state,
395  			  phys_state_to_str(attr.phys_state));
396  }
397  
link_layer_show(struct ib_device * ibdev,u32 port_num,struct ib_port_attribute * unused,char * buf)398  static ssize_t link_layer_show(struct ib_device *ibdev, u32 port_num,
399  			       struct ib_port_attribute *unused, char *buf)
400  {
401  	const char *output;
402  
403  	switch (rdma_port_get_link_layer(ibdev, port_num)) {
404  	case IB_LINK_LAYER_INFINIBAND:
405  		output = "InfiniBand";
406  		break;
407  	case IB_LINK_LAYER_ETHERNET:
408  		output = "Ethernet";
409  		break;
410  	default:
411  		output = "Unknown";
412  		break;
413  	}
414  
415  	return sysfs_emit(buf, "%s\n", output);
416  }
417  
418  static IB_PORT_ATTR_RO(state);
419  static IB_PORT_ATTR_RO(lid);
420  static IB_PORT_ATTR_RO(lid_mask_count);
421  static IB_PORT_ATTR_RO(sm_lid);
422  static IB_PORT_ATTR_RO(sm_sl);
423  static IB_PORT_ATTR_RO(cap_mask);
424  static IB_PORT_ATTR_RO(rate);
425  static IB_PORT_ATTR_RO(phys_state);
426  static IB_PORT_ATTR_RO(link_layer);
427  
428  static struct attribute *port_default_attrs[] = {
429  	&ib_port_attr_state.attr,
430  	&ib_port_attr_lid.attr,
431  	&ib_port_attr_lid_mask_count.attr,
432  	&ib_port_attr_sm_lid.attr,
433  	&ib_port_attr_sm_sl.attr,
434  	&ib_port_attr_cap_mask.attr,
435  	&ib_port_attr_rate.attr,
436  	&ib_port_attr_phys_state.attr,
437  	&ib_port_attr_link_layer.attr,
438  	NULL
439  };
440  ATTRIBUTE_GROUPS(port_default);
441  
print_ndev(const struct ib_gid_attr * gid_attr,char * buf)442  static ssize_t print_ndev(const struct ib_gid_attr *gid_attr, char *buf)
443  {
444  	struct net_device *ndev;
445  	int ret = -EINVAL;
446  
447  	rcu_read_lock();
448  	ndev = rcu_dereference(gid_attr->ndev);
449  	if (ndev)
450  		ret = sysfs_emit(buf, "%s\n", ndev->name);
451  	rcu_read_unlock();
452  	return ret;
453  }
454  
print_gid_type(const struct ib_gid_attr * gid_attr,char * buf)455  static ssize_t print_gid_type(const struct ib_gid_attr *gid_attr, char *buf)
456  {
457  	return sysfs_emit(buf, "%s\n",
458  			  ib_cache_gid_type_str(gid_attr->gid_type));
459  }
460  
_show_port_gid_attr(struct ib_device * ibdev,u32 port_num,struct ib_port_attribute * attr,char * buf,ssize_t (* print)(const struct ib_gid_attr * gid_attr,char * buf))461  static ssize_t _show_port_gid_attr(
462  	struct ib_device *ibdev, u32 port_num, struct ib_port_attribute *attr,
463  	char *buf,
464  	ssize_t (*print)(const struct ib_gid_attr *gid_attr, char *buf))
465  {
466  	struct port_table_attribute *tab_attr =
467  		container_of(attr, struct port_table_attribute, attr);
468  	const struct ib_gid_attr *gid_attr;
469  	ssize_t ret;
470  
471  	gid_attr = rdma_get_gid_attr(ibdev, port_num, tab_attr->index);
472  	if (IS_ERR(gid_attr))
473  		/* -EINVAL is returned for user space compatibility reasons. */
474  		return -EINVAL;
475  
476  	ret = print(gid_attr, buf);
477  	rdma_put_gid_attr(gid_attr);
478  	return ret;
479  }
480  
show_port_gid(struct ib_device * ibdev,u32 port_num,struct ib_port_attribute * attr,char * buf)481  static ssize_t show_port_gid(struct ib_device *ibdev, u32 port_num,
482  			     struct ib_port_attribute *attr, char *buf)
483  {
484  	struct port_table_attribute *tab_attr =
485  		container_of(attr, struct port_table_attribute, attr);
486  	const struct ib_gid_attr *gid_attr;
487  	int len;
488  
489  	gid_attr = rdma_get_gid_attr(ibdev, port_num, tab_attr->index);
490  	if (IS_ERR(gid_attr)) {
491  		const union ib_gid zgid = {};
492  
493  		/* If reading GID fails, it is likely due to GID entry being
494  		 * empty (invalid) or reserved GID in the table.  User space
495  		 * expects to read GID table entries as long as it given index
496  		 * is within GID table size.  Administrative/debugging tool
497  		 * fails to query rest of the GID entries if it hits error
498  		 * while querying a GID of the given index.  To avoid user
499  		 * space throwing such error on fail to read gid, return zero
500  		 * GID as before. This maintains backward compatibility.
501  		 */
502  		return sysfs_emit(buf, "%pI6\n", zgid.raw);
503  	}
504  
505  	len = sysfs_emit(buf, "%pI6\n", gid_attr->gid.raw);
506  	rdma_put_gid_attr(gid_attr);
507  	return len;
508  }
509  
show_port_gid_attr_ndev(struct ib_device * ibdev,u32 port_num,struct ib_port_attribute * attr,char * buf)510  static ssize_t show_port_gid_attr_ndev(struct ib_device *ibdev, u32 port_num,
511  				       struct ib_port_attribute *attr,
512  				       char *buf)
513  {
514  	return _show_port_gid_attr(ibdev, port_num, attr, buf, print_ndev);
515  }
516  
show_port_gid_attr_gid_type(struct ib_device * ibdev,u32 port_num,struct ib_port_attribute * attr,char * buf)517  static ssize_t show_port_gid_attr_gid_type(struct ib_device *ibdev,
518  					   u32 port_num,
519  					   struct ib_port_attribute *attr,
520  					   char *buf)
521  {
522  	return _show_port_gid_attr(ibdev, port_num, attr, buf, print_gid_type);
523  }
524  
show_port_pkey(struct ib_device * ibdev,u32 port_num,struct ib_port_attribute * attr,char * buf)525  static ssize_t show_port_pkey(struct ib_device *ibdev, u32 port_num,
526  			      struct ib_port_attribute *attr, char *buf)
527  {
528  	struct port_table_attribute *tab_attr =
529  		container_of(attr, struct port_table_attribute, attr);
530  	u16 pkey;
531  	int ret;
532  
533  	ret = ib_query_pkey(ibdev, port_num, tab_attr->index, &pkey);
534  	if (ret)
535  		return ret;
536  
537  	return sysfs_emit(buf, "0x%04x\n", pkey);
538  }
539  
540  #define PORT_PMA_ATTR(_name, _counter, _width, _offset)			\
541  struct port_table_attribute port_pma_attr_##_name = {			\
542  	.attr  = __ATTR(_name, S_IRUGO, show_pma_counter, NULL),	\
543  	.index = (_offset) | ((_width) << 16) | ((_counter) << 24),	\
544  	.attr_id = IB_PMA_PORT_COUNTERS,				\
545  }
546  
547  #define PORT_PMA_ATTR_EXT(_name, _width, _offset)			\
548  struct port_table_attribute port_pma_attr_ext_##_name = {		\
549  	.attr  = __ATTR(_name, S_IRUGO, show_pma_counter, NULL),	\
550  	.index = (_offset) | ((_width) << 16),				\
551  	.attr_id = IB_PMA_PORT_COUNTERS_EXT,				\
552  }
553  
554  /*
555   * Get a Perfmgmt MAD block of data.
556   * Returns error code or the number of bytes retrieved.
557   */
get_perf_mad(struct ib_device * dev,int port_num,__be16 attr,void * data,int offset,size_t size)558  static int get_perf_mad(struct ib_device *dev, int port_num, __be16 attr,
559  		void *data, int offset, size_t size)
560  {
561  	struct ib_mad *in_mad;
562  	struct ib_mad *out_mad;
563  	size_t mad_size = sizeof(*out_mad);
564  	u16 out_mad_pkey_index = 0;
565  	ssize_t ret;
566  
567  	if (!dev->ops.process_mad)
568  		return -ENOSYS;
569  
570  	in_mad = kzalloc(sizeof(*in_mad), GFP_KERNEL);
571  	out_mad = kzalloc(sizeof(*out_mad), GFP_KERNEL);
572  	if (!in_mad || !out_mad) {
573  		ret = -ENOMEM;
574  		goto out;
575  	}
576  
577  	in_mad->mad_hdr.base_version  = 1;
578  	in_mad->mad_hdr.mgmt_class    = IB_MGMT_CLASS_PERF_MGMT;
579  	in_mad->mad_hdr.class_version = 1;
580  	in_mad->mad_hdr.method        = IB_MGMT_METHOD_GET;
581  	in_mad->mad_hdr.attr_id       = attr;
582  
583  	if (attr != IB_PMA_CLASS_PORT_INFO)
584  		in_mad->data[41] = port_num;	/* PortSelect field */
585  
586  	if ((dev->ops.process_mad(dev, IB_MAD_IGNORE_MKEY, port_num, NULL, NULL,
587  				  in_mad, out_mad, &mad_size,
588  				  &out_mad_pkey_index) &
589  	     (IB_MAD_RESULT_SUCCESS | IB_MAD_RESULT_REPLY)) !=
590  	    (IB_MAD_RESULT_SUCCESS | IB_MAD_RESULT_REPLY)) {
591  		ret = -EINVAL;
592  		goto out;
593  	}
594  	memcpy(data, out_mad->data + offset, size);
595  	ret = size;
596  out:
597  	kfree(in_mad);
598  	kfree(out_mad);
599  	return ret;
600  }
601  
show_pma_counter(struct ib_device * ibdev,u32 port_num,struct ib_port_attribute * attr,char * buf)602  static ssize_t show_pma_counter(struct ib_device *ibdev, u32 port_num,
603  				struct ib_port_attribute *attr, char *buf)
604  {
605  	struct port_table_attribute *tab_attr =
606  		container_of(attr, struct port_table_attribute, attr);
607  	int offset = tab_attr->index & 0xffff;
608  	int width  = (tab_attr->index >> 16) & 0xff;
609  	int ret;
610  	u8 data[8];
611  	int len;
612  
613  	ret = get_perf_mad(ibdev, port_num, tab_attr->attr_id, &data,
614  			40 + offset / 8, sizeof(data));
615  	if (ret < 0)
616  		return ret;
617  
618  	switch (width) {
619  	case 4:
620  		len = sysfs_emit(buf, "%d\n",
621  				 (*data >> (4 - (offset % 8))) & 0xf);
622  		break;
623  	case 8:
624  		len = sysfs_emit(buf, "%u\n", *data);
625  		break;
626  	case 16:
627  		len = sysfs_emit(buf, "%u\n", be16_to_cpup((__be16 *)data));
628  		break;
629  	case 32:
630  		len = sysfs_emit(buf, "%u\n", be32_to_cpup((__be32 *)data));
631  		break;
632  	case 64:
633  		len = sysfs_emit(buf, "%llu\n", be64_to_cpup((__be64 *)data));
634  		break;
635  	default:
636  		len = 0;
637  		break;
638  	}
639  
640  	return len;
641  }
642  
643  static PORT_PMA_ATTR(symbol_error		    ,  0, 16,  32);
644  static PORT_PMA_ATTR(link_error_recovery	    ,  1,  8,  48);
645  static PORT_PMA_ATTR(link_downed		    ,  2,  8,  56);
646  static PORT_PMA_ATTR(port_rcv_errors		    ,  3, 16,  64);
647  static PORT_PMA_ATTR(port_rcv_remote_physical_errors,  4, 16,  80);
648  static PORT_PMA_ATTR(port_rcv_switch_relay_errors   ,  5, 16,  96);
649  static PORT_PMA_ATTR(port_xmit_discards		    ,  6, 16, 112);
650  static PORT_PMA_ATTR(port_xmit_constraint_errors    ,  7,  8, 128);
651  static PORT_PMA_ATTR(port_rcv_constraint_errors	    ,  8,  8, 136);
652  static PORT_PMA_ATTR(local_link_integrity_errors    ,  9,  4, 152);
653  static PORT_PMA_ATTR(excessive_buffer_overrun_errors, 10,  4, 156);
654  static PORT_PMA_ATTR(VL15_dropped		    , 11, 16, 176);
655  static PORT_PMA_ATTR(port_xmit_data		    , 12, 32, 192);
656  static PORT_PMA_ATTR(port_rcv_data		    , 13, 32, 224);
657  static PORT_PMA_ATTR(port_xmit_packets		    , 14, 32, 256);
658  static PORT_PMA_ATTR(port_rcv_packets		    , 15, 32, 288);
659  static PORT_PMA_ATTR(port_xmit_wait		    ,  0, 32, 320);
660  
661  /*
662   * Counters added by extended set
663   */
664  static PORT_PMA_ATTR_EXT(port_xmit_data		    , 64,  64);
665  static PORT_PMA_ATTR_EXT(port_rcv_data		    , 64, 128);
666  static PORT_PMA_ATTR_EXT(port_xmit_packets	    , 64, 192);
667  static PORT_PMA_ATTR_EXT(port_rcv_packets	    , 64, 256);
668  static PORT_PMA_ATTR_EXT(unicast_xmit_packets	    , 64, 320);
669  static PORT_PMA_ATTR_EXT(unicast_rcv_packets	    , 64, 384);
670  static PORT_PMA_ATTR_EXT(multicast_xmit_packets	    , 64, 448);
671  static PORT_PMA_ATTR_EXT(multicast_rcv_packets	    , 64, 512);
672  
673  static struct attribute *pma_attrs[] = {
674  	&port_pma_attr_symbol_error.attr.attr,
675  	&port_pma_attr_link_error_recovery.attr.attr,
676  	&port_pma_attr_link_downed.attr.attr,
677  	&port_pma_attr_port_rcv_errors.attr.attr,
678  	&port_pma_attr_port_rcv_remote_physical_errors.attr.attr,
679  	&port_pma_attr_port_rcv_switch_relay_errors.attr.attr,
680  	&port_pma_attr_port_xmit_discards.attr.attr,
681  	&port_pma_attr_port_xmit_constraint_errors.attr.attr,
682  	&port_pma_attr_port_rcv_constraint_errors.attr.attr,
683  	&port_pma_attr_local_link_integrity_errors.attr.attr,
684  	&port_pma_attr_excessive_buffer_overrun_errors.attr.attr,
685  	&port_pma_attr_VL15_dropped.attr.attr,
686  	&port_pma_attr_port_xmit_data.attr.attr,
687  	&port_pma_attr_port_rcv_data.attr.attr,
688  	&port_pma_attr_port_xmit_packets.attr.attr,
689  	&port_pma_attr_port_rcv_packets.attr.attr,
690  	&port_pma_attr_port_xmit_wait.attr.attr,
691  	NULL
692  };
693  
694  static struct attribute *pma_attrs_ext[] = {
695  	&port_pma_attr_symbol_error.attr.attr,
696  	&port_pma_attr_link_error_recovery.attr.attr,
697  	&port_pma_attr_link_downed.attr.attr,
698  	&port_pma_attr_port_rcv_errors.attr.attr,
699  	&port_pma_attr_port_rcv_remote_physical_errors.attr.attr,
700  	&port_pma_attr_port_rcv_switch_relay_errors.attr.attr,
701  	&port_pma_attr_port_xmit_discards.attr.attr,
702  	&port_pma_attr_port_xmit_constraint_errors.attr.attr,
703  	&port_pma_attr_port_rcv_constraint_errors.attr.attr,
704  	&port_pma_attr_local_link_integrity_errors.attr.attr,
705  	&port_pma_attr_excessive_buffer_overrun_errors.attr.attr,
706  	&port_pma_attr_VL15_dropped.attr.attr,
707  	&port_pma_attr_ext_port_xmit_data.attr.attr,
708  	&port_pma_attr_ext_port_rcv_data.attr.attr,
709  	&port_pma_attr_ext_port_xmit_packets.attr.attr,
710  	&port_pma_attr_port_xmit_wait.attr.attr,
711  	&port_pma_attr_ext_port_rcv_packets.attr.attr,
712  	&port_pma_attr_ext_unicast_rcv_packets.attr.attr,
713  	&port_pma_attr_ext_unicast_xmit_packets.attr.attr,
714  	&port_pma_attr_ext_multicast_rcv_packets.attr.attr,
715  	&port_pma_attr_ext_multicast_xmit_packets.attr.attr,
716  	NULL
717  };
718  
719  static struct attribute *pma_attrs_noietf[] = {
720  	&port_pma_attr_symbol_error.attr.attr,
721  	&port_pma_attr_link_error_recovery.attr.attr,
722  	&port_pma_attr_link_downed.attr.attr,
723  	&port_pma_attr_port_rcv_errors.attr.attr,
724  	&port_pma_attr_port_rcv_remote_physical_errors.attr.attr,
725  	&port_pma_attr_port_rcv_switch_relay_errors.attr.attr,
726  	&port_pma_attr_port_xmit_discards.attr.attr,
727  	&port_pma_attr_port_xmit_constraint_errors.attr.attr,
728  	&port_pma_attr_port_rcv_constraint_errors.attr.attr,
729  	&port_pma_attr_local_link_integrity_errors.attr.attr,
730  	&port_pma_attr_excessive_buffer_overrun_errors.attr.attr,
731  	&port_pma_attr_VL15_dropped.attr.attr,
732  	&port_pma_attr_ext_port_xmit_data.attr.attr,
733  	&port_pma_attr_ext_port_rcv_data.attr.attr,
734  	&port_pma_attr_ext_port_xmit_packets.attr.attr,
735  	&port_pma_attr_ext_port_rcv_packets.attr.attr,
736  	&port_pma_attr_port_xmit_wait.attr.attr,
737  	NULL
738  };
739  
740  static const struct attribute_group pma_group = {
741  	.name  = "counters",
742  	.attrs  = pma_attrs
743  };
744  
745  static const struct attribute_group pma_group_ext = {
746  	.name  = "counters",
747  	.attrs  = pma_attrs_ext
748  };
749  
750  static const struct attribute_group pma_group_noietf = {
751  	.name  = "counters",
752  	.attrs  = pma_attrs_noietf
753  };
754  
ib_port_release(struct kobject * kobj)755  static void ib_port_release(struct kobject *kobj)
756  {
757  	struct ib_port *port = container_of(kobj, struct ib_port, kobj);
758  	int i;
759  
760  	for (i = 0; i != ARRAY_SIZE(port->groups); i++)
761  		kfree(port->groups[i].attrs);
762  	if (port->hw_stats_data)
763  		rdma_free_hw_stats_struct(port->hw_stats_data->stats);
764  	kfree(port->hw_stats_data);
765  	kvfree(port);
766  }
767  
ib_port_gid_attr_release(struct kobject * kobj)768  static void ib_port_gid_attr_release(struct kobject *kobj)
769  {
770  	struct gid_attr_group *gid_attr_group =
771  		container_of(kobj, struct gid_attr_group, kobj);
772  	int i;
773  
774  	for (i = 0; i != ARRAY_SIZE(gid_attr_group->groups); i++)
775  		kfree(gid_attr_group->groups[i].attrs);
776  	kfree(gid_attr_group);
777  }
778  
779  static struct kobj_type port_type = {
780  	.release       = ib_port_release,
781  	.sysfs_ops     = &port_sysfs_ops,
782  	.default_groups = port_default_groups,
783  };
784  
785  static struct kobj_type gid_attr_type = {
786  	.sysfs_ops      = &gid_attr_sysfs_ops,
787  	.release        = ib_port_gid_attr_release
788  };
789  
790  /*
791   * Figure out which counter table to use depending on
792   * the device capabilities.
793   */
get_counter_table(struct ib_device * dev,int port_num)794  static const struct attribute_group *get_counter_table(struct ib_device *dev,
795  						       int port_num)
796  {
797  	struct ib_class_port_info cpi;
798  
799  	if (get_perf_mad(dev, port_num, IB_PMA_CLASS_PORT_INFO,
800  				&cpi, 40, sizeof(cpi)) >= 0) {
801  		if (cpi.capability_mask & IB_PMA_CLASS_CAP_EXT_WIDTH)
802  			/* We have extended counters */
803  			return &pma_group_ext;
804  
805  		if (cpi.capability_mask & IB_PMA_CLASS_CAP_EXT_WIDTH_NOIETF)
806  			/* But not the IETF ones */
807  			return &pma_group_noietf;
808  	}
809  
810  	/* Fall back to normal counters */
811  	return &pma_group;
812  }
813  
update_hw_stats(struct ib_device * dev,struct rdma_hw_stats * stats,u32 port_num,int index)814  static int update_hw_stats(struct ib_device *dev, struct rdma_hw_stats *stats,
815  			   u32 port_num, int index)
816  {
817  	int ret;
818  
819  	if (time_is_after_eq_jiffies(stats->timestamp + stats->lifespan))
820  		return 0;
821  	ret = dev->ops.get_hw_stats(dev, stats, port_num, index);
822  	if (ret < 0)
823  		return ret;
824  	if (ret == stats->num_counters)
825  		stats->timestamp = jiffies;
826  
827  	return 0;
828  }
829  
print_hw_stat(struct ib_device * dev,int port_num,struct rdma_hw_stats * stats,int index,char * buf)830  static int print_hw_stat(struct ib_device *dev, int port_num,
831  			 struct rdma_hw_stats *stats, int index, char *buf)
832  {
833  	u64 v = rdma_counter_get_hwstat_value(dev, port_num, index);
834  
835  	return sysfs_emit(buf, "%llu\n", stats->value[index] + v);
836  }
837  
show_hw_stats(struct ib_device * ibdev,struct rdma_hw_stats * stats,unsigned int index,unsigned int port_num,char * buf)838  static ssize_t show_hw_stats(struct ib_device *ibdev,
839  			     struct rdma_hw_stats *stats, unsigned int index,
840  			     unsigned int port_num, char *buf)
841  {
842  	int ret;
843  
844  	mutex_lock(&stats->lock);
845  	ret = update_hw_stats(ibdev, stats, port_num, index);
846  	if (ret)
847  		goto unlock;
848  	ret = print_hw_stat(ibdev, port_num, stats, index, buf);
849  unlock:
850  	mutex_unlock(&stats->lock);
851  
852  	return ret;
853  }
854  
show_stats_lifespan(struct ib_device * ibdev,struct rdma_hw_stats * stats,unsigned int index,unsigned int port_num,char * buf)855  static ssize_t show_stats_lifespan(struct ib_device *ibdev,
856  				   struct rdma_hw_stats *stats,
857  				   unsigned int index, unsigned int port_num,
858  				   char *buf)
859  {
860  	int msecs;
861  
862  	mutex_lock(&stats->lock);
863  	msecs = jiffies_to_msecs(stats->lifespan);
864  	mutex_unlock(&stats->lock);
865  
866  	return sysfs_emit(buf, "%d\n", msecs);
867  }
868  
set_stats_lifespan(struct ib_device * ibdev,struct rdma_hw_stats * stats,unsigned int index,unsigned int port_num,const char * buf,size_t count)869  static ssize_t set_stats_lifespan(struct ib_device *ibdev,
870  				   struct rdma_hw_stats *stats,
871  				   unsigned int index, unsigned int port_num,
872  				   const char *buf, size_t count)
873  {
874  	int msecs;
875  	int jiffies;
876  	int ret;
877  
878  	ret = kstrtoint(buf, 10, &msecs);
879  	if (ret)
880  		return ret;
881  	if (msecs < 0 || msecs > 10000)
882  		return -EINVAL;
883  	jiffies = msecs_to_jiffies(msecs);
884  
885  	mutex_lock(&stats->lock);
886  	stats->lifespan = jiffies;
887  	mutex_unlock(&stats->lock);
888  
889  	return count;
890  }
891  
892  static struct hw_stats_device_data *
alloc_hw_stats_device(struct ib_device * ibdev)893  alloc_hw_stats_device(struct ib_device *ibdev)
894  {
895  	struct hw_stats_device_data *data;
896  	struct rdma_hw_stats *stats;
897  
898  	if (!ibdev->ops.alloc_hw_device_stats)
899  		return ERR_PTR(-EOPNOTSUPP);
900  	stats = ibdev->ops.alloc_hw_device_stats(ibdev);
901  	if (!stats)
902  		return ERR_PTR(-ENOMEM);
903  	if (!stats->descs || stats->num_counters <= 0)
904  		goto err_free_stats;
905  
906  	/*
907  	 * Two extra attribue elements here, one for the lifespan entry and
908  	 * one to NULL terminate the list for the sysfs core code
909  	 */
910  	data = kzalloc(struct_size(data, attrs, size_add(stats->num_counters, 1)),
911  		       GFP_KERNEL);
912  	if (!data)
913  		goto err_free_stats;
914  	data->group.attrs = kcalloc(stats->num_counters + 2,
915  				    sizeof(*data->group.attrs), GFP_KERNEL);
916  	if (!data->group.attrs)
917  		goto err_free_data;
918  
919  	data->group.name = "hw_counters";
920  	data->stats = stats;
921  	return data;
922  
923  err_free_data:
924  	kfree(data);
925  err_free_stats:
926  	rdma_free_hw_stats_struct(stats);
927  	return ERR_PTR(-ENOMEM);
928  }
929  
ib_device_release_hw_stats(struct hw_stats_device_data * data)930  void ib_device_release_hw_stats(struct hw_stats_device_data *data)
931  {
932  	kfree(data->group.attrs);
933  	rdma_free_hw_stats_struct(data->stats);
934  	kfree(data);
935  }
936  
ib_setup_device_attrs(struct ib_device * ibdev)937  int ib_setup_device_attrs(struct ib_device *ibdev)
938  {
939  	struct hw_stats_device_attribute *attr;
940  	struct hw_stats_device_data *data;
941  	bool opstat_skipped = false;
942  	int i, ret, pos = 0;
943  
944  	data = alloc_hw_stats_device(ibdev);
945  	if (IS_ERR(data)) {
946  		if (PTR_ERR(data) == -EOPNOTSUPP)
947  			return 0;
948  		return PTR_ERR(data);
949  	}
950  	ibdev->hw_stats_data = data;
951  
952  	ret = ibdev->ops.get_hw_stats(ibdev, data->stats, 0,
953  				      data->stats->num_counters);
954  	if (ret != data->stats->num_counters) {
955  		if (WARN_ON(ret >= 0))
956  			return -EINVAL;
957  		return ret;
958  	}
959  
960  	data->stats->timestamp = jiffies;
961  
962  	for (i = 0; i < data->stats->num_counters; i++) {
963  		if (data->stats->descs[i].flags & IB_STAT_FLAG_OPTIONAL) {
964  			opstat_skipped = true;
965  			continue;
966  		}
967  
968  		WARN_ON(opstat_skipped);
969  		attr = &data->attrs[pos];
970  		sysfs_attr_init(&attr->attr.attr);
971  		attr->attr.attr.name = data->stats->descs[i].name;
972  		attr->attr.attr.mode = 0444;
973  		attr->attr.show = hw_stat_device_show;
974  		attr->show = show_hw_stats;
975  		data->group.attrs[pos] = &attr->attr.attr;
976  		pos++;
977  	}
978  
979  	attr = &data->attrs[pos];
980  	sysfs_attr_init(&attr->attr.attr);
981  	attr->attr.attr.name = "lifespan";
982  	attr->attr.attr.mode = 0644;
983  	attr->attr.show = hw_stat_device_show;
984  	attr->show = show_stats_lifespan;
985  	attr->attr.store = hw_stat_device_store;
986  	attr->store = set_stats_lifespan;
987  	data->group.attrs[pos] = &attr->attr.attr;
988  	for (i = 0; i != ARRAY_SIZE(ibdev->groups); i++)
989  		if (!ibdev->groups[i]) {
990  			ibdev->groups[i] = &data->group;
991  			ibdev->hw_stats_attr_index = i;
992  			return 0;
993  		}
994  	WARN(true, "struct ib_device->groups is too small");
995  	return -EINVAL;
996  }
997  
998  static struct hw_stats_port_data *
alloc_hw_stats_port(struct ib_port * port,struct attribute_group * group)999  alloc_hw_stats_port(struct ib_port *port, struct attribute_group *group)
1000  {
1001  	struct ib_device *ibdev = port->ibdev;
1002  	struct hw_stats_port_data *data;
1003  	struct rdma_hw_stats *stats;
1004  
1005  	if (!ibdev->ops.alloc_hw_port_stats)
1006  		return ERR_PTR(-EOPNOTSUPP);
1007  	stats = ibdev->ops.alloc_hw_port_stats(port->ibdev, port->port_num);
1008  	if (!stats)
1009  		return ERR_PTR(-ENOMEM);
1010  	if (!stats->descs || stats->num_counters <= 0)
1011  		goto err_free_stats;
1012  
1013  	/*
1014  	 * Two extra attribue elements here, one for the lifespan entry and
1015  	 * one to NULL terminate the list for the sysfs core code
1016  	 */
1017  	data = kzalloc(struct_size(data, attrs, size_add(stats->num_counters, 1)),
1018  		       GFP_KERNEL);
1019  	if (!data)
1020  		goto err_free_stats;
1021  	group->attrs = kcalloc(stats->num_counters + 2,
1022  				    sizeof(*group->attrs), GFP_KERNEL);
1023  	if (!group->attrs)
1024  		goto err_free_data;
1025  
1026  	group->name = "hw_counters";
1027  	data->stats = stats;
1028  	return data;
1029  
1030  err_free_data:
1031  	kfree(data);
1032  err_free_stats:
1033  	rdma_free_hw_stats_struct(stats);
1034  	return ERR_PTR(-ENOMEM);
1035  }
1036  
setup_hw_port_stats(struct ib_port * port,struct attribute_group * group)1037  static int setup_hw_port_stats(struct ib_port *port,
1038  			       struct attribute_group *group)
1039  {
1040  	struct hw_stats_port_attribute *attr;
1041  	struct hw_stats_port_data *data;
1042  	bool opstat_skipped = false;
1043  	int i, ret, pos = 0;
1044  
1045  	data = alloc_hw_stats_port(port, group);
1046  	if (IS_ERR(data))
1047  		return PTR_ERR(data);
1048  
1049  	ret = port->ibdev->ops.get_hw_stats(port->ibdev, data->stats,
1050  					    port->port_num,
1051  					    data->stats->num_counters);
1052  	if (ret != data->stats->num_counters) {
1053  		if (WARN_ON(ret >= 0))
1054  			return -EINVAL;
1055  		return ret;
1056  	}
1057  
1058  	data->stats->timestamp = jiffies;
1059  
1060  	for (i = 0; i < data->stats->num_counters; i++) {
1061  		if (data->stats->descs[i].flags & IB_STAT_FLAG_OPTIONAL) {
1062  			opstat_skipped = true;
1063  			continue;
1064  		}
1065  
1066  		WARN_ON(opstat_skipped);
1067  		attr = &data->attrs[pos];
1068  		sysfs_attr_init(&attr->attr.attr);
1069  		attr->attr.attr.name = data->stats->descs[i].name;
1070  		attr->attr.attr.mode = 0444;
1071  		attr->attr.show = hw_stat_port_show;
1072  		attr->show = show_hw_stats;
1073  		group->attrs[pos] = &attr->attr.attr;
1074  		pos++;
1075  	}
1076  
1077  	attr = &data->attrs[pos];
1078  	sysfs_attr_init(&attr->attr.attr);
1079  	attr->attr.attr.name = "lifespan";
1080  	attr->attr.attr.mode = 0644;
1081  	attr->attr.show = hw_stat_port_show;
1082  	attr->show = show_stats_lifespan;
1083  	attr->attr.store = hw_stat_port_store;
1084  	attr->store = set_stats_lifespan;
1085  	group->attrs[pos] = &attr->attr.attr;
1086  
1087  	port->hw_stats_data = data;
1088  	return 0;
1089  }
1090  
ib_get_hw_stats_port(struct ib_device * ibdev,u32 port_num)1091  struct rdma_hw_stats *ib_get_hw_stats_port(struct ib_device *ibdev,
1092  					   u32 port_num)
1093  {
1094  	if (!ibdev->port_data || !rdma_is_port_valid(ibdev, port_num) ||
1095  	    !ibdev->port_data[port_num].sysfs->hw_stats_data)
1096  		return NULL;
1097  	return ibdev->port_data[port_num].sysfs->hw_stats_data->stats;
1098  }
1099  
1100  static int
alloc_port_table_group(const char * name,struct attribute_group * group,struct port_table_attribute * attrs,size_t num,ssize_t (* show)(struct ib_device * ibdev,u32 port_num,struct ib_port_attribute *,char * buf))1101  alloc_port_table_group(const char *name, struct attribute_group *group,
1102  		       struct port_table_attribute *attrs, size_t num,
1103  		       ssize_t (*show)(struct ib_device *ibdev, u32 port_num,
1104  				       struct ib_port_attribute *, char *buf))
1105  {
1106  	struct attribute **attr_list;
1107  	int i;
1108  
1109  	attr_list = kcalloc(num + 1, sizeof(*attr_list), GFP_KERNEL);
1110  	if (!attr_list)
1111  		return -ENOMEM;
1112  
1113  	for (i = 0; i < num; i++) {
1114  		struct port_table_attribute *element = &attrs[i];
1115  
1116  		if (snprintf(element->name, sizeof(element->name), "%d", i) >=
1117  		    sizeof(element->name))
1118  			goto err;
1119  
1120  		sysfs_attr_init(&element->attr.attr);
1121  		element->attr.attr.name = element->name;
1122  		element->attr.attr.mode = 0444;
1123  		element->attr.show = show;
1124  		element->index = i;
1125  
1126  		attr_list[i] = &element->attr.attr;
1127  	}
1128  	group->name = name;
1129  	group->attrs = attr_list;
1130  	return 0;
1131  err:
1132  	kfree(attr_list);
1133  	return -EINVAL;
1134  }
1135  
1136  /*
1137   * Create the sysfs:
1138   *  ibp0s9/ports/XX/gid_attrs/{ndevs,types}/YYY
1139   * YYY is the gid table index in decimal
1140   */
setup_gid_attrs(struct ib_port * port,const struct ib_port_attr * attr)1141  static int setup_gid_attrs(struct ib_port *port,
1142  			   const struct ib_port_attr *attr)
1143  {
1144  	struct gid_attr_group *gid_attr_group;
1145  	int ret;
1146  
1147  	gid_attr_group = kzalloc(struct_size(gid_attr_group, attrs_list,
1148  					     size_mul(attr->gid_tbl_len, 2)),
1149  				 GFP_KERNEL);
1150  	if (!gid_attr_group)
1151  		return -ENOMEM;
1152  	gid_attr_group->port = port;
1153  	kobject_init(&gid_attr_group->kobj, &gid_attr_type);
1154  
1155  	ret = alloc_port_table_group("ndevs", &gid_attr_group->groups[0],
1156  				     gid_attr_group->attrs_list,
1157  				     attr->gid_tbl_len,
1158  				     show_port_gid_attr_ndev);
1159  	if (ret)
1160  		goto err_put;
1161  	gid_attr_group->groups_list[0] = &gid_attr_group->groups[0];
1162  
1163  	ret = alloc_port_table_group(
1164  		"types", &gid_attr_group->groups[1],
1165  		gid_attr_group->attrs_list + attr->gid_tbl_len,
1166  		attr->gid_tbl_len, show_port_gid_attr_gid_type);
1167  	if (ret)
1168  		goto err_put;
1169  	gid_attr_group->groups_list[1] = &gid_attr_group->groups[1];
1170  
1171  	ret = kobject_add(&gid_attr_group->kobj, &port->kobj, "gid_attrs");
1172  	if (ret)
1173  		goto err_put;
1174  	ret = sysfs_create_groups(&gid_attr_group->kobj,
1175  				  gid_attr_group->groups_list);
1176  	if (ret)
1177  		goto err_del;
1178  	port->gid_attr_group = gid_attr_group;
1179  	return 0;
1180  
1181  err_del:
1182  	kobject_del(&gid_attr_group->kobj);
1183  err_put:
1184  	kobject_put(&gid_attr_group->kobj);
1185  	return ret;
1186  }
1187  
destroy_gid_attrs(struct ib_port * port)1188  static void destroy_gid_attrs(struct ib_port *port)
1189  {
1190  	struct gid_attr_group *gid_attr_group = port->gid_attr_group;
1191  
1192  	if (!gid_attr_group)
1193  		return;
1194  	sysfs_remove_groups(&gid_attr_group->kobj, gid_attr_group->groups_list);
1195  	kobject_del(&gid_attr_group->kobj);
1196  	kobject_put(&gid_attr_group->kobj);
1197  }
1198  
1199  /*
1200   * Create the sysfs:
1201   *  ibp0s9/ports/XX/{gids,pkeys,counters}/YYY
1202   */
setup_port(struct ib_core_device * coredev,int port_num,const struct ib_port_attr * attr)1203  static struct ib_port *setup_port(struct ib_core_device *coredev, int port_num,
1204  				  const struct ib_port_attr *attr)
1205  {
1206  	struct ib_device *device = rdma_device_to_ibdev(&coredev->dev);
1207  	bool is_full_dev = &device->coredev == coredev;
1208  	const struct attribute_group **cur_group;
1209  	struct ib_port *p;
1210  	int ret;
1211  
1212  	p = kvzalloc(struct_size(p, attrs_list,
1213  				size_add(attr->gid_tbl_len, attr->pkey_tbl_len)),
1214  		     GFP_KERNEL);
1215  	if (!p)
1216  		return ERR_PTR(-ENOMEM);
1217  	p->ibdev = device;
1218  	p->port_num = port_num;
1219  	kobject_init(&p->kobj, &port_type);
1220  
1221  	if (device->port_data && is_full_dev)
1222  		device->port_data[port_num].sysfs = p;
1223  
1224  	cur_group = p->groups_list;
1225  	ret = alloc_port_table_group("gids", &p->groups[0], p->attrs_list,
1226  				     attr->gid_tbl_len, show_port_gid);
1227  	if (ret)
1228  		goto err_put;
1229  	*cur_group++ = &p->groups[0];
1230  
1231  	if (attr->pkey_tbl_len) {
1232  		ret = alloc_port_table_group("pkeys", &p->groups[1],
1233  					     p->attrs_list + attr->gid_tbl_len,
1234  					     attr->pkey_tbl_len, show_port_pkey);
1235  		if (ret)
1236  			goto err_put;
1237  		*cur_group++ = &p->groups[1];
1238  	}
1239  
1240  	/*
1241  	 * If port == 0, it means hw_counters are per device and not per
1242  	 * port, so holder should be device. Therefore skip per port
1243  	 * counter initialization.
1244  	 */
1245  	if (port_num && is_full_dev) {
1246  		ret = setup_hw_port_stats(p, &p->groups[2]);
1247  		if (ret && ret != -EOPNOTSUPP)
1248  			goto err_put;
1249  		if (!ret)
1250  			*cur_group++ = &p->groups[2];
1251  	}
1252  
1253  	if (device->ops.process_mad && is_full_dev)
1254  		*cur_group++ = get_counter_table(device, port_num);
1255  
1256  	ret = kobject_add(&p->kobj, coredev->ports_kobj, "%d", port_num);
1257  	if (ret)
1258  		goto err_put;
1259  	ret = sysfs_create_groups(&p->kobj, p->groups_list);
1260  	if (ret)
1261  		goto err_del;
1262  	if (is_full_dev) {
1263  		ret = sysfs_create_groups(&p->kobj, device->ops.port_groups);
1264  		if (ret)
1265  			goto err_groups;
1266  	}
1267  
1268  	list_add_tail(&p->kobj.entry, &coredev->port_list);
1269  	return p;
1270  
1271  err_groups:
1272  	sysfs_remove_groups(&p->kobj, p->groups_list);
1273  err_del:
1274  	kobject_del(&p->kobj);
1275  err_put:
1276  	if (device->port_data && is_full_dev)
1277  		device->port_data[port_num].sysfs = NULL;
1278  	kobject_put(&p->kobj);
1279  	return ERR_PTR(ret);
1280  }
1281  
destroy_port(struct ib_core_device * coredev,struct ib_port * port)1282  static void destroy_port(struct ib_core_device *coredev, struct ib_port *port)
1283  {
1284  	bool is_full_dev = &port->ibdev->coredev == coredev;
1285  
1286  	list_del(&port->kobj.entry);
1287  	if (is_full_dev)
1288  		sysfs_remove_groups(&port->kobj, port->ibdev->ops.port_groups);
1289  
1290  	sysfs_remove_groups(&port->kobj, port->groups_list);
1291  	kobject_del(&port->kobj);
1292  
1293  	if (port->ibdev->port_data &&
1294  	    port->ibdev->port_data[port->port_num].sysfs == port)
1295  		port->ibdev->port_data[port->port_num].sysfs = NULL;
1296  
1297  	kobject_put(&port->kobj);
1298  }
1299  
node_type_string(int node_type)1300  static const char *node_type_string(int node_type)
1301  {
1302  	switch (node_type) {
1303  	case RDMA_NODE_IB_CA:
1304  		return "CA";
1305  	case RDMA_NODE_IB_SWITCH:
1306  		return "switch";
1307  	case RDMA_NODE_IB_ROUTER:
1308  		return "router";
1309  	case RDMA_NODE_RNIC:
1310  		return "RNIC";
1311  	case RDMA_NODE_USNIC:
1312  		return "usNIC";
1313  	case RDMA_NODE_USNIC_UDP:
1314  		return "usNIC UDP";
1315  	case RDMA_NODE_UNSPECIFIED:
1316  		return "unspecified";
1317  	}
1318  	return "<unknown>";
1319  }
1320  
node_type_show(struct device * device,struct device_attribute * attr,char * buf)1321  static ssize_t node_type_show(struct device *device,
1322  			      struct device_attribute *attr, char *buf)
1323  {
1324  	struct ib_device *dev = rdma_device_to_ibdev(device);
1325  
1326  	return sysfs_emit(buf, "%u: %s\n", dev->node_type,
1327  			  node_type_string(dev->node_type));
1328  }
1329  static DEVICE_ATTR_RO(node_type);
1330  
sys_image_guid_show(struct device * device,struct device_attribute * dev_attr,char * buf)1331  static ssize_t sys_image_guid_show(struct device *device,
1332  				   struct device_attribute *dev_attr, char *buf)
1333  {
1334  	struct ib_device *dev = rdma_device_to_ibdev(device);
1335  	__be16 *guid = (__be16 *)&dev->attrs.sys_image_guid;
1336  
1337  	return sysfs_emit(buf, "%04x:%04x:%04x:%04x\n",
1338  			  be16_to_cpu(guid[0]),
1339  			  be16_to_cpu(guid[1]),
1340  			  be16_to_cpu(guid[2]),
1341  			  be16_to_cpu(guid[3]));
1342  }
1343  static DEVICE_ATTR_RO(sys_image_guid);
1344  
node_guid_show(struct device * device,struct device_attribute * attr,char * buf)1345  static ssize_t node_guid_show(struct device *device,
1346  			      struct device_attribute *attr, char *buf)
1347  {
1348  	struct ib_device *dev = rdma_device_to_ibdev(device);
1349  	__be16 *node_guid = (__be16 *)&dev->node_guid;
1350  
1351  	return sysfs_emit(buf, "%04x:%04x:%04x:%04x\n",
1352  			  be16_to_cpu(node_guid[0]),
1353  			  be16_to_cpu(node_guid[1]),
1354  			  be16_to_cpu(node_guid[2]),
1355  			  be16_to_cpu(node_guid[3]));
1356  }
1357  static DEVICE_ATTR_RO(node_guid);
1358  
node_desc_show(struct device * device,struct device_attribute * attr,char * buf)1359  static ssize_t node_desc_show(struct device *device,
1360  			      struct device_attribute *attr, char *buf)
1361  {
1362  	struct ib_device *dev = rdma_device_to_ibdev(device);
1363  
1364  	return sysfs_emit(buf, "%.64s\n", dev->node_desc);
1365  }
1366  
node_desc_store(struct device * device,struct device_attribute * attr,const char * buf,size_t count)1367  static ssize_t node_desc_store(struct device *device,
1368  			       struct device_attribute *attr,
1369  			       const char *buf, size_t count)
1370  {
1371  	struct ib_device *dev = rdma_device_to_ibdev(device);
1372  	struct ib_device_modify desc = {};
1373  	int ret;
1374  
1375  	if (!dev->ops.modify_device)
1376  		return -EOPNOTSUPP;
1377  
1378  	memcpy(desc.node_desc, buf, min_t(int, count, IB_DEVICE_NODE_DESC_MAX));
1379  	ret = ib_modify_device(dev, IB_DEVICE_MODIFY_NODE_DESC, &desc);
1380  	if (ret)
1381  		return ret;
1382  
1383  	return count;
1384  }
1385  static DEVICE_ATTR_RW(node_desc);
1386  
fw_ver_show(struct device * device,struct device_attribute * attr,char * buf)1387  static ssize_t fw_ver_show(struct device *device, struct device_attribute *attr,
1388  			   char *buf)
1389  {
1390  	struct ib_device *dev = rdma_device_to_ibdev(device);
1391  	char version[IB_FW_VERSION_NAME_MAX] = {};
1392  
1393  	ib_get_device_fw_str(dev, version);
1394  
1395  	return sysfs_emit(buf, "%s\n", version);
1396  }
1397  static DEVICE_ATTR_RO(fw_ver);
1398  
1399  static struct attribute *ib_dev_attrs[] = {
1400  	&dev_attr_node_type.attr,
1401  	&dev_attr_node_guid.attr,
1402  	&dev_attr_sys_image_guid.attr,
1403  	&dev_attr_fw_ver.attr,
1404  	&dev_attr_node_desc.attr,
1405  	NULL,
1406  };
1407  
1408  const struct attribute_group ib_dev_attr_group = {
1409  	.attrs = ib_dev_attrs,
1410  };
1411  
ib_free_port_attrs(struct ib_core_device * coredev)1412  void ib_free_port_attrs(struct ib_core_device *coredev)
1413  {
1414  	struct kobject *p, *t;
1415  
1416  	list_for_each_entry_safe(p, t, &coredev->port_list, entry) {
1417  		struct ib_port *port = container_of(p, struct ib_port, kobj);
1418  
1419  		destroy_gid_attrs(port);
1420  		destroy_port(coredev, port);
1421  	}
1422  
1423  	kobject_put(coredev->ports_kobj);
1424  }
1425  
ib_setup_port_attrs(struct ib_core_device * coredev)1426  int ib_setup_port_attrs(struct ib_core_device *coredev)
1427  {
1428  	struct ib_device *device = rdma_device_to_ibdev(&coredev->dev);
1429  	u32 port_num;
1430  	int ret;
1431  
1432  	coredev->ports_kobj = kobject_create_and_add("ports",
1433  						     &coredev->dev.kobj);
1434  	if (!coredev->ports_kobj)
1435  		return -ENOMEM;
1436  
1437  	rdma_for_each_port (device, port_num) {
1438  		struct ib_port_attr attr;
1439  		struct ib_port *port;
1440  
1441  		ret = ib_query_port(device, port_num, &attr);
1442  		if (ret)
1443  			goto err_put;
1444  
1445  		port = setup_port(coredev, port_num, &attr);
1446  		if (IS_ERR(port)) {
1447  			ret = PTR_ERR(port);
1448  			goto err_put;
1449  		}
1450  
1451  		ret = setup_gid_attrs(port, &attr);
1452  		if (ret)
1453  			goto err_put;
1454  	}
1455  	return 0;
1456  
1457  err_put:
1458  	ib_free_port_attrs(coredev);
1459  	return ret;
1460  }
1461  
1462  /**
1463   * ib_port_register_client_groups - Add an ib_client's attributes to the port
1464   *
1465   * @ibdev: IB device to add counters
1466   * @port_num: valid port number
1467   * @groups: Group list of attributes
1468   *
1469   * Do not use. Only for legacy sysfs compatibility.
1470   */
ib_port_register_client_groups(struct ib_device * ibdev,u32 port_num,const struct attribute_group ** groups)1471  int ib_port_register_client_groups(struct ib_device *ibdev, u32 port_num,
1472  				   const struct attribute_group **groups)
1473  {
1474  	return sysfs_create_groups(&ibdev->port_data[port_num].sysfs->kobj,
1475  				   groups);
1476  }
1477  EXPORT_SYMBOL(ib_port_register_client_groups);
1478  
ib_port_unregister_client_groups(struct ib_device * ibdev,u32 port_num,const struct attribute_group ** groups)1479  void ib_port_unregister_client_groups(struct ib_device *ibdev, u32 port_num,
1480  				      const struct attribute_group **groups)
1481  {
1482  	return sysfs_remove_groups(&ibdev->port_data[port_num].sysfs->kobj,
1483  				   groups);
1484  }
1485  EXPORT_SYMBOL(ib_port_unregister_client_groups);
1486