[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / net / wireless / b43legacy / sysfs.c

/*

  Broadcom B43legacy wireless driver

  SYSFS support routines

  Copyright (c) 2006 Michael Buesch <m@bues.ch>

  This program is free software; you can redistribute it and/or modify
  it under the terms of the GNU General Public License as published by
  the Free Software Foundation; either version 2 of the License, or
  (at your option) any later version.

  This program is distributed in the hope that it will be useful,
  but WITHOUT ANY WARRANTY; without even the implied warranty of
  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  GNU General Public License for more details.

  You should have received a copy of the GNU General Public License
  along with this program; see the file COPYING.  If not, write to
  the Free Software Foundation, Inc., 51 Franklin Steet, Fifth Floor,
  Boston, MA 02110-1301, USA.

*/

#include "sysfs.h"
#include "b43legacy.h"
#include "main.h"
#include "phy.h"
#include "radio.h"

#include <linux/capability.h>


#define GENERIC_FILESIZE	64


static int get_integer(const char *buf, size_t count)
{
	char tmp[10 + 1] = { 0 };
	int ret = -EINVAL;

	if (count == 0)
		goto out;
	count = min(count, (size_t)10);
	memcpy(tmp, buf, count);
	ret = simple_strtol(tmp, NULL, 10);
out:
	return ret;
}

static int get_boolean(const char *buf, size_t count)
{
	if (count != 0) {
		if (buf[0] == '1')
			return 1;
		if (buf[0] == '0')
			return 0;
		if (count >= 4 && memcmp(buf, "true", 4) == 0)
			return 1;
		if (count >= 5 && memcmp(buf, "false", 5) == 0)
			return 0;
		if (count >= 3 && memcmp(buf, "yes", 3) == 0)
			return 1;
		if (count >= 2 && memcmp(buf, "no", 2) == 0)
			return 0;
		if (count >= 2 && memcmp(buf, "on", 2) == 0)
			return 1;
		if (count >= 3 && memcmp(buf, "off", 3) == 0)
			return 0;
	}
	return -EINVAL;
}

static ssize_t b43legacy_attr_interfmode_show(struct device *dev,
					      struct device_attribute *attr,
					      char *buf)
{
	struct b43legacy_wldev *wldev = dev_to_b43legacy_wldev(dev);
	ssize_t count = 0;

	if (!capable(CAP_NET_ADMIN))
		return -EPERM;

	mutex_lock(&wldev->wl->mutex);

	switch (wldev->phy.interfmode) {
	case B43legacy_INTERFMODE_NONE:
		count = snprintf(buf, PAGE_SIZE, "0 (No Interference"
				 " Mitigation)\n");
		break;
	case B43legacy_INTERFMODE_NONWLAN:
		count = snprintf(buf, PAGE_SIZE, "1 (Non-WLAN Interference"
				 " Mitigation)\n");
		break;
	case B43legacy_INTERFMODE_MANUALWLAN:
		count = snprintf(buf, PAGE_SIZE, "2 (WLAN Interference"
				 " Mitigation)\n");
		break;
	default:
		B43legacy_WARN_ON(1);
	}

	mutex_unlock(&wldev->wl->mutex);

	return count;
}

static ssize_t b43legacy_attr_interfmode_store(struct device *dev,
					       struct device_attribute *attr,
					       const char *buf, size_t count)
{
	struct b43legacy_wldev *wldev = dev_to_b43legacy_wldev(dev);
	unsigned long flags;
	int err;
	int mode;

	if (!capable(CAP_NET_ADMIN))
		return -EPERM;

	mode = get_integer(buf, count);
	switch (mode) {
	case 0:
		mode = B43legacy_INTERFMODE_NONE;
		break;
	case 1:
		mode = B43legacy_INTERFMODE_NONWLAN;
		break;
	case 2:
		mode = B43legacy_INTERFMODE_MANUALWLAN;
		break;
	case 3:
		mode = B43legacy_INTERFMODE_AUTOWLAN;
		break;
	default:
		return -EINVAL;
	}

	mutex_lock(&wldev->wl->mutex);
	spin_lock_irqsave(&wldev->wl->irq_lock, flags);

	err = b43legacy_radio_set_interference_mitigation(wldev, mode);
	if (err)
		b43legacyerr(wldev->wl, "Interference Mitigation not "
		       "supported by device\n");
	mmiowb();
	spin_unlock_irqrestore(&wldev->wl->irq_lock, flags);
	mutex_unlock(&wldev->wl->mutex);

	return err ? err : count;
}

static DEVICE_ATTR(interference, 0644,
		   b43legacy_attr_interfmode_show,
		   b43legacy_attr_interfmode_store);

static ssize_t b43legacy_attr_preamble_show(struct device *dev,
					    struct device_attribute *attr,
					    char *buf)
{
	struct b43legacy_wldev *wldev = dev_to_b43legacy_wldev(dev);
	ssize_t count;

	if (!capable(CAP_NET_ADMIN))
		return -EPERM;

	mutex_lock(&wldev->wl->mutex);

	if (wldev->short_preamble)
		count = snprintf(buf, PAGE_SIZE, "1 (Short Preamble"
				 " enabled)\n");
	else
		count = snprintf(buf, PAGE_SIZE, "0 (Short Preamble"
				 " disabled)\n");

	mutex_unlock(&wldev->wl->mutex);

	return count;
}

static ssize_t b43legacy_attr_preamble_store(struct device *dev,
					     struct device_attribute *attr,
					     const char *buf, size_t count)
{
	struct b43legacy_wldev *wldev = dev_to_b43legacy_wldev(dev);
	unsigned long flags;
	int value;

	if (!capable(CAP_NET_ADMIN))
		return -EPERM;

	value = get_boolean(buf, count);
	if (value < 0)
		return value;
	mutex_lock(&wldev->wl->mutex);
	spin_lock_irqsave(&wldev->wl->irq_lock, flags);

	wldev->short_preamble = !!value;

	spin_unlock_irqrestore(&wldev->wl->irq_lock, flags);
	mutex_unlock(&wldev->wl->mutex);

	return count;
}

static DEVICE_ATTR(shortpreamble, 0644,
		   b43legacy_attr_preamble_show,
		   b43legacy_attr_preamble_store);

int b43legacy_sysfs_register(struct b43legacy_wldev *wldev)
{
	struct device *dev = wldev->dev->dev;
	int err;

	B43legacy_WARN_ON(b43legacy_status(wldev) !=
			  B43legacy_STAT_INITIALIZED);

	err = device_create_file(dev, &dev_attr_interference);
	if (err)
		goto out;
	err = device_create_file(dev, &dev_attr_shortpreamble);
	if (err)
		goto err_remove_interfmode;

out:
	return err;
err_remove_interfmode:
	device_remove_file(dev, &dev_attr_interference);
	goto out;
}

void b43legacy_sysfs_unregister(struct b43legacy_wldev *wldev)
{
	struct device *dev = wldev->dev->dev;

	device_remove_file(dev, &dev_attr_shortpreamble);
	device_remove_file(dev, &dev_attr_interference);
}
Commit	Line	Data
75388acd LF	1	/*
	2
	3	Broadcom B43legacy wireless driver
	4
	5	SYSFS support routines
	6
eb032b98	7	Copyright (c) 2006 Michael Buesch <m@bues.ch>
75388acd LF	8
	9	This program is free software; you can redistribute it and/or modify
	10	it under the terms of the GNU General Public License as published by
	11	the Free Software Foundation; either version 2 of the License, or
	12	(at your option) any later version.
	13
	14	This program is distributed in the hope that it will be useful,
	15	but WITHOUT ANY WARRANTY; without even the implied warranty of
	16	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	17	GNU General Public License for more details.
	18
	19	You should have received a copy of the GNU General Public License
	20	along with this program; see the file COPYING. If not, write to
	21	the Free Software Foundation, Inc., 51 Franklin Steet, Fifth Floor,
	22	Boston, MA 02110-1301, USA.
	23
	24	*/
	25
	26	#include "sysfs.h"
	27	#include "b43legacy.h"
	28	#include "main.h"
	29	#include "phy.h"
	30	#include "radio.h"
	31
	32	#include <linux/capability.h>
	33
	34
	35	#define GENERIC_FILESIZE 64
	36
	37
	38	static int get_integer(const char *buf, size_t count)
	39	{
	40	char tmp[10 + 1] = { 0 };
	41	int ret = -EINVAL;
	42
	43	if (count == 0)
	44	goto out;
	45	count = min(count, (size_t)10);
	46	memcpy(tmp, buf, count);
	47	ret = simple_strtol(tmp, NULL, 10);
	48	out:
	49	return ret;
	50	}
	51
	52	static int get_boolean(const char *buf, size_t count)
	53	{
	54	if (count != 0) {
	55	if (buf[0] == '1')
	56	return 1;
	57	if (buf[0] == '0')
	58	return 0;
	59	if (count >= 4 && memcmp(buf, "true", 4) == 0)
	60	return 1;
	61	if (count >= 5 && memcmp(buf, "false", 5) == 0)
	62	return 0;
	63	if (count >= 3 && memcmp(buf, "yes", 3) == 0)
	64	return 1;
	65	if (count >= 2 && memcmp(buf, "no", 2) == 0)
	66	return 0;
	67	if (count >= 2 && memcmp(buf, "on", 2) == 0)
	68	return 1;
	69	if (count >= 3 && memcmp(buf, "off", 3) == 0)
	70	return 0;
	71	}
72	return -EINVAL;
73	}
74
75	static ssize_t b43legacy_attr_interfmode_show(struct device *dev,
76	struct device_attribute *attr,
77	char *buf)
78	{
79	struct b43legacy_wldev *wldev = dev_to_b43legacy_wldev(dev);
80	ssize_t count = 0;
81
82	if (!capable(CAP_NET_ADMIN))
83	return -EPERM;
84
85	mutex_lock(&wldev->wl->mutex);
86
87	switch (wldev->phy.interfmode) {
88	case B43legacy_INTERFMODE_NONE:
89	count = snprintf(buf, PAGE_SIZE, "0 (No Interference"
90	" Mitigation)\n");
91	break;
92	case B43legacy_INTERFMODE_NONWLAN:
93	count = snprintf(buf, PAGE_SIZE, "1 (Non-WLAN Interference"
94	" Mitigation)\n");
95	break;
96	case B43legacy_INTERFMODE_MANUALWLAN:
97	count = snprintf(buf, PAGE_SIZE, "2 (WLAN Interference"
98	" Mitigation)\n");
99	break;
100	default:
101	B43legacy_WARN_ON(1);
102	}
103
104	mutex_unlock(&wldev->wl->mutex);
105
106	return count;
107	}
108
109	static ssize_t b43legacy_attr_interfmode_store(struct device *dev,
110	struct device_attribute *attr,
111	const char *buf, size_t count)
112	{
113	struct b43legacy_wldev *wldev = dev_to_b43legacy_wldev(dev);
114	unsigned long flags;
115	int err;
116	int mode;
117
118	if (!capable(CAP_NET_ADMIN))
119	return -EPERM;
120
121	mode = get_integer(buf, count);
122	switch (mode) {
123	case 0:
124	mode = B43legacy_INTERFMODE_NONE;
125	break;
126	case 1:
127	mode = B43legacy_INTERFMODE_NONWLAN;
128	break;
129	case 2:
130	mode = B43legacy_INTERFMODE_MANUALWLAN;
131	break;
132	case 3:
133	mode = B43legacy_INTERFMODE_AUTOWLAN;
134	break;
135	default:
136	return -EINVAL;
137	}
138
139	mutex_lock(&wldev->wl->mutex);
140	spin_lock_irqsave(&wldev->wl->irq_lock, flags);
141
142	err = b43legacy_radio_set_interference_mitigation(wldev, mode);
143	if (err)
144	b43legacyerr(wldev->wl, "Interference Mitigation not "
145	"supported by device\n");
146	mmiowb();
147	spin_unlock_irqrestore(&wldev->wl->irq_lock, flags);
148	mutex_unlock(&wldev->wl->mutex);
149
150	return err ? err : count;
151	}
152
153	static DEVICE_ATTR(interference, 0644,
154	b43legacy_attr_interfmode_show,
155	b43legacy_attr_interfmode_store);
156
157	static ssize_t b43legacy_attr_preamble_show(struct device *dev,
158	struct device_attribute *attr,
159	char *buf)
160	{
161	struct b43legacy_wldev *wldev = dev_to_b43legacy_wldev(dev);
162	ssize_t count;
163
164	if (!capable(CAP_NET_ADMIN))
165	return -EPERM;
166
167	mutex_lock(&wldev->wl->mutex);
168
169	if (wldev->short_preamble)
170	count = snprintf(buf, PAGE_SIZE, "1 (Short Preamble"
171	" enabled)\n");
172	else
173	count = snprintf(buf, PAGE_SIZE, "0 (Short Preamble"
174	" disabled)\n");
175
176	mutex_unlock(&wldev->wl->mutex);
177
178	return count;
179	}
180
181	static ssize_t b43legacy_attr_preamble_store(struct device *dev,
182	struct device_attribute *attr,
183	const char *buf, size_t count)
184	{
185	struct b43legacy_wldev *wldev = dev_to_b43legacy_wldev(dev);
186	unsigned long flags;
187	int value;
188
189	if (!capable(CAP_NET_ADMIN))
190	return -EPERM;
191
192	value = get_boolean(buf, count);
193	if (value < 0)
194	return value;
195	mutex_lock(&wldev->wl->mutex);
196	spin_lock_irqsave(&wldev->wl->irq_lock, flags);
197
198	wldev->short_preamble = !!value;
199
200	spin_unlock_irqrestore(&wldev->wl->irq_lock, flags);
201	mutex_unlock(&wldev->wl->mutex);
202
203	return count;
204	}
205
206	static DEVICE_ATTR(shortpreamble, 0644,
207	b43legacy_attr_preamble_show,
208	b43legacy_attr_preamble_store);
209
210	int b43legacy_sysfs_register(struct b43legacy_wldev *wldev)
211	{
212	struct device *dev = wldev->dev->dev;
213	int err;
214
215	B43legacy_WARN_ON(b43legacy_status(wldev) !=
216	B43legacy_STAT_INITIALIZED);
217
218	err = device_create_file(dev, &dev_attr_interference);
219	if (err)
220	goto out;
221	err = device_create_file(dev, &dev_attr_shortpreamble);
222	if (err)
223	goto err_remove_interfmode;
224
225	out:
226	return err;
227	err_remove_interfmode:
228	device_remove_file(dev, &dev_attr_interference);
229	goto out;
230	}
231
232	void b43legacy_sysfs_unregister(struct b43legacy_wldev *wldev)
233	{
234	struct device *dev = wldev->dev->dev;
235
236	device_remove_file(dev, &dev_attr_shortpreamble);
237	device_remove_file(dev, &dev_attr_interference);
238	}