platform/x86/asus-wireless.c

0001 // SPDX-License-Identifier: GPL-2.0-only
0002 /*
0003  * Asus Wireless Radio Control Driver
0004  *
0005  * Copyright (C) 2015-2016 Endless Mobile, Inc.
0006  */
0007
0008 #include <linux/kernel.h>
0009 #include <linux/module.h>
0010 #include <linux/init.h>
0011 #include <linux/types.h>
0012 #include <linux/acpi.h>
0013 #include <linux/input.h>
0014 #include <linux/pci_ids.h>
0015 #include <linux/leds.h>
0016
0017 struct hswc_params {
0018     u8 on;
0019     u8 off;
0020     u8 status;
0021 };
0022
0023 struct asus_wireless_data {
0024     struct input_dev *idev;
0025     struct acpi_device *adev;
0026     const struct hswc_params *hswc_params;
0027     struct workqueue_struct *wq;
0028     struct work_struct led_work;
0029     struct led_classdev led;
0030     int led_state;
0031 };
0032
0033 static const struct hswc_params atk4001_id_params = {
0034     .on = 0x0,
0035     .off = 0x1,
0036     .status = 0x2,
0037 };
0038
0039 static const struct hswc_params atk4002_id_params = {
0040     .on = 0x5,
0041     .off = 0x4,
0042     .status = 0x2,
0043 };
0044
0045 static const struct acpi_device_id device_ids[] = {
0046     {"ATK4001", (kernel_ulong_t)&atk4001_id_params},
0047     {"ATK4002", (kernel_ulong_t)&atk4002_id_params},
0048     {"", 0},
0049 };
0050 MODULE_DEVICE_TABLE(acpi, device_ids);
0051
0052 static acpi_status asus_wireless_method(acpi_handle handle, const char *method,
0053                     int param, u64 *ret)
0054 {
0055     struct acpi_object_list p;
0056     union acpi_object obj;
0057     acpi_status s;
0058
0059     acpi_handle_debug(handle, "Evaluating method %s, parameter %#x\n",
0060               method, param);
0061     obj.type = ACPI_TYPE_INTEGER;
0062     obj.integer.value = param;
0063     p.count = 1;
0064     p.pointer = &obj;
0065
0066     s = acpi_evaluate_integer(handle, (acpi_string) method, &p, ret);
0067     if (ACPI_FAILURE(s))
0068         acpi_handle_err(handle,
0069                 "Failed to eval method %s, param %#x (%d)\n",
0070                 method, param, s);
0071     else
0072         acpi_handle_debug(handle, "%s returned %#llx\n", method, *ret);
0073
0074     return s;
0075 }
0076
0077 static enum led_brightness led_state_get(struct led_classdev *led)
0078 {
0079     struct asus_wireless_data *data;
0080     acpi_status s;
0081     u64 ret;
0082
0083     data = container_of(led, struct asus_wireless_data, led);
0084     s = asus_wireless_method(acpi_device_handle(data->adev), "HSWC",
0085                  data->hswc_params->status, &ret);
0086     if (ACPI_SUCCESS(s) && ret == data->hswc_params->on)
0087         return LED_FULL;
0088     return LED_OFF;
0089 }
0090
0091 static void led_state_update(struct work_struct *work)
0092 {
0093     struct asus_wireless_data *data;
0094     u64 ret;
0095
0096     data = container_of(work, struct asus_wireless_data, led_work);
0097     asus_wireless_method(acpi_device_handle(data->adev), "HSWC",
0098                  data->led_state, &ret);
0099 }
0100
0101 static void led_state_set(struct led_classdev *led, enum led_brightness value)
0102 {
0103     struct asus_wireless_data *data;
0104
0105     data = container_of(led, struct asus_wireless_data, led);
0106     data->led_state = value == LED_OFF ? data->hswc_params->off :
0107                          data->hswc_params->on;
0108     queue_work(data->wq, &data->led_work);
0109 }
0110
0111 static void asus_wireless_notify(struct acpi_device *adev, u32 event)
0112 {
0113     struct asus_wireless_data *data = acpi_driver_data(adev);
0114
0115     dev_dbg(&adev->dev, "event=%#x\n", event);
0116     if (event != 0x88) {
0117         dev_notice(&adev->dev, "Unknown ASHS event: %#x\n", event);
0118         return;
0119     }
0120     input_report_key(data->idev, KEY_RFKILL, 1);
0121     input_sync(data->idev);
0122     input_report_key(data->idev, KEY_RFKILL, 0);
0123     input_sync(data->idev);
0124 }
0125
0126 static int asus_wireless_add(struct acpi_device *adev)
0127 {
0128     struct asus_wireless_data *data;
0129     const struct acpi_device_id *id;
0130     int err;
0131
0132     data = devm_kzalloc(&adev->dev, sizeof(*data), GFP_KERNEL);
0133     if (!data)
0134         return -ENOMEM;
0135     adev->driver_data = data;
0136     data->adev = adev;
0137
0138     data->idev = devm_input_allocate_device(&adev->dev);
0139     if (!data->idev)
0140         return -ENOMEM;
0141     data->idev->name = "Asus Wireless Radio Control";
0142     data->idev->phys = "asus-wireless/input0";
0143     data->idev->id.bustype = BUS_HOST;
0144     data->idev->id.vendor = PCI_VENDOR_ID_ASUSTEK;
0145     set_bit(EV_KEY, data->idev->evbit);
0146     set_bit(KEY_RFKILL, data->idev->keybit);
0147     err = input_register_device(data->idev);
0148     if (err)
0149         return err;
0150
0151     for (id = device_ids; id->id[0]; id++) {
0152         if (!strcmp((char *) id->id, acpi_device_hid(adev))) {
0153             data->hswc_params =
0154                 (const struct hswc_params *)id->driver_data;
0155             break;
0156         }
0157     }
0158     if (!data->hswc_params)
0159         return 0;
0160
0161     data->wq = create_singlethread_workqueue("asus_wireless_workqueue");
0162     if (!data->wq)
0163         return -ENOMEM;
0164     INIT_WORK(&data->led_work, led_state_update);
0165     data->led.name = "asus-wireless::airplane";
0166     data->led.brightness_set = led_state_set;
0167     data->led.brightness_get = led_state_get;
0168     data->led.flags = LED_CORE_SUSPENDRESUME;
0169     data->led.max_brightness = 1;
0170     data->led.default_trigger = "rfkill-none";
0171     err = devm_led_classdev_register(&adev->dev, &data->led);
0172     if (err)
0173         destroy_workqueue(data->wq);
0174
0175     return err;
0176 }
0177
0178 static int asus_wireless_remove(struct acpi_device *adev)
0179 {
0180     struct asus_wireless_data *data = acpi_driver_data(adev);
0181
0182     if (data->wq) {
0183         devm_led_classdev_unregister(&adev->dev, &data->led);
0184         destroy_workqueue(data->wq);
0185     }
0186     return 0;
0187 }
0188
0189 static struct acpi_driver asus_wireless_driver = {
0190     .name = "Asus Wireless Radio Control Driver",
0191     .class = "hotkey",
0192     .ids = device_ids,
0193     .ops = {
0194         .add = asus_wireless_add,
0195         .remove = asus_wireless_remove,
0196         .notify = asus_wireless_notify,
0197     },
0198 };
0199 module_acpi_driver(asus_wireless_driver);
0200
0201 MODULE_DESCRIPTION("Asus Wireless Radio Control Driver");
0202 MODULE_AUTHOR("João Paulo Rechi Vita <jprvita@gmail.com>");
0203 MODULE_LICENSE("GPL");