Commit | Line | Data |
---|---|---|
69c31b7a SG |
1 | /* |
2 | * Copyright 2011 Freescale Semiconductor, Inc. | |
3 | * Copyright 2011 Linaro Ltd. | |
4 | * | |
5 | * The code contained herein is licensed under the GNU General Public | |
6 | * License. You may obtain a copy of the GNU General Public License | |
7 | * Version 2 or later at the following locations: | |
8 | * | |
9 | * http://www.opensource.org/licenses/gpl-license.html | |
10 | * http://www.gnu.org/copyleft/gpl.html | |
11 | */ | |
12 | ||
13 | #include <linux/linkage.h> | |
14 | #include <linux/init.h> | |
69c31b7a | 15 | |
087bb283 SG |
16 | diag_reg_offset: |
17 | .word g_diag_reg - . | |
18 | ||
19 | .macro set_diag_reg | |
20 | adr r0, diag_reg_offset | |
21 | ldr r1, [r0] | |
22 | add r1, r1, r0 @ r1 = physical &g_diag_reg | |
23 | ldr r0, [r1] | |
24 | mcr p15, 0, r0, c15, c0, 1 @ write diagnostic register | |
25 | .endm | |
26 | ||
69c31b7a SG |
27 | ENTRY(v7_secondary_startup) |
28 | bl v7_invalidate_l1 | |
087bb283 | 29 | set_diag_reg |
69c31b7a SG |
30 | b secondary_startup |
31 | ENDPROC(v7_secondary_startup) |