Subversion Repositories c0or1k

/*
 * Realview generic initialisation and setup
 *
 * Copyright (C) 2009 B Labs Ltd.
 */
#include <l4/platform/realview/uart.h>
#include <l4/platform/realview/irq.h>
#include INC_PLAT(offsets.h)
#include INC_GLUE(mapping.h)
#include INC_GLUE(smp.h)
#include <l4/generic/irq.h>
#include <l4/generic/space.h>
#include <l4/generic/platform.h>
#include <l4/generic/smp.h>
#include INC_PLAT(platform.h)
#include INC_ARCH(io.h)
 
/* We will use UART0 for kernel as well as user tasks, so map it to kernel and user space */
void init_platform_console(void)
{
	add_boot_mapping(PLATFORM_UART0_BASE, PLATFORM_CONSOLE_VBASE, PAGE_SIZE,
			 MAP_IO_DEFAULT);
 
	/*
	 * Map same UART IO area to userspace so that primitive uart-based
	 * userspace printf can work. Note, this raw mapping is to be
	 * removed in the future, when file-based io is implemented.
	 */
	add_boot_mapping(PLATFORM_UART0_BASE, USERSPACE_CONSOLE_VBASE, PAGE_SIZE,
			 MAP_USR_IO);
 
	uart_init(PLATFORM_CONSOLE_VBASE);
}
 
void platform_timer_start(void)
{
	/* Enable irq line for TIMER0 */
	irq_enable(IRQ_TIMER0);
 
	/* Set cpu to all cpus for timer0 */
	// irq_set_cpu(IRQ_TIMER0, cpu_all_mask());
 
	/* Enable timer */
	timer_start(PLATFORM_TIMER0_VBASE);
}
 
void init_platform_timer(void)
{
	add_boot_mapping(PLATFORM_TIMER0_BASE, PLATFORM_TIMER0_VBASE, PAGE_SIZE,
			 MAP_IO_DEFAULT);
 
	/* 1 Mhz means can tick up to 1,000,000 times a second */
	timer_init(PLATFORM_TIMER0_VBASE, 1000000 / CONFIG_SCHED_TICKS);
}
 
/* If these bits are off, 32Khz OSC source is used */
#define TIMER3_SCTRL_1MHZ	(1 << 21)
#define TIMER2_SCTRL_1MHZ	(1 << 19)
#define TIMER1_SCTRL_1MHZ	(1 << 17)
#define TIMER0_SCTRL_1MHZ	(1 << 15)
 
/* Set all timers to use 1Mhz OSC clock */
void init_timer_osc(void)
{
	volatile u32 reg;
 
	add_boot_mapping(PLATFORM_SYSCTRL_BASE, PLATFORM_SYSCTRL_VBASE,
			 PAGE_SIZE, MAP_IO_DEFAULT);
 
	reg = read(SP810_SCCTRL);
 
	reg |= TIMER0_SCTRL_1MHZ | TIMER1_SCTRL_1MHZ
	       | TIMER2_SCTRL_1MHZ | TIMER3_SCTRL_1MHZ;
 
	write(reg, SP810_SCCTRL);
 
}
 
void platform_init(void)
{
	init_timer_osc();
	init_platform_console();
	init_platform_timer();
	init_platform_irq_controller();
	init_platform_devices();
 
#if defined (CONFIG_SMP)
	init_smp();
	scu_init();
#endif
}