Masahiro Yamada | 5894ca0 | 2014-10-03 19:21:06 +0900 | [diff] [blame] | 1 | /* |
Masahiro Yamada | 928f324 | 2016-08-25 21:03:41 +0900 | [diff] [blame] | 2 | * Copyright (C) 2012-2014 Panasonic Corporation |
| 3 | * Copyright (C) 2015-2016 Socionext Inc. |
| 4 | * Author: Masahiro Yamada <yamada.masahiro@socionext.com> |
Masahiro Yamada | 5894ca0 | 2014-10-03 19:21:06 +0900 | [diff] [blame] | 5 | * |
| 6 | * SPDX-License-Identifier: GPL-2.0+ |
| 7 | */ |
| 8 | |
| 9 | #include <common.h> |
Masahiro Yamada | f6e7f07 | 2015-05-29 17:30:00 +0900 | [diff] [blame] | 10 | #include <linux/io.h> |
Masahiro Yamada | 928f324 | 2016-08-25 21:03:41 +0900 | [diff] [blame] | 11 | #include <asm/secure.h> |
Masahiro Yamada | 107b3fb | 2016-01-09 01:51:13 +0900 | [diff] [blame] | 12 | |
| 13 | #include "sc-regs.h" |
Masahiro Yamada | 5894ca0 | 2014-10-03 19:21:06 +0900 | [diff] [blame] | 14 | |
Masahiro Yamada | 928f324 | 2016-08-25 21:03:41 +0900 | [diff] [blame] | 15 | /* If PSCI is enabled, this is used for SYSTEM_RESET function */ |
| 16 | #ifdef CONFIG_ARMV7_PSCI |
| 17 | #define __SECURE __secure |
| 18 | #else |
| 19 | #define __SECURE |
| 20 | #endif |
| 21 | |
| 22 | void __SECURE reset_cpu(unsigned long ignored) |
Masahiro Yamada | 5894ca0 | 2014-10-03 19:21:06 +0900 | [diff] [blame] | 23 | { |
| 24 | u32 tmp; |
| 25 | |
Masahiro Yamada | 5894ca0 | 2014-10-03 19:21:06 +0900 | [diff] [blame] | 26 | writel(5, SC_IRQTIMSET); /* default value */ |
| 27 | |
| 28 | tmp = readl(SC_SLFRSTSEL); |
| 29 | tmp &= ~0x3; /* mask [1:0] */ |
| 30 | tmp |= 0x0; /* XRST reboot */ |
| 31 | writel(tmp, SC_SLFRSTSEL); |
| 32 | |
| 33 | tmp = readl(SC_SLFRSTCTL); |
| 34 | tmp |= 0x1; |
| 35 | writel(tmp, SC_SLFRSTCTL); |
| 36 | } |