1 /* 2 * SMP operations for Alpine platform. 3 * 4 * Copyright (C) 2015 Annapurna Labs Ltd. 5 * 6 * This program is free software; you can redistribute it and/or modify 7 * it under the terms of the GNU General Public License as published by 8 * the Free Software Foundation; either version 2 of the License, or 9 * (at your option) any later version. 10 * 11 * This program is distributed in the hope that it will be useful, 12 * but WITHOUT ANY WARRANTY; without even the implied warranty of 13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 14 * GNU General Public License for more details. 15 */ 16 17 #include <linux/init.h> 18 #include <linux/errno.h> 19 #include <linux/io.h> 20 #include <linux/of.h> 21 22 #include <asm/smp_plat.h> 23 24 #include "alpine_cpu_pm.h" 25 26 static int alpine_boot_secondary(unsigned int cpu, struct task_struct *idle) 27 { 28 phys_addr_t addr; 29 30 addr = virt_to_phys(secondary_startup); 31 32 if (addr > (phys_addr_t)(uint32_t)(-1)) { 33 pr_err("FAIL: resume address over 32bit (%pa)", &addr); 34 return -EINVAL; 35 } 36 37 return alpine_cpu_wakeup(cpu_logical_map(cpu), (uint32_t)addr); 38 } 39 40 static void __init alpine_smp_prepare_cpus(unsigned int max_cpus) 41 { 42 alpine_cpu_pm_init(); 43 } 44 45 static struct smp_operations alpine_smp_ops __initdata = { 46 .smp_prepare_cpus = alpine_smp_prepare_cpus, 47 .smp_boot_secondary = alpine_boot_secondary, 48 }; 49 CPU_METHOD_OF_DECLARE(alpine_smp, "al,alpine-smp", &alpine_smp_ops); 50