blob: 78bb1657fc165de3c40e1124475f989791c1413a [file] [log] [blame]
Tom Rini10e47792018-05-06 17:58:06 -04001/* SPDX-License-Identifier: GPL-2.0+ */
Simon Glass5debe1f2015-02-07 10:47:30 -07002/*
3 * Utility functions for FEL mode.
4 *
5 * Copyright (c) 2015 Google, Inc
Simon Glass5debe1f2015-02-07 10:47:30 -07006 */
7
8#include <asm-offsets.h>
9#include <config.h>
10#include <asm/system.h>
11#include <linux/linkage.h>
12
13ENTRY(save_boot_params)
14 ldr r0, =fel_stash
15 str sp, [r0, #0]
16 str lr, [r0, #4]
Siarhei Siamashka7ef91f02015-02-16 10:23:59 +020017 mrs lr, cpsr @ Read CPSR
18 str lr, [r0, #8]
19 mrc p15, 0, lr, c1, c0, 0 @ Read CP15 SCTLR Register
20 str lr, [r0, #12]
21 mrc p15, 0, lr, c12, c0, 0 @ Read VBAR
22 str lr, [r0, #16]
Simon Glass5debe1f2015-02-07 10:47:30 -070023 b save_boot_params_ret
24ENDPROC(save_boot_params)
25
26ENTRY(return_to_fel)
27 mov sp, r0
28 mov lr, r1
Siarhei Siamashka7ef91f02015-02-16 10:23:59 +020029 ldr r0, =fel_stash
Siarhei Siamashka7ef91f02015-02-16 10:23:59 +020030 ldr r1, [r0, #16]
31 mcr p15, 0, r1, c12, c0, 0 @ Write VBAR
32 ldr r1, [r0, #12]
33 mcr p15, 0, r1, c1, c0, 0 @ Write CP15 SCTLR Register
34 ldr r1, [r0, #8]
35 msr cpsr, r1 @ Write CPSR
Simon Glass5debe1f2015-02-07 10:47:30 -070036 bx lr
37ENDPROC(return_to_fel)