Loading...
// SPDX-License-Identifier: GPL-2.0+

#include <asm/secure.h>
#include <asm/psci.h>
#include <asm/types.h>
#include <asm/io.h>
#include <asm/system.h>

#define GPIO2_GPDIR	0x2310000
#define GPIO2_GPDAT	0x2310008
#define RSTCR		0x1e60000
#define RESET_REQ	BIT(1)

u32 __secure psci_version(void)
{
	return ARM_PSCI_VER_0_2;
}

void __secure psci_system_reset(void)
{
	writel(RESET_REQ, RSTCR);

	while (1)
		wfi();
}

void __secure psci_system_off(void)
{
	int i;

	writel(0x02000000, GPIO2_GPDIR);
	writel(0, GPIO2_GPDAT);

	/* make sure the management controller has sampled the input */
	for (i = 0; i < (1 << 11); i++)
		asm("nop");

	writel(RESET_REQ, RSTCR);

	while (1)
		wfi();
}