11c51ed4fSMagnus Damm /* 21c51ed4fSMagnus Damm * SMP support for R-Mobile / SH-Mobile 31c51ed4fSMagnus Damm * 41c51ed4fSMagnus Damm * Copyright (C) 2010 Magnus Damm 5c413521eSPaul Mundt * Copyright (C) 2011 Paul Mundt 61c51ed4fSMagnus Damm * 71c51ed4fSMagnus Damm * Based on vexpress, Copyright (C) 2002 ARM Ltd, All Rights Reserved 81c51ed4fSMagnus Damm * 91c51ed4fSMagnus Damm * This program is free software; you can redistribute it and/or modify 101c51ed4fSMagnus Damm * it under the terms of the GNU General Public License version 2 as 111c51ed4fSMagnus Damm * published by the Free Software Foundation. 121c51ed4fSMagnus Damm */ 131c51ed4fSMagnus Damm #include <linux/init.h> 141c51ed4fSMagnus Damm #include <linux/smp.h> 15cc61591eSMagnus Damm #include <asm/cacheflush.h> 16cc61591eSMagnus Damm #include <asm/smp_plat.h> 17cc61591eSMagnus Damm #include <mach/common.h> 181c51ed4fSMagnus Damm 19a62580e5SMarc Zyngier void __init shmobile_smp_init_cpus(unsigned int ncores) 201c51ed4fSMagnus Damm { 211c51ed4fSMagnus Damm unsigned int i; 221c51ed4fSMagnus Damm 23a06f916bSRussell King if (ncores > nr_cpu_ids) { 24a06f916bSRussell King pr_warn("SMP: %u cores greater than maximum (%u), clipping\n", 25a06f916bSRussell King ncores, nr_cpu_ids); 26a06f916bSRussell King ncores = nr_cpu_ids; 27a06f916bSRussell King } 28a06f916bSRussell King 291c51ed4fSMagnus Damm for (i = 0; i < ncores; i++) 301c51ed4fSMagnus Damm set_cpu_possible(i, true); 311c51ed4fSMagnus Damm } 32cc61591eSMagnus Damm 33cc61591eSMagnus Damm extern unsigned long shmobile_smp_fn[]; 34cc61591eSMagnus Damm extern unsigned long shmobile_smp_arg[]; 35cc61591eSMagnus Damm extern unsigned long shmobile_smp_mpidr[]; 36cc61591eSMagnus Damm 37cc61591eSMagnus Damm void shmobile_smp_hook(unsigned int cpu, unsigned long fn, unsigned long arg) 38cc61591eSMagnus Damm { 39cc61591eSMagnus Damm shmobile_smp_fn[cpu] = 0; 40cc61591eSMagnus Damm flush_cache_all(); 41cc61591eSMagnus Damm 42cc61591eSMagnus Damm shmobile_smp_mpidr[cpu] = cpu_logical_map(cpu); 43cc61591eSMagnus Damm shmobile_smp_fn[cpu] = fn; 44cc61591eSMagnus Damm shmobile_smp_arg[cpu] = arg; 45cc61591eSMagnus Damm flush_cache_all(); 46cc61591eSMagnus Damm } 47