Subversion Repositories c0or1k

 
#include <l4/lib/spinlock.h>
#include <l4/lib/printk.h>
 
#include INC_GLUE(smp.h)
#include INC_SUBARCH(cpu.h)
 
DECLARE_SPINLOCK(smp_lock);
 
static unsigned long smp_var = 0;
static unsigned long signal_finished;
 
static unsigned long basic_var = 0;
 
void test_basic_coherent(void)
{
	dmb();
	if (smp_get_cpuid() == 0) {
		if (basic_var != 5555) {
			printk("FATAL: variable update not seen. var = %lu\n", basic_var);
			BUG();
		}
	} else {
		basic_var = 5555;
		dmb();
	}
}
 
void test_smp_coherent(void)
{
	int other;
 
	if (smp_get_cpuid() == 1)
		other = 0;
	else
		other = 1;
 
	/* Increment var */
	for (int i = 0; i < 1000; i++) {
		spin_lock(&smp_lock);
		smp_var++;
		spin_unlock(&smp_lock);
	}
 
	/* Signal finished */
	spin_lock(&smp_lock);
	signal_finished |= (1 << smp_get_cpuid());
	spin_unlock(&smp_lock);
 
	/* Wait for other to finish */
	while (!(signal_finished & (1 << other))) {
		dmb();
	}
	if (smp_get_cpuid() == 0) {
		printk("Total result: %lu\n", smp_var);
		if (smp_var != 2000) {
			printk("FATAL: Total result not as expected\n");
			BUG();
		}
		printk("%s: Success.\n", __FUNCTION__);
	}
 
}
 
 
static u32 make_mask(int ncpus)
{
	u32 mask = 0;
	while(--ncpus){
		mask |= CPUID_TO_MASK(ncpus);
	}
	mask |= CPUID_TO_MASK(0);
 
	return mask;
}
 
#ifndef MAX_IPIS
#define MAX_IPIS 15
#endif
 
void test_ipi(void)
{
	int ipi, cpu;
	for (ipi = 0; ipi <= MAX_IPIS; ipi++) {
		for (cpu = 0; cpu < CONFIG_NCPU; cpu++) {
			if (cpu == smp_get_cpuid())
				continue;
			printk("IPI %d from %d to %d\n", ipi, smp_get_cpuid(), cpu);
			arch_send_ipi(CPUID_TO_MASK(cpu), ipi);
		}
	}
	/* Send IPI to all cores at once */
	cpu = make_mask(CONFIG_NCPU);
	printk("IPI from %d to all\n", smp_get_cpuid());
	arch_send_ipi(cpu, 1);
 
	printk("IPI from %d to self\n", smp_get_cpuid());
	arch_send_ipi(0, 1);		/* Send IPI to self */
}