123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300 |
- #include <asm/unaligned.h>
- #include <linux/hid.h>
- #include <linux/kernel.h>
- #include <linux/module.h>
- #include <linux/platform_device.h>
- #include <linux/types.h>
- #include <linux/surface_aggregator/controller.h>
- #include "surface_hid_core.h"
- #define KBD_FEATURE_REPORT_SIZE 7
- enum surface_kbd_cid {
- SURFACE_KBD_CID_GET_DESCRIPTOR = 0x00,
- SURFACE_KBD_CID_SET_CAPSLOCK_LED = 0x01,
- SURFACE_KBD_CID_EVT_INPUT_GENERIC = 0x03,
- SURFACE_KBD_CID_EVT_INPUT_HOTKEYS = 0x04,
- SURFACE_KBD_CID_GET_FEATURE_REPORT = 0x0b,
- };
- static int ssam_kbd_get_descriptor(struct surface_hid_device *shid, u8 entry, u8 *buf, size_t len)
- {
- struct ssam_request rqst;
- struct ssam_response rsp;
- int status;
- rqst.target_category = shid->uid.category;
- rqst.target_id = shid->uid.target;
- rqst.command_id = SURFACE_KBD_CID_GET_DESCRIPTOR;
- rqst.instance_id = shid->uid.instance;
- rqst.flags = SSAM_REQUEST_HAS_RESPONSE;
- rqst.length = sizeof(entry);
- rqst.payload = &entry;
- rsp.capacity = len;
- rsp.length = 0;
- rsp.pointer = buf;
- status = ssam_retry(ssam_request_sync_onstack, shid->ctrl, &rqst, &rsp, sizeof(entry));
- if (status)
- return status;
- if (rsp.length != len) {
- dev_err(shid->dev, "invalid descriptor length: got %zu, expected, %zu\n",
- rsp.length, len);
- return -EPROTO;
- }
- return 0;
- }
- static int ssam_kbd_set_caps_led(struct surface_hid_device *shid, bool value)
- {
- struct ssam_request rqst;
- u8 value_u8 = value;
- rqst.target_category = shid->uid.category;
- rqst.target_id = shid->uid.target;
- rqst.command_id = SURFACE_KBD_CID_SET_CAPSLOCK_LED;
- rqst.instance_id = shid->uid.instance;
- rqst.flags = 0;
- rqst.length = sizeof(value_u8);
- rqst.payload = &value_u8;
- return ssam_retry(ssam_request_sync_onstack, shid->ctrl, &rqst, NULL, sizeof(value_u8));
- }
- static int ssam_kbd_get_feature_report(struct surface_hid_device *shid, u8 *buf, size_t len)
- {
- struct ssam_request rqst;
- struct ssam_response rsp;
- u8 payload = 0;
- int status;
- rqst.target_category = shid->uid.category;
- rqst.target_id = shid->uid.target;
- rqst.command_id = SURFACE_KBD_CID_GET_FEATURE_REPORT;
- rqst.instance_id = shid->uid.instance;
- rqst.flags = SSAM_REQUEST_HAS_RESPONSE;
- rqst.length = sizeof(payload);
- rqst.payload = &payload;
- rsp.capacity = len;
- rsp.length = 0;
- rsp.pointer = buf;
- status = ssam_retry(ssam_request_sync_onstack, shid->ctrl, &rqst, &rsp, sizeof(payload));
- if (status)
- return status;
- if (rsp.length != len) {
- dev_err(shid->dev, "invalid feature report length: got %zu, expected, %zu\n",
- rsp.length, len);
- return -EPROTO;
- }
- return 0;
- }
- static bool ssam_kbd_is_input_event(const struct ssam_event *event)
- {
- if (event->command_id == SURFACE_KBD_CID_EVT_INPUT_GENERIC)
- return true;
- if (event->command_id == SURFACE_KBD_CID_EVT_INPUT_HOTKEYS)
- return true;
- return false;
- }
- static u32 ssam_kbd_event_fn(struct ssam_event_notifier *nf, const struct ssam_event *event)
- {
- struct surface_hid_device *shid = container_of(nf, struct surface_hid_device, notif);
-
- if (shid->uid.category != event->target_category)
- return 0;
- if (shid->uid.target != event->target_id)
- return 0;
- if (shid->uid.instance != event->instance_id)
- return 0;
- if (!ssam_kbd_is_input_event(event))
- return 0;
- hid_input_report(shid->hid, HID_INPUT_REPORT, (u8 *)&event->data[0], event->length, 0);
- return SSAM_NOTIF_HANDLED;
- }
- static int skbd_get_caps_led_value(struct hid_device *hid, u8 rprt_id, u8 *buf, size_t len)
- {
- struct hid_field *field;
- unsigned int offset, size;
- int i;
-
- field = hidinput_get_led_field(hid);
- if (!field)
- return -ENOENT;
-
- if (len != hid_report_len(field->report))
- return -ENOENT;
- if (rprt_id != field->report->id)
- return -ENOENT;
-
- for (i = 0; i < field->report_count; i++)
- if ((field->usage[i].hid & 0xffff) == 0x02)
- break;
- if (i == field->report_count)
- return -ENOENT;
-
- size = field->report_size;
- offset = field->report_offset + i * size;
- return !!hid_field_extract(hid, buf + 1, size, offset);
- }
- static int skbd_output_report(struct surface_hid_device *shid, u8 rprt_id, u8 *buf, size_t len)
- {
- int caps_led;
- int status;
- caps_led = skbd_get_caps_led_value(shid->hid, rprt_id, buf, len);
- if (caps_led < 0)
- return -EIO;
- status = ssam_kbd_set_caps_led(shid, caps_led);
- if (status < 0)
- return status;
- return len;
- }
- static int skbd_get_feature_report(struct surface_hid_device *shid, u8 rprt_id, u8 *buf, size_t len)
- {
- u8 report[KBD_FEATURE_REPORT_SIZE];
- int status;
-
- if (len < ARRAY_SIZE(report))
- return -ENOSPC;
- status = ssam_kbd_get_feature_report(shid, report, ARRAY_SIZE(report));
- if (status < 0)
- return status;
- if (rprt_id != report[0])
- return -ENOENT;
- memcpy(buf, report, ARRAY_SIZE(report));
- return len;
- }
- static int skbd_set_feature_report(struct surface_hid_device *shid, u8 rprt_id, u8 *buf, size_t len)
- {
-
- return -EIO;
- }
- static int surface_kbd_probe(struct platform_device *pdev)
- {
- struct ssam_controller *ctrl;
- struct surface_hid_device *shid;
-
- ctrl = ssam_client_bind(&pdev->dev);
- if (IS_ERR(ctrl))
- return PTR_ERR(ctrl) == -ENODEV ? -EPROBE_DEFER : PTR_ERR(ctrl);
- shid = devm_kzalloc(&pdev->dev, sizeof(*shid), GFP_KERNEL);
- if (!shid)
- return -ENOMEM;
- shid->dev = &pdev->dev;
- shid->ctrl = ctrl;
- shid->uid.domain = SSAM_DOMAIN_SERIALHUB;
- shid->uid.category = SSAM_SSH_TC_KBD;
- shid->uid.target = 2;
- shid->uid.instance = 0;
- shid->uid.function = 0;
- shid->notif.base.priority = 1;
- shid->notif.base.fn = ssam_kbd_event_fn;
- shid->notif.event.reg = SSAM_EVENT_REGISTRY_SAM;
- shid->notif.event.id.target_category = shid->uid.category;
- shid->notif.event.id.instance = shid->uid.instance;
- shid->notif.event.mask = SSAM_EVENT_MASK_NONE;
- shid->notif.event.flags = 0;
- shid->ops.get_descriptor = ssam_kbd_get_descriptor;
- shid->ops.output_report = skbd_output_report;
- shid->ops.get_feature_report = skbd_get_feature_report;
- shid->ops.set_feature_report = skbd_set_feature_report;
- platform_set_drvdata(pdev, shid);
- return surface_hid_device_add(shid);
- }
- static int surface_kbd_remove(struct platform_device *pdev)
- {
- surface_hid_device_destroy(platform_get_drvdata(pdev));
- return 0;
- }
- static const struct acpi_device_id surface_kbd_match[] = {
- { "MSHW0096" },
- { },
- };
- MODULE_DEVICE_TABLE(acpi, surface_kbd_match);
- static struct platform_driver surface_kbd_driver = {
- .probe = surface_kbd_probe,
- .remove = surface_kbd_remove,
- .driver = {
- .name = "surface_keyboard",
- .acpi_match_table = surface_kbd_match,
- .pm = &surface_hid_pm_ops,
- .probe_type = PROBE_PREFER_ASYNCHRONOUS,
- },
- };
- module_platform_driver(surface_kbd_driver);
- MODULE_AUTHOR("Maximilian Luz <luzmaximilian@gmail.com>");
- MODULE_DESCRIPTION("HID legacy transport driver for Surface System Aggregator Module");
- MODULE_LICENSE("GPL");
|