derped/nixpkgs_local
1
0
Fork 0
Code Issues Pull requests Releases Wiki Activity
nixpkgs_local/linux_surface/patches/0001-surface-acpi.patch

3019 lines
82 KiB
Diff
Raw Normal View History

Init
2019-02-28 08:42:46 +01:00
From 6694d6dfb749b6d9149dd88ec9d6a51fc2d71869 Mon Sep 17 00:00:00 2001
From: Jake Day <jake@ninebysix.com>
Date: Sun, 27 Jan 2019 10:45:19 -0500
Subject: [PATCH 01/11] surface-acpi
---
drivers/acpi/acpica/dsopcode.c | 2 +-
drivers/acpi/acpica/exfield.c | 26 +-
drivers/platform/x86/Kconfig | 56 +
drivers/platform/x86/Makefile | 1 +
drivers/platform/x86/surface_acpi.c | 2727 +++++++++++++++++++++++++++
drivers/tty/serdev/core.c | 90 +-
6 files changed, 2883 insertions(+), 19 deletions(-)
create mode 100644 drivers/platform/x86/surface_acpi.c
diff --git a/drivers/acpi/acpica/dsopcode.c b/drivers/acpi/acpica/dsopcode.c
index 78f9de260d5f..0cd858520f5b 100644
--- a/drivers/acpi/acpica/dsopcode.c
+++ b/drivers/acpi/acpica/dsopcode.c
@@ -123,7 +123,7 @@ acpi_ds_init_buffer_field(u16 aml_opcode,
/* Offset is in bits, count is in bits */
- field_flags = AML_FIELD_ACCESS_BYTE;
+ field_flags = AML_FIELD_ACCESS_BUFFER;
bit_offset = offset;
bit_count = (u32) length_desc->integer.value;
diff --git a/drivers/acpi/acpica/exfield.c b/drivers/acpi/acpica/exfield.c
index b272c329d45d..cf547883a993 100644
--- a/drivers/acpi/acpica/exfield.c
+++ b/drivers/acpi/acpica/exfield.c
@@ -102,6 +102,7 @@ acpi_ex_read_data_from_field(struct acpi_walk_state *walk_state,
void *buffer;
u32 function;
u16 accessor_type;
+ u8 field_flags;
ACPI_FUNCTION_TRACE_PTR(ex_read_data_from_field, obj_desc);
@@ -199,11 +200,16 @@ acpi_ex_read_data_from_field(struct acpi_walk_state *walk_state,
* Note: Field.length is in bits.
*/
length =
- (acpi_size)ACPI_ROUND_BITS_UP_TO_BYTES(obj_desc->field.bit_length);
+ (acpi_size)ACPI_ROUND_BITS_UP_TO_BYTES(obj_desc->common_field.bit_length);
+ field_flags = obj_desc->common_field.field_flags;
- if (length > acpi_gbl_integer_byte_width) {
+ if (length > acpi_gbl_integer_byte_width ||
+ (field_flags & AML_FIELD_ACCESS_TYPE_MASK) == AML_FIELD_ACCESS_BUFFER) {
- /* Field is too large for an Integer, create a Buffer instead */
+ /*
+ * Field is either too large for an Integer, or a actually of type
+ * buffer, so create a Buffer.
+ */
buffer_desc = acpi_ut_create_buffer_object(length);
if (!buffer_desc) {
@@ -366,19 +372,7 @@ acpi_ex_write_data_to_field(union acpi_operand_object *source_desc,
} else if (obj_desc->field.region_obj->region.space_id ==
ACPI_ADR_SPACE_GSBUS) {
accessor_type = obj_desc->field.attribute;
- length =
- acpi_ex_get_serial_access_length(accessor_type,
- obj_desc->field.
- access_length);
-
- /*
- * Add additional 2 bytes for the generic_serial_bus data buffer:
- *
- * Status; (Byte 0 of the data buffer)
- * Length; (Byte 1 of the data buffer)
- * Data[x-1]: (Bytes 2-x of the arbitrary length data buffer)
- */
- length += 2;
+ length = source_desc->buffer.length;
function = ACPI_WRITE | (accessor_type << 16);
} else { /* IPMI */
diff --git a/drivers/platform/x86/Kconfig b/drivers/platform/x86/Kconfig
index 0c1aa6c314f5..716a32e1c66f 100644
--- a/drivers/platform/x86/Kconfig
+++ b/drivers/platform/x86/Kconfig
@@ -573,6 +573,62 @@ config THINKPAD_ACPI_HOTKEY_POLL
If you are not sure, say Y here. The driver enables polling only if
it is strictly necessary to do so.
+config SURFACE_ACPI
+ depends on ACPI
+ tristate "Microsoft Surface ACPI/Platform Drivers"
+ ---help---
+ ACPI and platform drivers for Microsoft Surface devices.
+
+config SURFACE_ACPI_SSH
+ bool "Surface Serial Hub Driver"
+ depends on SURFACE_ACPI
+ depends on X86_INTEL_LPSS
+ depends on SERIAL_8250_DW
+ depends on SERIAL_8250_DMA
+ depends on SERIAL_DEV_CTRL_TTYPORT
+ select CRC_CCITT
+ default y
+ ---help---
+ Surface Serial Hub driver for 5th generation (or later) Microsoft
+ Surface devices.
+
+ This is the base driver for the embedded serial controller found on
+ 5th generation (and later) Microsoft Surface devices (e.g. Book 2,
+ Laptop, Laptop 2, Pro 2017, Pro 6, ...). This driver itself only
+ provides access to the embedded controller and subsequent drivers are
+ required for the respective functionalities.
+
+ If you have a 5th generation (or later) Microsoft Surface device, say
+ Y or M here.
+
+config SURFACE_ACPI_SAN
+ bool "Surface ACPI Notify Driver"
+ depends on SURFACE_ACPI_SSH
+ default y
+ ---help---
+ Surface ACPI Notify driver for 5th generation (or later) Microsoft
+ Surface devices.
+
+ This driver enables basic ACPI events and requests, such as battery
+ status requests/events, thermal events, lid status, and possibly more,
+ which would otherwise not work on these devices.
+
+ If you are not sure, say Y here.
+
+config SURFACE_ACPI_VHF
+ bool "Surface Virtual HID Framework Driver"
+ depends on SURFACE_ACPI_SSH
+ depends on HID
+ default y
+ ---help---
+ Surface Virtual HID Framework driver for 5th generation (or later)
+ Microsoft Surface devices.
+
+ This driver provides support for the Microsoft Virtual HID framework,
+ which is required for the Surface Laptop (1 and newer) keyboard.
+
+ If you are not sure, say Y here.
+
config SENSORS_HDAPS
tristate "Thinkpad Hard Drive Active Protection System (hdaps)"
depends on INPUT
diff --git a/drivers/platform/x86/Makefile b/drivers/platform/x86/Makefile
index e6d1becf81ce..ab8be80b6596 100644
--- a/drivers/platform/x86/Makefile
+++ b/drivers/platform/x86/Makefile
@@ -35,6 +35,7 @@ obj-$(CONFIG_TC1100_WMI) += tc1100-wmi.o
obj-$(CONFIG_SONY_LAPTOP) += sony-laptop.o
obj-$(CONFIG_IDEAPAD_LAPTOP) += ideapad-laptop.o
obj-$(CONFIG_THINKPAD_ACPI) += thinkpad_acpi.o
+obj-$(CONFIG_SURFACE_ACPI) += surface_acpi.o
obj-$(CONFIG_SENSORS_HDAPS) += hdaps.o
obj-$(CONFIG_FUJITSU_LAPTOP) += fujitsu-laptop.o
obj-$(CONFIG_FUJITSU_TABLET) += fujitsu-tablet.o
diff --git a/drivers/platform/x86/surface_acpi.c b/drivers/platform/x86/surface_acpi.c
new file mode 100644
index 000000000000..6a3aa6a01493
--- /dev/null
+++ b/drivers/platform/x86/surface_acpi.c
@@ -0,0 +1,2727 @@
+#include <asm/unaligned.h>
+#include <linux/acpi.h>
+#include <linux/completion.h>
+#include <linux/crc-ccitt.h>
+#include <linux/delay.h>
+#include <linux/device.h>
+#include <linux/dmaengine.h>
+#include <linux/hid.h>
+#include <linux/input.h>
+#include <linux/jiffies.h>
+#include <linux/kernel.h>
+#include <linux/kfifo.h>
+#include <linux/mutex.h>
+#include <linux/platform_device.h>
+#include <linux/pm.h>
+#include <linux/refcount.h>
+#include <linux/serdev.h>
+#include <linux/spinlock.h>
+#include <linux/types.h>
+#include <linux/workqueue.h>
+
+
+/*************************************************************************
+ * Surface Serial Hub driver (cross-driver interface)
+ */
+
+#ifdef CONFIG_SURFACE_ACPI_SSH
+
+/*
+ * Maximum request payload size in bytes.
+ * Value based on ACPI (255 bytes minus header/status bytes).
+ */
+#define SURFACEGEN5_MAX_RQST_PAYLOAD (255 - 10)
+
+/*
+ * Maximum response payload size in bytes.
+ * Value based on ACPI (255 bytes minus header/status bytes).
+ */
+#define SURFACEGEN5_MAX_RQST_RESPONSE (255 - 4)
+
+#define SURFACEGEN5_RQID_EVENT_BITS 5
+
+#define SURFACEGEN5_EVENT_IMMEDIATE ((unsigned long) -1)
+
+
+struct surfacegen5_buf {
+ u8 cap;
+ u8 len;
+ u8 *data;
+};
+
+struct surfacegen5_rqst {
+ u8 tc;
+ u8 iid;
+ u8 cid;
+ u8 snc;
+ u8 cdl;
+ u8 *pld;
+};
+
+struct surfacegen5_event {
+ u16 rqid;
+ u8 tc;
+ u8 iid;
+ u8 cid;
+ u8 len;
+ u8 *pld;
+};
+
+
+typedef int (*surfacegen5_ec_event_handler_fn)(struct surfacegen5_event *event, void *data);
+typedef unsigned long (*surfacegen5_ec_event_handler_delay)(struct surfacegen5_event *event, void *data);
+
+struct device_link *surfacegen5_ec_consumer_add(struct device *consumer, u32 flags);
+int surfacegen5_ec_consumer_remove(struct device_link *link);
+
+int surfacegen5_ec_rqst(const struct surfacegen5_rqst *rqst, struct surfacegen5_buf *result);
+
+int surfacegen5_ec_enable_event_source(u8 tc, u8 unknown, u16 rqid);
+int surfacegen5_ec_disable_event_source(u8 tc, u8 unknown, u16 rqid);
+int surfacegen5_ec_remove_event_handler(u16 rqid);
+int surfacegen5_ec_set_event_handler(u16 rqid, surfacegen5_ec_event_handler_fn fn, void *data);
+int surfacegen5_ec_set_delayed_event_handler(u16 rqid,
+ surfacegen5_ec_event_handler_fn fn,
+ surfacegen5_ec_event_handler_delay delay,
+ void *data);
+
+#endif /* CONFIG_SURFACE_ACPI_SSH */
+
+
+/*************************************************************************
+ * Surface Serial Hub driver (private implementation)
+ */
+
+#ifdef CONFIG_SURFACE_ACPI_SSH
+
+#define SG5_RQST_TAG_FULL "surfacegen5_ec_rqst: "
+#define SG5_RQST_TAG "rqst: "
+#define SG5_EVENT_TAG "event: "
+#define SG5_RECV_TAG "recv: "
+
+#define SG5_SUPPORTED_FLOW_CONTROL_MASK (~((u8) ACPI_UART_FLOW_CONTROL_HW))
+
+#define SG5_BYTELEN_SYNC 2
+#define SG5_BYTELEN_TERM 2
+#define SG5_BYTELEN_CRC 2
+#define SG5_BYTELEN_CTRL 4 // command-header, ACK, or RETRY
+#define SG5_BYTELEN_CMDFRAME 8 // without payload
+
+#define SG5_MAX_WRITE ( \
+ SG5_BYTELEN_SYNC \
+ + SG5_BYTELEN_CTRL \
+ + SG5_BYTELEN_CRC \
+ + SG5_BYTELEN_CMDFRAME \
+ + SURFACEGEN5_MAX_RQST_PAYLOAD \
+ + SG5_BYTELEN_CRC \
+)
+
+#define SG5_MSG_LEN_CTRL ( \
+ SG5_BYTELEN_SYNC \
+ + SG5_BYTELEN_CTRL \
+ + SG5_BYTELEN_CRC \
+ + SG5_BYTELEN_TERM \
+)
+
+#define SG5_MSG_LEN_CMD_BASE ( \
+ SG5_BYTELEN_SYNC \
+ + SG5_BYTELEN_CTRL \
+ + SG5_BYTELEN_CRC \
+ + SG5_BYTELEN_CRC \
+) // without payload and command-frame
+
+#define SG5_WRITE_TIMEOUT msecs_to_jiffies(1000)
+#define SG5_READ_TIMEOUT msecs_to_jiffies(1000)
+#define SG5_NUM_RETRY 3
+
+#define SG5_WRITE_BUF_LEN SG5_MAX_WRITE
+#define SG5_READ_BUF_LEN 512 // must be power of 2
+#define SG5_EVAL_BUF_LEN SG5_MAX_WRITE // also works for reading
+
+#define SG5_FRAME_TYPE_CMD 0x80
+#define SG5_FRAME_TYPE_ACK 0x40
+#define SG5_FRAME_TYPE_RETRY 0x04
+
+#define SG5_FRAME_OFFS_CTRL SG5_BYTELEN_SYNC
+#define SG5_FRAME_OFFS_CTRL_CRC (SG5_FRAME_OFFS_CTRL + SG5_BYTELEN_CTRL)
+#define SG5_FRAME_OFFS_TERM (SG5_FRAME_OFFS_CTRL_CRC + SG5_BYTELEN_CRC)
+#define SG5_FRAME_OFFS_CMD SG5_FRAME_OFFS_TERM // either TERM or CMD
+#define SG5_FRAME_OFFS_CMD_PLD (SG5_FRAME_OFFS_CMD + SG5_BYTELEN_CMDFRAME)
+
+/*
+ * A note on Request IDs (RQIDs):
+ * 0x0000 is not a valid RQID
+ * 0x0001 is valid, but reserved for Surface Laptop keyboard events
+ */
+#define SG5_NUM_EVENT_TYPES ((1 << SURFACEGEN5_RQID_EVENT_BITS) - 1)
+
+/*
+ * Sync: aa 55
+ * Terminate: ff ff
+ *
+ * Request Message: sync cmd-hdr crc(cmd-hdr) cmd-rqst-frame crc(cmd-rqst-frame)
+ * Ack Message: sync ack crc(ack) terminate
+ * Retry Message: sync retry crc(retry) terminate
+ * Response Message: sync cmd-hdr crc(cmd-hdr) cmd-resp-frame crc(cmd-resp-frame)
+ *
+ * Command Header: 80 LEN 00 SEQ
+ * Ack: 40 00 00 SEQ
+ * Retry: 04 00 00 00
+ * Command Request Frame: 80 RTC 01 00 RIID RQID RCID PLD
+ * Command Response Frame: 80 RTC 00 01 RIID RQID RCID PLD
+ */
+
+struct surfacegen5_frame_ctrl {
+ u8 type;
+ u8 len; // without crc
+ u8 pad;
+ u8 seq;
+} __packed;
+
+struct surfacegen5_frame_cmd {
+ u8 type;
+ u8 tc;
+ u8 unknown1;
+ u8 unknown2;
+ u8 iid;
+ u8 rqid_lo; // id for request/response matching (low byte)
+ u8 rqid_hi; // id for request/response matching (high byte)
+ u8 cid;
+} __packed;
+
+
+enum surfacegen5_ec_state {
+ SG5_EC_UNINITIALIZED,
+ SG5_EC_INITIALIZED,
+ SG5_EC_SUSPENDED,
+};
+
+struct surfacegen5_ec_counters {
+ u8 seq; // control sequence id
+ u16 rqid; // id for request/response matching
+};
+
+struct surfacegen5_ec_writer {
+ u8 *data;
+ u8 *ptr;
+} __packed;
+
+enum surfacegen5_ec_receiver_state {
+ SG5_RCV_DISCARD,
+ SG5_RCV_CONTROL,
+ SG5_RCV_COMMAND,
+};
+
+struct surfacegen5_ec_receiver {
+ spinlock_t lock;
+ enum surfacegen5_ec_receiver_state state;
+ struct completion signal;
+ struct kfifo fifo;
+ struct {
+ bool pld;
+ u8 seq;
+ u16 rqid;
+ } expect;
+ struct {
+ u16 cap;
+ u16 len;
+ u8 *ptr;
+ } eval_buf;
+};
+
+struct surfacegen5_ec_event_handler {
+ surfacegen5_ec_event_handler_fn handler;
+ surfacegen5_ec_event_handler_delay delay;
+ void *data;
+};
+
+struct surfacegen5_ec_events {
+ spinlock_t lock;
+ struct workqueue_struct *queue_ack;
+ struct workqueue_struct *queue_evt;
+ struct surfacegen5_ec_event_handler handler[SG5_NUM_EVENT_TYPES];
+};
+
+struct surfacegen5_ec {
+ struct mutex lock;
+ enum surfacegen5_ec_state state;
+ struct serdev_device *serdev;
+ struct surfacegen5_ec_counters counter;
+ struct surfacegen5_ec_writer writer;
+ struct surfacegen5_ec_receiver receiver;
+ struct surfacegen5_ec_events events;
+};
+
+struct surfacegen5_fifo_packet {
+ u8 type; // packet type (ACK/RETRY/CMD)
+ u8 seq;
+ u8 len;
+};
+
+struct surfacegen5_event_work {
+ refcount_t refcount;
+ struct surfacegen5_ec *ec;
+ struct work_struct work_ack;
+ struct delayed_work work_evt;
+ struct surfacegen5_event event;
+ u8 seq;
+};
+
+
+static struct surfacegen5_ec surfacegen5_ec = {
+ .lock = __MUTEX_INITIALIZER(surfacegen5_ec.lock),
+ .state = SG5_EC_UNINITIALIZED,
+ .serdev = NULL,
+ .counter = {
+ .seq = 0,
+ .rqid = 0,
+ },
+ .writer = {
+ .data = NULL,
+ .ptr = NULL,
+ },
+ .receiver = {
+ .lock = __SPIN_LOCK_UNLOCKED(),
+ .state = SG5_RCV_DISCARD,
+ .expect = {},
+ },
+ .events = {
+ .lock = __SPIN_LOCK_UNLOCKED(),
+ .handler = {},
+ }
+};
+
+
+static int surfacegen5_ec_rqst_unlocked(struct surfacegen5_ec *ec,
+ const struct surfacegen5_rqst *rqst,
+ struct surfacegen5_buf *result);
+
+
+inline static struct surfacegen5_ec *surfacegen5_ec_acquire(void)
+{
+ struct surfacegen5_ec *ec = &surfacegen5_ec;
+
+ mutex_lock(&ec->lock);
+ return ec;
+}
+
+inline static void surfacegen5_ec_release(struct surfacegen5_ec *ec)
+{
+ mutex_unlock(&ec->lock);
+}
+
+inline static struct surfacegen5_ec *surfacegen5_ec_acquire_init(void)
+{
+ struct surfacegen5_ec *ec = surfacegen5_ec_acquire();
+
+ if (ec->state == SG5_EC_UNINITIALIZED) {
+ surfacegen5_ec_release(ec);
+ return NULL;
+ }
+
+ return ec;
+}
+
+struct device_link *surfacegen5_ec_consumer_add(struct device *consumer, u32 flags)
+{
+ struct surfacegen5_ec *ec;
+ struct device_link *link;
+
+ ec = surfacegen5_ec_acquire_init();
+ if (!ec) {
+ return ERR_PTR(-ENXIO);
+ }
+
+ link = device_link_add(consumer, &ec->serdev->dev, flags);
+
+ surfacegen5_ec_release(ec);
+ return link;
+}
+
+int surfacegen5_ec_consumer_remove(struct device_link *link)
+{
+ struct surfacegen5_ec *ec = surfacegen5_ec_acquire_init();
+ if (!ec) {
+ return -ENXIO;
+ }
+
+ device_link_del(link);
+
+ surfacegen5_ec_release(ec);
+ return 0;
+}
+
+
+inline static u16 surfacegen5_rqid_to_rqst(u16 rqid) {
+ return rqid << SURFACEGEN5_RQID_EVENT_BITS;
+}
+
+inline static bool surfacegen5_rqid_is_event(u16 rqid) {
+ const u16 mask = (1 << SURFACEGEN5_RQID_EVENT_BITS) - 1;
+ return rqid != 0 && (rqid | mask) == mask;
+}
+
+int surfacegen5_ec_enable_event_source(u8 tc, u8 unknown, u16 rqid)
+{
+ struct surfacegen5_ec *ec;
+
+ u8 pld[4] = { tc, unknown, rqid & 0xff, rqid >> 8 };
+ u8 buf[1] = { 0x00 };
+
+ struct surfacegen5_rqst rqst = {
+ .tc = 0x01,
+ .iid = 0x00,
+ .cid = 0x0b,
+ .snc = 0x01,
+ .cdl = 0x04,
+ .pld = pld,
+ };
+
+ struct surfacegen5_buf result = {
+ result.cap = ARRAY_SIZE(buf),
+ result.len = 0,
+ result.data = buf,
+ };
+
+ int status;
+
+ // only allow RQIDs that lie within event spectrum
+ if (!surfacegen5_rqid_is_event(rqid)) {
+ return -EINVAL;
+ }
+
+ ec = surfacegen5_ec_acquire_init();
+ if (!ec) {
+ printk(KERN_WARNING SG5_RQST_TAG_FULL "embedded controller is uninitialized\n");
+ return -ENXIO;
+ }
+
+ if (ec->state == SG5_EC_SUSPENDED) {
+ dev_warn(&ec->serdev->dev, SG5_RQST_TAG "embedded controller is suspended\n");
+
+ surfacegen5_ec_release(ec);
+ return -EPERM;
+ }
+
+ status = surfacegen5_ec_rqst_unlocked(ec, &rqst, &result);
+
+ if (buf[0] != 0x00) {
+ dev_warn(&ec->serdev->dev,
+ "unexpected result while enabling event source: 0x%02x\n",
+ buf[0]);
+ }
+
+ surfacegen5_ec_release(ec);
+ return status;
+
+}
+
+int surfacegen5_ec_disable_event_source(u8 tc, u8 unknown, u16 rqid)
+{
+ struct surfacegen5_ec *ec;
+
+ u8 pld[4] = { tc, unknown, rqid & 0xff, rqid >> 8 };
+ u8 buf[1] = { 0x00 };
+
+ struct surfacegen5_rqst rqst = {
+ .tc = 0x01,
+ .iid = 0x00,
+ .cid = 0x0c,
+ .snc = 0x01,
+ .cdl = 0x04,
+ .pld = pld,
+ };
+
+ struct surfacegen5_buf result = {
+ result.cap = ARRAY_SIZE(buf),
+ result.len = 0,
+ result.data = buf,
+ };
+
+ int status;
+
+ // only allow RQIDs that lie within event spectrum
+ if (!surfacegen5_rqid_is_event(rqid)) {
+ return -EINVAL;
+ }
+
+ ec = surfacegen5_ec_acquire_init();
+ if (!ec) {
+ printk(KERN_WARNING SG5_RQST_TAG_FULL "embedded controller is uninitialized\n");
+ return -ENXIO;
+ }
+
+ if (ec->state == SG5_EC_SUSPENDED) {
+ dev_warn(&ec->serdev->dev, SG5_RQST_TAG "embedded controller is suspended\n");
+
+ surfacegen5_ec_release(ec);
+ return -EPERM;
+ }
+
+ status = surfacegen5_ec_rqst_unlocked(ec, &rqst, &result);
+
+ if (buf[0] != 0x00) {
+ dev_warn(&ec->serdev->dev,
+ "unexpected result while disabling event source: 0x%02x\n",
+ buf[0]);
+ }
+
+ surfacegen5_ec_release(ec);
+ return status;
+}
+
+int surfacegen5_ec_set_delayed_event_handler(
+ u16 rqid, surfacegen5_ec_event_handler_fn fn,
+ surfacegen5_ec_event_handler_delay delay,
+ void *data)
+{
+ struct surfacegen5_ec *ec;
+ unsigned long flags;
+
+ if (!surfacegen5_rqid_is_event(rqid)) {
+ return -EINVAL;
+ }
+
+ ec = surfacegen5_ec_acquire_init();
+ if (!ec) {
+ return -ENXIO;
+ }
+
+ spin_lock_irqsave(&ec->events.lock, flags);
+
+ // 0 is not a valid event RQID
+ ec->events.handler[rqid - 1].handler = fn;
+ ec->events.handler[rqid - 1].delay = delay;
+ ec->events.handler[rqid - 1].data = data;
+
+ spin_unlock_irqrestore(&ec->events.lock, flags);
+ surfacegen5_ec_release(ec);
+
+ return 0;
+}
+
+int surfacegen5_ec_set_event_handler(
+ u16 rqid, surfacegen5_ec_event_handler_fn fn, void *data)
+{
+ return surfacegen5_ec_set_delayed_event_handler(rqid, fn, NULL, data);
+}
+
+int surfacegen5_ec_remove_event_handler(u16 rqid)
+{
+ struct surfacegen5_ec *ec;
+ unsigned long flags;
+
+ if (!surfacegen5_rqid_is_event(rqid)) {
+ return -EINVAL;
+ }
+
+ ec = surfacegen5_ec_acquire_init();
+ if (!ec) {
+ return -ENXIO;
+ }
+
+ spin_lock_irqsave(&ec->events.lock, flags);
+
+ // 0 is not a valid event RQID
+ ec->events.handler[rqid - 1].handler = NULL;
+ ec->events.handler[rqid - 1].delay = NULL;
+ ec->events.handler[rqid - 1].data = NULL;
+
+ spin_unlock_irqrestore(&ec->events.lock, flags);
+ surfacegen5_ec_release(ec);
+
+ /*
+ * Make sure that the handler is not in use any more after we've
+ * removed it.
+ */
+ flush_workqueue(ec->events.queue_evt);
+
+ return 0;
+}
+
+
+inline static u16 surfacegen5_ssh_crc(const u8 *buf, size_t size)
+{
+ return crc_ccitt_false(0xffff, buf, size);
+}
+
+inline static void surfacegen5_ssh_write_u16(struct surfacegen5_ec_writer *writer, u16 in)
+{
+ put_unaligned_le16(in, writer->ptr);
+ writer->ptr += 2;
+}
+
+inline static void surfacegen5_ssh_write_crc(struct surfacegen5_ec_writer *writer,
+ const u8 *buf, size_t size)
+{
+ surfacegen5_ssh_write_u16(writer, surfacegen5_ssh_crc(buf, size));
+}
+
+inline static void surfacegen5_ssh_write_syn(struct surfacegen5_ec_writer *writer)
+{
+ u8 *w = writer->ptr;
+
+ *w++ = 0xaa;
+ *w++ = 0x55;
+
+ writer->ptr = w;
+}
+
+inline static void surfacegen5_ssh_write_ter(struct surfacegen5_ec_writer *writer)
+{
+ u8 *w = writer->ptr;
+
+ *w++ = 0xff;
+ *w++ = 0xff;
+
+ writer->ptr = w;
+}
+
+inline static void surfacegen5_ssh_write_buf(struct surfacegen5_ec_writer *writer,
+ u8 *in, size_t len)
+{
+ writer->ptr = memcpy(writer->ptr, in, len) + len;
+}
+
+inline static void surfacegen5_ssh_write_hdr(struct surfacegen5_ec_writer *writer,
+ const struct surfacegen5_rqst *rqst,
+ struct surfacegen5_ec *ec)
+{
+ struct surfacegen5_frame_ctrl *hdr = (struct surfacegen5_frame_ctrl *)writer->ptr;
+ u8 *begin = writer->ptr;
+
+ hdr->type = SG5_FRAME_TYPE_CMD;
+ hdr->len = SG5_BYTELEN_CMDFRAME + rqst->cdl; // without CRC
+ hdr->pad = 0x00;
+ hdr->seq = ec->counter.seq;
+
+ writer->ptr += sizeof(*hdr);
+
+ surfacegen5_ssh_write_crc(writer, begin, writer->ptr - begin);
+}
+
+inline static void surfacegen5_ssh_write_cmd(struct surfacegen5_ec_writer *writer,
+ const struct surfacegen5_rqst *rqst,
+ struct surfacegen5_ec *ec)
+{
+ struct surfacegen5_frame_cmd *cmd = (struct surfacegen5_frame_cmd *)writer->ptr;
+ u8 *begin = writer->ptr;
+
+ u16 rqid = surfacegen5_rqid_to_rqst(ec->counter.rqid);
+ u8 rqid_lo = rqid & 0xFF;
+ u8 rqid_hi = rqid >> 8;
+
+ cmd->type = SG5_FRAME_TYPE_CMD;
+ cmd->tc = rqst->tc;
+ cmd->unknown1 = 0x01;
+ cmd->unknown2 = 0x00;
+ cmd->iid = rqst->iid;
+ cmd->rqid_lo = rqid_lo;
+ cmd->rqid_hi = rqid_hi;
+ cmd->cid = rqst->cid;
+
+ writer->ptr += sizeof(*cmd);
+
+ surfacegen5_ssh_write_buf(writer, rqst->pld, rqst->cdl);
+ surfacegen5_ssh_write_crc(writer, begin, writer->ptr - begin);
+}
+
+inline static void surfacegen5_ssh_write_ack(struct surfacegen5_ec_writer *writer, u8 seq)
+{
+ struct surfacegen5_frame_ctrl *ack = (struct surfacegen5_frame_ctrl *)writer->ptr;
+ u8 *begin = writer->ptr;
+
+ ack->type = SG5_FRAME_TYPE_ACK;
+ ack->len = 0x00;
+ ack->pad = 0x00;
+ ack->seq = seq;
+
+ writer->ptr += sizeof(*ack);
+
+ surfacegen5_ssh_write_crc(writer, begin, writer->ptr - begin);
+}
+
+inline static void surfacegen5_ssh_writer_reset(struct surfacegen5_ec_writer *writer)
+{
+ writer->ptr = writer->data;
+}
+
+inline static int surfacegen5_ssh_writer_flush(struct surfacegen5_ec *ec)
+{
+ struct surfacegen5_ec_writer *writer = &ec->writer;
+ struct serdev_device *serdev = ec->serdev;
+
+ size_t len = writer->ptr - writer->data;
+
+ dev_dbg(&ec->serdev->dev, "sending message\n");
+ print_hex_dump_debug("send: ", DUMP_PREFIX_OFFSET, 16, 1,
+ writer->data, writer->ptr - writer->data, false);
+
+ return serdev_device_write(serdev, writer->data, len, SG5_WRITE_TIMEOUT);
+}
+
+inline static void surfacegen5_ssh_write_msg_cmd(struct surfacegen5_ec *ec,
+ const struct surfacegen5_rqst *rqst)
+{
+ surfacegen5_ssh_writer_reset(&ec->writer);
+ surfacegen5_ssh_write_syn(&ec->writer);
+ surfacegen5_ssh_write_hdr(&ec->writer, rqst, ec);
+ surfacegen5_ssh_write_cmd(&ec->writer, rqst, ec);
+}
+
+inline static void surfacegen5_ssh_write_msg_ack(struct surfacegen5_ec *ec, u8 seq)
+{
+ surfacegen5_ssh_writer_reset(&ec->writer);
+ surfacegen5_ssh_write_syn(&ec->writer);
+ surfacegen5_ssh_write_ack(&ec->writer, seq);
+ surfacegen5_ssh_write_ter(&ec->writer);
+}
+
+inline static void surfacegen5_ssh_receiver_restart(struct surfacegen5_ec *ec,
+ const struct surfacegen5_rqst *rqst)
+{
+ unsigned long flags;
+
+ spin_lock_irqsave(&ec->receiver.lock, flags);
+ reinit_completion(&ec->receiver.signal);
+ ec->receiver.state = SG5_RCV_CONTROL;
+ ec->receiver.expect.pld = rqst->snc;
+ ec->receiver.expect.seq = ec->counter.seq;
+ ec->receiver.expect.rqid = surfacegen5_rqid_to_rqst(ec->counter.rqid);
+ ec->receiver.eval_buf.len = 0;
+ spin_unlock_irqrestore(&ec->receiver.lock, flags);
+}
+
+inline static void surfacegen5_ssh_receiver_discard(struct surfacegen5_ec *ec)
+{
+ unsigned long flags;
+
+ spin_lock_irqsave(&ec->receiver.lock, flags);
+ ec->receiver.state = SG5_RCV_DISCARD;
+ ec->receiver.eval_buf.len = 0;
+ kfifo_reset(&ec->receiver.fifo);
+ spin_unlock_irqrestore(&ec->receiver.lock, flags);
+}
+
+static int surfacegen5_ec_rqst_unlocked(struct surfacegen5_ec *ec,
+ const struct surfacegen5_rqst *rqst,
+ struct surfacegen5_buf *result)
+{
+ struct device *dev = &ec->serdev->dev;
+ struct surfacegen5_fifo_packet packet = {};
+ int status;
+ int try;
+ unsigned int rem;
+
+ if (rqst->cdl > SURFACEGEN5_MAX_RQST_PAYLOAD) {
+ dev_err(dev, SG5_RQST_TAG "request payload too large\n");
+ return -EINVAL;
+ }
+
+ // write command in buffer, we may need it multiple times
+ surfacegen5_ssh_write_msg_cmd(ec, rqst);
+ surfacegen5_ssh_receiver_restart(ec, rqst);
+
+ // send command, try to get an ack response
+ for (try = 0; try < SG5_NUM_RETRY; try++) {
+ status = surfacegen5_ssh_writer_flush(ec);
+ if (status) {
+ goto ec_rqst_out;
+ }
+
+ rem = wait_for_completion_timeout(&ec->receiver.signal, SG5_READ_TIMEOUT);
+ if (rem) {
+ // completion assures valid packet, thus ignore returned length
+ (void) !kfifo_out(&ec->receiver.fifo, &packet, sizeof(packet));
+
+ if (packet.type == SG5_FRAME_TYPE_ACK) {
+ break;
+ }
+ }
+ }
+
+ // check if we ran out of tries?
+ if (try >= SG5_NUM_RETRY) {
+ dev_err(dev, SG5_RQST_TAG "communication failed %d times, giving up\n", try);
+ status = -EIO;
+ goto ec_rqst_out;
+ }
+
+ ec->counter.seq += 1;
+ ec->counter.rqid += 1;
+
+ // get command response/payload
+ if (rqst->snc && result) {
+ rem = wait_for_completion_timeout(&ec->receiver.signal, SG5_READ_TIMEOUT);
+ if (rem) {
+ // completion assures valid packet, thus ignore returned length
+ (void) !kfifo_out(&ec->receiver.fifo, &packet, sizeof(packet));
+
+ if (result->cap < packet.len) {
+ status = -EINVAL;
+ goto ec_rqst_out;
+ }
+
+ // completion assures valid packet, thus ignore returned length
+ (void) !kfifo_out(&ec->receiver.fifo, result->data, packet.len);
+ result->len = packet.len;
+ } else {
+ dev_err(dev, SG5_RQST_TAG "communication timed out\n");
+ status = -EIO;
+ goto ec_rqst_out;
+ }
+
+ // send ACK
+ surfacegen5_ssh_write_msg_ack(ec, packet.seq);
+ status = surfacegen5_ssh_writer_flush(ec);
+ if (status) {
+ goto ec_rqst_out;
+ }
+ }
+
+ec_rqst_out:
+ surfacegen5_ssh_receiver_discard(ec);
+ return status;
+}
+
+int surfacegen5_ec_rqst(const struct surfacegen5_rqst *rqst, struct surfacegen5_buf *result)
+{
+ struct surfacegen5_ec *ec;
+ int status;
+
+ ec = surfacegen5_ec_acquire_init();
+ if (!ec) {
+ printk(KERN_WARNING SG5_RQST_TAG_FULL "embedded controller is uninitialized\n");
+ return -ENXIO;
+ }
+
+ if (ec->state == SG5_EC_SUSPENDED) {
+ dev_warn(&ec->serdev->dev, SG5_RQST_TAG "embedded controller is suspended\n");
+
+ surfacegen5_ec_release(ec);
+ return -EPERM;
+ }
+
+ status = surfacegen5_ec_rqst_unlocked(ec, rqst, result);
+
+ surfacegen5_ec_release(ec);
+ return status;
+}
+
+
+static int surfacegen5_ssh_ec_resume(struct surfacegen5_ec *ec)
+{
+ u8 buf[1] = { 0x00 };
+
+ struct surfacegen5_rqst rqst = {
+ .tc = 0x01,
+ .iid = 0x00,
+ .cid = 0x16,
+ .snc = 0x01,
+ .cdl = 0x00,
+ .pld = NULL,
+ };
+
+ struct surfacegen5_buf result = {
+ result.cap = ARRAY_SIZE(buf),
+ result.len = 0,
+ result.data = buf,
+ };
+
+ int status = surfacegen5_ec_rqst_unlocked(ec, &rqst, &result);
+ if (status) {
+ return status;
+ }
+
+ if (buf[0] != 0x00) {
+ dev_warn(&ec->serdev->dev,
+ "unexpected result while trying to resume EC: 0x%02x\n",
+ buf[0]);
+ }
+
+ return 0;
+}
+
+static int surfacegen5_ssh_ec_suspend(struct surfacegen5_ec *ec)
+{
+ u8 buf[1] = { 0x00 };
+
+ struct surfacegen5_rqst rqst = {
+ .tc = 0x01,
+ .iid = 0x00,
+ .cid = 0x15,
+ .snc = 0x01,
+ .cdl = 0x00,
+ .pld = NULL,
+ };
+
+ struct surfacegen5_buf result = {
+ result.cap = ARRAY_SIZE(buf),
+ result.len = 0,
+ result.data = buf,
+ };
+
+ int status = surfacegen5_ec_rqst_unlocked(ec, &rqst, &result);
+ if (status) {
+ return status;
+ }
+
+ if (buf[0] != 0x00) {
+ dev_warn(&ec->serdev->dev,
+ "unexpected result while trying to suspend EC: 0x%02x\n",
+ buf[0]);
+ }
+
+ return 0;
+}
+
+
+inline static bool surfacegen5_ssh_is_valid_syn(const u8 *ptr)
+{
+ return ptr[0] == 0xaa && ptr[1] == 0x55;
+}
+
+inline static bool surfacegen5_ssh_is_valid_ter(const u8 *ptr)
+{
+ return ptr[0] == 0xff && ptr[1] == 0xff;
+}
+
+inline static bool surfacegen5_ssh_is_valid_crc(const u8 *begin, const u8 *end)
+{
+ u16 crc = surfacegen5_ssh_crc(begin, end - begin);
+ return (end[0] == (crc & 0xff)) && (end[1] == (crc >> 8));
+}
+
+
+static int surfacegen5_ssh_send_ack(struct surfacegen5_ec *ec, u8 seq)
+{
+ u8 buf[SG5_MSG_LEN_CTRL];
+ u16 crc;
+
+ buf[0] = 0xaa;
+ buf[1] = 0x55;
+ buf[2] = 0x40;
+ buf[3] = 0x00;
+ buf[4] = 0x00;
+ buf[5] = seq;
+
+ crc = surfacegen5_ssh_crc(buf + SG5_FRAME_OFFS_CTRL, SG5_BYTELEN_CTRL);
+ buf[6] = crc & 0xff;
+ buf[7] = crc >> 8;
+
+ buf[8] = 0xff;
+ buf[9] = 0xff;
+
+ dev_dbg(&ec->serdev->dev, "sending message\n");
+ print_hex_dump_debug("send: ", DUMP_PREFIX_OFFSET, 16, 1,
+ buf, SG5_MSG_LEN_CTRL, false);
+
+ return serdev_device_write(ec->serdev, buf, SG5_MSG_LEN_CTRL, SG5_WRITE_TIMEOUT);
+}
+
+static void surfacegen5_event_work_ack_handler(struct work_struct *_work)
+{
+ struct surfacegen5_event_work *work;
+ struct surfacegen5_event *event;
+ struct surfacegen5_ec *ec;
+ struct device *dev;
+ int status;
+
+ work = container_of(_work, struct surfacegen5_event_work, work_ack);
+ event = &work->event;
+ ec = work->ec;
+ dev = &ec->serdev->dev;
+
+ // make sure we load a fresh ec state
+ smp_mb();
+
+ if (ec->state == SG5_EC_INITIALIZED) {
+ status = surfacegen5_ssh_send_ack(ec, work->seq);
+ if (status) {
+ dev_err(dev, SG5_EVENT_TAG "failed to send ACK: %d\n", status);
+ }
+ }
+
+ if (refcount_dec_and_test(&work->refcount)) {
+ kfree(work);
+ }
+}
+
+static void surfacegen5_event_work_evt_handler(struct work_struct *_work)
+{
+ struct delayed_work *dwork = (struct delayed_work *)_work;
+ struct surfacegen5_event_work *work;
+ struct surfacegen5_event *event;
+ struct surfacegen5_ec *ec;
+ struct device *dev;
+ unsigned long flags;
+
+ surfacegen5_ec_event_handler_fn handler;
+ void *handler_data;
+
+ int status = 0;
+
+ work = container_of(dwork, struct surfacegen5_event_work, work_evt);
+ event = &work->event;
+ ec = work->ec;
+ dev = &ec->serdev->dev;
+
+ spin_lock_irqsave(&ec->events.lock, flags);
+ handler = ec->events.handler[event->rqid - 1].handler;
+ handler_data = ec->events.handler[event->rqid - 1].data;
+ spin_unlock_irqrestore(&ec->events.lock, flags);
+
+ /*
+ * During handler removal or driver release, we ensure every event gets
+ * handled before return of that function. Thus a handler obtained here is
+ * guaranteed to be valid at least until this function returns.
+ */
+
+ if (handler) {
+ status = handler(event, handler_data);
+ } else {
+ dev_warn(dev, SG5_EVENT_TAG "unhandled event (rqid: %04x)\n", event->rqid);
+ }
+
+ if (status) {
+ dev_err(dev, SG5_EVENT_TAG "error handling event: %d\n", status);
+ }
+
+ if (refcount_dec_and_test(&work->refcount)) {
+ kfree(work);
+ }
+}
+
+static void surfacegen5_ssh_handle_event(struct surfacegen5_ec *ec, const u8 *buf)
+{
+ struct device *dev = &ec->serdev->dev;
+ const struct surfacegen5_frame_ctrl *ctrl;
+ const struct surfacegen5_frame_cmd *cmd;
+ struct surfacegen5_event_work *work;
+ unsigned long flags;
+ u16 pld_len;
+
+ surfacegen5_ec_event_handler_delay delay_fn;
+ void *handler_data;
+ unsigned long delay = 0;
+
+ ctrl = (const struct surfacegen5_frame_ctrl *)(buf + SG5_FRAME_OFFS_CTRL);
+ cmd = (const struct surfacegen5_frame_cmd *)(buf + SG5_FRAME_OFFS_CMD);
+
+ pld_len = ctrl->len - SG5_BYTELEN_CMDFRAME;
+
+ work = kzalloc(sizeof(struct surfacegen5_event_work) + pld_len, GFP_ATOMIC);
+ if (!work) {
+ dev_warn(dev, SG5_EVENT_TAG "failed to allocate memory, dropping event\n");
+ return;
+ }
+
+ refcount_set(&work->refcount, 2);
+ work->ec = ec;
+ work->seq = ctrl->seq;
+ work->event.rqid = (cmd->rqid_hi << 8) | cmd->rqid_lo;
+ work->event.tc = cmd->tc;
+ work->event.iid = cmd->iid;
+ work->event.cid = cmd->cid;
+ work->event.len = pld_len;
+ work->event.pld = ((u8*) work) + sizeof(struct surfacegen5_event_work);
+
+ memcpy(work->event.pld, buf + SG5_FRAME_OFFS_CMD_PLD, pld_len);
+
+ INIT_WORK(&work->work_ack, surfacegen5_event_work_ack_handler);
+ queue_work(ec->events.queue_ack, &work->work_ack);
+
+ spin_lock_irqsave(&ec->events.lock, flags);
+ handler_data = ec->events.handler[work->event.rqid - 1].data;
+ delay_fn = ec->events.handler[work->event.rqid - 1].delay;
+ if (delay_fn) {
+ delay = delay_fn(&work->event, handler_data);
+ }
+ spin_unlock_irqrestore(&ec->events.lock, flags);
+
+ // immediate execution for high priority events (e.g. keyboard)
+ if (delay == SURFACEGEN5_EVENT_IMMEDIATE) {
+ surfacegen5_event_work_evt_handler(&work->work_evt.work);
+ } else {
+ INIT_DELAYED_WORK(&work->work_evt, surfacegen5_event_work_evt_handler);
+ queue_delayed_work(ec->events.queue_evt, &work->work_evt, delay);
+ }
+}
+
+static int surfacegen5_ssh_receive_msg_ctrl(struct surfacegen5_ec *ec,
+ const u8 *buf, size_t size)
+{
+ struct device *dev = &ec->serdev->dev;
+ struct surfacegen5_ec_receiver *rcv = &ec->receiver;
+ const struct surfacegen5_frame_ctrl *ctrl;
+ struct surfacegen5_fifo_packet packet;
+
+ const u8 *ctrl_begin = buf + SG5_FRAME_OFFS_CTRL;
+ const u8 *ctrl_end = buf + SG5_FRAME_OFFS_CTRL_CRC;
+
+ ctrl = (const struct surfacegen5_frame_ctrl *)(ctrl_begin);
+
+ // actual length check
+ if (size < SG5_MSG_LEN_CTRL) {
+ return 0; // need more bytes
+ }
+
+ // validate TERM
+ if (!surfacegen5_ssh_is_valid_ter(buf + SG5_FRAME_OFFS_TERM)) {
+ dev_err(dev, SG5_RECV_TAG "invalid end of message\n");
+ return size; // discard everything
+ }
+
+ // validate CRC
+ if (!surfacegen5_ssh_is_valid_crc(ctrl_begin, ctrl_end)) {
+ dev_err(dev, SG5_RECV_TAG "invalid checksum (ctrl)\n");
+ return SG5_MSG_LEN_CTRL; // only discard message
+ }
+
+ // check if we expect the message
+ if (rcv->state != SG5_RCV_CONTROL) {
+ dev_err(dev, SG5_RECV_TAG "discarding message: ctrl not expected\n");
+ return SG5_MSG_LEN_CTRL; // discard message
+ }
+
+ // check if it is for our request
+ if (ctrl->type == SG5_FRAME_TYPE_ACK && ctrl->seq != rcv->expect.seq) {
+ dev_err(dev, SG5_RECV_TAG "discarding message: ack does not match\n");
+ return SG5_MSG_LEN_CTRL; // discard message
+ }
+
+ // we now have a valid & expected ACK/RETRY message
+ dev_dbg(dev, SG5_RECV_TAG "valid control message received (type: 0x%02x)\n", ctrl->type);
+
+ packet.type = ctrl->type;
+ packet.seq = ctrl->seq;
+ packet.len = 0;
+
+ if (kfifo_avail(&rcv->fifo) >= sizeof(packet)) {
+ kfifo_in(&rcv->fifo, (u8 *) &packet, sizeof(packet));
+
+ } else {
+ dev_warn(dev, SG5_RECV_TAG
+ "dropping frame: not enough space in fifo (type = %d)\n",
+ SG5_FRAME_TYPE_CMD);
+
+ return SG5_MSG_LEN_CTRL; // discard message
+ }
+
+ // update decoder state
+ if (ctrl->type == SG5_FRAME_TYPE_ACK) {
+ rcv->state = rcv->expect.pld
+ ? SG5_RCV_COMMAND
+ : SG5_RCV_DISCARD;
+ }
+
+ complete(&rcv->signal);
+ return SG5_MSG_LEN_CTRL; // handled message
+}
+
+static int surfacegen5_ssh_receive_msg_cmd(struct surfacegen5_ec *ec,
+ const u8 *buf, size_t size)
+{
+ struct device *dev = &ec->serdev->dev;
+ struct surfacegen5_ec_receiver *rcv = &ec->receiver;
+ const struct surfacegen5_frame_ctrl *ctrl;
+ const struct surfacegen5_frame_cmd *cmd;
+ struct surfacegen5_fifo_packet packet;
+
+ const u8 *ctrl_begin = buf + SG5_FRAME_OFFS_CTRL;
+ const u8 *ctrl_end = buf + SG5_FRAME_OFFS_CTRL_CRC;
+ const u8 *cmd_begin = buf + SG5_FRAME_OFFS_CMD;
+ const u8 *cmd_begin_pld = buf + SG5_FRAME_OFFS_CMD_PLD;
+ const u8 *cmd_end;
+
+ size_t msg_len;
+
+ ctrl = (const struct surfacegen5_frame_ctrl *)(ctrl_begin);
+ cmd = (const struct surfacegen5_frame_cmd *)(cmd_begin);
+
+ // we need at least a full control frame
+ if (size < (SG5_BYTELEN_SYNC + SG5_BYTELEN_CTRL + SG5_BYTELEN_CRC)) {
+ return 0; // need more bytes
+ }
+
+ // validate control-frame CRC
+ if (!surfacegen5_ssh_is_valid_crc(ctrl_begin, ctrl_end)) {
+ dev_err(dev, SG5_RECV_TAG "invalid checksum (cmd-ctrl)\n");
+ /*
+ * We can't be sure here if length is valid, thus
+ * discard everything.
+ */
+ return size;
+ }
+
+ // actual length check (ctrl->len contains command-frame but not crc)
+ msg_len = SG5_MSG_LEN_CMD_BASE + ctrl->len;
+ if (size < msg_len) {
+ return 0; // need more bytes
+ }
+
+ cmd_end = cmd_begin + ctrl->len;
+
+ // validate command-frame type
+ if (cmd->type != SG5_FRAME_TYPE_CMD) {
+ dev_err(dev, SG5_RECV_TAG "expected command frame type but got 0x%02x\n", cmd->type);
+ return size; // discard everything
+ }
+
+ // validate command-frame CRC
+ if (!surfacegen5_ssh_is_valid_crc(cmd_begin, cmd_end)) {
+ dev_err(dev, SG5_RECV_TAG "invalid checksum (cmd-pld)\n");
+
+ /*
+ * The message length is provided in the control frame. As we
+ * already validated that, we can be sure here that it's
+ * correct, so we only need to discard the message.
+ */
+ return msg_len;
+ }
+
+ // check if we received an event notification
+ if (surfacegen5_rqid_is_event((cmd->rqid_hi << 8) | cmd->rqid_lo)) {
+ surfacegen5_ssh_handle_event(ec, buf);
+ return msg_len; // handled message
+ }
+
+ // check if we expect the message
+ if (rcv->state != SG5_RCV_COMMAND) {
+ dev_dbg(dev, SG5_RECV_TAG "discarding message: command not expected\n");
+ return msg_len; // discard message
+ }
+
+ // check if response is for our request
+ if (rcv->expect.rqid != (cmd->rqid_lo | (cmd->rqid_hi << 8))) {
+ dev_dbg(dev, SG5_RECV_TAG "discarding message: command not a match\n");
+ return msg_len; // discard message
+ }
+
+ // we now have a valid & expected command message
+ dev_dbg(dev, SG5_RECV_TAG "valid command message received\n");
+
+ packet.type = ctrl->type;
+ packet.seq = ctrl->seq;
+ packet.len = cmd_end - cmd_begin_pld;
+
+ if (kfifo_avail(&rcv->fifo) >= sizeof(packet) + packet.len) {
+ kfifo_in(&rcv->fifo, &packet, sizeof(packet));
+ kfifo_in(&rcv->fifo, cmd_begin_pld, packet.len);
+
+ } else {
+ dev_warn(dev, SG5_RECV_TAG
+ "dropping frame: not enough space in fifo (type = %d)\n",
+ SG5_FRAME_TYPE_CMD);
+
+ return SG5_MSG_LEN_CTRL; // discard message
+ }
+
+ rcv->state = SG5_RCV_DISCARD;
+
+ complete(&rcv->signal);
+ return msg_len; // handled message
+}
+
+static int surfacegen5_ssh_eval_buf(struct surfacegen5_ec *ec,
+ const u8 *buf, size_t size)
+{
+ struct device *dev = &ec->serdev->dev;
+ struct surfacegen5_frame_ctrl *ctrl;
+
+ // we need at least a control frame to check what to do
+ if (size < (SG5_BYTELEN_SYNC + SG5_BYTELEN_CTRL)) {
+ return 0; // need more bytes
+ }
+
+ // make sure we're actually at the start of a new message
+ if (!surfacegen5_ssh_is_valid_syn(buf)) {
+ dev_err(dev, SG5_RECV_TAG "invalid start of message\n");
+ return size; // discard everything
+ }
+
+ // handle individual message types seperately
+ ctrl = (struct surfacegen5_frame_ctrl *)(buf + SG5_FRAME_OFFS_CTRL);
+
+ switch (ctrl->type) {
+ case SG5_FRAME_TYPE_ACK:
+ case SG5_FRAME_TYPE_RETRY:
+ return surfacegen5_ssh_receive_msg_ctrl(ec, buf, size);
+
+ case SG5_FRAME_TYPE_CMD:
+ return surfacegen5_ssh_receive_msg_cmd(ec, buf, size);
+
+ default:
+ dev_err(dev, SG5_RECV_TAG "unknown frame type 0x%02x\n", ctrl->type);
+ return size; // discard everything
+ }
+}
+
+static int surfacegen5_ssh_receive_buf(struct serdev_device *serdev,
+ const unsigned char *buf, size_t size)
+{
+ struct surfacegen5_ec *ec = serdev_device_get_drvdata(serdev);
+ struct surfacegen5_ec_receiver *rcv = &ec->receiver;
+ unsigned long flags;
+ int offs = 0;
+ int used, n;
+
+ dev_dbg(&serdev->dev, SG5_RECV_TAG "received buffer (size: %zu)\n", size);
+ print_hex_dump_debug(SG5_RECV_TAG, DUMP_PREFIX_OFFSET, 16, 1, buf, size, false);
+
+ /*
+ * The battery _BIX message gets a bit long, thus we have to add some
+ * additional buffering here.
+ */
+
+ spin_lock_irqsave(&rcv->lock, flags);
+
+ // copy to eval-buffer
+ used = min(size, (size_t)(rcv->eval_buf.cap - rcv->eval_buf.len));
+ memcpy(rcv->eval_buf.ptr + rcv->eval_buf.len, buf, used);
+ rcv->eval_buf.len += used;
+
+ // evaluate buffer until we need more bytes or eval-buf is empty
+ while (offs < rcv->eval_buf.len) {
+ n = rcv->eval_buf.len - offs;
+ n = surfacegen5_ssh_eval_buf(ec, rcv->eval_buf.ptr + offs, n);
+ if (n <= 0) break; // need more bytes
+
+ offs += n;
+ }
+
+ // throw away the evaluated parts
+ rcv->eval_buf.len -= offs;
+ memmove(rcv->eval_buf.ptr, rcv->eval_buf.ptr + offs, rcv->eval_buf.len);
+
+ spin_unlock_irqrestore(&rcv->lock, flags);
+
+ return used;
+}
+
+
+static acpi_status
+surfacegen5_ssh_setup_from_resource(struct acpi_resource *resource, void *context)
+{
+ struct serdev_device *serdev = context;
+ struct acpi_resource_common_serialbus *serial;
+ struct acpi_resource_uart_serialbus *uart;
+ int status = 0;
+
+ if (resource->type != ACPI_RESOURCE_TYPE_SERIAL_BUS) {
+ return AE_OK;
+ }
+
+ serial = &resource->data.common_serial_bus;
+ if (serial->type != ACPI_RESOURCE_SERIAL_TYPE_UART) {
+ return AE_OK;
+ }
+
+ uart = &resource->data.uart_serial_bus;
+
+ // set up serdev device
+ serdev_device_set_baudrate(serdev, uart->default_baud_rate);
+
+ // serdev currently only supports RTSCTS flow control
+ if (uart->flow_control & SG5_SUPPORTED_FLOW_CONTROL_MASK) {
+ dev_warn(&serdev->dev, "unsupported flow control (value: 0x%02x)\n", uart->flow_control);
+ }
+
+ // set RTSCTS flow control
+ serdev_device_set_flow_control(serdev, uart->flow_control & ACPI_UART_FLOW_CONTROL_HW);
+
+ // serdev currently only supports EVEN/ODD parity
+ switch (uart->parity) {
+ case ACPI_UART_PARITY_NONE:
+ status = serdev_device_set_parity(serdev, SERDEV_PARITY_NONE);
+ break;
+ case ACPI_UART_PARITY_EVEN:
+ status = serdev_device_set_parity(serdev, SERDEV_PARITY_EVEN);
+ break;
+ case ACPI_UART_PARITY_ODD:
+ status = serdev_device_set_parity(serdev, SERDEV_PARITY_ODD);
+ break;
+ default:
+ dev_warn(&serdev->dev, "unsupported parity (value: 0x%02x)\n", uart->parity);
+ break;
+ }
+
+ if (status) {
+ dev_err(&serdev->dev, "failed to set parity (value: 0x%02x)\n", uart->parity);
+ return status;
+ }
+
+ return AE_CTRL_TERMINATE; // we've found the resource and are done
+}
+
+
+static bool surfacegen5_idma_filter(struct dma_chan *chan, void *param)
+{
+ // see dw8250_idma_filter
+ return param == chan->device->dev->parent;
+}
+
+static int surfacegen5_ssh_check_dma(struct serdev_device *serdev)
+{
+ struct device *dev = serdev->ctrl->dev.parent;
+ struct dma_chan *rx, *tx;
+ dma_cap_mask_t mask;
+ int status = 0;
+
+ /*
+ * The EC UART requires DMA for proper communication. If we don't use DMA,
+ * we'll drop bytes when the system has high load, e.g. during boot. This
+ * causes some ugly behaviour, i.e. battery information (_BIX) messages
+ * failing frequently. We're making sure the required DMA channels are
+ * available here so serial8250_do_startup is able to grab them later
+ * instead of silently falling back to a non-DMA approach.
+ */
+
+ dma_cap_zero(mask);
+ dma_cap_set(DMA_SLAVE, mask);
+
+ rx = dma_request_slave_channel_compat(mask, surfacegen5_idma_filter, dev->parent, dev, "rx");
+ if (IS_ERR_OR_NULL(rx)) {
+ status = rx ? PTR_ERR(rx) : -EPROBE_DEFER;
+ if (status != -EPROBE_DEFER) {
+ dev_err(&serdev->dev, "sg5_dma: error requesting rx channel: %d\n", status);
+ } else {
+ dev_dbg(&serdev->dev, "sg5_dma: rx channel not found, deferring probe\n");
+ }
+ goto check_dma_out;
+ }
+
+ tx = dma_request_slave_channel_compat(mask, surfacegen5_idma_filter, dev->parent, dev, "tx");
+ if (IS_ERR_OR_NULL(tx)) {
+ status = tx ? PTR_ERR(tx) : -EPROBE_DEFER;
+ if (status != -EPROBE_DEFER) {
+ dev_err(&serdev->dev, "sg5_dma: error requesting tx channel: %d\n", status);
+ } else {
+ dev_dbg(&serdev->dev, "sg5_dma: tx channel not found, deferring probe\n");
+ }
+ goto check_dma_release_rx;
+ }
+
+ dma_release_channel(tx);
+check_dma_release_rx:
+ dma_release_channel(rx);
+check_dma_out:
+ return status;
+}
+
+
+static int surfacegen5_ssh_suspend(struct device *dev)
+{
+ struct surfacegen5_ec *ec;
+ int status = 0;
+
+ dev_dbg(dev, "suspending\n");
+
+ ec = surfacegen5_ec_acquire_init();
+ if (ec) {
+ status = surfacegen5_ssh_ec_suspend(ec);
+ if (status) {
+ dev_err(dev, "failed to suspend EC: %d\n", status);
+ }
+
+ ec->state = SG5_EC_SUSPENDED;
+ surfacegen5_ec_release(ec);
+ }
+
+ return status;
+}
+
+static int surfacegen5_ssh_resume(struct device *dev)
+{
+ struct surfacegen5_ec *ec;
+ int status = 0;
+
+ dev_dbg(dev, "resuming\n");
+
+ ec = surfacegen5_ec_acquire_init();
+ if (ec) {
+ ec->state = SG5_EC_INITIALIZED;
+
+ status = surfacegen5_ssh_ec_resume(ec);
+ if (status) {
+ dev_err(dev, "failed to resume EC: %d\n", status);
+ }
+
+ surfacegen5_ec_release(ec);
+ }
+
+ return status;
+}
+
+static SIMPLE_DEV_PM_OPS(surfacegen5_ssh_pm_ops, surfacegen5_ssh_suspend, surfacegen5_ssh_resume);
+
+
+static const struct serdev_device_ops surfacegen5_ssh_device_ops = {
+ .receive_buf = surfacegen5_ssh_receive_buf,
+ .write_wakeup = serdev_device_write_wakeup,
+};
+
+static int surfacegen5_acpi_ssh_probe(struct serdev_device *serdev)
+{
+ struct surfacegen5_ec *ec;
+ struct workqueue_struct *event_queue_ack;
+ struct workqueue_struct *event_queue_evt;
+ u8 *write_buf;
+ u8 *read_buf;
+ u8 *eval_buf;
+ acpi_handle *ssh = ACPI_HANDLE(&serdev->dev);
+ acpi_status status;
+
+ dev_dbg(&serdev->dev, "probing\n");
+
+ // ensure DMA is ready before we set up the device
+ status = surfacegen5_ssh_check_dma(serdev);
+ if (status) {
+ return status;
+ }
+
+ // allocate buffers
+ write_buf = kzalloc(SG5_WRITE_BUF_LEN, GFP_KERNEL);
+ if (!write_buf) {
+ status = -ENOMEM;
+ goto err_ssh_probe_write_buf;
+ }
+
+ read_buf = kzalloc(SG5_READ_BUF_LEN, GFP_KERNEL);
+ if (!read_buf) {
+ status = -ENOMEM;
+ goto err_ssh_probe_read_buf;
+ }
+
+ eval_buf = kzalloc(SG5_EVAL_BUF_LEN, GFP_KERNEL);
+ if (!eval_buf) {
+ status = -ENOMEM;
+ goto err_ssh_probe_eval_buf;
+ }
+
+ event_queue_ack = create_singlethread_workqueue("sg5_ackq");
+ if (!event_queue_ack) {
+ status = -ENOMEM;
+ goto err_ssh_probe_ackq;
+ }
+
+ event_queue_evt = create_workqueue("sg5_evtq");
+ if (!event_queue_evt) {
+ status = -ENOMEM;
+ goto err_ssh_probe_evtq;
+ }
+
+ // set up EC
+ ec = surfacegen5_ec_acquire();
+ if (ec->state != SG5_EC_UNINITIALIZED) {
+ dev_err(&serdev->dev, "embedded controller already initialized\n");
+ surfacegen5_ec_release(ec);
+
+ status = -EBUSY;
+ goto err_ssh_probe_busy;
+ }
+
+ ec->serdev = serdev;
+ ec->writer.data = write_buf;
+ ec->writer.ptr = write_buf;
+
+ // initialize receiver
+ init_completion(&ec->receiver.signal);
+ kfifo_init(&ec->receiver.fifo, read_buf, SG5_READ_BUF_LEN);
+ ec->receiver.eval_buf.ptr = eval_buf;
+ ec->receiver.eval_buf.cap = SG5_EVAL_BUF_LEN;
+ ec->receiver.eval_buf.len = 0;
+
+ // initialize event handling
+ ec->events.queue_ack = event_queue_ack;
+ ec->events.queue_evt = event_queue_evt;
+
+ ec->state = SG5_EC_INITIALIZED;
+
+ serdev_device_set_drvdata(serdev, ec);
+
+ // ensure everything is properly set-up before we open the device
+ smp_mb();
+
+ serdev_device_set_client_ops(serdev, &surfacegen5_ssh_device_ops);
+ status = serdev_device_open(serdev);
+ if (status) {
+ goto err_ssh_probe_open;
+ }
+
+ status = acpi_walk_resources(ssh, METHOD_NAME__CRS,
+ surfacegen5_ssh_setup_from_resource, serdev);
+ if (ACPI_FAILURE(status)) {
+ goto err_ssh_probe_devinit;
+ }
+
+ status = surfacegen5_ssh_ec_resume(ec);
+ if (status) {
+ goto err_ssh_probe_devinit;
+ }
+
+ surfacegen5_ec_release(ec);
+ acpi_walk_dep_device_list(ssh);
+
+ return 0;
+
+err_ssh_probe_devinit:
+ serdev_device_close(serdev);
+err_ssh_probe_open:
+ ec->state = SG5_EC_UNINITIALIZED;
+ serdev_device_set_drvdata(serdev, NULL);
+ surfacegen5_ec_release(ec);
+err_ssh_probe_busy:
+ destroy_workqueue(event_queue_evt);
+err_ssh_probe_evtq:
+ destroy_workqueue(event_queue_ack);
+err_ssh_probe_ackq:
+ kfree(eval_buf);
+err_ssh_probe_eval_buf:
+ kfree(read_buf);
+err_ssh_probe_read_buf:
+ kfree(write_buf);
+err_ssh_probe_write_buf:
+ return status;
+}
+
+static void surfacegen5_acpi_ssh_remove(struct serdev_device *serdev)
+{
+ struct surfacegen5_ec *ec;
+ unsigned long flags;
+ int status;
+
+ ec = surfacegen5_ec_acquire_init();
+ if (!ec) {
+ return;
+ }
+
+ // suspend EC and disable events
+ status = surfacegen5_ssh_ec_suspend(ec);
+ if (status) {
+ dev_err(&serdev->dev, "failed to suspend EC: %d\n", status);
+ }
+
+ // make sure all events (received up to now) have been properly handled
+ flush_workqueue(ec->events.queue_ack);
+ flush_workqueue(ec->events.queue_evt);
+
+ // remove event handlers
+ spin_lock_irqsave(&ec->events.lock, flags);
+ memset(ec->events.handler, 0,
+ sizeof(struct surfacegen5_ec_event_handler)
+ * SG5_NUM_EVENT_TYPES);
+ spin_unlock_irqrestore(&ec->events.lock, flags);
+
+ // set device to deinitialized state
+ ec->state = SG5_EC_UNINITIALIZED;
+ ec->serdev = NULL;
+
+ // ensure state and serdev get set before continuing
+ smp_mb();
+
+ /*
+ * Flush any event that has not been processed yet to ensure we're not going to
+ * use the serial device any more (e.g. for ACKing).
+ */
+ flush_workqueue(ec->events.queue_ack);
+ flush_workqueue(ec->events.queue_evt);
+
+ serdev_device_close(serdev);
+
+ /*
+ * Only at this point, no new events can be received. Destroying the
+ * workqueue here flushes all remaining events. Those events will be
+ * silently ignored and neither ACKed nor any handler gets called.
+ */
+ destroy_workqueue(ec->events.queue_ack);
+ destroy_workqueue(ec->events.queue_evt);
+
+ // free writer
+ kfree(ec->writer.data);
+ ec->writer.data = NULL;
+ ec->writer.ptr = NULL;
+
+ // free receiver
+ spin_lock_irqsave(&ec->receiver.lock, flags);
+ ec->receiver.state = SG5_RCV_DISCARD;
+ kfifo_free(&ec->receiver.fifo);
+
+ kfree(ec->receiver.eval_buf.ptr);
+ ec->receiver.eval_buf.ptr = NULL;
+ ec->receiver.eval_buf.cap = 0;
+ ec->receiver.eval_buf.len = 0;
+ spin_unlock_irqrestore(&ec->receiver.lock, flags);
+
+ serdev_device_set_drvdata(serdev, NULL);
+ surfacegen5_ec_release(ec);
+}
+
+
+static const struct acpi_device_id surfacegen5_acpi_ssh_match[] = {
+ { "MSHW0084", 0 },
+ { },
+};
+MODULE_DEVICE_TABLE(acpi, surfacegen5_acpi_ssh_match);
+
+static struct serdev_device_driver surfacegen5_acpi_ssh = {
+ .probe = surfacegen5_acpi_ssh_probe,
+ .remove = surfacegen5_acpi_ssh_remove,
+ .driver = {
+ .name = "surfacegen5_acpi_ssh",
+ .acpi_match_table = ACPI_PTR(surfacegen5_acpi_ssh_match),
+ .pm = &surfacegen5_ssh_pm_ops,
+ },
+};
+
+#endif /* CONFIG_SURFACE_ACPI_SSH */
+
+
+/*************************************************************************
+ * Surface ACPI Notify driver
+ */
+
+#ifdef CONFIG_SURFACE_ACPI_SAN
+
+#define SG5_RQST_RETRY 5
+
+#define SG5_SAN_DSM_REVISION 0
+#define SG5_SAN_DSM_FN_NOTIFY_SENSOR_TRIP_POINT 0x09
+
+static const guid_t SG5_SAN_DSM_UUID =
+ GUID_INIT(0x93b666c5, 0x70c6, 0x469f, 0xa2, 0x15, 0x3d,
+ 0x48, 0x7c, 0x91, 0xab, 0x3c);
+
+#define SG5_EVENT_DELAY_POWER msecs_to_jiffies(5000)
+
+#define SG5_EVENT_PWR_TC 0x02
+#define SG5_EVENT_PWR_RQID 0x0002
+#define SG5_EVENT_PWR_CID_HWCHANGE 0x15
+#define SG5_EVENT_PWR_CID_CHARGING 0x16
+#define SG5_EVENT_PWR_CID_ADAPTER 0x17
+#define SG5_EVENT_PWR_CID_STATE 0x4f
+
+#define SG5_EVENT_TEMP_TC 0x03
+#define SG5_EVENT_TEMP_RQID 0x0003
+#define SG5_EVENT_TEMP_CID_NOTIFY_SENSOR_TRIP_POINT 0x0b
+
+#define SG5_SAN_RQST_TAG "san_rqst: "
+
+#define SG5_QUIRK_BASE_STATE_DELAY 1000
+
+
+struct surfacegen5_san_acpi_consumer {
+ char *path;
+ bool required;
+ u32 flags;
+};
+
+struct surfacegen5_san_opreg_context {
+ struct acpi_connection_info connection;
+ struct device *dev;
+};
+
+struct surfacegen5_san_consumers {
+ u32 num;
+ struct device_link **links;
+};
+
+struct surfacegen5_san_drvdata {
+ struct surfacegen5_san_opreg_context opreg_ctx;
+ struct surfacegen5_san_consumers consumers;
+ struct device_link *ec_link;
+};
+
+struct gsb_data_in {
+ u8 cv;
+} __packed;
+
+struct gsb_data_rqsx {
+ u8 cv; // command value (should be 0x01 or 0x03)
+ u8 tc; // target controller
+ u8 tid; // expected to be 0x01, could be revision
+ u8 iid; // target sub-controller (e.g. primary vs. secondary battery)
+ u8 snc; // expect-response-flag
+ u8 cid; // command ID
+ u8 cdl; // payload length
+ u8 _pad; // padding
+ u8 pld[0]; // payload
+} __packed;
+
+struct gsb_data_etwl {
+ u8 cv; // command value (should be 0x02)
+ u8 etw3; // ?
+ u8 etw4; // ?
+ u8 msg[0]; // error message (ASCIIZ)
+} __packed;
+
+struct gsb_data_out {
+ u8 status; // _SSH communication status
+ u8 len; // _SSH payload length
+ u8 pld[0]; // _SSH payload
+} __packed;
+
+union gsb_buffer_data {
+ struct gsb_data_in in; // common input
+ struct gsb_data_rqsx rqsx; // RQSX input
+ struct gsb_data_etwl etwl; // ETWL input
+ struct gsb_data_out out; // output
+};
+
+struct gsb_buffer {
+ u8 status; // GSB AttribRawProcess status
+ u8 len; // GSB AttribRawProcess length
+ union gsb_buffer_data data;
+} __packed;
+
+
+enum surfacegen5_pwr_event {
+ SURFACEGEN5_PWR_EVENT_BAT1_STAT = 0x03,
+ SURFACEGEN5_PWR_EVENT_BAT1_INFO = 0x04,
+ SURFACEGEN5_PWR_EVENT_ADP1_STAT = 0x05,
+ SURFACEGEN5_PWR_EVENT_ADP1_INFO = 0x06,
+ SURFACEGEN5_PWR_EVENT_BAT2_STAT = 0x07,
+ SURFACEGEN5_PWR_EVENT_BAT2_INFO = 0x08,
+};
+
+
+static int surfacegen5_acpi_notify_power_event(struct device *dev, enum surfacegen5_pwr_event event)
+{
+ acpi_handle san = ACPI_HANDLE(dev);
+ union acpi_object *obj;
+
+ obj = acpi_evaluate_dsm_typed(san, &SG5_SAN_DSM_UUID, SG5_SAN_DSM_REVISION,
+ (u8) event, NULL, ACPI_TYPE_BUFFER);
+
+ if (IS_ERR_OR_NULL(obj)) {
+ return obj ? PTR_ERR(obj) : -ENXIO;
+ }
+
+ if (obj->buffer.length != 1 || obj->buffer.pointer[0] != 0) {
+ dev_err(dev, "got unexpected result from _DSM\n");
+ return -EFAULT;
+ }
+
+ ACPI_FREE(obj);
+ return 0;
+}
+
+static int surfacegen5_acpi_notify_sensor_trip_point(struct device *dev, u8 iid)
+{
+ acpi_handle san = ACPI_HANDLE(dev);
+ union acpi_object *obj;
+ union acpi_object param;
+
+ param.type = ACPI_TYPE_INTEGER;
+ param.integer.value = iid;
+
+ obj = acpi_evaluate_dsm_typed(san, &SG5_SAN_DSM_UUID, SG5_SAN_DSM_REVISION,
+ SG5_SAN_DSM_FN_NOTIFY_SENSOR_TRIP_POINT,
+ &param, ACPI_TYPE_BUFFER);
+
+ if (IS_ERR_OR_NULL(obj)) {
+ return obj ? PTR_ERR(obj) : -ENXIO;
+ }
+
+ if (obj->buffer.length != 1 || obj->buffer.pointer[0] != 0) {
+ dev_err(dev, "got unexpected result from _DSM\n");
+ return -EFAULT;
+ }
+
+ ACPI_FREE(obj);
+ return 0;
+}
+
+
+inline static int surfacegen5_evt_power_adapter(struct device *dev, struct surfacegen5_event *event)
+{
+ int status;
+
+ status = surfacegen5_acpi_notify_power_event(dev, SURFACEGEN5_PWR_EVENT_ADP1_STAT);
+ if (status) {
+ dev_err(dev, "error handling power event (cid = %x)\n", event->cid);
+ return status;
+ }
+
+ return 0;
+}
+
+inline static int surfacegen5_evt_power_hwchange(struct device *dev, struct surfacegen5_event *event)
+{
+ enum surfacegen5_pwr_event evcode;
+ int status;
+
+ if (event->iid == 0x02) {
+ evcode = SURFACEGEN5_PWR_EVENT_BAT2_INFO;
+ } else {
+ evcode = SURFACEGEN5_PWR_EVENT_BAT1_INFO;
+ }
+
+ status = surfacegen5_acpi_notify_power_event(dev, evcode);
+ if (status) {
+ dev_err(dev, "error handling power event (cid = %x)\n", event->cid);
+ return status;
+ }
+
+ return 0;
+}
+
+inline static int surfacegen5_evt_power_state(struct device *dev, struct surfacegen5_event *event)
+{
+ int status;
+
+ status = surfacegen5_acpi_notify_power_event(dev, SURFACEGEN5_PWR_EVENT_BAT1_STAT);
+ if (status) {
+ dev_err(dev, "error handling power event (cid = %x)\n", event->cid);
+ return status;
+ }
+
+ status = surfacegen5_acpi_notify_power_event(dev, SURFACEGEN5_PWR_EVENT_BAT2_STAT);
+ if (status) {
+ dev_err(dev, "error handling power event (cid = %x)\n", event->cid);
+ return status;
+ }
+
+ return 0;
+}
+
+static unsigned long surfacegen5_evt_power_delay(struct surfacegen5_event *event, void *data)
+{
+ switch (event->cid) {
+ case SG5_EVENT_PWR_CID_CHARGING:
+ case SG5_EVENT_PWR_CID_STATE:
+ return SG5_EVENT_DELAY_POWER;
+
+ case SG5_EVENT_PWR_CID_ADAPTER:
+ case SG5_EVENT_PWR_CID_HWCHANGE:
+ default:
+ return 0;
+ }
+}
+
+static int surfacegen5_evt_power(struct surfacegen5_event *event, void *data)
+{
+ struct device *dev = (struct device *)data;
+
+ switch (event->cid) {
+ case SG5_EVENT_PWR_CID_HWCHANGE:
+ return surfacegen5_evt_power_hwchange(dev, event);
+
+ case SG5_EVENT_PWR_CID_ADAPTER:
+ return surfacegen5_evt_power_adapter(dev, event);
+
+ case SG5_EVENT_PWR_CID_CHARGING:
+ case SG5_EVENT_PWR_CID_STATE:
+ return surfacegen5_evt_power_state(dev, event);
+
+ default:
+ dev_warn(dev, "unhandled power event (cid = %x)\n", event->cid);
+ }
+
+ return 0;
+}
+
+
+inline static int surfacegen5_evt_thermal_notify(struct device *dev, struct surfacegen5_event *event)
+{
+ int status;
+
+ status = surfacegen5_acpi_notify_sensor_trip_point(dev, event->iid);
+ if (status) {
+ dev_err(dev, "error handling thermal event (cid = %x)\n", event->cid);
+ return status;
+ }
+
+ return 0;
+}
+
+static int surfacegen5_evt_thermal(struct surfacegen5_event *event, void *data)
+{
+ struct device *dev = (struct device *)data;
+
+ switch (event->cid) {
+ case SG5_EVENT_TEMP_CID_NOTIFY_SENSOR_TRIP_POINT:
+ return surfacegen5_evt_thermal_notify(dev, event);
+
+ default:
+ dev_warn(dev, "unhandled thermal event (cid = %x)\n", event->cid);
+ }
+
+ return 0;
+}
+
+
+static struct gsb_data_rqsx *surfacegen5_san_validate_rqsx(
+ struct device *dev, const char *type, struct gsb_buffer *buffer)
+{
+ struct gsb_data_rqsx *rqsx = &buffer->data.rqsx;
+
+ if (buffer->len < 8) {
+ dev_err(dev, "invalid %s package (len = %d)\n",
+ type, buffer->len);
+ return NULL;
+ }
+
+ if (rqsx->cdl != buffer->len - 8) {
+ dev_err(dev, "bogus %s package (len = %d, cdl = %d)\n",
+ type, buffer->len, rqsx->cdl);
+ return NULL;
+ }
+
+ if (rqsx->tid != 0x01) {
+ dev_warn(dev, "unsupported %s package (tid = 0x%02x)\n",
+ type, rqsx->tid);
+ return NULL;
+ }
+
+ return rqsx;
+}
+
+static acpi_status
+surfacegen5_san_etwl(struct surfacegen5_san_opreg_context *ctx, struct gsb_buffer *buffer)
+{
+ struct gsb_data_etwl *etwl = &buffer->data.etwl;
+
+ if (buffer->len < 3) {
+ dev_err(ctx->dev, "invalid ETWL package (len = %d)\n", buffer->len);
+ return AE_OK;
+ }
+
+ dev_err(ctx->dev, "ETWL(0x%02x, 0x%02x): %.*s\n",
+ etwl->etw3, etwl->etw4,
+ buffer->len - 3, (char *)etwl->msg);
+
+ // indicate success
+ buffer->status = 0x00;
+ buffer->len = 0x00;
+
+ return AE_OK;
+}
+
+static acpi_status
+surfacegen5_san_rqst(struct surfacegen5_san_opreg_context *ctx, struct gsb_buffer *buffer)
+{
+ struct gsb_data_rqsx *gsb_rqst = surfacegen5_san_validate_rqsx(ctx->dev, "RQST", buffer);
+ struct surfacegen5_rqst rqst = {};
+ struct surfacegen5_buf result = {};
+ int status = 0;
+ int try;
+
+ if (!gsb_rqst) {
+ return AE_OK;
+ }
+
+ rqst.tc = gsb_rqst->tc;
+ rqst.iid = gsb_rqst->iid;
+ rqst.cid = gsb_rqst->cid;
+ rqst.snc = gsb_rqst->snc;
+ rqst.cdl = gsb_rqst->cdl;
+ rqst.pld = &gsb_rqst->pld[0];
+
+ result.cap = SURFACEGEN5_MAX_RQST_RESPONSE;
+ result.len = 0;
+ result.data = kzalloc(result.cap, GFP_KERNEL);
+
+ if (!result.data) {
+ return AE_NO_MEMORY;
+ }
+
+ for (try = 0; try < SG5_RQST_RETRY; try++) {
+ if (try) {
+ dev_warn(ctx->dev, SG5_SAN_RQST_TAG "IO error occured, trying again\n");
+ }
+
+ status = surfacegen5_ec_rqst(&rqst, &result);
+ if (status != -EIO) break;
+ }
+
+ if (rqst.tc == 0x11 && rqst.cid == 0x0D && status == -EPERM) {
+ /* Base state quirk:
+ * The base state may be queried from ACPI when the EC is
+ * still suspended. In this case it will return '-EPERM'.
+ * Returning 0xff (unknown base status) here will suppress
+ * error messages and cause an immediate re-query of the
+ * state. Delay return to avoid spinning.
+ */
+
+ buffer->status = 0x00;
+ buffer->len = 0x03;
+ buffer->data.out.status = 0x00;
+ buffer->data.out.len = 0x01;
+ buffer->data.out.pld[0] = 0xFF;
+ msleep(SG5_QUIRK_BASE_STATE_DELAY);
+
+ } else if (!status) { // success
+ buffer->status = 0x00;
+ buffer->len = result.len + 2;
+ buffer->data.out.status = 0x00;
+ buffer->data.out.len = result.len;
+ memcpy(&buffer->data.out.pld[0], result.data, result.len);
+
+ } else { // failure
+ dev_err(ctx->dev, SG5_SAN_RQST_TAG "failed with error %d\n", status);
+ buffer->status = 0x00;
+ buffer->len = 0x02;
+ buffer->data.out.status = 0x01; // indicate _SSH error
+ buffer->data.out.len = 0x00;
+ }
+
+ kfree(result.data);
+
+ return AE_OK;
+}
+
+static acpi_status
+surfacegen5_san_rqsg(struct surfacegen5_san_opreg_context *ctx, struct gsb_buffer *buffer)
+{
+ struct gsb_data_rqsx *rqsg = surfacegen5_san_validate_rqsx(ctx->dev, "RQSG", buffer);
+
+ if (!rqsg) {
+ return AE_OK;
+ }
+
+ // TODO: RQSG handler
+
+ dev_warn(ctx->dev, "unsupported request: RQSG(0x%02x, 0x%02x, 0x%02x)\n",
+ rqsg->tc, rqsg->cid, rqsg->iid);
+
+ return AE_OK;
+}
+
+
+static acpi_status
+surfacegen5_san_opreg_handler(u32 function, acpi_physical_address command,
+ u32 bits, u64 *value64,
+ void *opreg_context, void *region_context)
+{
+ struct surfacegen5_san_opreg_context *context = opreg_context;
+ struct gsb_buffer *buffer = (struct gsb_buffer *)value64;
+ int accessor_type = (0xFFFF0000 & function) >> 16;
+
+ if (command != 0) {
+ dev_warn(context->dev, "unsupported command: 0x%02llx\n", command);
+ return AE_OK;
+ }
+
+ if (accessor_type != ACPI_GSB_ACCESS_ATTRIB_RAW_PROCESS) {
+ dev_err(context->dev, "invalid access type: 0x%02x\n", accessor_type);
+ return AE_OK;
+ }
+
+ // buffer must have at least contain the command-value
+ if (buffer->len == 0) {
+ dev_err(context->dev, "request-package too small\n");
+ return AE_OK;
+ }
+
+ switch (buffer->data.in.cv) {
+ case 0x01: return surfacegen5_san_rqst(context, buffer);
+ case 0x02: return surfacegen5_san_etwl(context, buffer);
+ case 0x03: return surfacegen5_san_rqsg(context, buffer);
+ }
+
+ dev_warn(context->dev, "unsupported SAN0 request (cv: 0x%02x)\n", buffer->data.in.cv);
+ return AE_OK;
+}
+
+static int surfacegen5_san_enable_events(struct device *dev)
+{
+ int status;
+
+ status = surfacegen5_ec_set_delayed_event_handler(
+ SG5_EVENT_PWR_RQID, surfacegen5_evt_power,
+ surfacegen5_evt_power_delay, dev);
+ if (status) {
+ goto err_san_event_handler_power;
+ }
+
+ status = surfacegen5_ec_set_event_handler(
+ SG5_EVENT_TEMP_RQID, surfacegen5_evt_thermal,
+ dev);
+ if (status) {
+ goto err_san_event_handler_thermal;
+ }
+
+ status = surfacegen5_ec_enable_event_source(SG5_EVENT_PWR_TC, 0x01, SG5_EVENT_PWR_RQID);
+ if (status) {
+ goto err_san_event_source_power;
+ }
+
+ status = surfacegen5_ec_enable_event_source(SG5_EVENT_TEMP_TC, 0x01, SG5_EVENT_TEMP_RQID);
+ if (status) {
+ goto err_san_event_source_thermal;
+ }
+
+ return 0;
+
+err_san_event_source_thermal:
+ surfacegen5_ec_disable_event_source(SG5_EVENT_PWR_TC, 0x01, SG5_EVENT_PWR_RQID);
+err_san_event_source_power:
+ surfacegen5_ec_remove_event_handler(SG5_EVENT_TEMP_RQID);
+err_san_event_handler_thermal:
+ surfacegen5_ec_remove_event_handler(SG5_EVENT_PWR_RQID);
+err_san_event_handler_power:
+ return status;
+}
+
+static void surfacegen5_san_disable_events(void)
+{
+ surfacegen5_ec_disable_event_source(SG5_EVENT_TEMP_TC, 0x01, SG5_EVENT_TEMP_RQID);
+ surfacegen5_ec_disable_event_source(SG5_EVENT_PWR_TC, 0x01, SG5_EVENT_PWR_RQID);
+ surfacegen5_ec_remove_event_handler(SG5_EVENT_TEMP_RQID);
+ surfacegen5_ec_remove_event_handler(SG5_EVENT_PWR_RQID);
+}
+
+
+static int surfacegen5_san_consumers_link(struct platform_device *pdev,
+ const struct surfacegen5_san_acpi_consumer *cons,
+ struct surfacegen5_san_consumers *out)
+{
+ const struct surfacegen5_san_acpi_consumer *con;
+ struct device_link **links, **link;
+ struct acpi_device *adev;
+ acpi_handle handle;
+ u32 max_links = 0;
+ int status;
+
+ if (!cons) {
+ return 0;
+ }
+
+ // count links
+ for (con = cons; con->path; ++con) {
+ max_links += 1;
+ }
+
+ // allocate
+ links = kzalloc(max_links * sizeof(struct device_link *), GFP_KERNEL);
+ link = &links[0];
+
+ if (!links) {
+ return -ENOMEM;
+ }
+
+ // create links
+ for (con = cons; con->path; ++con) {
+ status = acpi_get_handle(NULL, con->path, &handle);
+ if (status) {
+ if (con->required || status != AE_NOT_FOUND) {
+ status = -ENXIO;
+ goto san_consumers_link_cleanup;
+ } else {
+ continue;
+ }
+ }
+
+ status = acpi_bus_get_device(handle, &adev);
+ if (status) {
+ goto san_consumers_link_cleanup;
+ }
+
+ *link = device_link_add(&adev->dev, &pdev->dev, con->flags);
+ if (!(*link)) {
+ status = -EFAULT;
+ goto san_consumers_link_cleanup;
+ }
+
+ link += 1;
+ }
+
+ out->num = link - links;
+ out->links = links;
+
+ return 0;
+
+san_consumers_link_cleanup:
+ for (link = link - 1; link >= links; --link) {
+ device_link_del(*link);
+ }
+
+ return status;
+}
+
+static void surfacegen5_san_consumers_unlink(struct surfacegen5_san_consumers *consumers) {
+ u32 i;
+
+ if (!consumers) {
+ return;
+ }
+
+ for (i = 0; i < consumers->num; ++i) {
+ device_link_del(consumers->links[i]);
+ }
+
+ kfree(consumers->links);
+
+ consumers->num = 0;
+ consumers->links = NULL;
+}
+
+static int surfacegen5_acpi_san_probe(struct platform_device *pdev)
+{
+ const struct surfacegen5_san_acpi_consumer *cons;
+ struct surfacegen5_san_drvdata *drvdata;
+ struct device_link *ec_link;
+ acpi_handle san = ACPI_HANDLE(&pdev->dev); // _SAN device node
+ int status;
+
+ drvdata = kzalloc(sizeof(struct surfacegen5_san_drvdata), GFP_KERNEL);
+ if (!drvdata) {
+ return -ENOMEM;
+ }
+
+ /*
+ * Defer probe if the _SSH driver has not set up the controller yet. This
+ * makes sure we do not fail any initial requests (e.g. _STA request without
+ * which the battery does not get set up correctly). Otherwise register as
+ * consumer to set up a device_link.
+ */
+ ec_link = surfacegen5_ec_consumer_add(&pdev->dev, DL_FLAG_PM_RUNTIME);
+ if (IS_ERR_OR_NULL(ec_link)) {
+ if (PTR_ERR(ec_link) == -ENXIO) {
+ status = -EPROBE_DEFER;
+ } else {
+ status = -EFAULT;
+ }
+
+ goto err_san_probe_ec_link;
+ }
+
+ drvdata->ec_link = ec_link;
+ drvdata->opreg_ctx.dev = &pdev->dev;
+
+ cons = acpi_device_get_match_data(&pdev->dev);
+ status = surfacegen5_san_consumers_link(pdev, cons, &drvdata->consumers);
+ if (status) {
+ goto err_san_probe_consumers;
+ }
+
+ platform_set_drvdata(pdev, drvdata);
+
+ status = acpi_install_address_space_handler(san,
+ ACPI_ADR_SPACE_GSBUS,
+ &surfacegen5_san_opreg_handler,
+ NULL, &drvdata->opreg_ctx);
+
+ if (ACPI_FAILURE(status)) {
+ status = -ENODEV;
+ goto err_san_probe_install_handler;
+ }
+
+ status = surfacegen5_san_enable_events(&pdev->dev);
+ if (status) {
+ goto err_san_probe_enable_events;
+ }
+
+ acpi_walk_dep_device_list(san);
+ return 0;
+
+err_san_probe_enable_events:
+ acpi_remove_address_space_handler(san, ACPI_ADR_SPACE_GSBUS, &surfacegen5_san_opreg_handler);
+err_san_probe_install_handler:
+ platform_set_drvdata(san, NULL);
+ surfacegen5_san_consumers_unlink(&drvdata->consumers);
+err_san_probe_consumers:
+ surfacegen5_ec_consumer_remove(drvdata->ec_link);
+err_san_probe_ec_link:
+ kfree(drvdata);
+ return status;
+}
+
+static int surfacegen5_acpi_san_remove(struct platform_device *pdev)
+{
+ struct surfacegen5_san_drvdata *drvdata = platform_get_drvdata(pdev);
+ acpi_handle san = ACPI_HANDLE(&pdev->dev); // _SAN device node
+ acpi_status status = AE_OK;
+
+ acpi_remove_address_space_handler(san, ACPI_ADR_SPACE_GSBUS, &surfacegen5_san_opreg_handler);
+ surfacegen5_san_disable_events();
+
+ surfacegen5_san_consumers_unlink(&drvdata->consumers);
+ surfacegen5_ec_consumer_remove(drvdata->ec_link);
+ kfree(drvdata);
+
+ platform_set_drvdata(pdev, NULL);
+ return status;
+}
+
+
+static const struct surfacegen5_san_acpi_consumer surfacegen5_mshw0091_consumers[] = {
+ { "\\_SB.SRTC", true, DL_FLAG_PM_RUNTIME | DL_FLAG_STATELESS },
+ { "\\ADP1", true, DL_FLAG_PM_RUNTIME | DL_FLAG_STATELESS },
+ { "\\_SB.BAT1", true, DL_FLAG_PM_RUNTIME | DL_FLAG_STATELESS },
+ { "\\_SB.BAT2", false, DL_FLAG_PM_RUNTIME | DL_FLAG_STATELESS },
+ { },
+};
+
+static const struct acpi_device_id surfacegen5_acpi_san_match[] = {
+ { "MSHW0091", (long unsigned int) surfacegen5_mshw0091_consumers },
+ { },
+};
+MODULE_DEVICE_TABLE(acpi, surfacegen5_acpi_san_match);
+
+static struct platform_driver surfacegen5_acpi_san = {
+ .probe = surfacegen5_acpi_san_probe,
+ .remove = surfacegen5_acpi_san_remove,
+ .driver = {
+ .name = "surfacegen5_acpi_san",
+ .acpi_match_table = ACPI_PTR(surfacegen5_acpi_san_match),
+ },
+};
+
+#endif /* CONFIG_SURFACE_ACPI_SAN */
+
+
+/*************************************************************************
+ * Virtual HID Framework driver
+ */
+
+#ifdef CONFIG_SURFACE_ACPI_VHF
+
+#define USB_VENDOR_ID_MICROSOFT 0x045e
+#define USB_DEVICE_ID_MS_VHF 0xf001
+
+/*
+ * Request ID for VHF events. This value is based on the output of the Surface
+ * EC and should not be changed.
+ */
+#define SG5_VHF_RQID 0x0001
+
+
+struct surfacegen5_vhf_evtctx {
+ struct device *dev;
+ struct hid_device *hid;
+};
+
+struct surfacegen5_vhf_drvdata {
+ struct device_link *ec_link;
+ struct surfacegen5_vhf_evtctx event_ctx;
+};
+
+
+/*
+ * These report descriptors have been extracted from a Surface Book 2.
+ * They seems to be similar enough to be usable on the Surface Laptop.
+ */
+static const u8 vhf_hid_desc[] = {
+ // keyboard descriptor (event command ID 0x03)
+ 0x05, 0x01, /* Usage Page (Desktop), */
+ 0x09, 0x06, /* Usage (Keyboard), */
+ 0xA1, 0x01, /* Collection (Application), */
+ 0x85, 0x01, /* Report ID (1), */
+ 0x15, 0x00, /* Logical Minimum (0), */
+ 0x25, 0x01, /* Logical Maximum (1), */
+ 0x75, 0x01, /* Report Size (1), */
+ 0x95, 0x08, /* Report Count (8), */
+ 0x05, 0x07, /* Usage Page (Keyboard), */
+ 0x19, 0xE0, /* Usage Minimum (KB Leftcontrol), */
+ 0x29, 0xE7, /* Usage Maximum (KB Right GUI), */
+ 0x81, 0x02, /* Input (Variable), */
+ 0x75, 0x08, /* Report Size (8), */
+ 0x95, 0x0A, /* Report Count (10), */
+ 0x19, 0x00, /* Usage Minimum (None), */
+ 0x29, 0x91, /* Usage Maximum (KB LANG2), */
+ 0x26, 0xFF, 0x00, /* Logical Maximum (255), */
+ 0x81, 0x00, /* Input, */
+ 0x05, 0x0C, /* Usage Page (Consumer), */
+ 0x0A, 0xC0, 0x02, /* Usage (02C0h), */
+ 0xA1, 0x02, /* Collection (Logical), */
+ 0x1A, 0xC1, 0x02, /* Usage Minimum (02C1h), */
+ 0x2A, 0xC6, 0x02, /* Usage Maximum (02C6h), */
+ 0x95, 0x06, /* Report Count (6), */
+ 0xB1, 0x03, /* Feature (Constant, Variable), */
+ 0xC0, /* End Collection, */
+ 0x05, 0x08, /* Usage Page (LED), */
+ 0x19, 0x01, /* Usage Minimum (01h), */
+ 0x29, 0x03, /* Usage Maximum (03h), */
+ 0x75, 0x01, /* Report Size (1), */
+ 0x95, 0x03, /* Report Count (3), */
+ 0x25, 0x01, /* Logical Maximum (1), */
+ 0x91, 0x02, /* Output (Variable), */
+ 0x95, 0x05, /* Report Count (5), */
+ 0x91, 0x01, /* Output (Constant), */
+ 0xC0, /* End Collection, */
+
+ // media key descriptor (event command ID 0x04)
+ 0x05, 0x0C, /* Usage Page (Consumer), */
+ 0x09, 0x01, /* Usage (Consumer Control), */
+ 0xA1, 0x01, /* Collection (Application), */
+ 0x85, 0x03, /* Report ID (3), */
+ 0x75, 0x10, /* Report Size (16), */
+ 0x15, 0x00, /* Logical Minimum (0), */
+ 0x26, 0xFF, 0x03, /* Logical Maximum (1023), */
+ 0x19, 0x00, /* Usage Minimum (00h), */
+ 0x2A, 0xFF, 0x03, /* Usage Maximum (03FFh), */
+ 0x81, 0x00, /* Input, */
+ 0xC0, /* End Collection, */
+};
+
+
+static int vhf_hid_start(struct hid_device *hid)
+{
+ hid_dbg(hid, "%s\n", __func__);
+ return 0;
+}
+
+static void vhf_hid_stop(struct hid_device *hid)
+{
+ hid_dbg(hid, "%s\n", __func__);
+}
+
+static int vhf_hid_open(struct hid_device *hid)
+{
+ hid_dbg(hid, "%s\n", __func__);
+ return 0;
+}
+
+static void vhf_hid_close(struct hid_device *hid)
+{
+ hid_dbg(hid, "%s\n", __func__);
+}
+
+static int vhf_hid_parse(struct hid_device *hid)
+{
+ return hid_parse_report(hid, (u8 *)vhf_hid_desc, ARRAY_SIZE(vhf_hid_desc));
+}
+
+static int vhf_hid_raw_request(struct hid_device *hid, unsigned char reportnum,
+ u8 *buf, size_t len, unsigned char rtype,
+ int reqtype)
+{
+ hid_dbg(hid, "%s\n", __func__);
+ return 0;
+}
+
+static int vhf_hid_output_report(struct hid_device *hid, u8 *buf, size_t len)
+{
+ hid_dbg(hid, "%s\n", __func__);
+ print_hex_dump_debug("report:", DUMP_PREFIX_OFFSET, 16, 1, buf, len, false);
+
+ return len;
+}
+
+static struct hid_ll_driver vhf_hid_ll_driver = {
+ .start = vhf_hid_start,
+ .stop = vhf_hid_stop,
+ .open = vhf_hid_open,
+ .close = vhf_hid_close,
+ .parse = vhf_hid_parse,
+ .raw_request = vhf_hid_raw_request,
+ .output_report = vhf_hid_output_report,
+};
+
+
+static struct hid_device *surfacegen5_vhf_create_hid_device(struct platform_device *pdev)
+{
+ struct hid_device *hid;
+
+ hid = hid_allocate_device();
+ if (IS_ERR(hid)) {
+ return hid;
+ }
+
+ hid->dev.parent = &pdev->dev;
+
+ hid->bus = BUS_VIRTUAL;
+ hid->vendor = USB_VENDOR_ID_MICROSOFT;
+ hid->product = USB_DEVICE_ID_MS_VHF;
+
+ hid->ll_driver = &vhf_hid_ll_driver;
+
+ sprintf(hid->name, "%s", "Microsoft Virtual HID Framework Device");
+
+ return hid;
+}
+
+static int surfacegen5_vhf_event_handler(struct surfacegen5_event *event, void *data)
+{
+ struct surfacegen5_vhf_evtctx *ctx = (struct surfacegen5_vhf_evtctx *)data;
+
+ if (event->tc == 0x08 && (event->cid == 0x03 || event->cid == 0x04)) {
+ return hid_input_report(ctx->hid, HID_INPUT_REPORT, event->pld, event->len, 1);
+ }
+
+ dev_warn(ctx->dev, "unsupported event (tc = %d, cid = %d)\n", event->tc, event->cid);
+ return 0;
+}
+
+static unsigned long surfacegen5_vhf_event_delay(struct surfacegen5_event *event, void *data)
+{
+ // high priority immediate execution for keyboard events
+ if (event->tc == 0x08 && (event->cid == 0x03 || event->cid == 0x04)) {
+ return SURFACEGEN5_EVENT_IMMEDIATE;
+ }
+
+ return 0;
+}
+
+static int surfacegen5_acpi_vhf_probe(struct platform_device *pdev)
+{
+ struct surfacegen5_vhf_drvdata *drvdata;
+ struct device_link *ec_link;
+ struct hid_device *hid;
+ int status;
+
+ drvdata = kzalloc(sizeof(struct surfacegen5_vhf_drvdata), GFP_KERNEL);
+ if (!drvdata) {
+ return -ENOMEM;
+ }
+
+ // add device link to EC
+ ec_link = surfacegen5_ec_consumer_add(&pdev->dev, DL_FLAG_PM_RUNTIME);
+ if (IS_ERR_OR_NULL(ec_link)) {
+ if (PTR_ERR(ec_link) == -ENXIO) {
+ status = -EPROBE_DEFER;
+ } else {
+ status = -EFAULT;
+ }
+
+ goto err_probe_ec_link;
+ }
+
+ hid = surfacegen5_vhf_create_hid_device(pdev);
+ if (IS_ERR(hid)) {
+ status = PTR_ERR(hid);
+ goto err_probe_hid;
+ }
+
+ status = hid_add_device(hid);
+ if (status) {
+ goto err_add_hid;
+ }
+
+ drvdata->ec_link = ec_link;
+ drvdata->event_ctx.dev = &pdev->dev;
+ drvdata->event_ctx.hid = hid;
+
+ platform_set_drvdata(pdev, drvdata);
+
+ /*
+ * Set event hanlder for VHF events. They seem to be enabled by
+ * default, thus there should be no need to explicitly enable them.
+ */
+ status = surfacegen5_ec_set_delayed_event_handler(
+ SG5_VHF_RQID,
+ surfacegen5_vhf_event_handler,
+ surfacegen5_vhf_event_delay,
+ &drvdata->event_ctx);
+ if (status) {
+ goto err_add_hid;
+ }
+
+ return 0;
+
+err_add_hid:
+ hid_destroy_device(hid);
+ platform_set_drvdata(pdev, NULL);
+err_probe_hid:
+ surfacegen5_ec_consumer_remove(drvdata->ec_link);
+err_probe_ec_link:
+ kfree(drvdata);
+ return status;
+}
+
+static int surfacegen5_acpi_vhf_remove(struct platform_device *pdev)
+{
+ struct surfacegen5_vhf_drvdata *drvdata = platform_get_drvdata(pdev);
+
+ surfacegen5_ec_remove_event_handler(SG5_VHF_RQID);
+
+ hid_destroy_device(drvdata->event_ctx.hid);
+ surfacegen5_ec_consumer_remove(drvdata->ec_link);
+ kfree(drvdata);
+
+ platform_set_drvdata(pdev, NULL);
+ return 0;
+}
+
+
+static const struct acpi_device_id surfacegen5_acpi_vhf_match[] = {
+ { "MSHW0096" },
+ { },
+};
+MODULE_DEVICE_TABLE(acpi, surfacegen5_acpi_vhf_match);
+
+static struct platform_driver surfacegen5_acpi_vhf = {
+ .probe = surfacegen5_acpi_vhf_probe,
+ .remove = surfacegen5_acpi_vhf_remove,
+ .driver = {
+ .name = "surfacegen5_acpi_vhf",
+ .acpi_match_table = ACPI_PTR(surfacegen5_acpi_vhf_match),
+ },
+};
+
+#endif /* CONFIG_SURFACE_ACPI_VHF */
+
+
+/*************************************************************************
+ * Module initialization
+ */
+
+int __init surface_acpi_init(void)
+{
+ int status;
+
+#ifdef CONFIG_SURFACE_ACPI_SSH
+ status = serdev_device_driver_register(&surfacegen5_acpi_ssh);
+ if (status) {
+ goto err_modinit_ssh;
+ }
+#endif /* CONFIG_SURFACE_ACPI_SSH */
+
+#ifdef CONFIG_SURFACE_ACPI_SAN
+ status = platform_driver_register(&surfacegen5_acpi_san);
+ if (status) {
+ goto err_modinit_san;
+ }
+#endif /* CONFIG_SURFACE_ACPI_SAN */
+
+#ifdef CONFIG_SURFACE_ACPI_VHF
+ status = platform_driver_register(&surfacegen5_acpi_vhf);
+ if (status) {
+ goto err_modinit_vhf;
+ }
+#endif /* CONFIG_SURFACE_ACPI_VHF */
+
+ return 0;
+
+#ifdef CONFIG_SURFACE_ACPI_VHF
+ platform_driver_unregister(&surfacegen5_acpi_vhf);
+err_modinit_vhf:
+#endif /* CONFIG_SURFACE_ACPI_VHF */
+
+#ifdef CONFIG_SURFACE_ACPI_SAN
+ platform_driver_unregister(&surfacegen5_acpi_san);
+err_modinit_san:
+#endif /* CONFIG_SURFACE_ACPI_SAN */
+
+#ifdef CONFIG_SURFACE_ACPI_SSH
+ serdev_device_driver_unregister(&surfacegen5_acpi_ssh);
+err_modinit_ssh:
+#endif /* CONFIG_SURFACE_ACPI_SSH */
+
+ return status;
+}
+
+void __exit surface_acpi_exit(void)
+{
+#ifdef CONFIG_SURFACE_ACPI_VHF
+ platform_driver_unregister(&surfacegen5_acpi_vhf);
+#endif /* CONFIG_SURFACE_ACPI_VHF */
+
+#ifdef CONFIG_SURFACE_ACPI_SAN
+ platform_driver_unregister(&surfacegen5_acpi_san);
+#endif /* CONFIG_SURFACE_ACPI_SAN */
+
+#ifdef CONFIG_SURFACE_ACPI_SSH
+ serdev_device_driver_unregister(&surfacegen5_acpi_ssh);
+#endif /* CONFIG_SURFACE_ACPI_SSH */
+}
+
+
+module_init(surface_acpi_init)
+module_exit(surface_acpi_exit)
+
+MODULE_AUTHOR("Maximilian Luz <luzmaximilian@gmail.com>");
+MODULE_DESCRIPTION("ACPI/Platform Drivers for Microsoft Surface Devices");
+MODULE_LICENSE("GPL v2");
diff --git a/drivers/tty/serdev/core.c b/drivers/tty/serdev/core.c
index 9db93f500b4e..2290d4f86ca4 100644
--- a/drivers/tty/serdev/core.c
+++ b/drivers/tty/serdev/core.c
@@ -502,8 +502,7 @@ static acpi_status acpi_serdev_register_device(struct serdev_controller *ctrl,
struct serdev_device *serdev = NULL;
int err;
- if (acpi_bus_get_status(adev) || !adev->status.present ||
- acpi_device_enumerated(adev))
+ if (acpi_bus_get_status(adev) || !adev->status.present)
return AE_OK;
serdev = serdev_device_alloc(ctrl);
@@ -526,6 +525,81 @@ static acpi_status acpi_serdev_register_device(struct serdev_controller *ctrl,
return AE_OK;
}
+struct acpi_serdev_add_device_from_resource_ctx {
+ acpi_handle ctrl_handle;
+ acpi_handle device_handle;
+ struct serdev_controller *ctrl;
+ struct acpi_device *device;
+};
+
+static acpi_status
+acpi_serdev_add_device_from_resource(struct acpi_resource *resource, void *data)
+{
+ struct acpi_serdev_add_device_from_resource_ctx* ctx = data;
+ struct acpi_resource_source *ctrl_name;
+ acpi_handle ctrl_handle;
+ acpi_status status;
+
+ if (resource->type != ACPI_RESOURCE_TYPE_SERIAL_BUS)
+ return AE_OK;
+
+ if (resource->data.common_serial_bus.type != ACPI_RESOURCE_SERIAL_TYPE_UART)
+ return AE_OK;
+
+ ctrl_name = &resource->data.common_serial_bus.resource_source;
+ if (ctrl_name->string_length == 0 || !ctrl_name->string_ptr) {
+ return AE_OK;
+ }
+
+ status = acpi_get_handle(ctx->device_handle, ctrl_name->string_ptr,
+ &ctrl_handle);
+ if (ACPI_FAILURE(status)) {
+ return AE_OK;
+ }
+
+ if (ctrl_handle == ctx->ctrl_handle) {
+ return acpi_serdev_register_device(ctx->ctrl, ctx->device);
+ }
+
+ return AE_OK;
+}
+
+static acpi_status
+acpi_serdev_add_devices_from_resources(acpi_handle handle, u32 level,
+ void *data, void **return_value)
+{
+ struct acpi_serdev_add_device_from_resource_ctx *ctx = data;
+ acpi_status status;
+
+ ctx->device_handle = handle;
+
+ status = acpi_bus_get_device(handle, &ctx->device);
+ if (status) return AE_OK;
+
+ status = acpi_walk_resources(handle, METHOD_NAME__CRS,
+ acpi_serdev_add_device_from_resource,
+ ctx);
+
+ if (status == AE_NOT_FOUND)
+ return AE_OK; // not finding _CRS is not an error
+ else
+ return status;
+}
+
+static int
+acpi_serdev_register_devices_from_resources(acpi_handle handle,
+ struct serdev_controller *ctrl)
+{
+ struct acpi_serdev_add_device_from_resource_ctx ctx = {
+ .ctrl = ctrl,
+ .ctrl_handle = handle,
+ };
+
+ return acpi_walk_namespace(ACPI_TYPE_DEVICE, ACPI_ROOT_OBJECT, 128,
+ acpi_serdev_add_devices_from_resources,
+ NULL, &ctx, NULL);
+}
+
static acpi_status acpi_serdev_add_device(acpi_handle handle, u32 level,
void *data, void **return_value)
{
@@ -535,6 +609,9 @@ static acpi_status acpi_serdev_add_device(acpi_handle handle, u32 level,
if (acpi_bus_get_device(handle, &adev))
return AE_OK;
+ if (acpi_device_enumerated(adev))
+ return AE_OK;
+
return acpi_serdev_register_device(ctrl, adev);
}
@@ -552,6 +629,15 @@ static int acpi_serdev_register_devices(struct serdev_controller *ctrl)
if (ACPI_FAILURE(status))
dev_dbg(&ctrl->dev, "failed to enumerate serdev slaves\n");
+ if (!ctrl->serdev) {
+ status = acpi_serdev_register_devices_from_resources(handle, ctrl);
+ if (ACPI_FAILURE(status)) {
+ dev_dbg(&ctrl->dev,
+ "failed to register serdev slaves from resources: %x\n",
+ status);
+ }
+ }
+
if (!ctrl->serdev)
return -ENODEV;
--
2.17.1
Reference in a new issue Copy permalink