diff mbox

[2/3,V2] acpi: mpst: add ACPI MPST test

Message ID 1470212033-6185-2-git-send-email-alex.hung@canonical.com
State Superseded
Headers show

Commit Message

Alex Hung Aug. 3, 2016, 8:13 a.m. UTC
Signed-off-by: Alex Hung <alex.hung@canonical.com>
---
 src/Makefile.am      |   1 +
 src/acpi/mpst/mpst.c | 227 +++++++++++++++++++++++++++++++++++++++++++++++++++
 2 files changed, 228 insertions(+)
 create mode 100644 src/acpi/mpst/mpst.c

Comments

Ivan Hu Aug. 8, 2016, 3:29 a.m. UTC | #1
On 2016年08月03日 16:13, Alex Hung wrote:
> Signed-off-by: Alex Hung <alex.hung@canonical.com>
> ---
>  src/Makefile.am      |   1 +
>  src/acpi/mpst/mpst.c | 227 +++++++++++++++++++++++++++++++++++++++++++++++++++
>  2 files changed, 228 insertions(+)
>  create mode 100644 src/acpi/mpst/mpst.c
>
> diff --git a/src/Makefile.am b/src/Makefile.am
> index bc23e8d..ff82cbc 100644
> --- a/src/Makefile.am
> +++ b/src/Makefile.am
> @@ -70,6 +70,7 @@ fwts_SOURCES = main.c 				\
>  	acpi/madt/madt.c			\
>  	acpi/mcfg/mcfg.c 			\
>  	acpi/mchi/mchi.c 			\
> +	acpi/mpst/mpst.c 			\
>  	acpi/msct/msct.c 			\
>  	acpi/msdm/msdm.c 			\
>  	acpi/method/method.c 			\
> diff --git a/src/acpi/mpst/mpst.c b/src/acpi/mpst/mpst.c
> new file mode 100644
> index 0000000..02fe47d
> --- /dev/null
> +++ b/src/acpi/mpst/mpst.c
> @@ -0,0 +1,227 @@
> +/*
> + * Copyright (C) 2016 Canonical
> + *
> + * This program is free software; you can redistribute it and/or
> + * modify it under the terms of the GNU General Public License
> + * as published by the Free Software Foundation; either version 2
> + * of the License, or (at your option) any later version.
> + *
> + * This program is distributed in the hope that it will be useful,
> + * but WITHOUT ANY WARRANTY; without even the implied warranty of
> + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
> + * GNU General Public License for more details.
> + *
> + */
> +#include "fwts.h"
> +
> +#if defined(FWTS_HAS_ACPI)
> +
> +#include <stdlib.h>
> +#include <stdio.h>
> +#include <string.h>
> +#include <unistd.h>
> +#include <inttypes.h>
> +#include <stdbool.h>
> +
> +static fwts_acpi_table_info *table;
> +
> +static int mpst_init(fwts_framework *fw)
> +{
> +	if (fwts_acpi_find_table(fw, "MPST", 0, &table) != FWTS_OK) {
> +		fwts_log_error(fw, "Cannot load ACPI table");
> +		return FWTS_ERROR;
> +	}
> +	if (table == NULL) {
> +		fwts_log_error(fw, "ACPI MPST table does not exist, skipping test");
> +		return FWTS_ERROR;
> +	}
> +
> +	return FWTS_OK;
> +}
> +
> +static int mpst_test1(fwts_framework *fw)
> +{
> +	fwts_acpi_table_mpst *mpst = (fwts_acpi_table_mpst*) table->data;
> +	fwts_acpi_table_mpst_power_node_list *node_list;
> +	fwts_acpi_table_mpst_power_char_list *char_list;
> +	bool passed = true;
> +	uint32_t reserved;
> +	uint32_t node_offset;
> +	uint16_t i, j;
> +
> +	reserved = (uint32_t) mpst->reserved[0] +
> +		   ((uint32_t) mpst->reserved[1] << 8) +
> +		   ((uint32_t) mpst->reserved[2] << 16);
> +
> +	fwts_log_info_verbatim(fw, "MPST Table:");
> +	fwts_log_info_verbatim(fw, "  Communication Channel ID:        0x%2.2" PRIx8, mpst->channel_id);
> +	fwts_log_info_verbatim(fw, "  Reserved:                        0x%8.8" PRIx32, reserved);
> +
> +	if (reserved != 0) {
> +		passed = false;
> +		fwts_failed(fw, LOG_LEVEL_LOW,
> +			"MPSTReservedNonZero",
> +			"MPST reserved field must be zero, got "
> +			"0x%8.8" PRIx32 " instead", reserved);
> +	}
> +
> +	node_list = (fwts_acpi_table_mpst_power_node_list *) (table->data + sizeof(fwts_acpi_table_mpst));
> +	fwts_log_info_verbatim(fw, "  Memory Power Node Count:         0x%4.4" PRIx16, node_list->count);
> +	fwts_log_info_verbatim(fw, "  Reserved:                        0x%4.4" PRIx16, node_list->reserved);
> +
> +	if (node_list->reserved != 0) {
> +		passed = false;
> +		fwts_failed(fw, LOG_LEVEL_LOW,
> +			"MPSTReservedNonZero",
> +			"MPST reserved field must be zero, got "
> +			"0x%4.4" PRIx16 " instead", node_list->reserved);
> +	}
> +
> +	node_offset = sizeof(fwts_acpi_table_mpst) + (sizeof(fwts_acpi_table_mpst_power_node_list));
> +	for (i = 0; i < node_list->count; i++) {
> +		fwts_acpi_table_mpst_power_node *power_node = (fwts_acpi_table_mpst_power_node *) (table->data + node_offset);
> +		uint32_t node_length;
> +
> +		fwts_log_info_verbatim(fw, "  MPST Power Node:");
> +		fwts_log_info_verbatim(fw, "    Flags:                         0x%2.2" PRIx8, power_node->flags);
> +		fwts_log_info_verbatim(fw, "    Reserved:                      0x%2.2" PRIx8, power_node->reserved);
> +		fwts_log_info_verbatim(fw, "    Memory Power Node Id:          0x%4.4" PRIx16, power_node->node_id);
> +		fwts_log_info_verbatim(fw, "    Power Node Length:             0x%8.8" PRIx32, power_node->length);
> +		fwts_log_info_verbatim(fw, "    Base Address:                  0x%16.16" PRIx64, power_node->range_address);
> +		fwts_log_info_verbatim(fw, "    Memory Length:                 0x%16.16" PRIx64, power_node->range_ength);
> +		fwts_log_info_verbatim(fw, "    Number of Power States:        0x%8.8" PRIx32, power_node->num_states);
> +		fwts_log_info_verbatim(fw, "    Number of Physical Components: 0x%8.8" PRIx32, power_node->num_components);
> +
> +		if (power_node->flags & ~0x7) {
> +			passed = false;
> +			fwts_failed(fw, LOG_LEVEL_HIGH,
> +				"MPSTBadPowerNodeFlags",
> +				"MPST Power Node Flags Bit 3..7 be zero, got "
> +				"0x%2.2" PRIx8 " instead", power_node->flags);
> +		}
> +
> +		if (power_node->reserved != 0) {
> +			passed = false;
> +			fwts_failed(fw, LOG_LEVEL_LOW,
> +				"MPSTReservedNonZero",
> +				"MPST reserved field must be zero, got "
> +				"0x%2.2" PRIx8 " instead", power_node->reserved);
> +		}
> +
> +		node_length = sizeof(fwts_acpi_table_mpst_power_node) +
> +			      sizeof(fwts_acpi_table_mpst_power_state) * power_node->num_states +
> +			      sizeof(fwts_acpi_table_mpst_component) * power_node->num_components;
> +
> +		if (power_node->length != node_length) {
> +			passed = false;
> +			fwts_failed(fw, LOG_LEVEL_HIGH,
> +				"MPSTBadPowerNodeLength",
> +				"MPST Power Node Length should be 0x%8.8" PRIx32 ", got "
> +				"0x%8.8" PRIx32 " instead", node_length, power_node->length);
> +		}
> +
> +		node_offset += sizeof(fwts_acpi_table_mpst_power_node);
> +		for (j = 0; j < power_node->num_states; j++) {
> +			fwts_acpi_table_mpst_power_state *state = (fwts_acpi_table_mpst_power_state *) (table->data + node_offset);
> +			fwts_log_info_verbatim(fw, "    Power State Value:             0x%2.2" PRIx8, state->value);
> +			fwts_log_info_verbatim(fw, "    Power State Information Index: 0x%2.2" PRIx8, state->info_index);
> +			node_offset += sizeof(fwts_acpi_table_mpst_power_state);
> +		}
> +
> +		for (j = 0; j < power_node->num_components; j++) {
> +			fwts_acpi_table_mpst_component *component = (fwts_acpi_table_mpst_component *) (table->data + node_offset);
> +			fwts_log_info_verbatim(fw, "    Physical Component Id:         0x%2.2" PRIx8, component->id);
> +			node_offset +=  sizeof(fwts_acpi_table_mpst_component);
> +		}
> +	}
> +
> +	char_list = (fwts_acpi_table_mpst_power_char_list *) (table->data + node_offset);
> +	fwts_log_info_verbatim(fw, "  Memory Characteristics Count:    0x%4.4" PRIx16, char_list->count);
> +	fwts_log_info_verbatim(fw, "  Reserved:                        0x%4.4" PRIx16, char_list->reserved);
> +
> +	if (char_list->reserved != 0) {
> +		passed = false;
> +		fwts_failed(fw, LOG_LEVEL_LOW,
> +			"MPSTReservedNonZero",
> +			"MPST reserved field must be zero, got "
> +			"0x%4.4" PRIx16 " instead", char_list->reserved);
> +	}
> +
> +	node_offset += sizeof(fwts_acpi_table_mpst_power_char_list);
> +	for (i = 0; i < char_list->count; i++) {
> +		fwts_acpi_table_mpst_power_char *power_char = (fwts_acpi_table_mpst_power_char *) (table->data + node_offset);
> +
> +		fwts_log_info_verbatim(fw, "  MPST Power Characteristics:");
> +		fwts_log_info_verbatim(fw, "    Power State Structure ID:      0x%2.2" PRIx8, power_char->structure_id);
> +		fwts_log_info_verbatim(fw, "    Flags:                         0x%2.2" PRIx8, power_char->flags);
> +		fwts_log_info_verbatim(fw, "    Reserved:                      0x%4.4" PRIx16, power_char->reserved1);
> +		fwts_log_info_verbatim(fw, "    Average Power Consumed:        0x%8.8" PRIx32, power_char->average_power);
> +		fwts_log_info_verbatim(fw, "    Relative Power Saving:         0x%8.8" PRIx32, power_char->power_saving);
> +		fwts_log_info_verbatim(fw, "    Exit Latency:                  0x%16.16" PRIx64, power_char->exit_latency);
> +		fwts_log_info_verbatim(fw, "    Reserved:                      0x%16.16" PRIx64, power_char->reserved2);
> +
> +		if ((power_char->structure_id & 0x3F) != 1) {
> +			passed = false;
> +			fwts_failed(fw, LOG_LEVEL_HIGH,
> +				"MPSTBadPowerCharacteristicsID",
> +				"MPST Power Characteristics ID must be 1, got "
> +				"0x%2.2" PRIx8 " instead", power_char->structure_id & 0x3F);
> +		}
> +
> +		if (((power_char->structure_id & 0xC0) >> 6) != 1) {
> +			passed = false;
> +			fwts_failed(fw, LOG_LEVEL_HIGH,
> +				"MPSTBadPowerCharacteristicsRevision",
> +				"MPST Power Characteristics Revision must be 1, got "
> +				"0x%2.2" PRIx8 " instead", (power_char->structure_id & 0xC0) >> 6);
> +		}
> +
> +		if (power_char->flags & ~0x7) {
> +			passed = false;
> +			fwts_failed(fw, LOG_LEVEL_HIGH,
> +				"MPSTBadPowerCharacteristicsFlags",
> +				"MPST Power Characteristics Flags Bit 3..7 be zero, got "
> +				"0x%2.2" PRIx8 " instead", power_char->flags);
> +		}
> +
> +		if (power_char->reserved1 != 0) {
> +			passed = false;
> +			fwts_failed(fw, LOG_LEVEL_LOW,
> +				"MPSTReservedNonZero",
> +				"MPST reserved field must be zero, got "
> +				"0x%4.4" PRIx16 " instead", power_char->reserved1);
> +		}
> +
> +		if (power_char->reserved2 != 0) {
> +			passed = false;
> +			fwts_failed(fw, LOG_LEVEL_LOW,
> +				"MPSTReservedNonZero",
> +				"MPST reserved field must be zero, got "
> +				"0x%16.16" PRIx64 " instead", power_char->reserved2);
> +		}
> +
> +		node_offset +=  sizeof(fwts_acpi_table_mpst_power_char);
> +	}
> +
> +	fwts_log_nl(fw);
> +
> +	if (passed)
> +		fwts_passed(fw, "No issues found in MPST table.");
> +
> +	return FWTS_OK;
> +}
> +
> +static fwts_framework_minor_test mpst_tests[] = {
> +	{ mpst_test1, "Validate MPST table." },
> +	{ NULL, NULL }
> +};
> +
> +static fwts_framework_ops mpst_ops = {
> +	.description = "MPST Memory Power State Table test.",
> +	.init        = mpst_init,
> +	.minor_tests = mpst_tests
> +};
> +
> +FWTS_REGISTER("mpst", &mpst_ops, FWTS_TEST_ANYTIME, FWTS_FLAG_BATCH | FWTS_FLAG_TEST_ACPI)
> +
> +#endif
>

