[deliverable/linux.git] / drivers / platform / x86 / asus-wireless.c

/*
 * Asus Wireless Radio Control Driver
 *
 * Copyright (C) 2015-2016 Endless Mobile, Inc.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/types.h>
#include <linux/acpi.h>
#include <linux/input.h>
#include <linux/pci_ids.h>
#include <linux/leds.h>

#define ASUS_WIRELESS_LED_STATUS 0x2
#define ASUS_WIRELESS_LED_OFF 0x4
#define ASUS_WIRELESS_LED_ON 0x5

struct asus_wireless_data {
	struct input_dev *idev;
	struct acpi_device *adev;
	struct workqueue_struct *wq;
	struct work_struct led_work;
	struct led_classdev led;
	int led_state;
};

static u64 asus_wireless_method(acpi_handle handle, const char *method,
				int param)
{
	struct acpi_object_list p;
	union acpi_object obj;
	acpi_status s;
	u64 ret;

	acpi_handle_debug(handle, "Evaluating method %s, parameter %#x\n",
			  method, param);
	obj.type = ACPI_TYPE_INTEGER;
	obj.integer.value = param;
	p.count = 1;
	p.pointer = &obj;

	s = acpi_evaluate_integer(handle, (acpi_string) method, &p, &ret);
	if (ACPI_FAILURE(s))
		acpi_handle_err(handle,
				"Failed to eval method %s, param %#x (%d)\n",
				method, param, s);
	acpi_handle_debug(handle, "%s returned %#x\n", method, (uint) ret);
	return ret;
}

static enum led_brightness led_state_get(struct led_classdev *led)
{
	struct asus_wireless_data *data;
	int s;

	data = container_of(led, struct asus_wireless_data, led);
	s = asus_wireless_method(acpi_device_handle(data->adev), "HSWC",
				 ASUS_WIRELESS_LED_STATUS);
	if (s == ASUS_WIRELESS_LED_ON)
		return LED_FULL;
	return LED_OFF;
}

static void led_state_update(struct work_struct *work)
{
	struct asus_wireless_data *data;

	data = container_of(work, struct asus_wireless_data, led_work);
	asus_wireless_method(acpi_device_handle(data->adev), "HSWC",
			     data->led_state);
}

static void led_state_set(struct led_classdev *led,
				  enum led_brightness value)
{
	struct asus_wireless_data *data;

	data = container_of(led, struct asus_wireless_data, led);
	data->led_state = value == LED_OFF ? ASUS_WIRELESS_LED_OFF :
					     ASUS_WIRELESS_LED_ON;
	queue_work(data->wq, &data->led_work);
}

static void asus_wireless_notify(struct acpi_device *adev, u32 event)
{
	struct asus_wireless_data *data = acpi_driver_data(adev);

	dev_dbg(&adev->dev, "event=%#x\n", event);
	if (event != 0x88) {
		dev_notice(&adev->dev, "Unknown ASHS event: %#x\n", event);
		return;
	}
	input_report_key(data->idev, KEY_RFKILL, 1);
	input_report_key(data->idev, KEY_RFKILL, 0);
	input_sync(data->idev);
}

static int asus_wireless_add(struct acpi_device *adev)
{
	struct asus_wireless_data *data;
	int err;

	data = devm_kzalloc(&adev->dev, sizeof(*data), GFP_KERNEL);
	if (!data)
		return -ENOMEM;
	adev->driver_data = data;

	data->idev = devm_input_allocate_device(&adev->dev);
	if (!data->idev)
		return -ENOMEM;
	data->idev->name = "Asus Wireless Radio Control";
	data->idev->phys = "asus-wireless/input0";
	data->idev->id.bustype = BUS_HOST;
	data->idev->id.vendor = PCI_VENDOR_ID_ASUSTEK;
	set_bit(EV_KEY, data->idev->evbit);
	set_bit(KEY_RFKILL, data->idev->keybit);
	err = input_register_device(data->idev);
	if (err)
		return err;

	data->adev = adev;
	data->wq = create_singlethread_workqueue("asus_wireless_workqueue");
	if (!data->wq)
		return -ENOMEM;
	INIT_WORK(&data->led_work, led_state_update);
	data->led.name = "asus-wireless::airplane";
	data->led.brightness_set = led_state_set;
	data->led.brightness_get = led_state_get;
	data->led.flags = LED_CORE_SUSPENDRESUME;
	data->led.max_brightness = 1;
	err = devm_led_classdev_register(&adev->dev, &data->led);
	if (err)
		destroy_workqueue(data->wq);
	return err;
}

static int asus_wireless_remove(struct acpi_device *adev)
{
	struct asus_wireless_data *data = acpi_driver_data(adev);

	if (data->wq)
		destroy_workqueue(data->wq);
	return 0;
}

static const struct acpi_device_id device_ids[] = {
	{"ATK4001", 0},
	{"ATK4002", 0},
	{"", 0},
};
MODULE_DEVICE_TABLE(acpi, device_ids);

static struct acpi_driver asus_wireless_driver = {
	.name = "Asus Wireless Radio Control Driver",
	.class = "hotkey",
	.ids = device_ids,
	.ops = {
		.add = asus_wireless_add,
		.remove = asus_wireless_remove,
		.notify = asus_wireless_notify,
	},
};
module_acpi_driver(asus_wireless_driver);

MODULE_DESCRIPTION("Asus Wireless Radio Control Driver");
MODULE_AUTHOR("João Paulo Rechi Vita <jprvita@gmail.com>");
MODULE_LICENSE("GPL");
Commit	Line	Data
f6a6bbae JPRV	1	/*
	2	* Asus Wireless Radio Control Driver
	3	*
	4	* Copyright (C) 2015-2016 Endless Mobile, Inc.
	5	*
	6	* This program is free software; you can redistribute it and/or modify
	7	* it under the terms of the GNU General Public License version 2 as
	8	* published by the Free Software Foundation.
	9	*/
	10
	11	#include <linux/kernel.h>
	12	#include <linux/module.h>
	13	#include <linux/init.h>
	14	#include <linux/types.h>
	15	#include <linux/acpi.h>
	16	#include <linux/input.h>
	17	#include <linux/pci_ids.h>
