src/superio/common/conf_mode.c

/* SPDX-License-Identifier: GPL-2.0-only */

#include <arch/io.h>
#include <device/device.h>
#include <superio/conf_mode.h>
#include <acpi/acpigen.h>

/* Common enter/exit implementations */

void pnp_enter_conf_mode_55(struct device *dev)
{
	outb(0x55, dev->path.pnp.port);
}

void pnp_enter_conf_mode_6767(struct device *dev)
{
	outb(0x67, dev->path.pnp.port);
	outb(0x67, dev->path.pnp.port);
}

void pnp_enter_conf_mode_7777(struct device *dev)
{
	outb(0x77, dev->path.pnp.port);
	outb(0x77, dev->path.pnp.port);
}

void pnp_enter_conf_mode_8787(struct device *dev)
{
	outb(0x87, dev->path.pnp.port);
	outb(0x87, dev->path.pnp.port);
}

void pnp_enter_conf_mode_a0a0(struct device *dev)
{
	outb(0xa0, dev->path.pnp.port);
	outb(0xa0, dev->path.pnp.port);
}

void pnp_enter_conf_mode_a5a5(struct device *dev)
{
	outb(0xa5, dev->path.pnp.port);
	outb(0xa5, dev->path.pnp.port);
}

void pnp_exit_conf_mode_aa(struct device *dev)
{
	outb(0xaa, dev->path.pnp.port);
}

void pnp_enter_conf_mode_870155aa(struct device *dev)
{
	outb(0x87, dev->path.pnp.port);
	outb(0x01, dev->path.pnp.port);
	outb(0x55, dev->path.pnp.port);

	if (dev->path.pnp.port == 0x4e)
		outb(0xaa, dev->path.pnp.port);
	else
		outb(0x55, dev->path.pnp.port);
}

void pnp_exit_conf_mode_0202(struct device *dev)
{
	pnp_write_config(dev, 0x02, (1 << 1));
}

/* Functions for ACPI */
#if CONFIG(HAVE_ACPI_TABLES)
static void pnp_ssdt_enter_conf_mode_55(struct device *dev, const char *idx, const char *data)
{
	acpigen_write_store();
	acpigen_write_byte(0x55);
	acpigen_emit_namestring(idx);
}

static void pnp_ssdt_enter_conf_mode_6767(struct device *dev, const char *idx, const char *data)
{
	acpigen_write_store();
	acpigen_write_byte(0x67);
	acpigen_emit_namestring(idx);

	acpigen_write_store();
	acpigen_write_byte(0x67);
	acpigen_emit_namestring(idx);
}

static void pnp_ssdt_enter_conf_mode_7777(struct device *dev, const char *idx, const char *data)
{
	acpigen_write_store();
	acpigen_write_byte(0x77);
	acpigen_emit_namestring(idx);

	acpigen_write_store();
	acpigen_write_byte(0x77);
	acpigen_emit_namestring(idx);
}

static void pnp_ssdt_enter_conf_mode_8787(struct device *dev, const char *idx, const char *data)
{
	acpigen_write_store();
	acpigen_write_byte(0x87);
	acpigen_emit_namestring(idx);

	acpigen_write_store();
	acpigen_write_byte(0x87);
	acpigen_emit_namestring(idx);
}

static void pnp_ssdt_enter_conf_mode_a0a0(struct device *dev, const char *idx, const char *data)
{
	acpigen_write_store();
	acpigen_write_byte(0xa0);
	acpigen_emit_namestring(idx);

	acpigen_write_store();
	acpigen_write_byte(0xa0);
	acpigen_emit_namestring(idx);

}

static void pnp_ssdt_enter_conf_mode_a5a5(struct device *dev, const char *idx, const char *data)
{
	acpigen_write_store();
	acpigen_write_byte(0xa5);
	acpigen_emit_namestring(idx);

	acpigen_write_store();
	acpigen_write_byte(0xa5);
	acpigen_emit_namestring(idx);
}

static void pnp_ssdt_enter_conf_mode_870155aa(struct device *dev,
					      const char *idx, const char *data)
{
	acpigen_write_store();
	acpigen_write_byte(0x87);
	acpigen_emit_namestring(idx);

	acpigen_write_store();
	acpigen_write_byte(0x01);
	acpigen_emit_namestring(idx);

	acpigen_write_store();
	acpigen_write_byte(0x55);
	acpigen_emit_namestring(idx);

	acpigen_write_store();
	if (dev->path.pnp.port == 0x4e)
		acpigen_write_byte(0xaa);
	else
		acpigen_write_byte(0x55);
	acpigen_emit_namestring(idx);
}

