/* SPDX-License-Identifier: Apache-2.0
 * Copyright 2024 The TenonOS Authors
 */

#include <stdint.h>

#include <uk/plat/lcpu.h>

#include <arm/cpu.h>
#include <arm/irq.h>

void ukplat_lcpu_enable_irq(void)
{
	local_irq_enable();
}

void ukplat_lcpu_disable_irq(void)
{
	local_irq_disable();
}

void ukplat_lcpu_halt_irq(void)
{
	UK_ASSERT(ukplat_lcpu_irqs_disabled());

	halt();
}

unsigned long ukplat_lcpu_save_irqf(void)
{
	unsigned long flags;

	local_irq_save(flags);

	return flags;
}

void ukplat_lcpu_restore_irqf(unsigned long flags)
{
	local_irq_restore(flags);
}

int ukplat_lcpu_irqs_disabled(void)
{
	return irqs_disabled();
}

void ukplat_lcpu_irqs_handle_pending(void)
{
	// TODO
}

unsigned int tnplat_lcpu_physical_index(__lcpuid_p cpuid)
{
	return (cpuid & MPIDR_AFF1_MASK) >> MPIDR_AFF1_SHIFT;
}