ARM: highbank: add SMP support

	depends on REALVIEW_EB_ARM11MP || REALVIEW_EB_A9MP || \

		 MACH_REALVIEW_PB11MP || MACH_REALVIEW_PBX || ARCH_OMAP4 || \

		 ARCH_EXYNOS4 || ARCH_TEGRA || ARCH_U8500 || ARCH_VEXPRESS_CA9X4 || \

		 ARCH_MSM_SCORPIONMP || ARCH_SHMOBILE

		 ARCH_MSM_SCORPIONMP || ARCH_SHMOBILE || ARCH_HIGHBANK

	select USE_GENERIC_SMP_HELPERS

	select HAVE_ARM_SCU if !ARCH_MSM_SCORPIONMP

	help

obj-y					:= clock.o highbank.o system.o

obj-$(CONFIG_DEBUG_HIGHBANK_UART)	+= lluart.o

obj-$(CONFIG_SMP)			+= platsmp.o

obj-$(CONFIG_LOCAL_TIMERS)		+= localtimer.o

/*

 * Copyright 2010-2011 Calxeda, Inc.

 * Based on localtimer.c, Copyright (C) 2002 ARM Ltd.

 *

 * This program is free software; you can redistribute it and/or modify it

 * under the terms and conditions of the GNU General Public License,

 * version 2, as published by the Free Software Foundation.

 *

 * This program is distributed in the hope it will be useful, but WITHOUT

 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or

 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for

 * more details.

 *

 * You should have received a copy of the GNU General Public License along with

 * this program.  If not, see <http://www.gnu.org/licenses/>.

 */

#include <linux/init.h>

#include <linux/clockchips.h>

#include <linux/of.h>

#include <linux/of_address.h>

#include <linux/of_irq.h>

#include <asm/smp_twd.h>

/*

 * Setup the local clock events for a CPU.

 */

int __cpuinit local_timer_setup(struct clock_event_device *evt)

{

	struct device_node *np;

	np = of_find_compatible_node(NULL, NULL, "arm,smp-twd");

	if (!twd_base) {

		twd_base = of_iomap(np, 0);

		WARN_ON(!twd_base);

	}

	evt->irq = irq_of_parse_and_map(np, 0);

	twd_timer_setup(evt);

	return 0;

}

/*

 * Copyright 2010-2011 Calxeda, Inc.

 * Based on platsmp.c, Copyright (C) 2002 ARM Ltd.

 *

 * This program is free software; you can redistribute it and/or modify it

 * under the terms and conditions of the GNU General Public License,

 * version 2, as published by the Free Software Foundation.

 *

 * This program is distributed in the hope it will be useful, but WITHOUT

 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or

 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for

 * more details.

 *

 * You should have received a copy of the GNU General Public License along with

 * this program.  If not, see <http://www.gnu.org/licenses/>.

 */

#include <linux/init.h>

#include <linux/smp.h>

#include <linux/io.h>

#include <asm/smp_scu.h>

#include <asm/hardware/gic.h>

#include "core.h"

extern void secondary_startup(void);

void __cpuinit platform_secondary_init(unsigned int cpu)

{

	gic_secondary_init(0);

}

int __cpuinit boot_secondary(unsigned int cpu, struct task_struct *idle)

{

	gic_raise_softirq(cpumask_of(cpu), 0);

	return 0;

}

/*

 * Initialise the CPU possible map early - this describes the CPUs

 * which may be present or become present in the system.

 */

void __init smp_init_cpus(void)

{

	unsigned int i, ncores;

	ncores = scu_get_core_count(scu_base_addr);

	/* sanity check */

	if (ncores > NR_CPUS) {

		printk(KERN_WARNING

		       "highbank: no. of cores (%d) greater than configured "

		       "maximum of %d - clipping\n",

		       ncores, NR_CPUS);

		ncores = NR_CPUS;

	}

	for (i = 0; i < ncores; i++)

		set_cpu_possible(i, true);

	set_smp_cross_call(gic_raise_softirq);

}

void __init platform_smp_prepare_cpus(unsigned int max_cpus)

{

	int i;

	scu_enable(scu_base_addr);

	/*

	 * Write the address of secondary startup into the jump table

	 * The cores are in wfi and wait until they receive a soft interrupt

	 * and a non-zero value to jump to. Then the secondary CPU branches

	 * to this address.

	 */

	for (i = 1; i < max_cpus; i++)

		highbank_set_cpu_jump(i, secondary_startup);

}