Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 | /* * 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_sync(data->idev); 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) { devm_led_classdev_unregister(&adev->dev, &data->led); 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"); |