162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci
462306a36Sopenharmony_ci  Broadcom B43 wireless driver
562306a36Sopenharmony_ci
662306a36Sopenharmony_ci  SYSFS support routines
762306a36Sopenharmony_ci
862306a36Sopenharmony_ci  Copyright (c) 2006 Michael Buesch <m@bues.ch>
962306a36Sopenharmony_ci
1062306a36Sopenharmony_ci
1162306a36Sopenharmony_ci*/
1262306a36Sopenharmony_ci
1362306a36Sopenharmony_ci#include <linux/capability.h>
1462306a36Sopenharmony_ci#include <linux/io.h>
1562306a36Sopenharmony_ci
1662306a36Sopenharmony_ci#include "b43.h"
1762306a36Sopenharmony_ci#include "sysfs.h"
1862306a36Sopenharmony_ci#include "main.h"
1962306a36Sopenharmony_ci#include "phy_common.h"
2062306a36Sopenharmony_ci
2162306a36Sopenharmony_ci#define GENERIC_FILESIZE	64
2262306a36Sopenharmony_ci
2362306a36Sopenharmony_cistatic int get_integer(const char *buf, size_t count)
2462306a36Sopenharmony_ci{
2562306a36Sopenharmony_ci	char tmp[10 + 1] = { 0 };
2662306a36Sopenharmony_ci	int ret = -EINVAL;
2762306a36Sopenharmony_ci
2862306a36Sopenharmony_ci	if (count == 0)
2962306a36Sopenharmony_ci		goto out;
3062306a36Sopenharmony_ci	count = min_t(size_t, count, 10);
3162306a36Sopenharmony_ci	memcpy(tmp, buf, count);
3262306a36Sopenharmony_ci	ret = simple_strtol(tmp, NULL, 10);
3362306a36Sopenharmony_ci      out:
3462306a36Sopenharmony_ci	return ret;
3562306a36Sopenharmony_ci}
3662306a36Sopenharmony_ci
3762306a36Sopenharmony_cistatic ssize_t b43_attr_interfmode_show(struct device *dev,
3862306a36Sopenharmony_ci					struct device_attribute *attr,
3962306a36Sopenharmony_ci					char *buf)
4062306a36Sopenharmony_ci{
4162306a36Sopenharmony_ci	struct b43_wldev *wldev = dev_to_b43_wldev(dev);
4262306a36Sopenharmony_ci	ssize_t count = 0;
4362306a36Sopenharmony_ci
4462306a36Sopenharmony_ci	if (!capable(CAP_NET_ADMIN))
4562306a36Sopenharmony_ci		return -EPERM;
4662306a36Sopenharmony_ci
4762306a36Sopenharmony_ci	mutex_lock(&wldev->wl->mutex);
4862306a36Sopenharmony_ci
4962306a36Sopenharmony_ci	if (wldev->phy.type != B43_PHYTYPE_G) {
5062306a36Sopenharmony_ci		mutex_unlock(&wldev->wl->mutex);
5162306a36Sopenharmony_ci		return -ENOSYS;
5262306a36Sopenharmony_ci	}
5362306a36Sopenharmony_ci
5462306a36Sopenharmony_ci	switch (wldev->phy.g->interfmode) {
5562306a36Sopenharmony_ci	case B43_INTERFMODE_NONE:
5662306a36Sopenharmony_ci		count =
5762306a36Sopenharmony_ci		    snprintf(buf, PAGE_SIZE,
5862306a36Sopenharmony_ci			     "0 (No Interference Mitigation)\n");
5962306a36Sopenharmony_ci		break;
6062306a36Sopenharmony_ci	case B43_INTERFMODE_NONWLAN:
6162306a36Sopenharmony_ci		count =
6262306a36Sopenharmony_ci		    snprintf(buf, PAGE_SIZE,
6362306a36Sopenharmony_ci			     "1 (Non-WLAN Interference Mitigation)\n");
6462306a36Sopenharmony_ci		break;
6562306a36Sopenharmony_ci	case B43_INTERFMODE_MANUALWLAN:
6662306a36Sopenharmony_ci		count =
6762306a36Sopenharmony_ci		    snprintf(buf, PAGE_SIZE,
6862306a36Sopenharmony_ci			     "2 (WLAN Interference Mitigation)\n");
6962306a36Sopenharmony_ci		break;
7062306a36Sopenharmony_ci	default:
7162306a36Sopenharmony_ci		B43_WARN_ON(1);
7262306a36Sopenharmony_ci	}
7362306a36Sopenharmony_ci
7462306a36Sopenharmony_ci	mutex_unlock(&wldev->wl->mutex);
7562306a36Sopenharmony_ci
7662306a36Sopenharmony_ci	return count;
7762306a36Sopenharmony_ci}
7862306a36Sopenharmony_ci
7962306a36Sopenharmony_cistatic ssize_t b43_attr_interfmode_store(struct device *dev,
8062306a36Sopenharmony_ci					 struct device_attribute *attr,
8162306a36Sopenharmony_ci					 const char *buf, size_t count)
8262306a36Sopenharmony_ci{
8362306a36Sopenharmony_ci	struct b43_wldev *wldev = dev_to_b43_wldev(dev);
8462306a36Sopenharmony_ci	int err;
8562306a36Sopenharmony_ci	int mode;
8662306a36Sopenharmony_ci
8762306a36Sopenharmony_ci	if (!capable(CAP_NET_ADMIN))
8862306a36Sopenharmony_ci		return -EPERM;
8962306a36Sopenharmony_ci
9062306a36Sopenharmony_ci	mode = get_integer(buf, count);
9162306a36Sopenharmony_ci	switch (mode) {
9262306a36Sopenharmony_ci	case 0:
9362306a36Sopenharmony_ci		mode = B43_INTERFMODE_NONE;
9462306a36Sopenharmony_ci		break;
9562306a36Sopenharmony_ci	case 1:
9662306a36Sopenharmony_ci		mode = B43_INTERFMODE_NONWLAN;
9762306a36Sopenharmony_ci		break;
9862306a36Sopenharmony_ci	case 2:
9962306a36Sopenharmony_ci		mode = B43_INTERFMODE_MANUALWLAN;
10062306a36Sopenharmony_ci		break;
10162306a36Sopenharmony_ci	case 3:
10262306a36Sopenharmony_ci		mode = B43_INTERFMODE_AUTOWLAN;
10362306a36Sopenharmony_ci		break;
10462306a36Sopenharmony_ci	default:
10562306a36Sopenharmony_ci		return -EINVAL;
10662306a36Sopenharmony_ci	}
10762306a36Sopenharmony_ci
10862306a36Sopenharmony_ci	mutex_lock(&wldev->wl->mutex);
10962306a36Sopenharmony_ci
11062306a36Sopenharmony_ci	if (wldev->phy.ops->interf_mitigation) {
11162306a36Sopenharmony_ci		err = wldev->phy.ops->interf_mitigation(wldev, mode);
11262306a36Sopenharmony_ci		if (err) {
11362306a36Sopenharmony_ci			b43err(wldev->wl, "Interference Mitigation not "
11462306a36Sopenharmony_ci			       "supported by device\n");
11562306a36Sopenharmony_ci		}
11662306a36Sopenharmony_ci	} else
11762306a36Sopenharmony_ci		err = -ENOSYS;
11862306a36Sopenharmony_ci
11962306a36Sopenharmony_ci	mutex_unlock(&wldev->wl->mutex);
12062306a36Sopenharmony_ci
12162306a36Sopenharmony_ci	return err ? err : count;
12262306a36Sopenharmony_ci}
12362306a36Sopenharmony_ci
12462306a36Sopenharmony_cistatic DEVICE_ATTR(interference, 0644,
12562306a36Sopenharmony_ci		   b43_attr_interfmode_show, b43_attr_interfmode_store);
12662306a36Sopenharmony_ci
12762306a36Sopenharmony_ciint b43_sysfs_register(struct b43_wldev *wldev)
12862306a36Sopenharmony_ci{
12962306a36Sopenharmony_ci	struct device *dev = wldev->dev->dev;
13062306a36Sopenharmony_ci
13162306a36Sopenharmony_ci	B43_WARN_ON(b43_status(wldev) != B43_STAT_INITIALIZED);
13262306a36Sopenharmony_ci
13362306a36Sopenharmony_ci	return device_create_file(dev, &dev_attr_interference);
13462306a36Sopenharmony_ci}
13562306a36Sopenharmony_ci
13662306a36Sopenharmony_civoid b43_sysfs_unregister(struct b43_wldev *wldev)
13762306a36Sopenharmony_ci{
13862306a36Sopenharmony_ci	struct device *dev = wldev->dev->dev;
13962306a36Sopenharmony_ci
14062306a36Sopenharmony_ci	device_remove_file(dev, &dev_attr_interference);
14162306a36Sopenharmony_ci}
142