1/*
2 * Keystone SOC SMP platform code
3 *
4 * Copyright 2013 Texas Instruments, Inc.
5 *	Cyril Chemparathy <cyril@ti.com>
6 *	Santosh Shilimkar <santosh.shillimkar@ti.com>
7 *
8 * Based on platsmp.c, Copyright (C) 2002 ARM Ltd.
9 *
10 * This program is free software; you can redistribute it and/or modify it
11 * under the terms and conditions of the GNU General Public License,
12 * version 2, as published by the Free Software Foundation.
13 */
14
15#include <linux/init.h>
16#include <linux/smp.h>
17#include <linux/io.h>
18
19#include <asm/smp_plat.h>
20#include <asm/prom.h>
21#include <asm/tlbflush.h>
22#include <asm/pgtable.h>
23
24#include "keystone.h"
25
26static int keystone_smp_boot_secondary(unsigned int cpu,
27						struct task_struct *idle)
28{
29	unsigned long start = virt_to_idmap(&secondary_startup);
30	int error;
31
32	pr_debug("keystone-smp: booting cpu %d, vector %08lx\n",
33		 cpu, start);
34
35	error = keystone_cpu_smc(KEYSTONE_MON_CPU_UP_IDX, cpu, start);
36	if (error)
37		pr_err("CPU %d bringup failed with %d\n", cpu, error);
38
39	return error;
40}
41
42#ifdef CONFIG_ARM_LPAE
43static void __cpuinit keystone_smp_secondary_initmem(unsigned int cpu)
44{
45	pgd_t *pgd0 = pgd_offset_k(0);
46	cpu_set_ttbr(1, __pa(pgd0) + TTBR1_OFFSET);
47	local_flush_tlb_all();
48}
49#else
50static inline void __cpuinit keystone_smp_secondary_initmem(unsigned int cpu)
51{}
52#endif
53
54struct smp_operations keystone_smp_ops __initdata = {
55	.smp_boot_secondary	= keystone_smp_boot_secondary,
56	.smp_secondary_init     = keystone_smp_secondary_initmem,
57};
58