WIP: Host commands

Signed-off-by: Daniel Schaefer <dhs@frame.work>

Author: JohnAZoidberg

FrameworkSensors/EcCommunication.cpp

@@ -51,3 +51,48 @@ int CrosEcReadMemU8(HANDLE Handle, unsigned int offset, UINT8* dest)
 
     return rm.bytes;
 }
+
+int CrosEcHostCommand(HANDLE Handle, UINT8 cmd_ver, UINT8 cmd, UINT8 *req, UINT8 req_len)
+{
+    NTSTATUS Status = STATUS_SUCCESS;
+    DWORD retb{};
+    CROSEC_COMMAND cmd{};
+
+    if (req_len > CROSEC_CMD_MAX_REQUEST) {
+        Status = STATUS_INVALID_PARAMETER;
+        TraceError("COMBO %!FUNC! Request size too long");
+    }
+
+    if (Handle == INVALID_HANDLE_VALUE) {
+        Status = STATUS_INVALID_HANDLE;
+        TraceError("COMBO %!FUNC! Invalid Handle");
+        return 0;
+    }
+
+    cmd.version = cmd_ver;
+    cmd.command = cmd;
+    cmd.outsize = req_len;
+    cmd.insize = CROSEC_CMD_MAX_REQUEST - CROSEC_CMD_HEADER_LEN;
+    cmd.result = 0xFF;
+    for (UINT8 i = 0; i < req_len; i++) {
+      cmd.buffer[i] = req[i];
+    }
+
+    Status = DeviceIoControl(Handle,
+        (DWORD) IOCTL_CROSEC_XCMD,
+        &cmd,
+        sizeof(cmd),
+        &cmd,
+        sizeof(cmd),
+        &retb,
+        nullptr);
+    if (!NT_SUCCESS(Status)) {
+        TraceError("COMBO %!FUNC! ConnectToEc failed %!STATUS!", Status);
+        return 0;
+    }
+
+    TraceInformation("COMBO %!FUNC! Successfully read %d bytes from EC memory at %02x. First one %02x. retb=%d", rm.bytes, rm.offset, rm.buffer[0], retb);
+    *dest = rm.buffer[0];
+
+    return rm.bytes;
+}

FrameworkSensors/EcCommunication.h

@@ -40,6 +40,7 @@ extern "C" {
 
 #define CROSEC_CMD_MAX_REQUEST  0x100
 #define CROSEC_CMD_MAX_RESPONSE 0x100
+#define CROSEC_CMD_HEADER_LEN   0x10
 #define CROSEC_MEMMAP_SIZE      0xFF
 
 typedef struct _CROSEC_READMEM {
@@ -50,6 +51,15 @@ typedef struct _CROSEC_READMEM {
 
 int CrosEcReadMemU8(HANDLE Handle, unsigned int offset, UINT8* dest);
 
+typedef struct _CROSEC_COMMAND {
+	ULONG version;
+	ULONG command;
+	ULONG outsize;
+	ULONG insize;
+	ULONG result;
+	UCHAR buffer[CROSEC_CMD_MAX_REQUEST];
+} * PCROSEC_COMMAND, CROSEC_COMMAND;
+
 #ifdef __cplusplus
 }
 #endif