2 * Utility functions for FEL mode.
4 * Copyright (c) 2015 Google, Inc
6 * SPDX-License-Identifier: GPL-2.0+
9 #include <asm-offsets.h>
11 #include <asm/system.h>
12 #include <linux/linkage.h>
14 ENTRY(save_boot_params)
18 mrs lr, cpsr @ Read CPSR
20 mrc p15, 0, lr, c1, c0, 0 @ Read CP15 SCTLR Register
22 mrc p15, 0, lr, c12, c0, 0 @ Read VBAR
24 mrc p15, 0, lr, c1, c0, 0 @ Read CP15 Control Register
26 b save_boot_params_ret
27 ENDPROC(save_boot_params)
34 mcr p15, 0, r1, c1, c0, 0 @ Write CP15 Control Register
36 mcr p15, 0, r1, c12, c0, 0 @ Write VBAR
38 mcr p15, 0, r1, c1, c0, 0 @ Write CP15 SCTLR Register
40 msr cpsr, r1 @ Write CPSR
42 ENDPROC(return_to_fel)