1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 
4   Broadcom B43 wireless driver
5 
6   SYSFS support routines
7 
8   Copyright (c) 2006 Michael Buesch <m@bues.ch>
9 
10 
11 */
12 
13 #include <linux/capability.h>
14 #include <linux/io.h>
15 
16 #include "b43.h"
17 #include "sysfs.h"
18 #include "main.h"
19 #include "phy_common.h"
20 
21 #define GENERIC_FILESIZE	64
22 
get_integer(const char * buf,size_t count)23 static int get_integer(const char *buf, size_t count)
24 {
25 	char tmp[10 + 1] = { 0 };
26 	int ret = -EINVAL;
27 
28 	if (count == 0)
29 		goto out;
30 	count = min_t(size_t, count, 10);
31 	memcpy(tmp, buf, count);
32 	ret = simple_strtol(tmp, NULL, 10);
33       out:
34 	return ret;
35 }
36 
b43_attr_interfmode_show(struct device * dev,struct device_attribute * attr,char * buf)37 static ssize_t b43_attr_interfmode_show(struct device *dev,
38 					struct device_attribute *attr,
39 					char *buf)
40 {
41 	struct b43_wldev *wldev = dev_to_b43_wldev(dev);
42 	ssize_t count = 0;
43 
44 	if (!capable(CAP_NET_ADMIN))
45 		return -EPERM;
46 
47 	mutex_lock(&wldev->wl->mutex);
48 
49 	if (wldev->phy.type != B43_PHYTYPE_G) {
50 		mutex_unlock(&wldev->wl->mutex);
51 		return -ENOSYS;
52 	}
53 
54 	switch (wldev->phy.g->interfmode) {
55 	case B43_INTERFMODE_NONE:
56 		count =
57 		    snprintf(buf, PAGE_SIZE,
58 			     "0 (No Interference Mitigation)\n");
59 		break;
60 	case B43_INTERFMODE_NONWLAN:
61 		count =
62 		    snprintf(buf, PAGE_SIZE,
63 			     "1 (Non-WLAN Interference Mitigation)\n");
64 		break;
65 	case B43_INTERFMODE_MANUALWLAN:
66 		count =
67 		    snprintf(buf, PAGE_SIZE,
68 			     "2 (WLAN Interference Mitigation)\n");
69 		break;
70 	default:
71 		B43_WARN_ON(1);
72 	}
73 
74 	mutex_unlock(&wldev->wl->mutex);
75 
76 	return count;
77 }
78 
b43_attr_interfmode_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)79 static ssize_t b43_attr_interfmode_store(struct device *dev,
80 					 struct device_attribute *attr,
81 					 const char *buf, size_t count)
82 {
83 	struct b43_wldev *wldev = dev_to_b43_wldev(dev);
84 	int err;
85 	int mode;
86 
87 	if (!capable(CAP_NET_ADMIN))
88 		return -EPERM;
89 
90 	mode = get_integer(buf, count);
91 	switch (mode) {
92 	case 0:
93 		mode = B43_INTERFMODE_NONE;
94 		break;
95 	case 1:
96 		mode = B43_INTERFMODE_NONWLAN;
97 		break;
98 	case 2:
99 		mode = B43_INTERFMODE_MANUALWLAN;
100 		break;
101 	case 3:
102 		mode = B43_INTERFMODE_AUTOWLAN;
103 		break;
104 	default:
105 		return -EINVAL;
106 	}
107 
108 	mutex_lock(&wldev->wl->mutex);
109 
110 	if (wldev->phy.ops->interf_mitigation) {
111 		err = wldev->phy.ops->interf_mitigation(wldev, mode);
112 		if (err) {
113 			b43err(wldev->wl, "Interference Mitigation not "
114 			       "supported by device\n");
115 		}
116 	} else
117 		err = -ENOSYS;
118 
119 	mutex_unlock(&wldev->wl->mutex);
120 
121 	return err ? err : count;
122 }
123 
124 static DEVICE_ATTR(interference, 0644,
125 		   b43_attr_interfmode_show, b43_attr_interfmode_store);
126 
b43_sysfs_register(struct b43_wldev * wldev)127 int b43_sysfs_register(struct b43_wldev *wldev)
128 {
129 	struct device *dev = wldev->dev->dev;
130 
131 	B43_WARN_ON(b43_status(wldev) != B43_STAT_INITIALIZED);
132 
133 	return device_create_file(dev, &dev_attr_interference);
134 }
135 
b43_sysfs_unregister(struct b43_wldev * wldev)136 void b43_sysfs_unregister(struct b43_wldev *wldev)
137 {
138 	struct device *dev = wldev->dev->dev;
139 
140 	device_remove_file(dev, &dev_attr_interference);
141 }
142