Add basic probe and wmi notifiers

This commit is contained in:
Christoffer Sandberg 2020-05-29 17:47:18 +02:00
parent 3bb71064ae
commit f7d79e6bbc
No known key found for this signature in database
GPG key ID: BF563F71B6C7A96D

View file

@ -18,20 +18,113 @@
* Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
*/
#include "tuxedo_keyboard_common.h"
#include <linux/acpi.h>
#include <linux/wmi.h>
#define UNIWILL_WMI_MGMT_GUID_BA "ABBC0F6D-8EA1-11D1-00A0-C90629100000"
#define UNIWILL_WMI_MGMT_GUID_BB "ABBC0F6E-8EA1-11D1-00A0-C90629100000"
#define UNIWILL_WMI_MGMT_GUID_BC "ABBC0F6F-8EA1-11D1-00A0-C90629100000"
#define UNIWILL_WMI_EVENT_GUID_0 "ABBC0F70-8EA1-11D1-00A0-C90629100000"
#define UNIWILL_WMI_EVENT_GUID_1 "ABBC0F71-8EA1-11D1-00A0-C90629100000"
#define UNIWILL_WMI_EVENT_GUID_2 "ABBC0F72-8EA1-11D1-00A0-C90629100000"
#define UNIWILL_OSD_RADIOON 0x01A
#define UNIWILL_OSD_RADIOOFF 0x01B
struct tuxedo_keyboard_driver uniwill_keyboard_driver;
static struct key_entry uniwill_wmi_keymap[] = {
{ KE_KEY, UNIWILL_OSD_RADIOON, { KEY_RFKILL } },
{ KE_KEY, UNIWILL_OSD_RADIOOFF, { KEY_RFKILL } },
{ KE_END, 0 }
};
static void uniwill_wmi_handle_event(u32 value, void *context, u32 guid_nr)
{
struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
union acpi_object *obj;
acpi_status status;
int code;
status = wmi_get_event_data(value, &response);
if (status != AE_OK) {
TUXEDO_ERROR("uniwill handle event -> bad event status\n");
return;
}
obj = (union acpi_object *) response.pointer;
if (obj && obj->type == ACPI_TYPE_INTEGER) {
code = obj->integer.value;
if (!sparse_keymap_report_known_event(current_driver->input_device, code, 1, true)) {
TUXEDO_DEBUG("Unknown key - %d (%0#6x)\n", code, code);
}
}
kfree(obj);
}
static void uniwill_wmi_notify0(u32 value, void *context)
{
uniwill_wmi_handle_event(value, context, 0);
}
static void uniwill_wmi_notify1(u32 value, void *context)
{
uniwill_wmi_handle_event(value, context, 1);
}
static void uniwill_wmi_notify2(u32 value, void *context)
{
uniwill_wmi_handle_event(value, context, 2);
}
static int uniwill_keyboard_probe(struct platform_device *dev)
{
int status;
// Look for for GUIDs used on uniwill devices
status =
wmi_has_guid(UNIWILL_WMI_EVENT_GUID_0) &&
wmi_has_guid(UNIWILL_WMI_EVENT_GUID_1) &&
wmi_has_guid(UNIWILL_WMI_EVENT_GUID_2) &&
wmi_has_guid(UNIWILL_WMI_MGMT_GUID_BA) &&
wmi_has_guid(UNIWILL_WMI_MGMT_GUID_BB) &&
wmi_has_guid(UNIWILL_WMI_MGMT_GUID_BC);
if (!status) {
TUXEDO_DEBUG("probe: At least one Uniwill GUID missing\n");
return -ENODEV;
}
// Attempt to add event handlers
status =
wmi_install_notify_handler(UNIWILL_WMI_EVENT_GUID_0, uniwill_wmi_notify0, NULL) &&
wmi_install_notify_handler(UNIWILL_WMI_EVENT_GUID_1, uniwill_wmi_notify1, NULL) &&
wmi_install_notify_handler(UNIWILL_WMI_EVENT_GUID_2, uniwill_wmi_notify2, NULL);
if (!status) {
TUXEDO_ERROR("probe: Failed to install at least one uniwill notify handler\n");
goto err_remove_notifiers;
}
return 0;
err_remove_notifiers:
wmi_remove_notify_handler(UNIWILL_WMI_EVENT_GUID_0);
wmi_remove_notify_handler(UNIWILL_WMI_EVENT_GUID_1);
wmi_remove_notify_handler(UNIWILL_WMI_EVENT_GUID_2);
return -ENODEV;
}
static int uniwill_keyboard_remove(struct platform_device *dev)
{
wmi_remove_notify_handler(UNIWILL_WMI_EVENT_GUID_0);
wmi_remove_notify_handler(UNIWILL_WMI_EVENT_GUID_1);
wmi_remove_notify_handler(UNIWILL_WMI_EVENT_GUID_2);
return 0;
}