[linux-2.6-block.git] / drivers / platform / x86 / xo1-rfkill.c

// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * Support for rfkill through the OLPC XO-1 laptop embedded controller
 *
 * Copyright (C) 2010 One Laptop per Child
 */

#include <linux/module.h>
#include <linux/platform_device.h>
#include <linux/rfkill.h>
#include <linux/olpc-ec.h>

static bool card_blocked;

static int rfkill_set_block(void *data, bool blocked)
{
	unsigned char cmd;
	int r;

	if (blocked == card_blocked)
		return 0;

	if (blocked)
		cmd = EC_WLAN_ENTER_RESET;
	else
		cmd = EC_WLAN_LEAVE_RESET;

	r = olpc_ec_cmd(cmd, NULL, 0, NULL, 0);
	if (r == 0)
		card_blocked = blocked;

	return r;
}

static const struct rfkill_ops rfkill_ops = {
	.set_block = rfkill_set_block,
};

static int xo1_rfkill_probe(struct platform_device *pdev)
{
	struct rfkill *rfk;
	int r;

	rfk = rfkill_alloc(pdev->name, &pdev->dev, RFKILL_TYPE_WLAN,
			   &rfkill_ops, NULL);
	if (!rfk)
		return -ENOMEM;

	r = rfkill_register(rfk);
	if (r) {
		rfkill_destroy(rfk);
		return r;
	}

	platform_set_drvdata(pdev, rfk);
	return 0;
}

static void xo1_rfkill_remove(struct platform_device *pdev)
{
	struct rfkill *rfk = platform_get_drvdata(pdev);
	rfkill_unregister(rfk);
	rfkill_destroy(rfk);
}

static struct platform_driver xo1_rfkill_driver = {
	.driver = {
		.name = "xo1-rfkill",
	},
	.probe		= xo1_rfkill_probe,
	.remove_new	= xo1_rfkill_remove,
};

module_platform_driver(xo1_rfkill_driver);

MODULE_AUTHOR("Daniel Drake <dsd@laptop.org>");
MODULE_DESCRIPTION("OLPC XO-1 software RF kill switch");
MODULE_LICENSE("GPL");
MODULE_ALIAS("platform:xo1-rfkill");
Commit	Line	Data
2874c5fd	1	// SPDX-License-Identifier: GPL-2.0-or-later
260586d2 DD	2	/*
	3	* Support for rfkill through the OLPC XO-1 laptop embedded controller
	4	*
	5	* Copyright (C) 2010 One Laptop per Child
260586d2 DD	6	*/
	7
	8	#include <linux/module.h>
	9	#include <linux/platform_device.h>
	10	#include <linux/rfkill.h>
3bf9428f	11	#include <linux/olpc-ec.h>
260586d2	12
bc7ab495 DD	13	static bool card_blocked;
bc7ab495 DD	14
260586d2 DD	15	static int rfkill_set_block(void *data, bool blocked)
	16	{
	17	unsigned char cmd;
bc7ab495 DD	18	int r;
	19
	20	if (blocked == card_blocked)
	21	return 0;
	22
260586d2 DD	23	if (blocked)
	24	cmd = EC_WLAN_ENTER_RESET;
	25	else
	26	cmd = EC_WLAN_LEAVE_RESET;
	27
bc7ab495 DD	28	r = olpc_ec_cmd(cmd, NULL, 0, NULL, 0);
	29	if (r == 0)
	30	card_blocked = blocked;
	31
	32	return r;
260586d2 DD	33	}
	34
	35	static const struct rfkill_ops rfkill_ops = {
	36	.set_block = rfkill_set_block,
	37	};
	38
b859f159	39	static int xo1_rfkill_probe(struct platform_device *pdev)
260586d2 DD	40	{
	41	struct rfkill *rfk;
	42	int r;
	43
	44	rfk = rfkill_alloc(pdev->name, &pdev->dev, RFKILL_TYPE_WLAN,
	45	&rfkill_ops, NULL);
	46	if (!rfk)
	47	return -ENOMEM;
	48
	49	r = rfkill_register(rfk);
	50	if (r) {
	51	rfkill_destroy(rfk);
	52	return r;
	53	}
	54
	55	platform_set_drvdata(pdev, rfk);
	56	return 0;
	57	}
	58
9a318b8b	59	static void xo1_rfkill_remove(struct platform_device *pdev)
260586d2 DD	60	{
	61	struct rfkill *rfk = platform_get_drvdata(pdev);
	62	rfkill_unregister(rfk);
	63	rfkill_destroy(rfk);
260586d2 DD	64	}
	65
	66	static struct platform_driver xo1_rfkill_driver = {
	67	.driver = {
	68	.name = "xo1-rfkill",
260586d2 DD	69	},
260586d2 DD	70	.probe = xo1_rfkill_probe,
9a318b8b	71	.remove_new = xo1_rfkill_remove,
260586d2 DD	72	};
260586d2 DD	73
73d99a22	74	module_platform_driver(xo1_rfkill_driver);
260586d2 DD	75
260586d2 DD	76	MODULE_AUTHOR("Daniel Drake <dsd@laptop.org>");
7add1ee3	77	MODULE_DESCRIPTION("OLPC XO-1 software RF kill switch");
260586d2 DD	78	MODULE_LICENSE("GPL");
260586d2 DD	79	MODULE_ALIAS("platform:xo1-rfkill");