| Thomas Gleixner | fcaf203 | 2019-05-27 08:55:08 +0200 | [diff] [blame] | 1 | /* SPDX-License-Identifier: GPL-2.0-or-later */ |
| Shawn Guo | 69c31b7 | 2011-09-06 14:59:40 +0800 | [diff] [blame] | 2 | /* |
| 3 | * Copyright 2011 Freescale Semiconductor, Inc. |
| 4 | * Copyright 2011 Linaro Ltd. |
| Shawn Guo | 69c31b7 | 2011-09-06 14:59:40 +0800 | [diff] [blame] | 5 | */ |
| 6 | |
| 7 | #include <linux/linkage.h> |
| 8 | #include <linux/init.h> |
| Johannes Berg | 26e30c6 | 2016-01-27 17:59:36 +0100 | [diff] [blame] | 9 | #include <asm/assembler.h> |
| Shawn Guo | 69c31b7 | 2011-09-06 14:59:40 +0800 | [diff] [blame] | 10 | |
| Shawn Guo | 087bb28 | 2013-04-16 22:11:19 +0800 | [diff] [blame] | 11 | diag_reg_offset: |
| 12 | .word g_diag_reg - . |
| 13 | |
| 14 | .macro set_diag_reg |
| 15 | adr r0, diag_reg_offset |
| 16 | ldr r1, [r0] |
| 17 | add r1, r1, r0 @ r1 = physical &g_diag_reg |
| 18 | ldr r0, [r1] |
| 19 | mcr p15, 0, r0, c15, c0, 1 @ write diagnostic register |
| 20 | .endm |
| 21 | |
| Shawn Guo | 69c31b7 | 2011-09-06 14:59:40 +0800 | [diff] [blame] | 22 | ENTRY(v7_secondary_startup) |
| Johannes Berg | 26e30c6 | 2016-01-27 17:59:36 +0100 | [diff] [blame] | 23 | ARM_BE8(setend be) @ go BE8 if entered LE |
| Shawn Guo | 087bb28 | 2013-04-16 22:11:19 +0800 | [diff] [blame] | 24 | set_diag_reg |
| Shawn Guo | 69c31b7 | 2011-09-06 14:59:40 +0800 | [diff] [blame] | 25 | b secondary_startup |
| 26 | ENDPROC(v7_secondary_startup) |