1 /* SPDX-License-Identifier: GPL-2.0+ */
3 * Utility functions for FEL mode.
5 * Copyright (c) 2015 Google, Inc
8 #include <asm-offsets.h>
10 #include <asm/system.h>
11 #include <linux/linkage.h>
13 ENTRY(save_boot_params)
17 mrs lr, cpsr @ Read CPSR
19 mrc p15, 0, lr, c1, c0, 0 @ Read CP15 SCTLR Register
21 mrc p15, 0, lr, c12, c0, 0 @ Read VBAR
23 mrc p15, 0, lr, c1, c0, 0 @ Read CP15 Control Register
25 b save_boot_params_ret
26 ENDPROC(save_boot_params)
33 mcr p15, 0, r1, c1, c0, 0 @ Write CP15 Control Register
35 mcr p15, 0, r1, c12, c0, 0 @ Write VBAR
37 mcr p15, 0, r1, c1, c0, 0 @ Write CP15 SCTLR Register
39 msr cpsr, r1 @ Write CPSR
41 ENDPROC(return_to_fel)