static void pnp_ssdt_exit_conf_mode_aa(struct device *dev, const char *idx, const char *data)
{
	acpigen_write_store();
	acpigen_write_byte(0xaa);
	acpigen_emit_namestring(idx);
}

static void pnp_ssdt_exit_conf_mode_0202(struct device *dev, const char *idx, const char *data)
{

	acpigen_write_store();
	acpigen_write_byte(0x02);
	acpigen_emit_namestring(idx);

	acpigen_write_store();
	acpigen_write_byte(0x02);
	acpigen_emit_namestring(data);
}
#endif

const struct pnp_mode_ops pnp_conf_mode_55_aa = {
	.enter_conf_mode = pnp_enter_conf_mode_55,
	.exit_conf_mode  = pnp_exit_conf_mode_aa,
#if CONFIG(HAVE_ACPI_TABLES)
	.ssdt_enter_conf_mode = pnp_ssdt_enter_conf_mode_55,
	.ssdt_exit_conf_mode = pnp_ssdt_exit_conf_mode_aa,
#endif
};

const struct pnp_mode_ops pnp_conf_mode_6767_aa = {
	.enter_conf_mode = pnp_enter_conf_mode_6767,
	.exit_conf_mode  = pnp_exit_conf_mode_aa,
#if CONFIG(HAVE_ACPI_TABLES)
	.ssdt_enter_conf_mode = pnp_ssdt_enter_conf_mode_6767,
	.ssdt_exit_conf_mode = pnp_ssdt_exit_conf_mode_aa,
#endif
};

const struct pnp_mode_ops pnp_conf_mode_7777_aa = {
	.enter_conf_mode = pnp_enter_conf_mode_7777,
	.exit_conf_mode  = pnp_exit_conf_mode_aa,
#if CONFIG(HAVE_ACPI_TABLES)
	.ssdt_enter_conf_mode = pnp_ssdt_enter_conf_mode_7777,
	.ssdt_exit_conf_mode = pnp_ssdt_exit_conf_mode_aa,
#endif
};

const struct pnp_mode_ops pnp_conf_mode_8787_aa = {
	.enter_conf_mode = pnp_enter_conf_mode_8787,
	.exit_conf_mode  = pnp_exit_conf_mode_aa,
#if CONFIG(HAVE_ACPI_TABLES)
	.ssdt_enter_conf_mode = pnp_ssdt_enter_conf_mode_8787,
	.ssdt_exit_conf_mode = pnp_ssdt_exit_conf_mode_aa,
#endif
};

const struct pnp_mode_ops pnp_conf_mode_a0a0_aa = {
	.enter_conf_mode = pnp_enter_conf_mode_a0a0,
	.exit_conf_mode  = pnp_exit_conf_mode_aa,
#if CONFIG(HAVE_ACPI_TABLES)
	.ssdt_enter_conf_mode = pnp_ssdt_enter_conf_mode_a0a0,
	.ssdt_exit_conf_mode = pnp_ssdt_exit_conf_mode_aa,
#endif
};

const struct pnp_mode_ops pnp_conf_mode_a5a5_aa = {
	.enter_conf_mode = pnp_enter_conf_mode_a5a5,
	.exit_conf_mode  = pnp_exit_conf_mode_aa,
#if CONFIG(HAVE_ACPI_TABLES)
	.ssdt_enter_conf_mode = pnp_ssdt_enter_conf_mode_a5a5,
	.ssdt_exit_conf_mode = pnp_ssdt_exit_conf_mode_aa,
#endif
};

const struct pnp_mode_ops pnp_conf_mode_870155_aa = {
	.enter_conf_mode = pnp_enter_conf_mode_870155aa,
	.exit_conf_mode  = pnp_exit_conf_mode_0202,
#if CONFIG(HAVE_ACPI_TABLES)
	.ssdt_enter_conf_mode = pnp_ssdt_enter_conf_mode_870155aa,
	.ssdt_exit_conf_mode = pnp_ssdt_exit_conf_mode_0202,
#endif
};