Linux Audio

Check our new training course

Loading...
v6.2
  1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 * Asus Wireless Radio Control Driver
  4 *
  5 * Copyright (C) 2015-2016 Endless Mobile, Inc.
 
 
 
 
  6 */
  7
  8#include <linux/kernel.h>
  9#include <linux/module.h>
 10#include <linux/init.h>
 11#include <linux/types.h>
 12#include <linux/acpi.h>
 13#include <linux/input.h>
 14#include <linux/pci_ids.h>
 15#include <linux/leds.h>
 16
 17struct hswc_params {
 18	u8 on;
 19	u8 off;
 20	u8 status;
 21};
 22
 23struct asus_wireless_data {
 24	struct input_dev *idev;
 25	struct acpi_device *adev;
 26	const struct hswc_params *hswc_params;
 27	struct workqueue_struct *wq;
 28	struct work_struct led_work;
 29	struct led_classdev led;
 30	int led_state;
 31};
 32
 33static const struct hswc_params atk4001_id_params = {
 34	.on = 0x0,
 35	.off = 0x1,
 36	.status = 0x2,
 37};
 38
 39static const struct hswc_params atk4002_id_params = {
 40	.on = 0x5,
 41	.off = 0x4,
 42	.status = 0x2,
 43};
 44
 45static const struct acpi_device_id device_ids[] = {
 46	{"ATK4001", (kernel_ulong_t)&atk4001_id_params},
 47	{"ATK4002", (kernel_ulong_t)&atk4002_id_params},
 48	{"", 0},
 49};
 50MODULE_DEVICE_TABLE(acpi, device_ids);
 51
 52static acpi_status asus_wireless_method(acpi_handle handle, const char *method,
 53					int param, u64 *ret)
 54{
 55	struct acpi_object_list p;
 56	union acpi_object obj;
 57	acpi_status s;
 
 58
 59	acpi_handle_debug(handle, "Evaluating method %s, parameter %#x\n",
 60			  method, param);
 61	obj.type = ACPI_TYPE_INTEGER;
 62	obj.integer.value = param;
 63	p.count = 1;
 64	p.pointer = &obj;
 65
 66	s = acpi_evaluate_integer(handle, (acpi_string) method, &p, ret);
 67	if (ACPI_FAILURE(s))
 68		acpi_handle_err(handle,
 69				"Failed to eval method %s, param %#x (%d)\n",
 70				method, param, s);
 71	else
 72		acpi_handle_debug(handle, "%s returned %#llx\n", method, *ret);
 73
 74	return s;
 75}
 76
 77static enum led_brightness led_state_get(struct led_classdev *led)
 78{
 79	struct asus_wireless_data *data;
 80	acpi_status s;
 81	u64 ret;
 82
 83	data = container_of(led, struct asus_wireless_data, led);
 84	s = asus_wireless_method(acpi_device_handle(data->adev), "HSWC",
 85				 data->hswc_params->status, &ret);
 86	if (ACPI_SUCCESS(s) && ret == data->hswc_params->on)
 87		return LED_FULL;
 88	return LED_OFF;
 89}
 90
 91static void led_state_update(struct work_struct *work)
 92{
 93	struct asus_wireless_data *data;
 94	u64 ret;
 95
 96	data = container_of(work, struct asus_wireless_data, led_work);
 97	asus_wireless_method(acpi_device_handle(data->adev), "HSWC",
 98			     data->led_state, &ret);
 99}
