Gitiles
Code Review Sign In
gerrit-public.fairphone.software / kernel / msm-4.9 / 8b438bcb9009609a15e5480ab1947acff6fb9005 / . / arch / arm / mach-shmobile / headsmp.S
blob: faf82144a2629e307c64480f1a232a2035f48719 [file] [log] [blame]
Magnus Damm1c51ed42010-12-14 16:56:55 +0900[diff] [blame]1/*
2 * SMP support for R-Mobile / SH-Mobile
3 *
4 * Copyright (C) 2010 Magnus Damm
5 * Copyright (C) 2010 Takashi Yoshii
6 *
7 * Based on vexpress, Copyright (c) 2003 ARM Limited, All Rights Reserved
8 *
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License version 2 as
11 * published by the Free Software Foundation.
12 */
Magnus Damm1c51ed42010-12-14 16:56:55 +0900[diff] [blame]13#include <linux/init.h>
Magnus Damm8b438bc2014-06-06 16:20:10 +0900[diff] [blame^]14#include <linux/linkage.h>
15#include <linux/threads.h>
Magnus Damm6155f772010-12-20 11:04:50 +0000[diff] [blame]16#include <asm/memory.h>
Magnus Damm1c51ed42010-12-14 16:56:55 +0900[diff] [blame]17
Magnus Damm8b438bc2014-06-06 16:20:10 +0900[diff] [blame^]18#ifdef CONFIG_SMP
Magnus Damme994d5e2012-05-09 16:24:59 +0900[diff] [blame]19ENTRY(shmobile_invalidate_start)
20 bl v7_invalidate_l1
21 b secondary_startup
22ENDPROC(shmobile_invalidate_start)
Magnus Damm8b438bc2014-06-06 16:20:10 +0900[diff] [blame^]23#endif
Magnus Damme994d5e2012-05-09 16:24:59 +0900[diff] [blame]24
Magnus Damm1c51ed42010-12-14 16:56:55 +0900[diff] [blame]25/*
26 * Reset vector for secondary CPUs.
27 * This will be mapped at address 0 by SBAR register.
28 * We need _long_ jump to the physical address.
29 */
Tetsuyuki Kobayashic1d7e2e2013-07-10 10:56:36 +0900[diff] [blame]30 .arm
Magnus Damm1c51ed42010-12-14 16:56:55 +0900[diff] [blame]31 .align 12
Magnus Dammebe72ab2013-06-10 18:19:36 +0900[diff] [blame]32ENTRY(shmobile_boot_vector)
33 ldr r0, 2f
Tetsuyuki Kobayashic1d7e2e2013-07-10 10:56:36 +0900[diff] [blame]34 ldr r1, 1f
35 bx r1
36
Magnus Dammebe72ab2013-06-10 18:19:36 +0900[diff] [blame]37ENDPROC(shmobile_boot_vector)
38
Tetsuyuki Kobayashi0b933cb2013-07-10 10:56:37 +0900[diff] [blame]39 .align 2
Magnus Dammebe72ab2013-06-10 18:19:36 +0900[diff] [blame]40 .globl shmobile_boot_fn
41shmobile_boot_fn:
421: .space 4
43 .globl shmobile_boot_arg
44shmobile_boot_arg:
452: .space 4
Magnus Damma84a5ab2013-08-08 07:14:07 +0900[diff] [blame]46 .globl shmobile_boot_size
47shmobile_boot_size:
48 .long . - shmobile_boot_vector
Magnus Dammcc615912013-08-01 03:38:18 +0900[diff] [blame]49
50/*
51 * Per-CPU SMP boot function/argument selection code based on MPIDR
52 */
53
54ENTRY(shmobile_smp_boot)
55 @ r0 = MPIDR_HWID_BITMASK
56 mrc p15, 0, r1, c0, c0, 5 @ r1 = MPIDR
57 and r0, r1, r0 @ r0 = cpu_logical_map() value
58 mov r1, #0 @ r1 = CPU index
59 adr r5, 1f @ array of per-cpu mpidr values
60 adr r6, 2f @ array of per-cpu functions
61 adr r7, 3f @ array of per-cpu arguments
62
63shmobile_smp_boot_find_mpidr:
64 ldr r8, [r5, r1, lsl #2]
65 cmp r8, r0
66 bne shmobile_smp_boot_next
67
68 ldr r9, [r6, r1, lsl #2]
69 cmp r9, #0
70 bne shmobile_smp_boot_found
71
72shmobile_smp_boot_next:
73 add r1, r1, #1
Magnus Damm8b438bc2014-06-06 16:20:10 +0900[diff] [blame^]74 cmp r1, #NR_CPUS
Magnus Dammcc615912013-08-01 03:38:18 +0900[diff] [blame]75 blo shmobile_smp_boot_find_mpidr
76
77 b shmobile_smp_sleep
78
79shmobile_smp_boot_found:
80 ldr r0, [r7, r1, lsl #2]
81 mov pc, r9
82ENDPROC(shmobile_smp_boot)
83
84ENTRY(shmobile_smp_sleep)
85 wfi
86 b shmobile_smp_boot
87ENDPROC(shmobile_smp_sleep)
88
89 .globl shmobile_smp_mpidr
90shmobile_smp_mpidr:
Magnus Damm8b438bc2014-06-06 16:20:10 +0900[diff] [blame^]911: .space NR_CPUS * 4
Magnus Dammcc615912013-08-01 03:38:18 +0900[diff] [blame]92 .globl shmobile_smp_fn
93shmobile_smp_fn:
Magnus Damm8b438bc2014-06-06 16:20:10 +0900[diff] [blame^]942: .space NR_CPUS * 4
Magnus Dammcc615912013-08-01 03:38:18 +0900[diff] [blame]95 .globl shmobile_smp_arg
96shmobile_smp_arg:
Magnus Damm8b438bc2014-06-06 16:20:10 +0900[diff] [blame^]973: .space NR_CPUS * 4