| // SPDX-License-Identifier: GPL-2.0 | |
| /* | |
| * Generation of ACPI (Advanced Configuration and Power Interface) tables | |
| * | |
| * Copyright 2019 Google LLC | |
| * Mostly taken from coreboot | |
| */ | |
| #define LOG_CATEGORY LOGC_ACPI | |
| #include <dm.h> | |
| #include <log.h> | |
| #include <uuid.h> | |
| #include <acpi/acpigen.h> | |
| #include <acpi/acpi_device.h> | |
| #include <acpi/acpi_table.h> | |
| #include <dm/acpi.h> | |
| /* CPU path format */ | |
| #define ACPI_CPU_STRING "\\_PR.CP%02d" | |
| u8 *acpigen_get_current(struct acpi_ctx *ctx) | |
| { | |
| return ctx->current; | |
| } | |
| void acpigen_emit_byte(struct acpi_ctx *ctx, uint data) | |
| { | |
| *(u8 *)ctx->current++ = data; | |
| } | |
| void acpigen_emit_word(struct acpi_ctx *ctx, uint data) | |
| { | |
| acpigen_emit_byte(ctx, data & 0xff); | |
| acpigen_emit_byte(ctx, (data >> 8) & 0xff); | |
| } | |
| void acpigen_emit_dword(struct acpi_ctx *ctx, uint data) | |
| { | |
| /* Output the value in little-endian format */ | |
| acpigen_emit_byte(ctx, data & 0xff); | |
| acpigen_emit_byte(ctx, (data >> 8) & 0xff); | |
| acpigen_emit_byte(ctx, (data >> 16) & 0xff); | |
| acpigen_emit_byte(ctx, (data >> 24) & 0xff); | |
| } | |
| /* | |
| * Maximum length for an ACPI object generated by this code, | |
| * | |
| * If you need to change this, change acpigen_write_len_f(ctx) and | |
| * acpigen_pop_len(ctx) | |
| */ | |
| #define ACPIGEN_MAXLEN 0xfffff | |
| void acpigen_write_len_f(struct acpi_ctx *ctx) | |
| { | |
| assert(ctx->ltop < (ACPIGEN_LENSTACK_SIZE - 1)); | |
| ctx->len_stack[ctx->ltop++] = ctx->current; | |
| acpigen_emit_byte(ctx, 0); | |
| acpigen_emit_byte(ctx, 0); | |
| acpigen_emit_byte(ctx, 0); | |
| } | |
| void acpigen_pop_len(struct acpi_ctx *ctx) | |
| { | |
| int len; | |
| char *p; | |
| assert(ctx->ltop > 0); | |
| p = ctx->len_stack[--ctx->ltop]; | |
| len = ctx->current - (void *)p; | |
| assert(len <= ACPIGEN_MAXLEN); | |
| /* generate store length for 0xfffff max */ | |
| p[0] = ACPI_PKG_LEN_3_BYTES | (len & 0xf); | |
| p[1] = len >> 4 & 0xff; | |
| p[2] = len >> 12 & 0xff; | |
| } | |
| void acpigen_emit_ext_op(struct acpi_ctx *ctx, uint op) | |
| { | |
| acpigen_emit_byte(ctx, EXT_OP_PREFIX); | |
| acpigen_emit_byte(ctx, op); | |
| } | |
| char *acpigen_write_package(struct acpi_ctx *ctx, int nr_el) | |
| { | |
| char *p; | |
| acpigen_emit_byte(ctx, PACKAGE_OP); | |
| acpigen_write_len_f(ctx); | |
| p = ctx->current; | |
| acpigen_emit_byte(ctx, nr_el); | |
| return p; | |
| } | |
| void acpigen_write_byte(struct acpi_ctx *ctx, unsigned int data) | |
| { | |
| acpigen_emit_byte(ctx, BYTE_PREFIX); | |
| acpigen_emit_byte(ctx, data & 0xff); | |
| } | |
| void acpigen_write_word(struct acpi_ctx *ctx, unsigned int data) | |
| { | |
| acpigen_emit_byte(ctx, WORD_PREFIX); | |
| acpigen_emit_word(ctx, data); | |
| } | |
| void acpigen_write_dword(struct acpi_ctx *ctx, unsigned int data) | |
| { | |
| acpigen_emit_byte(ctx, DWORD_PREFIX); | |
| acpigen_emit_dword(ctx, data); | |
| } | |
| void acpigen_write_qword(struct acpi_ctx *ctx, u64 data) | |
| { | |
| acpigen_emit_byte(ctx, QWORD_PREFIX); | |
| acpigen_emit_dword(ctx, data & 0xffffffff); | |
| acpigen_emit_dword(ctx, (data >> 32) & 0xffffffff); | |
| } | |
| void acpigen_write_zero(struct acpi_ctx *ctx) | |
| { | |
| acpigen_emit_byte(ctx, ZERO_OP); | |
| } | |
| void acpigen_write_one(struct acpi_ctx *ctx) | |
| { | |
| acpigen_emit_byte(ctx, ONE_OP); | |
| } | |
| void acpigen_write_integer(struct acpi_ctx *ctx, u64 data) | |
| { | |
| if (data == 0) | |
| acpigen_write_zero(ctx); | |
| else if (data == 1) | |
| acpigen_write_one(ctx); | |
| else if (data <= 0xff) | |
| acpigen_write_byte(ctx, (unsigned char)data); | |
| else if (data <= 0xffff) | |
| acpigen_write_word(ctx, (unsigned int)data); | |
| else if (data <= 0xffffffff) | |
| acpigen_write_dword(ctx, (unsigned int)data); | |
| else | |
| acpigen_write_qword(ctx, data); | |
| } | |
| void acpigen_write_name_zero(struct acpi_ctx *ctx, const char *name) | |
| { | |
| acpigen_write_name(ctx, name); | |
| acpigen_write_zero(ctx); | |
| } | |
| void acpigen_write_name_one(struct acpi_ctx *ctx, const char *name) | |
| { | |
| acpigen_write_name(ctx, name); | |
| acpigen_write_one(ctx); | |
| } | |
| void acpigen_write_name_byte(struct acpi_ctx *ctx, const char *name, uint val) | |
| { | |
| acpigen_write_name(ctx, name); | |
| acpigen_write_byte(ctx, val); | |
| } | |
| void acpigen_write_name_word(struct acpi_ctx *ctx, const char *name, uint val) | |
| { | |
| acpigen_write_name(ctx, name); | |
| acpigen_write_word(ctx, val); | |
| } | |
| void acpigen_write_name_dword(struct acpi_ctx *ctx, const char *name, uint val) | |
| { | |
| acpigen_write_name(ctx, name); | |
| acpigen_write_dword(ctx, val); | |
| } | |
| void acpigen_write_name_qword(struct acpi_ctx *ctx, const char *name, u64 val) | |
| { | |
| acpigen_write_name(ctx, name); | |
| acpigen_write_qword(ctx, val); | |
| } | |
| void acpigen_write_name_integer(struct acpi_ctx *ctx, const char *name, u64 val) | |
| { | |
| acpigen_write_name(ctx, name); | |
| acpigen_write_integer(ctx, val); | |
| } | |
| void acpigen_write_name_string(struct acpi_ctx *ctx, const char *name, | |
| const char *string) | |
| { | |
| acpigen_write_name(ctx, name); | |
| acpigen_write_string(ctx, string); | |
| } | |
| void acpigen_emit_stream(struct acpi_ctx *ctx, const char *data, int size) | |
| { | |
| int i; | |
| for (i = 0; i < size; i++) | |
| acpigen_emit_byte(ctx, data[i]); | |
| } | |
| void acpigen_emit_string(struct acpi_ctx *ctx, const char *str) | |
| { | |
| acpigen_emit_stream(ctx, str, str ? strlen(str) : 0); | |
| acpigen_emit_byte(ctx, '\0'); | |
| } | |
| void acpigen_write_string(struct acpi_ctx *ctx, const char *str) | |
| { | |
| acpigen_emit_byte(ctx, STRING_PREFIX); | |
| acpigen_emit_string(ctx, str); | |
| } | |
| /* | |
| * The naming conventions for ACPI namespace names are a bit tricky as | |
| * each element has to be 4 chars wide ("All names are a fixed 32 bits.") | |
| * and "By convention, when an ASL compiler pads a name shorter than 4 | |
| * characters, it is done so with trailing underscores ('_')". | |
| * | |
| * Check sections 5.3, 20.2.2 and 20.4 of ACPI spec 6.3 for details. | |
| */ | |
| static void acpigen_emit_simple_namestring(struct acpi_ctx *ctx, | |
| const char *name) | |
| { | |
| const char *ptr; | |
| int i; | |
| for (i = 0, ptr = name; i < 4; i++) { | |
| if (!*ptr || *ptr == '.') | |
| acpigen_emit_byte(ctx, '_'); | |
| else | |
| acpigen_emit_byte(ctx, *ptr++); | |
| } | |
| } | |
| static void acpigen_emit_double_namestring(struct acpi_ctx *ctx, | |
| const char *name, int dotpos) | |
| { | |
| acpigen_emit_byte(ctx, DUAL_NAME_PREFIX); | |
| acpigen_emit_simple_namestring(ctx, name); | |
| acpigen_emit_simple_namestring(ctx, &name[dotpos + 1]); | |
| } | |
| static void acpigen_emit_multi_namestring(struct acpi_ctx *ctx, | |
| const char *name) | |
| { | |
| unsigned char *pathlen; | |
| int count = 0; | |
| acpigen_emit_byte(ctx, MULTI_NAME_PREFIX); | |
| pathlen = ctx->current; | |
| acpigen_emit_byte(ctx, 0); | |
| while (*name) { | |
| acpigen_emit_simple_namestring(ctx, name); | |
| /* find end or next entity */ | |
| while (*name != '.' && *name) | |
| name++; | |
| /* forward to next */ | |
| if (*name == '.') | |
| name++; | |
| count++; | |
| } | |
| *pathlen = count; | |
| } | |
| void acpigen_emit_namestring(struct acpi_ctx *ctx, const char *namepath) | |
| { | |
| int dotcount; | |
| int dotpos; | |
| int i; | |
| /* We can start with a '\' */ | |
| if (*namepath == '\\') { | |
| acpigen_emit_byte(ctx, '\\'); | |
| namepath++; | |
| } | |
| /* And there can be any number of '^' */ | |
| while (*namepath == '^') { | |
| acpigen_emit_byte(ctx, '^'); | |
| namepath++; | |
| } | |
| for (i = 0, dotcount = 0; namepath[i]; i++) { | |
| if (namepath[i] == '.') { | |
| dotcount++; | |
| dotpos = i; | |
| } | |
| } | |
| /* If we have only \\ or only ^* then we need to add a null name */ | |
| if (!*namepath) | |
| acpigen_emit_byte(ctx, ZERO_OP); | |
| else if (dotcount == 0) | |
| acpigen_emit_simple_namestring(ctx, namepath); | |
| else if (dotcount == 1) | |
| acpigen_emit_double_namestring(ctx, namepath, dotpos); | |
| else | |
| acpigen_emit_multi_namestring(ctx, namepath); | |
| } | |
| void acpigen_write_name(struct acpi_ctx *ctx, const char *namepath) | |
| { | |
| acpigen_emit_byte(ctx, NAME_OP); | |
| acpigen_emit_namestring(ctx, namepath); | |
| } | |
| void acpigen_write_scope(struct acpi_ctx *ctx, const char *scope) | |
| { | |
| acpigen_emit_byte(ctx, SCOPE_OP); | |
| acpigen_write_len_f(ctx); | |
| acpigen_emit_namestring(ctx, scope); | |
| } | |
| static void acpigen_write_method_internal(struct acpi_ctx *ctx, | |
| const char *name, uint flags) | |
| { | |
| acpigen_emit_byte(ctx, METHOD_OP); | |
| acpigen_write_len_f(ctx); | |
| acpigen_emit_namestring(ctx, name); | |
| acpigen_emit_byte(ctx, flags); | |
| } | |
| /* Method (name, nargs, NotSerialized) */ | |
| void acpigen_write_method(struct acpi_ctx *ctx, const char *name, int nargs) | |
| { | |
| acpigen_write_method_internal(ctx, name, | |
| nargs & ACPI_METHOD_NARGS_MASK); | |
| } | |
| /* Method (name, nargs, Serialized) */ | |
| void acpigen_write_method_serialized(struct acpi_ctx *ctx, const char *name, | |
| int nargs) | |
| { | |
| acpigen_write_method_internal(ctx, name, | |
| (nargs & ACPI_METHOD_NARGS_MASK) | | |
| ACPI_METHOD_SERIALIZED_MASK); | |
| } | |
| void acpigen_write_processor(struct acpi_ctx *ctx, uint cpuindex, | |
| u32 pblock_addr, uint pblock_len) | |
| { | |
| /* | |
| * Processor (\_PR.CPnn, cpuindex, pblock_addr, pblock_len) | |
| * { | |
| */ | |
| char pscope[16]; | |
| acpigen_emit_ext_op(ctx, PROCESSOR_OP); | |
| acpigen_write_len_f(ctx); | |
| snprintf(pscope, sizeof(pscope), ACPI_CPU_STRING, cpuindex); | |
| acpigen_emit_namestring(ctx, pscope); | |
| acpigen_emit_byte(ctx, cpuindex); | |
| acpigen_emit_dword(ctx, pblock_addr); | |
| acpigen_emit_byte(ctx, pblock_len); | |
| } | |
| void acpigen_write_processor_package(struct acpi_ctx *ctx, | |
| const char *const name, | |
| const uint first_core, | |
| const uint core_count) | |
| { | |
| uint i; | |
| char pscope[16]; | |
| acpigen_write_name(ctx, name); | |
| acpigen_write_package(ctx, core_count); | |
| for (i = first_core; i < first_core + core_count; ++i) { | |
| snprintf(pscope, sizeof(pscope), ACPI_CPU_STRING, i); | |
| acpigen_emit_namestring(ctx, pscope); | |
| } | |
| acpigen_pop_len(ctx); | |
| } | |
| void acpigen_write_processor_cnot(struct acpi_ctx *ctx, const uint num_cores) | |
| { | |
| int core_id; | |
| acpigen_write_method(ctx, "\\_PR.CNOT", 1); | |
| for (core_id = 0; core_id < num_cores; core_id++) { | |
| char buffer[30]; | |
| snprintf(buffer, sizeof(buffer), ACPI_CPU_STRING, core_id); | |
| acpigen_emit_byte(ctx, NOTIFY_OP); | |
| acpigen_emit_namestring(ctx, buffer); | |
| acpigen_emit_byte(ctx, ARG0_OP); | |
| } | |
| acpigen_pop_len(ctx); | |
| } | |
| void acpigen_write_device(struct acpi_ctx *ctx, const char *name) | |
| { | |
| acpigen_emit_ext_op(ctx, DEVICE_OP); | |
| acpigen_write_len_f(ctx); | |
| acpigen_emit_namestring(ctx, name); | |
| } | |
| void acpigen_write_sta(struct acpi_ctx *ctx, uint status) | |
| { | |
| /* Method (_STA, 0, NotSerialized) { Return (status) } */ | |
| acpigen_write_method(ctx, "_STA", 0); | |
| acpigen_emit_byte(ctx, RETURN_OP); | |
| acpigen_write_byte(ctx, status); | |
| acpigen_pop_len(ctx); | |
| } | |
| static void acpigen_write_register(struct acpi_ctx *ctx, | |
| const struct acpi_gen_regaddr *addr) | |
| { | |
| /* See ACPI v6.3 section 6.4.3.7: Generic Register Descriptor */ | |
| acpigen_emit_byte(ctx, ACPI_DESCRIPTOR_REGISTER); | |
| acpigen_emit_byte(ctx, 0x0c); /* Register Length 7:0 */ | |
| acpigen_emit_byte(ctx, 0x00); /* Register Length 15:8 */ | |
| acpigen_emit_byte(ctx, addr->space_id); | |
| acpigen_emit_byte(ctx, addr->bit_width); | |
| acpigen_emit_byte(ctx, addr->bit_offset); | |
| acpigen_emit_byte(ctx, addr->access_size); | |
| acpigen_emit_dword(ctx, addr->addrl); | |
| acpigen_emit_dword(ctx, addr->addrh); | |
| } | |
| void acpigen_write_resourcetemplate_header(struct acpi_ctx *ctx) | |
| { | |
| /* | |
| * A ResourceTemplate() is a Buffer() with a | |
| * (Byte|Word|DWord) containing the length, followed by one or more | |
| * resource items, terminated by the end tag. | |
| * (small item 0xf, len 1) | |
| */ | |
| acpigen_emit_byte(ctx, BUFFER_OP); | |
| acpigen_write_len_f(ctx); | |
| acpigen_emit_byte(ctx, WORD_PREFIX); | |
| ctx->len_stack[ctx->ltop++] = ctx->current; | |
| /* | |
| * Add two dummy bytes for the ACPI word (keep aligned with the | |
| * calculation in acpigen_write_resourcetemplate_footer() below) | |
| */ | |
| acpigen_emit_byte(ctx, 0x00); | |
| acpigen_emit_byte(ctx, 0x00); | |
| } | |
| void acpigen_write_resourcetemplate_footer(struct acpi_ctx *ctx) | |
| { | |
| char *p = ctx->len_stack[--ctx->ltop]; | |
| int len; | |
| /* | |
| * See ACPI v6.3 section 6.4.2.9: End Tag | |
| * 0x79 <checksum> | |
| * 0x00 is treated as a good checksum according to the spec | |
| * and is what iasl generates. | |
| */ | |
| acpigen_emit_byte(ctx, ACPI_END_TAG); | |
| acpigen_emit_byte(ctx, 0x00); | |
| /* | |
| * Start counting past the 2-bytes length added in | |
| * acpigen_write_resourcetemplate_header() above | |
| */ | |
| len = (char *)ctx->current - (p + 2); | |
| /* patch len word */ | |
| p[0] = len & 0xff; | |
| p[1] = (len >> 8) & 0xff; | |
| acpigen_pop_len(ctx); | |
| } | |
| void acpigen_write_register_resource(struct acpi_ctx *ctx, | |
| const struct acpi_gen_regaddr *addr) | |
| { | |
| acpigen_write_resourcetemplate_header(ctx); | |
| acpigen_write_register(ctx, addr); | |
| acpigen_write_resourcetemplate_footer(ctx); | |
| } | |
| void acpigen_write_ppc(struct acpi_ctx *ctx, uint num_pstates) | |
| { | |
| /* | |
| * Method (_PPC, 0, NotSerialized) | |
| * { | |
| * Return (num_pstates) | |
| * } | |
| */ | |
| acpigen_write_method(ctx, "_PPC", 0); | |
| acpigen_emit_byte(ctx, RETURN_OP); | |
| acpigen_write_byte(ctx, num_pstates); | |
| acpigen_pop_len(ctx); | |
| } | |
| /* | |
| * Generates a func with max supported P-states saved | |
| * in the variable PPCM. | |
| */ | |
| void acpigen_write_ppc_nvs(struct acpi_ctx *ctx) | |
| { | |
| /* | |
| * Method (_PPC, 0, NotSerialized) | |
| * { | |
| * Return (PPCM) | |
| * } | |
| */ | |
| acpigen_write_method(ctx, "_PPC", 0); | |
| acpigen_emit_byte(ctx, RETURN_OP); | |
| acpigen_emit_namestring(ctx, "PPCM"); | |
| acpigen_pop_len(ctx); | |
| } | |
| void acpigen_write_tpc(struct acpi_ctx *ctx, const char *gnvs_tpc_limit) | |
| { | |
| /* | |
| * // Sample _TPC method | |
| * Method (_TPC, 0, NotSerialized) | |
| * { | |
| * Return (\TLVL) | |
| * } | |
| */ | |
| acpigen_write_method(ctx, "_TPC", 0); | |
| acpigen_emit_byte(ctx, RETURN_OP); | |
| acpigen_emit_namestring(ctx, gnvs_tpc_limit); | |
| acpigen_pop_len(ctx); | |
| } | |
| void acpigen_write_prw(struct acpi_ctx *ctx, uint wake, uint level) | |
| { | |
| /* Name (_PRW, Package () { wake, level } */ | |
| acpigen_write_name(ctx, "_PRW"); | |
| acpigen_write_package(ctx, 2); | |
| acpigen_write_integer(ctx, wake); | |
| acpigen_write_integer(ctx, level); | |
| acpigen_pop_len(ctx); | |
| } | |
| void acpigen_write_pss_package(struct acpi_ctx *ctx, u32 core_freq, u32 power, | |
| u32 trans_lat, u32 busm_lat, u32 control, | |
| u32 status) | |
| { | |
| acpigen_write_package(ctx, 6); | |
| acpigen_write_dword(ctx, core_freq); | |
| acpigen_write_dword(ctx, power); | |
| acpigen_write_dword(ctx, trans_lat); | |
| acpigen_write_dword(ctx, busm_lat); | |
| acpigen_write_dword(ctx, control); | |
| acpigen_write_dword(ctx, status); | |
| acpigen_pop_len(ctx); | |
| log_debug("PSS: %uMHz power %u control 0x%x status 0x%x\n", | |
| core_freq, power, control, status); | |
| } | |
| void acpigen_write_psd_package(struct acpi_ctx *ctx, uint domain, uint numprocs, | |
| enum psd_coord coordtype) | |
| { | |
| acpigen_write_name(ctx, "_PSD"); | |
| acpigen_write_package(ctx, 1); | |
| acpigen_write_package(ctx, 5); | |
| acpigen_write_byte(ctx, 5); // 5 values | |
| acpigen_write_byte(ctx, 0); // revision 0 | |
| acpigen_write_dword(ctx, domain); | |
| acpigen_write_dword(ctx, coordtype); | |
| acpigen_write_dword(ctx, numprocs); | |
| acpigen_pop_len(ctx); | |
| acpigen_pop_len(ctx); | |
| } | |
| static void acpigen_write_cst_package_entry(struct acpi_ctx *ctx, | |
| const struct acpi_cstate *cstate) | |
| { | |
| acpigen_write_package(ctx, 4); | |
| acpigen_write_register_resource(ctx, &cstate->resource); | |
| acpigen_write_dword(ctx, cstate->ctype); | |
| acpigen_write_dword(ctx, cstate->latency); | |
| acpigen_write_dword(ctx, cstate->power); | |
| acpigen_pop_len(ctx); | |
| } | |
| void acpigen_write_cst_package(struct acpi_ctx *ctx, | |
| const struct acpi_cstate *cstate, int nentries) | |
| { | |
| int i; | |
| acpigen_write_name(ctx, "_CST"); | |
| acpigen_write_package(ctx, nentries + 1); | |
| acpigen_write_dword(ctx, nentries); | |
| for (i = 0; i < nentries; i++) | |
| acpigen_write_cst_package_entry(ctx, cstate + i); | |
| acpigen_pop_len(ctx); | |
| } | |
| void acpigen_write_csd_package(struct acpi_ctx *ctx, uint domain, uint numprocs, | |
| enum csd_coord coordtype, uint index) | |
| { | |
| acpigen_write_name(ctx, "_CSD"); | |
| acpigen_write_package(ctx, 1); | |
| acpigen_write_package(ctx, 6); | |
| acpigen_write_byte(ctx, 6); // 6 values | |
| acpigen_write_byte(ctx, 0); // revision 0 | |
| acpigen_write_dword(ctx, domain); | |
| acpigen_write_dword(ctx, coordtype); | |
| acpigen_write_dword(ctx, numprocs); | |
| acpigen_write_dword(ctx, index); | |
| acpigen_pop_len(ctx); | |
| acpigen_pop_len(ctx); | |
| } | |
| void acpigen_write_tss_package(struct acpi_ctx *ctx, | |
| struct acpi_tstate *entry, int nentries) | |
| { | |
| /* | |
| * Sample _TSS package with 100% and 50% duty cycles | |
| * Name (_TSS, Package (0x02) | |
| * { | |
| * Package(){100, 1000, 0, 0x00, 0) | |
| * Package(){50, 520, 0, 0x18, 0) | |
| * }) | |
| */ | |
| struct acpi_tstate *tstate = entry; | |
| int i; | |
| acpigen_write_name(ctx, "_TSS"); | |
| acpigen_write_package(ctx, nentries); | |
| for (i = 0; i < nentries; i++) { | |
| acpigen_write_package(ctx, 5); | |
| acpigen_write_dword(ctx, tstate->percent); | |
| acpigen_write_dword(ctx, tstate->power); | |
| acpigen_write_dword(ctx, tstate->latency); | |
| acpigen_write_dword(ctx, tstate->control); | |
| acpigen_write_dword(ctx, tstate->status); | |
| acpigen_pop_len(ctx); | |
| tstate++; | |
| } | |
| acpigen_pop_len(ctx); | |
| } | |
| void acpigen_write_tsd_package(struct acpi_ctx *ctx, u32 domain, u32 numprocs, | |
| enum psd_coord coordtype) | |
| { | |
| acpigen_write_name(ctx, "_TSD"); | |
| acpigen_write_package(ctx, 1); | |
| acpigen_write_package(ctx, 5); | |
| acpigen_write_byte(ctx, 5); // 5 values | |
| acpigen_write_byte(ctx, 0); // revision 0 | |
| acpigen_write_dword(ctx, domain); | |
| acpigen_write_dword(ctx, coordtype); | |
| acpigen_write_dword(ctx, numprocs); | |
| acpigen_pop_len(ctx); | |
| acpigen_pop_len(ctx); | |
| } | |
| /* | |
| * ToUUID(uuid) | |
| * | |
| * ACPI 6.3 Section 19.6.142 table 19-438 defines a special output order for the | |
| * bytes that make up a UUID Buffer object: | |
| * | |
| * UUID byte order for input to this function: | |
| * aabbccdd-eeff-gghh-iijj-kkllmmnnoopp | |
| * | |
| * UUID byte order output by this function: | |
| * ddccbbaa-ffee-hhgg-iijj-kkllmmnnoopp | |
| */ | |
| int acpigen_write_uuid(struct acpi_ctx *ctx, const char *uuid) | |
| { | |
| u8 buf[UUID_BIN_LEN]; | |
| int ret; | |
| /* Parse UUID string into bytes */ | |
| ret = uuid_str_to_bin(uuid, buf, UUID_STR_FORMAT_GUID); | |
| if (ret) | |
| return log_msg_ret("bad hex", -EINVAL); | |
| /* BufferOp */ | |
| acpigen_emit_byte(ctx, BUFFER_OP); | |
| acpigen_write_len_f(ctx); | |
| /* Buffer length in bytes */ | |
| acpigen_write_word(ctx, UUID_BIN_LEN); | |
| /* Output UUID in expected order */ | |
| acpigen_emit_stream(ctx, (char *)buf, UUID_BIN_LEN); | |
| acpigen_pop_len(ctx); | |
| return 0; | |
| } | |
| void acpigen_write_power_res(struct acpi_ctx *ctx, const char *name, uint level, | |
| uint order, const char *const dev_states[], | |
| size_t dev_states_count) | |
| { | |
| size_t i; | |
| for (i = 0; i < dev_states_count; i++) { | |
| acpigen_write_name(ctx, dev_states[i]); | |
| acpigen_write_package(ctx, 1); | |
| acpigen_emit_simple_namestring(ctx, name); | |
| acpigen_pop_len(ctx); /* Package */ | |
| } | |
| acpigen_emit_ext_op(ctx, POWER_RES_OP); | |
| acpigen_write_len_f(ctx); | |
| acpigen_emit_simple_namestring(ctx, name); | |
| acpigen_emit_byte(ctx, level); | |
| acpigen_emit_word(ctx, order); | |
| } | |
| /* Sleep (ms) */ | |
| void acpigen_write_sleep(struct acpi_ctx *ctx, u64 sleep_ms) | |
| { | |
| acpigen_emit_ext_op(ctx, SLEEP_OP); | |
| acpigen_write_integer(ctx, sleep_ms); | |
| } | |
| void acpigen_write_store(struct acpi_ctx *ctx) | |
| { | |
| acpigen_emit_byte(ctx, STORE_OP); | |
| } | |
| /* Or (arg1, arg2, res) */ | |
| void acpigen_write_or(struct acpi_ctx *ctx, u8 arg1, u8 arg2, u8 res) | |
| { | |
| acpigen_emit_byte(ctx, OR_OP); | |
| acpigen_emit_byte(ctx, arg1); | |
| acpigen_emit_byte(ctx, arg2); | |
| acpigen_emit_byte(ctx, res); | |
| } | |
| /* And (arg1, arg2, res) */ | |
| void acpigen_write_and(struct acpi_ctx *ctx, u8 arg1, u8 arg2, u8 res) | |
| { | |
| acpigen_emit_byte(ctx, AND_OP); | |
| acpigen_emit_byte(ctx, arg1); | |
| acpigen_emit_byte(ctx, arg2); | |
| acpigen_emit_byte(ctx, res); | |
| } | |
| /* Not (arg, res) */ | |
| void acpigen_write_not(struct acpi_ctx *ctx, u8 arg, u8 res) | |
| { | |
| acpigen_emit_byte(ctx, NOT_OP); | |
| acpigen_emit_byte(ctx, arg); | |
| acpigen_emit_byte(ctx, res); | |
| } | |
| /* Store (str, DEBUG) */ | |
| void acpigen_write_debug_string(struct acpi_ctx *ctx, const char *str) | |
| { | |
| acpigen_write_store(ctx); | |
| acpigen_write_string(ctx, str); | |
| acpigen_emit_ext_op(ctx, DEBUG_OP); | |
| } | |
| void acpigen_write_if(struct acpi_ctx *ctx) | |
| { | |
| acpigen_emit_byte(ctx, IF_OP); | |
| acpigen_write_len_f(ctx); | |
| } | |
| void acpigen_write_if_lequal_op_int(struct acpi_ctx *ctx, uint op, u64 val) | |
| { | |
| acpigen_write_if(ctx); | |
| acpigen_emit_byte(ctx, LEQUAL_OP); | |
| acpigen_emit_byte(ctx, op); | |
| acpigen_write_integer(ctx, val); | |
| } | |
| void acpigen_write_else(struct acpi_ctx *ctx) | |
| { | |
| acpigen_emit_byte(ctx, ELSE_OP); | |
| acpigen_write_len_f(ctx); | |
| } | |
| void acpigen_write_to_buffer(struct acpi_ctx *ctx, uint src, uint dst) | |
| { | |
| acpigen_emit_byte(ctx, TO_BUFFER_OP); | |
| acpigen_emit_byte(ctx, src); | |
| acpigen_emit_byte(ctx, dst); | |
| } | |
| void acpigen_write_to_integer(struct acpi_ctx *ctx, uint src, uint dst) | |
| { | |
| acpigen_emit_byte(ctx, TO_INTEGER_OP); | |
| acpigen_emit_byte(ctx, src); | |
| acpigen_emit_byte(ctx, dst); | |
| } | |
| void acpigen_write_byte_buffer(struct acpi_ctx *ctx, u8 *arr, size_t size) | |
| { | |
| size_t i; | |
| acpigen_emit_byte(ctx, BUFFER_OP); | |
| acpigen_write_len_f(ctx); | |
| acpigen_write_integer(ctx, size); | |
| for (i = 0; i < size; i++) | |
| acpigen_emit_byte(ctx, arr[i]); | |
| acpigen_pop_len(ctx); | |
| } | |
| void acpigen_write_return_byte_buffer(struct acpi_ctx *ctx, u8 *arr, | |
| size_t size) | |
| { | |
| acpigen_emit_byte(ctx, RETURN_OP); | |
| acpigen_write_byte_buffer(ctx, arr, size); | |
| } | |
| void acpigen_write_return_singleton_buffer(struct acpi_ctx *ctx, uint arg) | |
| { | |
| u8 buf = arg; | |
| acpigen_write_return_byte_buffer(ctx, &buf, 1); | |
| } | |
| void acpigen_write_return_byte(struct acpi_ctx *ctx, uint arg) | |
| { | |
| acpigen_emit_byte(ctx, RETURN_OP); | |
| acpigen_write_byte(ctx, arg); | |
| } | |
| void acpigen_write_dsm_start(struct acpi_ctx *ctx) | |
| { | |
| /* Method (_DSM, 4, Serialized) */ | |
| acpigen_write_method_serialized(ctx, "_DSM", 4); | |
| /* ToBuffer (Arg0, Local0) */ | |
| acpigen_write_to_buffer(ctx, ARG0_OP, LOCAL0_OP); | |
| } | |
| int acpigen_write_dsm_uuid_start(struct acpi_ctx *ctx, const char *uuid) | |
| { | |
| int ret; | |
| /* If (LEqual (Local0, ToUUID(uuid))) */ | |
| acpigen_write_if(ctx); | |
| acpigen_emit_byte(ctx, LEQUAL_OP); | |
| acpigen_emit_byte(ctx, LOCAL0_OP); | |
| ret = acpigen_write_uuid(ctx, uuid); | |
| if (ret) | |
| return log_msg_ret("uuid", ret); | |
| /* ToInteger (Arg2, Local1) */ | |
| acpigen_write_to_integer(ctx, ARG2_OP, LOCAL1_OP); | |
| return 0; | |
| } | |
| void acpigen_write_dsm_uuid_start_cond(struct acpi_ctx *ctx, int seq) | |
| { | |
| /* If (LEqual (Local1, i)) */ | |
| acpigen_write_if_lequal_op_int(ctx, LOCAL1_OP, seq); | |
| } | |
| void acpigen_write_dsm_uuid_end_cond(struct acpi_ctx *ctx) | |
| { | |
| acpigen_pop_len(ctx); /* If */ | |
| } | |
| void acpigen_write_dsm_uuid_end(struct acpi_ctx *ctx) | |
| { | |
| /* Default case: Return (Buffer (One) { 0x0 }) */ | |
| acpigen_write_return_singleton_buffer(ctx, 0x0); | |
| acpigen_pop_len(ctx); /* If (LEqual (Local0, ToUUID(uuid))) */ | |
| } | |
| void acpigen_write_dsm_end(struct acpi_ctx *ctx) | |
| { | |
| /* Return (Buffer (One) { 0x0 }) */ | |
| acpigen_write_return_singleton_buffer(ctx, 0x0); | |
| acpigen_pop_len(ctx); /* Method _DSM */ | |
| } | |
| /** | |
| * acpigen_get_dw0_in_local5() - Generate code to put dw0 cfg0 in local5 | |
| * | |
| * Store (\_SB.GPC0 (addr), Local5) | |
| * | |
| * \_SB.GPC0 is used to read cfg0 value from dw0. It is typically defined in | |
| * the board's gpiolib.asl | |
| * | |
| * The value needs to be stored in a local variable so that it can be used in | |
| * expressions in the ACPI code. | |
| * | |
| * @ctx: ACPI context pointer | |
| * @dw0_read: Name to use to read dw0, e.g. "\\_SB.GPC0" | |
| * @addr: GPIO pin configuration register address | |
| * | |
| */ | |
| static void acpigen_get_dw0_in_local5(struct acpi_ctx *ctx, | |
| const char *dw0_read, ulong addr) | |
| { | |
| acpigen_write_store(ctx); | |
| acpigen_emit_namestring(ctx, dw0_read); | |
| acpigen_write_integer(ctx, addr); | |
| acpigen_emit_byte(ctx, LOCAL5_OP); | |
| } | |
| /** | |
| * acpigen_set_gpio_val() - Emit code to set value of TX GPIO to on/off | |
| * | |
| * @ctx: ACPI context pointer | |
| * @dw0_read: Method name to use to read dw0, e.g. "\\_SB.GPC0" | |
| * @dw0_write: Method name to use to read dw0, e.g. "\\_SB.SPC0" | |
| * @gpio_num: GPIO number to adjust | |
| * @vaL: true to set on, false to set off | |
| */ | |
| static int acpigen_set_gpio_val(struct acpi_ctx *ctx, u32 tx_state_val, | |
| const char *dw0_read, const char *dw0_write, | |
| struct acpi_gpio *gpio, bool val) | |
| { | |
| acpigen_get_dw0_in_local5(ctx, dw0_read, gpio->pin0_addr); | |
| /* Store (0x40, Local0) */ | |
| acpigen_write_store(ctx); | |
| acpigen_write_integer(ctx, tx_state_val); | |
| acpigen_emit_byte(ctx, LOCAL0_OP); | |
| if (val) { | |
| /* Or (Local5, PAD_CFG0_TX_STATE, Local5) */ | |
| acpigen_write_or(ctx, LOCAL5_OP, LOCAL0_OP, LOCAL5_OP); | |
| } else { | |
| /* Not (PAD_CFG0_TX_STATE, Local6) */ | |
| acpigen_write_not(ctx, LOCAL0_OP, LOCAL6_OP); | |
| /* And (Local5, Local6, Local5) */ | |
| acpigen_write_and(ctx, LOCAL5_OP, LOCAL6_OP, LOCAL5_OP); | |
| } | |
| /* | |
| * \_SB.SPC0 (addr, Local5) | |
| * \_SB.SPC0 is used to write cfg0 value in dw0. It is defined in | |
| * gpiolib.asl. | |
| */ | |
| acpigen_emit_namestring(ctx, dw0_write); | |
| acpigen_write_integer(ctx, gpio->pin0_addr); | |
| acpigen_emit_byte(ctx, LOCAL5_OP); | |
| return 0; | |
| } | |
| int acpigen_set_enable_tx_gpio(struct acpi_ctx *ctx, u32 tx_state_val, | |
| const char *dw0_read, const char *dw0_write, | |
| struct acpi_gpio *gpio, bool enable) | |
| { | |
| bool set; | |
| int ret; | |
| set = gpio->polarity == ACPI_GPIO_ACTIVE_HIGH ? enable : !enable; | |
| ret = acpigen_set_gpio_val(ctx, tx_state_val, dw0_read, dw0_write, gpio, | |
| set); | |
| if (ret) | |
| return log_msg_ret("call", ret); | |
| return 0; | |
| } |