100
101static void led_state_set(struct led_classdev *led, enum led_brightness value)
102{
103	struct asus_wireless_data *data;
104
105	data = container_of(led, struct asus_wireless_data, led);
106	data->led_state = value == LED_OFF ? data->hswc_params->off :
107					     data->hswc_params->on;
108	queue_work(data->wq, &data->led_work);
109}
110
111static void asus_wireless_notify(struct acpi_device *adev, u32 event)
112{
113	struct asus_wireless_data *data = acpi_driver_data(adev);
114
115	dev_dbg(&adev->dev, "event=%#x\n", event);
116	if (event != 0x88) {
117		dev_notice(&adev->dev, "Unknown ASHS event: %#x\n", event);
118		return;
119	}
120	input_report_key(data->idev, KEY_RFKILL, 1);
121	input_sync(data->idev);
122	input_report_key(data->idev, KEY_RFKILL, 0);
123	input_sync(data->idev);
124}
125
126static int asus_wireless_add(struct acpi_device *adev)
127{
128	struct asus_wireless_data *data;
129	const struct acpi_device_id *id;
130	int err;
131
132	data = devm_kzalloc(&adev->dev, sizeof(*data), GFP_KERNEL);
133	if (!data)
134		return -ENOMEM;
135	adev->driver_data = data;
136	data->adev = adev;
137
138	data->idev = devm_input_allocate_device(&adev->dev);
139	if (!data->idev)
140		return -ENOMEM;
141	data->idev->name = "Asus Wireless Radio Control";
142	data->idev->phys = "asus-wireless/input0";
143	data->idev->id.bustype = BUS_HOST;
144	data->idev->id.vendor = PCI_VENDOR_ID_ASUSTEK;
145	set_bit(EV_KEY, data->idev->evbit);
146	set_bit(KEY_RFKILL, data->idev->keybit);
147	err = input_register_device(data->idev);
148	if (err)
149		return err;
150
151	for (id = device_ids; id->id[0]; id++) {
152		if (!strcmp((char *) id->id, acpi_device_hid(adev))) {
153			data->hswc_params =
154				(const struct hswc_params *)id->driver_data;
155			break;
156		}
157	}
158	if (!data->hswc_params)
159		return 0;
160
161	data->wq = create_singlethread_workqueue("asus_wireless_workqueue");
162	if (!data->wq)
163		return -ENOMEM;
164	INIT_WORK(&data->led_work, led_state_update);
165	data->led.name = "asus-wireless::airplane";
166	data->led.brightness_set = led_state_set;
167	data->led.brightness_get = led_state_get;
168	data->led.flags = LED_CORE_SUSPENDRESUME;
169	data->led.max_brightness = 1;
170	data->led.default_trigger = "rfkill-none";
171	err = devm_led_classdev_register(&adev->dev, &data->led);
172	if (err)
173		destroy_workqueue(data->wq);
174
175	return err;
176}
177
178static void asus_wireless_remove(struct acpi_device *adev)
179{
180	struct asus_wireless_data *data = acpi_driver_data(adev);
181
182	if (data->wq) {
183		devm_led_classdev_unregister(&adev->dev, &data->led);
184		destroy_workqueue(data->wq);
185	}
 
186}
187
188static struct acpi_driver asus_wireless_driver = {
189	.name = "Asus Wireless Radio Control Driver",
190	.class = "hotkey",
191	.ids = device_ids,
192	.ops = {
193		.add = asus_wireless_add,
194		.remove = asus_wireless_remove,
195		.notify = asus_wireless_notify,
196	},
197};
198module_acpi_driver(asus_wireless_driver);
199
200MODULE_DESCRIPTION("Asus Wireless Radio Control Driver");
201MODULE_AUTHOR("João Paulo Rechi Vita <jprvita@gmail.com>");
202MODULE_LICENSE("GPL");
v4.17
 
  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>
 18#include <linux/leds.h>
 19
 20struct hswc_params {
 21	u8 on;
 22	u8 off;
 23	u8 status;
 24};
 25
 26struct asus_wireless_data {
 27	struct input_dev *idev;
 28	struct acpi_device *adev;
 29	const struct hswc_params *hswc_params;
 30	struct workqueue_struct *wq;
 31	struct work_struct led_work;
 32	struct led_classdev led;
 33	int led_state;
 34};
 35
 36static const struct hswc_params atk4001_id_params = {
 37	.on = 0x0,
 38	.off = 0x1,
 39	.status = 0x2,
 40};
 41
 42static const struct hswc_params atk4002_id_params = {
 43	.on = 0x5,
 44	.off = 0x4,
 45	.status = 0x2,
 46};
 47
 48static const struct acpi_device_id device_ids[] = {
 49	{"ATK4001", (kernel_ulong_t)&atk4001_id_params},
 50	{"ATK4002", (kernel_ulong_t)&atk4002_id_params},
 51	{"", 0},
 52};
 53MODULE_DEVICE_TABLE(acpi, device_ids);
 54
 55static u64 asus_wireless_method(acpi_handle handle, const char *method,
 56				int param)
 57{
 58	struct acpi_object_list p;
 59	union acpi_object obj;
 60	acpi_status s;
 61	u64 ret;
 62
 63	acpi_handle_debug(handle, "Evaluating method %s, parameter %#x\n",
 64			  method, param);
 65	obj.type = ACPI_TYPE_INTEGER;
 66	obj.integer.value = param;
 67	p.count = 1;
 68	p.pointer = &obj;
 69
 70	s = acpi_evaluate_integer(handle, (acpi_string) method, &p, &ret);
 71	if (ACPI_FAILURE(s))
 72		acpi_handle_err(handle,
 73				"Failed to eval method %s, param %#x (%d)\n",
 74				method, param, s);
 75	acpi_handle_debug(handle, "%s returned %#x\n", method, (uint) ret);
 76	return ret;
 
 
 77}
 78
 79static enum led_brightness led_state_get(struct led_classdev *led)
 80{
 81	struct asus_wireless_data *data;
 82	int s;
 
 83
 84	data = container_of(led, struct asus_wireless_data, led);
 85	s = asus_wireless_method(acpi_device_handle(data->adev), "HSWC",
 86				 data->hswc_params->status);
 87	if (s == data->hswc_params->on)
 88		return LED_FULL;
 89	return LED_OFF;
 90}
 91
 92static void led_state_update(struct work_struct *work)
 93{
 94	struct asus_wireless_data *data;
 
 95
 96	data = container_of(work, struct asus_wireless_data, led_work);
 97	asus_wireless_method(acpi_device_handle(data->adev), "HSWC",
 98			     data->led_state);
 99}