2c1a49c9 JPRV	18	#include <linux/leds.h>
	19
	20	#define ASUS_WIRELESS_LED_STATUS 0x2
	21	#define ASUS_WIRELESS_LED_OFF 0x4
	22	#define ASUS_WIRELESS_LED_ON 0x5
f6a6bbae JPRV	23
	24	struct asus_wireless_data {
	25	struct input_dev *idev;
2c1a49c9 JPRV	26	struct acpi_device *adev;
	27	struct workqueue_struct *wq;
	28	struct work_struct led_work;
	29	struct led_classdev led;
	30	int led_state;
f6a6bbae JPRV	31	};
f6a6bbae JPRV	32
2c1a49c9 JPRV	33	static u64 asus_wireless_method(acpi_handle handle, const char *method,
	34	int param)
	35	{
	36	struct acpi_object_list p;
	37	union acpi_object obj;
	38	acpi_status s;
	39	u64 ret;
	40
	41	acpi_handle_debug(handle, "Evaluating method %s, parameter %#x\n",
	42	method, param);
	43	obj.type = ACPI_TYPE_INTEGER;
	44	obj.integer.value = param;
	45	p.count = 1;
	46	p.pointer = &obj;
	47
	48	s = acpi_evaluate_integer(handle, (acpi_string) method, &p, &ret);
	49	if (ACPI_FAILURE(s))
	50	acpi_handle_err(handle,
	51	"Failed to eval method %s, param %#x (%d)\n",
	52	method, param, s);
	53	acpi_handle_debug(handle, "%s returned %#x\n", method, (uint) ret);
	54	return ret;
	55	}
	56
	57	static enum led_brightness led_state_get(struct led_classdev *led)
	58	{
	59	struct asus_wireless_data *data;
	60	int s;
	61
	62	data = container_of(led, struct asus_wireless_data, led);
	63	s = asus_wireless_method(acpi_device_handle(data->adev), "HSWC",
	64	ASUS_WIRELESS_LED_STATUS);
	65	if (s == ASUS_WIRELESS_LED_ON)
	66	return LED_FULL;
	67	return LED_OFF;
	68	}
	69
	70	static void led_state_update(struct work_struct *work)
	71	{
	72	struct asus_wireless_data *data;
	73
	74	data = container_of(work, struct asus_wireless_data, led_work);
	75	asus_wireless_method(acpi_device_handle(data->adev), "HSWC",
	76	data->led_state);
	77	}
	78
	79	static void led_state_set(struct led_classdev *led,
	80	enum led_brightness value)
	81	{
	82	struct asus_wireless_data *data;
	83
	84	data = container_of(led, struct asus_wireless_data, led);
	85	data->led_state = value == LED_OFF ? ASUS_WIRELESS_LED_OFF :
	86	ASUS_WIRELESS_LED_ON;
	87	queue_work(data->wq, &data->led_work);
	88	}
	89
