GNU Linux-libre 4.19.314-gnu1
[releases.git] / arch / arm / mach-alpine / platsmp.c
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 = __pa_symbol(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 const struct smp_operations alpine_smp_ops __initconst = {
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);