100
101static void led_state_set(struct led_classdev *led, enum led_brightness value)
102{
103	struct asus_wireless_data *data;
104
105	data = container_of(led, struct asus_wireless_data, led);
106	data->led_state = value == LED_OFF ? data->hswc_params->off :
107					     data->hswc_params->on;
108	queue_work(data->wq, &data->led_work);
109}
110
111static void asus_wireless_notify(struct acpi_device *adev, u32 event)
112{
113	struct asus_wireless_data *data = acpi_driver_data(adev);
114
115	dev_dbg(&adev->dev, "event=%#x\n", event);
116	if (event != 0x88) {
117		dev_notice(&adev->dev, "Unknown ASHS event: %#x\n", event);
118		return;
119	}
120	input_report_key(data->idev, KEY_RFKILL, 1);
121	input_sync(data->idev);
122	input_report_key(data->idev, KEY_RFKILL, 0);
123	input_sync(data->idev);
124}
125
126static int asus_wireless_add(struct acpi_device *adev)
127{
128	struct asus_wireless_data *data;
129	const struct acpi_device_id *id;
130	int err;
131
132	data = devm_kzalloc(&adev->dev, sizeof(*data), GFP_KERNEL);
133	if (!data)
134		return -ENOMEM;
135	adev->driver_data = data;
136	data->adev = adev;
137
138	data->idev = devm_input_allocate_device(&adev->dev);
139	if (!data->idev)
140		return -ENOMEM;
141	data->idev->name = "Asus Wireless Radio Control";
142	data->idev->phys = "asus-wireless/input0";
143	data->idev->id.bustype = BUS_HOST;
144	data->idev->id.vendor = PCI_VENDOR_ID_ASUSTEK;
145	set_bit(EV_KEY, data->idev->evbit);
146	set_bit(KEY_RFKILL, data->idev->keybit);
147	err = input_register_device(data->idev);
148	if (err)
149		return err;
150
151	for (id = device_ids; id->id[0]; id++) {
152		if (!strcmp((char *) id->id, acpi_device_hid(adev))) {
153			data->hswc_params =
154				(const struct hswc_params *)id->driver_data;
155			break;
156		}
157	}
158	if (!data->hswc_params)
159		return 0;
160
161	data->wq = create_singlethread_workqueue("asus_wireless_workqueue");
162	if (!data->wq)
163		return -ENOMEM;
164	INIT_WORK(&data->led_work, led_state_update);
165	data->led.name = "asus-wireless::airplane";
166	data->led.brightness_set = led_state_set;
167	data->led.brightness_get = led_state_get;
168	data->led.flags = LED_CORE_SUSPENDRESUME;
169	data->led.max_brightness = 1;
 
170	err = devm_led_classdev_register(&adev->dev, &data->led);
171	if (err)
172		destroy_workqueue(data->wq);
173
174	return err;
175}
176
177static int asus_wireless_remove(struct acpi_device *adev)
178{
179	struct asus_wireless_data *data = acpi_driver_data(adev);
180
181	if (data->wq) {
182		devm_led_classdev_unregister(&adev->dev, &data->led);
183		destroy_workqueue(data->wq);
184	}
185	return 0;
186}
187
188static struct acpi_driver asus_wireless_driver = {
189	.name = "Asus Wireless Radio Control Driver",
190	.class = "hotkey",
191	.ids = device_ids,
192	.ops = {
193		.add = asus_wireless_add,
194		.remove = asus_wireless_remove,
195		.notify = asus_wireless_notify,
196	},
197};
198module_acpi_driver(asus_wireless_driver);
199
200MODULE_DESCRIPTION("Asus Wireless Radio Control Driver");
201MODULE_AUTHOR("João Paulo Rechi Vita <jprvita@gmail.com>");
202MODULE_LICENSE("GPL");