/*
 * Copyright (C) 2009 Jean-Christophe PLAGNIOL-VILLARD <plagnio@jcrosoft.com>
 *
 * GPLv2 only
 */

#include <common.h>
#include <io.h>
#include <asm/hardware/sp810.h>
#include <mach/vexpress/devices.h>
#include <mach/vexpress/vexpress.h>

void __iomem *v2m_sysreg_base;

static void v2m_sysctl_init(void __iomem *base)
{
	u32 scctrl;

	v2m_sysreg_base = base;

	/* Select 1MHz TIMCLK as the reference clock for SP804 timers */
	scctrl = readl(base + SCCTRL);
	scctrl |= SCCTRL_TIMEREN0SEL_TIMCLK;
	scctrl |= SCCTRL_TIMEREN1SEL_TIMCLK;
	writel(scctrl, base + SCCTRL);
}

void vexpress_a9_legacy_init(void)
{
	v2m_sysctl_init(IOMEM(0x10001000));
	vexpress_restart_register_feature(IOMEM(0x1000f000));
}

void vexpress_init(void)
{
	v2m_sysctl_init(IOMEM(0x1c020000));
	vexpress_restart_register_feature(IOMEM(0x1c0f0000));
}