/* 
 * Copyright 2007, Haiku Inc. All rights reserved.
 * Distributed under the terms of the MIT License.
 *
 * Authors:
 * 		François Revol <revol@free.fr>
 *
 * Copyright 2004, Axel Dörfler, axeld@pinc-software.de
 * Distributed under the terms of the MIT License.
 */


#include <KernelExport.h>

#include <boot/stage2.h>
#include <arch/smp.h>
#include <debug.h>
#include <int.h>

#include <cpu.h>
#include <platform/sbi/sbi_syscalls.h>


extern uint32 gPlatform;


status_t
arch_smp_init(kernel_args *args)
{
	dprintf("arch_smp_init()\n");
	return B_OK;
}


status_t
arch_smp_per_cpu_init(kernel_args *args, int32 cpuId)
{
	return B_OK;
}


void
arch_smp_send_multicast_ici(CPUSet& cpuSet)
{
	switch (gPlatform) {
		case kPlatformSbi: {
			uint64 hartMask = 0;
			int32 cpuCount = smp_get_num_cpus();
			for (int32 i = 0; i < cpuCount; i++) {
				if (cpuSet.GetBit(i) && i != smp_get_current_cpu())
					hartMask |= (uint64)1 << gCPU[i].arch.hartId;
			}
			// TODO: handle hart ID >= 64
			sbi_send_ipi(hartMask, 0);
			break;
		}
		case kPlatformMNative:
		default:
			dprintf("arch_smp_send_multicast_ici: not implemented\n");
	}
#if KDEBUG
	if (are_interrupts_enabled())
		panic("arch_smp_send_multicast_ici: called with interrupts enabled");
#endif
}


void
arch_smp_send_ici(int32 target_cpu)
{
	switch (gPlatform) {
	case kPlatformSbi:
		// dprintf("arch_smp_send_ici(%" B_PRId32 ")\n", target_cpu);
		sbi_send_ipi((uint64)1 << gCPU[target_cpu].arch.hartId, 0);
		break;
	case kPlatformMNative:
	default:
		dprintf("arch_smp_send_ici: not implemented\n");
	}
}


void
arch_smp_send_broadcast_ici()
{
	switch (gPlatform) {
	case kPlatformSbi:
		// dprintf("arch_smp_send_broadcast_ici()\n");
		sbi_send_ipi(0, -1);
		break;
	case kPlatformMNative:
	default:
		dprintf("arch_smp_send_broadcast_ici: not implemented\n");
	}
}