f6a6bbae JPRV	90	static void asus_wireless_notify(struct acpi_device *adev, u32 event)
	91	{
	92	struct asus_wireless_data *data = acpi_driver_data(adev);
	93
	94	dev_dbg(&adev->dev, "event=%#x\n", event);
	95	if (event != 0x88) {
	96	dev_notice(&adev->dev, "Unknown ASHS event: %#x\n", event);
	97	return;
	98	}
	99	input_report_key(data->idev, KEY_RFKILL, 1);
	100	input_report_key(data->idev, KEY_RFKILL, 0);
	101	input_sync(data->idev);
	102	}
	103
	104	static int asus_wireless_add(struct acpi_device *adev)
	105	{
	106	struct asus_wireless_data *data;
2c1a49c9	107	int err;
f6a6bbae JPRV	108
	109	data = devm_kzalloc(&adev->dev, sizeof(*data), GFP_KERNEL);
	110	if (!data)
	111	return -ENOMEM;
	112	adev->driver_data = data;
	113
	114	data->idev = devm_input_allocate_device(&adev->dev);
	115	if (!data->idev)
	116	return -ENOMEM;
	117	data->idev->name = "Asus Wireless Radio Control";
	118	data->idev->phys = "asus-wireless/input0";
	119	data->idev->id.bustype = BUS_HOST;
	120	data->idev->id.vendor = PCI_VENDOR_ID_ASUSTEK;
	121	set_bit(EV_KEY, data->idev->evbit);
	122	set_bit(KEY_RFKILL, data->idev->keybit);
2c1a49c9 JPRV	123	err = input_register_device(data->idev);
	124	if (err)
	125	return err;
	126
	127	data->adev = adev;
	128	data->wq = create_singlethread_workqueue("asus_wireless_workqueue");
	129	if (!data->wq)
	130	return -ENOMEM;
	131	INIT_WORK(&data->led_work, led_state_update);
	132	data->led.name = "asus-wireless::airplane";
	133	data->led.brightness_set = led_state_set;
	134	data->led.brightness_get = led_state_get;
	135	data->led.flags = LED_CORE_SUSPENDRESUME;
	136	data->led.max_brightness = 1;
	137	err = devm_led_classdev_register(&adev->dev, &data->led);
	138	if (err)
	139	destroy_workqueue(data->wq);
	140	return err;
f6a6bbae JPRV	141	}
	142
	143	static int asus_wireless_remove(struct acpi_device *adev)
	144	{
2c1a49c9 JPRV	145	struct asus_wireless_data *data = acpi_driver_data(adev);
	146
	147	if (data->wq)
	148	destroy_workqueue(data->wq);
f6a6bbae JPRV	149	return 0;
	150	}
	151
	152	static const struct acpi_device_id device_ids[] = {
b0a095fc	153	{"ATK4001", 0},
f6a6bbae JPRV	154	{"ATK4002", 0},
	155	{"", 0},
	156	};
	157	MODULE_DEVICE_TABLE(acpi, device_ids);
	158
	159	static struct acpi_driver asus_wireless_driver = {
	160	.name = "Asus Wireless Radio Control Driver",
	161	.class = "hotkey",
	162	.ids = device_ids,
	163	.ops = {
	164	.add = asus_wireless_add,
	165	.remove = asus_wireless_remove,
	166	.notify = asus_wireless_notify,
	167	},
	168	};
	169	module_acpi_driver(asus_wireless_driver);
	170
	171	MODULE_DESCRIPTION("Asus Wireless Radio Control Driver");
	172	MODULE_AUTHOR("João Paulo Rechi Vita <jprvita@gmail.com>");
	173	MODULE_LICENSE("GPL");