Acked-by: Ivan Hu <ivan.hu@canonical.com>
Colin Ian King Aug. 15, 2016, 8:39 a.m. UTC | #2
On 03/08/16 09:13, Alex Hung wrote:
> Signed-off-by: Alex Hung <alex.hung@canonical.com>
> ---
>  src/Makefile.am      |   1 +
>  src/acpi/mpst/mpst.c | 227 +++++++++++++++++++++++++++++++++++++++++++++++++++
>  2 files changed, 228 insertions(+)
>  create mode 100644 src/acpi/mpst/mpst.c
> 
> diff --git a/src/Makefile.am b/src/Makefile.am
> index bc23e8d..ff82cbc 100644
> --- a/src/Makefile.am
> +++ b/src/Makefile.am
> @@ -70,6 +70,7 @@ fwts_SOURCES = main.c 				\
>  	acpi/madt/madt.c			\
>  	acpi/mcfg/mcfg.c 			\
>  	acpi/mchi/mchi.c 			\
> +	acpi/mpst/mpst.c 			\
>  	acpi/msct/msct.c 			\
>  	acpi/msdm/msdm.c 			\
>  	acpi/method/method.c 			\
> diff --git a/src/acpi/mpst/mpst.c b/src/acpi/mpst/mpst.c
> new file mode 100644
> index 0000000..02fe47d
> --- /dev/null
> +++ b/src/acpi/mpst/mpst.c
> @@ -0,0 +1,227 @@
> +/*
> + * Copyright (C) 2016 Canonical
> + *
> + * This program is free software; you can redistribute it and/or
> + * modify it under the terms of the GNU General Public License
> + * as published by the Free Software Foundation; either version 2
> + * of the License, or (at your option) any later version.
> + *
> + * This program is distributed in the hope that it will be useful,
> + * but WITHOUT ANY WARRANTY; without even the implied warranty of
> + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
> + * GNU General Public License for more details.
> + *
> + */
> +#include "fwts.h"
> +
> +#if defined(FWTS_HAS_ACPI)
> +
> +#include <stdlib.h>
> +#include <stdio.h>
> +#include <string.h>
> +#include <unistd.h>
> +#include <inttypes.h>
> +#include <stdbool.h>
> +
> +static fwts_acpi_table_info *table;
> +
> +static int mpst_init(fwts_framework *fw)
> +{
> +	if (fwts_acpi_find_table(fw, "MPST", 0, &table) != FWTS_OK) {
> +		fwts_log_error(fw, "Cannot load ACPI table");
> +		return FWTS_ERROR;
> +	}
> +	if (table == NULL) {
> +		fwts_log_error(fw, "ACPI MPST table does not exist, skipping test");
> +		return FWTS_ERROR;
> +	}
> +
> +	return FWTS_OK;
> +}
> +
> +static int mpst_test1(fwts_framework *fw)
> +{
> +	fwts_acpi_table_mpst *mpst = (fwts_acpi_table_mpst*) table->data;
> +	fwts_acpi_table_mpst_power_node_list *node_list;
> +	fwts_acpi_table_mpst_power_char_list *char_list;
> +	bool passed = true;
> +	uint32_t reserved;
> +	uint32_t node_offset;
> +	uint16_t i, j;
> +
> +	reserved = (uint32_t) mpst->reserved[0] +
> +		   ((uint32_t) mpst->reserved[1] << 8) +
> +		   ((uint32_t) mpst->reserved[2] << 16);
> +
> +	fwts_log_info_verbatim(fw, "MPST Table:");
> +	fwts_log_info_verbatim(fw, "  Communication Channel ID:        0x%2.2" PRIx8, mpst->channel_id);
> +	fwts_log_info_verbatim(fw, "  Reserved:                        0x%8.8" PRIx32, reserved);
> +
> +	if (reserved != 0) {
> +		passed = false;
> +		fwts_failed(fw, LOG_LEVEL_LOW,
> +			"MPSTReservedNonZero",
> +			"MPST reserved field must be zero, got "
> +			"0x%8.8" PRIx32 " instead", reserved);
> +	}
> +
> +	node_list = (fwts_acpi_table_mpst_power_node_list *) (table->data + sizeof(fwts_acpi_table_mpst));
> +	fwts_log_info_verbatim(fw, "  Memory Power Node Count:         0x%4.4" PRIx16, node_list->count);
> +	fwts_log_info_verbatim(fw, "  Reserved:                        0x%4.4" PRIx16, node_list->reserved);
> +
> +	if (node_list->reserved != 0) {
> +		passed = false;
> +		fwts_failed(fw, LOG_LEVEL_LOW,
> +			"MPSTReservedNonZero",
> +			"MPST reserved field must be zero, got "
> +			"0x%4.4" PRIx16 " instead", node_list->reserved);
> +	}
> +
> +	node_offset = sizeof(fwts_acpi_table_mpst) + (sizeof(fwts_acpi_table_mpst_power_node_list));

I think we need to sanity check node_list->count and that we don't fall
off the end of the table.. see comment below

> +	for (i = 0; i < node_list->count; i++) {
> +		fwts_acpi_table_mpst_power_node *power_node = (fwts_acpi_table_mpst_power_node *) (table->data + node_offset);

if node_list->count is too large, power_node may be outside the table
and cause a segfault, so some ranage checking needs to be done

> +		uint32_t node_length;
> +
> +		fwts_log_info_verbatim(fw, "  MPST Power Node:");
> +		fwts_log_info_verbatim(fw, "    Flags:                         0x%2.2" PRIx8, power_node->flags);
> +		fwts_log_info_verbatim(fw, "    Reserved:                      0x%2.2" PRIx8, power_node->reserved);
> +		fwts_log_info_verbatim(fw, "    Memory Power Node Id:          0x%4.4" PRIx16, power_node->node_id);
> +		fwts_log_info_verbatim(fw, "    Power Node Length:             0x%8.8" PRIx32, power_node->length);
> +		fwts_log_info_verbatim(fw, "    Base Address:                  0x%16.16" PRIx64, power_node->range_address);
> +		fwts_log_info_verbatim(fw, "    Memory Length:                 0x%16.16" PRIx64, power_node->range_ength);

should range_ength be range_length?


> +		fwts_log_info_verbatim(fw, "    Number of Power States:        0x%8.8" PRIx32, power_node->num_states);
> +		fwts_log_info_verbatim(fw, "    Number of Physical Components: 0x%8.8" PRIx32, power_node->num_components);
> +
> +		if (power_node->flags & ~0x7) {
> +			passed = false;
> +			fwts_failed(fw, LOG_LEVEL_HIGH,
> +				"MPSTBadPowerNodeFlags",
> +				"MPST Power Node Flags Bit 3..7 be zero, got "
> +				"0x%2.2" PRIx8 " instead", power_node->flags);
> +		}
> +
> +		if (power_node->reserved != 0) {
> +			passed = false;
> +			fwts_failed(fw, LOG_LEVEL_LOW,
> +				"MPSTReservedNonZero",
> +				"MPST reserved field must be zero, got "
> +				"0x%2.2" PRIx8 " instead", power_node->reserved);
> +		}
> +
> +		node_length = sizeof(fwts_acpi_table_mpst_power_node) +
> +			      sizeof(fwts_acpi_table_mpst_power_state) * power_node->num_states +
> +			      sizeof(fwts_acpi_table_mpst_component) * power_node->num_components;
> +
> +		if (power_node->length != node_length) {
> +			passed = false;
> +			fwts_failed(fw, LOG_LEVEL_HIGH,
> +				"MPSTBadPowerNodeLength",
> +				"MPST Power Node Length should be 0x%8.8" PRIx32 ", got "
> +				"0x%8.8" PRIx32 " instead", node_length, power_node->length);
> +		}
> +
> +		node_offset += sizeof(fwts_acpi_table_mpst_power_node);

and we need to also ensure power_node->num_states is sane so we don't
fall outside the table with state too

> +		for (j = 0; j < power_node->num_states; j++) {
> +			fwts_acpi_table_mpst_power_state *state = (fwts_acpi_table_mpst_power_state *) (table->data + node_offset);
> +			fwts_log_info_verbatim(fw, "    Power State Value:             0x%2.2" PRIx8, state->value);
> +			fwts_log_info_verbatim(fw, "    Power State Information Index: 0x%2.2" PRIx8, state->info_index);
> +			node_offset += sizeof(fwts_acpi_table_mpst_power_state);
> +		}
> +

same for power_node->num_components being sanity checked so component
does not fall outside the table too

> +		for (j = 0; j < power_node->num_components; j++) {
> +			fwts_acpi_table_mpst_component *component = (fwts_acpi_table_mpst_component *) (table->data + node_offset);
> +			fwts_log_info_verbatim(fw, "    Physical Component Id:         0x%2.2" PRIx8, component->id);
> +			node_offset +=  sizeof(fwts_acpi_table_mpst_component);
> +		}
> +	}
> +
> +	char_list = (fwts_acpi_table_mpst_power_char_list *) (table->data + node_offset);
> +	fwts_log_info_verbatim(fw, "  Memory Characteristics Count:    0x%4.4" PRIx16, char_list->count);
> +	fwts_log_info_verbatim(fw, "  Reserved:                        0x%4.4" PRIx16, char_list->reserved);
> +
> +	if (char_list->reserved != 0) {
> +		passed = false;
> +		fwts_failed(fw, LOG_LEVEL_LOW,
> +			"MPSTReservedNonZero",
> +			"MPST reserved field must be zero, got "
> +			"0x%4.4" PRIx16 " instead", char_list->reserved);
> +	}
> +
> +	node_offset += sizeof(fwts_acpi_table_mpst_power_char_list);

and the same for char_list->count being sanity checked so that
power_char does not fall off the end of the table

> +	for (i = 0; i < char_list->count; i++) {
> +		fwts_acpi_table_mpst_power_char *power_char = (fwts_acpi_table_mpst_power_char *) (table->data + node_offset);
> +
> +		fwts_log_info_verbatim(fw, "  MPST Power Characteristics:");
> +		fwts_log_info_verbatim(fw, "    Power State Structure ID:      0x%2.2" PRIx8, power_char->structure_id);
> +		fwts_log_info_verbatim(fw, "    Flags:                         0x%2.2" PRIx8, power_char->flags);
> +		fwts_log_info_verbatim(fw, "    Reserved:                      0x%4.4" PRIx16, power_char->reserved1);
> +		fwts_log_info_verbatim(fw, "    Average Power Consumed:        0x%8.8" PRIx32, power_char->average_power);
> +		fwts_log_info_verbatim(fw, "    Relative Power Saving:         0x%8.8" PRIx32, power_char->power_saving);
> +		fwts_log_info_verbatim(fw, "    Exit Latency:                  0x%16.16" PRIx64, power_char->exit_latency);
> +		fwts_log_info_verbatim(fw, "    Reserved:                      0x%16.16" PRIx64, power_char->reserved2);
> +
> +		if ((power_char->structure_id & 0x3F) != 1) {
> +			passed = false;
> +			fwts_failed(fw, LOG_LEVEL_HIGH,
> +				"MPSTBadPowerCharacteristicsID",
> +				"MPST Power Characteristics ID must be 1, got "
> +				"0x%2.2" PRIx8 " instead", power_char->structure_id & 0x3F);
> +		}
> +
> +		if (((power_char->structure_id & 0xC0) >> 6) != 1) {
> +			passed = false;
> +			fwts_failed(fw, LOG_LEVEL_HIGH,
> +				"MPSTBadPowerCharacteristicsRevision",
> +				"MPST Power Characteristics Revision must be 1, got "
> +				"0x%2.2" PRIx8 " instead", (power_char->structure_id & 0xC0) >> 6);
> +		}
> +
> +		if (power_char->flags & ~0x7) {
> +			passed = false;
> +			fwts_failed(fw, LOG_LEVEL_HIGH,
> +				"MPSTBadPowerCharacteristicsFlags",
> +				"MPST Power Characteristics Flags Bit 3..7 be zero, got "
> +				"0x%2.2" PRIx8 " instead", power_char->flags);
> +		}
> +
> +		if (power_char->reserved1 != 0) {
> +			passed = false;
> +			fwts_failed(fw, LOG_LEVEL_LOW,
> +				"MPSTReservedNonZero",
> +				"MPST reserved field must be zero, got "
> +				"0x%4.4" PRIx16 " instead", power_char->reserved1);
> +		}
> +
> +		if (power_char->reserved2 != 0) {
> +			passed = false;
> +			fwts_failed(fw, LOG_LEVEL_LOW,
> +				"MPSTReservedNonZero",
> +				"MPST reserved field must be zero, got "
> +				"0x%16.16" PRIx64 " instead", power_char->reserved2);
> +		}
> +
> +		node_offset +=  sizeof(fwts_acpi_table_mpst_power_char);
> +	}
> +
> +	fwts_log_nl(fw);
> +
> +	if (passed)
> +		fwts_passed(fw, "No issues found in MPST table.");
> +
> +	return FWTS_OK;
> +}
> +
> +static fwts_framework_minor_test mpst_tests[] = {
> +	{ mpst_test1, "Validate MPST table." },
> +	{ NULL, NULL }
> +};
> +
> +static fwts_framework_ops mpst_ops = {
> +	.description = "MPST Memory Power State Table test.",
> +	.init        = mpst_init,
> +	.minor_tests = mpst_tests
> +};
> +
> +FWTS_REGISTER("mpst", &mpst_ops, FWTS_TEST_ANYTIME, FWTS_FLAG_BATCH | FWTS_FLAG_TEST_ACPI)
> +
> +#endif
>
diff mbox

