Subversion Repositories c0or1k

/*
 * Copyright (C) 2010 B Labs Ltd.
 *
 * Authors: Prem Mallappa, Bahadir Balban
 *
 * SMP Initialization of cores.
 */
 
#include <l4/generic/platform.h>
#include INC_GLUE(smp.h)
#include INC_GLUE(init.h)
#include INC_GLUE(mapping.h)
#include INC_SUBARCH(cpu.h)
#include INC_SUBARCH(proc.h)
#include INC_SUBARCH(mmu_ops.h)
#include INC_ARCH(linker.h)
#include INC_ARCH(io.h)
#include <l4/drivers/irq/gic/gic.h>
 
unsigned long secondary_run_signal;
unsigned long secondary_ready_signal;
 
void __smp_start(void);
 
void smp_start_cores(void)
{
	void (*smp_start_func)(int) =
		(void (*)(int))virt_to_phys(__smp_start);
 
	/* FIXME: Check why this high-level version doesn't work */
	// v7_up_dcache_op_setway(CACHE_SETWAY_CLEAN);
	v7_clean_invalidate_setway();
 
	/* We dont probably need this, it is not listed as a requirement */
	arm_smp_inval_icache_entirely();
 
	/* Start other cpus */
	for (int cpu = 1; cpu < CONFIG_NCPU; cpu++) {
		printk("%s: Bringing up CPU%d\n", __KERNELNAME__, cpu);
		if ((platform_smp_start(cpu, smp_start_func)) < 0) {
			printk("FATAL: Could not start secondary cpu. "
			       "cpu=%d\n", cpu);
			BUG();
		}
 
		/* Wait for this particular secondary to become ready */
		while(!(secondary_ready_signal & CPUID_TO_MASK(cpu)))
			dmb();
	}
 
	scu_print_state();
}
 
void init_smp(void)
{
	/* Start_secondary_cpus */
	if (CONFIG_NCPU > 1) {
		/* This sets IPI function pointer at bare minimum */
		platform_smp_init(CONFIG_NCPU);
	}
}
 
void secondary_setup_idle_task(void)
{
	/* This also has its spid allocated by primary */
	current->space = &init_space;
	TASK_PGD(current) = &init_pgd;
 
	/* We need a thread id */
	current->tid = id_new(&kernel_resources.ktcb_ids);
}
 
/*
 * Idle wait before any tasks become available for running.
 *
 * FIXME: This should be changed such that tasks running on other
 * cpus can be killed and secondaries wait on an idle task.
 *
 * Currently the tasks are held in wfi() even if asked to be killed
 * until a new runnable task becomes runnable. This may be problematic
 * for a pager who issued a kill request and is waiting for it to finish.
 */
void sched_secondary_start(void)
{
	while (!secondary_run_signal)
		dmb();
 
	secondary_setup_idle_task();
 
	setup_idle_caps();
 
	idle_task();
 
	BUG();
}
 
 
/*
 * this is where it jumps from secondary_start(), which is called from
 * board_smp_start() to align each core to start here
 */
 
void smp_secondary_init(void)
{
	/* Print early core start message */
	// print_early("Secondary core started.\n");
 
	/* Start virtual memory */
	start_virtual_memory();
 
	arm_smp_inval_tlb_entirely();
	arm_smp_inval_bpa_entirely();
	dsb();
	isb();
 
	printk("%s: CPU%d: Virtual memory enabled.\n",
	       __KERNELNAME__, smp_get_cpuid());
 
	/* Mostly initialize GIC CPU interface */
	secondary_init_platform();
 
	printk("%s: CPU%d: Initialized.\n",
	       __KERNELNAME__, smp_get_cpuid());
 
	sched_init();
 
	/* Signal primary that we are ready */
	dmb();
	secondary_ready_signal |= cpu_mask_self();
 
	/*
	 * Wait for the first runnable task to become available
	 */
	sched_secondary_start();
}