mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-08-19 00:18:51 +09:00
![Simon Glass](/assets/img/avatar_default.png)
This adds tables relating to P-States and C-States. Signed-off-by: Simon Glass <sjg@chromium.org>
971 lines
24 KiB
C
971 lines
24 KiB
C
// 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 <common.h>
|
|
#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;
|
|
}
|