Patch

diff --git a/src/Makefile.am b/src/Makefile.am
index bc23e8d..ff82cbc 100644
--- a/src/Makefile.am
+++ b/src/Makefile.am
@@ -70,6 +70,7 @@  fwts_SOURCES = main.c 				\
 	acpi/madt/madt.c			\
 	acpi/mcfg/mcfg.c 			\
 	acpi/mchi/mchi.c 			\
+	acpi/mpst/mpst.c 			\
 	acpi/msct/msct.c 			\
 	acpi/msdm/msdm.c 			\
 	acpi/method/method.c 			\
diff --git a/src/acpi/mpst/mpst.c b/src/acpi/mpst/mpst.c
new file mode 100644
index 0000000..02fe47d
--- /dev/null
+++ b/src/acpi/mpst/mpst.c
@@ -0,0 +1,227 @@ 
+/*
+ * Copyright (C) 2016 Canonical
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License
+ * as published by the Free Software Foundation; either version 2
+ * of the License, or (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ */
+#include "fwts.h"
+
+#if defined(FWTS_HAS_ACPI)
+
+#include <stdlib.h>
+#include <stdio.h>
+#include <string.h>
+#include <unistd.h>
+#include <inttypes.h>
+#include <stdbool.h>
+
+static fwts_acpi_table_info *table;
+
+static int mpst_init(fwts_framework *fw)
+{
+	if (fwts_acpi_find_table(fw, "MPST", 0, &table) != FWTS_OK) {
+		fwts_log_error(fw, "Cannot load ACPI table");
+		return FWTS_ERROR;
+	}
+	if (table == NULL) {
+		fwts_log_error(fw, "ACPI MPST table does not exist, skipping test");
+		return FWTS_ERROR;
+	}
+
+	return FWTS_OK;
+}
+
+static int mpst_test1(fwts_framework *fw)
+{
+	fwts_acpi_table_mpst *mpst = (fwts_acpi_table_mpst*) table->data;
+	fwts_acpi_table_mpst_power_node_list *node_list;
+	fwts_acpi_table_mpst_power_char_list *char_list;
+	bool passed = true;
+	uint32_t reserved;
+	uint32_t node_offset;
+	uint16_t i, j;
+
+	reserved = (uint32_t) mpst->reserved[0] +
+		   ((uint32_t) mpst->reserved[1] << 8) +
+		   ((uint32_t) mpst->reserved[2] << 16);
+
+	fwts_log_info_verbatim(fw, "MPST Table:");
+	fwts_log_info_verbatim(fw, "  Communication Channel ID:        0x%2.2" PRIx8, mpst->channel_id);
+	fwts_log_info_verbatim(fw, "  Reserved:                        0x%8.8" PRIx32, reserved);
+
+	if (reserved != 0) {
+		passed = false;
+		fwts_failed(fw, LOG_LEVEL_LOW,
+			"MPSTReservedNonZero",
+			"MPST reserved field must be zero, got "
+			"0x%8.8" PRIx32 " instead", reserved);
+	}
+
+	node_list = (fwts_acpi_table_mpst_power_node_list *) (table->data + sizeof(fwts_acpi_table_mpst));
+	fwts_log_info_verbatim(fw, "  Memory Power Node Count:         0x%4.4" PRIx16, node_list->count);
+	fwts_log_info_verbatim(fw, "  Reserved:                        0x%4.4" PRIx16, node_list->reserved);
+
+	if (node_list->reserved != 0) {
+		passed = false;
+		fwts_failed(fw, LOG_LEVEL_LOW,
+			"MPSTReservedNonZero",
+			"MPST reserved field must be zero, got "
+			"0x%4.4" PRIx16 " instead", node_list->reserved);
+	}
+
+	node_offset = sizeof(fwts_acpi_table_mpst) + (sizeof(fwts_acpi_table_mpst_power_node_list));
+	for (i = 0; i < node_list->count; i++) {
+		fwts_acpi_table_mpst_power_node *power_node = (fwts_acpi_table_mpst_power_node *) (table->data + node_offset);
+		uint32_t node_length;
+
+		fwts_log_info_verbatim(fw, "  MPST Power Node:");
+		fwts_log_info_verbatim(fw, "    Flags:                         0x%2.2" PRIx8, power_node->flags);
+		fwts_log_info_verbatim(fw, "    Reserved:                      0x%2.2" PRIx8, power_node->reserved);
+		fwts_log_info_verbatim(fw, "    Memory Power Node Id:          0x%4.4" PRIx16, power_node->node_id);
+		fwts_log_info_verbatim(fw, "    Power Node Length:             0x%8.8" PRIx32, power_node->length);
+		fwts_log_info_verbatim(fw, "    Base Address:                  0x%16.16" PRIx64, power_node->range_address);
+		fwts_log_info_verbatim(fw, "    Memory Length:                 0x%16.16" PRIx64, power_node->range_ength);
+		fwts_log_info_verbatim(fw, "    Number of Power States:        0x%8.8" PRIx32, power_node->num_states);
+		fwts_log_info_verbatim(fw, "    Number of Physical Components: 0x%8.8" PRIx32, power_node->num_components);
+
+		if (power_node->flags & ~0x7) {
+			passed = false;
+			fwts_failed(fw, LOG_LEVEL_HIGH,
+				"MPSTBadPowerNodeFlags",
+				"MPST Power Node Flags Bit 3..7 be zero, got "
+				"0x%2.2" PRIx8 " instead", power_node->flags);
+		}
+
+		if (power_node->reserved != 0) {
+			passed = false;
+			fwts_failed(fw, LOG_LEVEL_LOW,
+				"MPSTReservedNonZero",
+				"MPST reserved field must be zero, got "
+				"0x%2.2" PRIx8 " instead", power_node->reserved);
+		}
+
+		node_length = sizeof(fwts_acpi_table_mpst_power_node) +
+			      sizeof(fwts_acpi_table_mpst_power_state) * power_node->num_states +
+			      sizeof(fwts_acpi_table_mpst_component) * power_node->num_components;
+
+		if (power_node->length != node_length) {
+			passed = false;
+			fwts_failed(fw, LOG_LEVEL_HIGH,
+				"MPSTBadPowerNodeLength",
+				"MPST Power Node Length should be 0x%8.8" PRIx32 ", got "
+				"0x%8.8" PRIx32 " instead", node_length, power_node->length);
+		}
+
+		node_offset += sizeof(fwts_acpi_table_mpst_power_node);
+		for (j = 0; j < power_node->num_states; j++) {
+			fwts_acpi_table_mpst_power_state *state = (fwts_acpi_table_mpst_power_state *) (table->data + node_offset);
+			fwts_log_info_verbatim(fw, "    Power State Value:             0x%2.2" PRIx8, state->value);
+			fwts_log_info_verbatim(fw, "    Power State Information Index: 0x%2.2" PRIx8, state->info_index);
+			node_offset += sizeof(fwts_acpi_table_mpst_power_state);
+		}
+
+		for (j = 0; j < power_node->num_components; j++) {
+			fwts_acpi_table_mpst_component *component = (fwts_acpi_table_mpst_component *) (table->data + node_offset);
+			fwts_log_info_verbatim(fw, "    Physical Component Id:         0x%2.2" PRIx8, component->id);
+			node_offset +=  sizeof(fwts_acpi_table_mpst_component);
+		}
+	}
+
+	char_list = (fwts_acpi_table_mpst_power_char_list *) (table->data + node_offset);
+	fwts_log_info_verbatim(fw, "  Memory Characteristics Count:    0x%4.4" PRIx16, char_list->count);
+	fwts_log_info_verbatim(fw, "  Reserved:                        0x%4.4" PRIx16, char_list->reserved);
+
+	if (char_list->reserved != 0) {
+		passed = false;
+		fwts_failed(fw, LOG_LEVEL_LOW,
+			"MPSTReservedNonZero",
+			"MPST reserved field must be zero, got "
+			"0x%4.4" PRIx16 " instead", char_list->reserved);
+	}
+
+	node_offset += sizeof(fwts_acpi_table_mpst_power_char_list);
+	for (i = 0; i < char_list->count; i++) {
+		fwts_acpi_table_mpst_power_char *power_char = (fwts_acpi_table_mpst_power_char *) (table->data + node_offset);
+
+		fwts_log_info_verbatim(fw, "  MPST Power Characteristics:");
+		fwts_log_info_verbatim(fw, "    Power State Structure ID:      0x%2.2" PRIx8, power_char->structure_id);
+		fwts_log_info_verbatim(fw, "    Flags:                         0x%2.2" PRIx8, power_char->flags);
+		fwts_log_info_verbatim(fw, "    Reserved:                      0x%4.4" PRIx16, power_char->reserved1);
+		fwts_log_info_verbatim(fw, "    Average Power Consumed:        0x%8.8" PRIx32, power_char->average_power);
+		fwts_log_info_verbatim(fw, "    Relative Power Saving:         0x%8.8" PRIx32, power_char->power_saving);
+		fwts_log_info_verbatim(fw, "    Exit Latency:                  0x%16.16" PRIx64, power_char->exit_latency);
+		fwts_log_info_verbatim(fw, "    Reserved:                      0x%16.16" PRIx64, power_char->reserved2);
+
+		if ((power_char->structure_id & 0x3F) != 1) {
+			passed = false;
+			fwts_failed(fw, LOG_LEVEL_HIGH,
+				"MPSTBadPowerCharacteristicsID",
+				"MPST Power Characteristics ID must be 1, got "
+				"0x%2.2" PRIx8 " instead", power_char->structure_id & 0x3F);
+		}
+
+		if (((power_char->structure_id & 0xC0) >> 6) != 1) {
+			passed = false;
+			fwts_failed(fw, LOG_LEVEL_HIGH,
+				"MPSTBadPowerCharacteristicsRevision",
+				"MPST Power Characteristics Revision must be 1, got "
+				"0x%2.2" PRIx8 " instead", (power_char->structure_id & 0xC0) >> 6);
+		}
+
+		if (power_char->flags & ~0x7) {
+			passed = false;
+			fwts_failed(fw, LOG_LEVEL_HIGH,
+				"MPSTBadPowerCharacteristicsFlags",
+				"MPST Power Characteristics Flags Bit 3..7 be zero, got "
+				"0x%2.2" PRIx8 " instead", power_char->flags);
+		}
+
+		if (power_char->reserved1 != 0) {
+			passed = false;
+			fwts_failed(fw, LOG_LEVEL_LOW,
+				"MPSTReservedNonZero",
+				"MPST reserved field must be zero, got "
+				"0x%4.4" PRIx16 " instead", power_char->reserved1);
+		}
+
+		if (power_char->reserved2 != 0) {
+			passed = false;
+			fwts_failed(fw, LOG_LEVEL_LOW,
+				"MPSTReservedNonZero",
+				"MPST reserved field must be zero, got "
+				"0x%16.16" PRIx64 " instead", power_char->reserved2);
+		}
+
+		node_offset +=  sizeof(fwts_acpi_table_mpst_power_char);
+	}
+
+	fwts_log_nl(fw);
+
+	if (passed)
+		fwts_passed(fw, "No issues found in MPST table.");
+
+	return FWTS_OK;
+}
+
+static fwts_framework_minor_test mpst_tests[] = {
+	{ mpst_test1, "Validate MPST table." },
+	{ NULL, NULL }
+};
+
+static fwts_framework_ops mpst_ops = {
+	.description = "MPST Memory Power State Table test.",
+	.init        = mpst_init,
+	.minor_tests = mpst_tests
+};
+
+FWTS_REGISTER("mpst", &mpst_ops, FWTS_TEST_ANYTIME, FWTS_FLAG_BATCH | FWTS_FLAG_TEST_ACPI)
+
+#endif