164 lines
3.6 KiB
ArmAsm
164 lines
3.6 KiB
ArmAsm
/*
|
|
* SPDX-License-Identifier: BSD-2-Clause
|
|
*
|
|
* Copyright (c) 2019 Western Digital Corporation or its affiliates.
|
|
*
|
|
* Authors:
|
|
* Anup Patel <anup.patel@wdc.com>
|
|
*/
|
|
|
|
#include <sbi/fw_dynamic.h>
|
|
|
|
#include "fw_base.S"
|
|
|
|
.section .entry, "ax", %progbits
|
|
.align 3
|
|
_bad_dynamic_info:
|
|
wfi
|
|
j _bad_dynamic_info
|
|
|
|
.section .entry, "ax", %progbits
|
|
.align 3
|
|
.global fw_boot_hart
|
|
/*
|
|
* This function is called very early even before
|
|
* fw_save_info() is called.
|
|
* We can only use a0, a1, and a2 registers here.
|
|
* The boot HART id should be returned in 'a0'.
|
|
*/
|
|
fw_boot_hart:
|
|
/* Sanity checks */
|
|
li a1, FW_DYNAMIC_INFO_MAGIC_VALUE
|
|
REG_L a0, FW_DYNAMIC_INFO_MAGIC_OFFSET(a2)
|
|
bne a0, a1, _bad_dynamic_info
|
|
li a1, FW_DYNAMIC_INFO_VERSION_MAX
|
|
REG_L a0, FW_DYNAMIC_INFO_VERSION_OFFSET(a2)
|
|
bgt a0, a1, _bad_dynamic_info
|
|
|
|
/* Read boot HART id */
|
|
li a1, 0x2
|
|
blt a0, a1, 2f
|
|
REG_L a0, FW_DYNAMIC_INFO_BOOT_HART_OFFSET(a2)
|
|
ret
|
|
2: li a0, -1
|
|
ret
|
|
|
|
.section .entry, "ax", %progbits
|
|
.align 3
|
|
.global fw_save_info
|
|
/*
|
|
* We can only use a0, a1, a2, a3, and a4 registers here.
|
|
* The a0, a1, and a2 registers will be same as passed by
|
|
* previous booting stage.
|
|
* Nothing to be returned here.
|
|
*/
|
|
fw_save_info:
|
|
/* Save next arg1 in 'a1' */
|
|
la a4, _dynamic_next_arg1
|
|
REG_S a1, (a4)
|
|
|
|
/* Sanity checks */
|
|
li a4, FW_DYNAMIC_INFO_MAGIC_VALUE
|
|
REG_L a3, FW_DYNAMIC_INFO_MAGIC_OFFSET(a2)
|
|
bne a3, a4, _bad_dynamic_info
|
|
li a4, FW_DYNAMIC_INFO_VERSION_MAX
|
|
REG_L a3, FW_DYNAMIC_INFO_VERSION_OFFSET(a2)
|
|
bgt a3, a4, _bad_dynamic_info
|
|
|
|
/* Save version == 0x1 fields */
|
|
la a4, _dynamic_next_addr
|
|
REG_L a3, FW_DYNAMIC_INFO_NEXT_ADDR_OFFSET(a2)
|
|
REG_S a3, (a4)
|
|
la a4, _dynamic_next_mode
|
|
REG_L a3, FW_DYNAMIC_INFO_NEXT_MODE_OFFSET(a2)
|
|
REG_S a3, (a4)
|
|
la a4, _dynamic_options
|
|
REG_L a3, FW_DYNAMIC_INFO_OPTIONS_OFFSET(a2)
|
|
REG_S a3, (a4)
|
|
|
|
/* Save version == 0x2 fields */
|
|
li a4, 0x2
|
|
REG_L a3, FW_DYNAMIC_INFO_VERSION_OFFSET(a2)
|
|
blt a3, a4, 2f
|
|
la a4, _dynamic_boot_hart
|
|
REG_L a3, FW_DYNAMIC_INFO_BOOT_HART_OFFSET(a2)
|
|
REG_S a3, (a4)
|
|
2:
|
|
ret
|
|
|
|
.section .entry, "ax", %progbits
|
|
.align 3
|
|
.global fw_prev_arg1
|
|
/*
|
|
* We can only use a0, a1, and a2 registers here.
|
|
* The a0, a1, and a2 registers will be same as passed by
|
|
* previous booting stage.
|
|
* The previous arg1 should be returned in 'a0'.
|
|
*/
|
|
fw_prev_arg1:
|
|
add a0, zero, zero
|
|
ret
|
|
|
|
.section .entry, "ax", %progbits
|
|
.align 3
|
|
.global fw_next_arg1
|
|
/*
|
|
* We can only use a0, a1, and a2 registers here.
|
|
* The a0, a1, and a2 registers will be same as passed by
|
|
* previous booting stage.
|
|
* The next arg1 should be returned in 'a0'.
|
|
*/
|
|
fw_next_arg1:
|
|
la a0, _dynamic_next_arg1
|
|
REG_L a0, (a0)
|
|
ret
|
|
|
|
.section .entry, "ax", %progbits
|
|
.align 3
|
|
.global fw_next_addr
|
|
/*
|
|
* We can only use a0, a1, and a2 registers here.
|
|
* The next address should be returned in 'a0'.
|
|
*/
|
|
fw_next_addr:
|
|
la a0, _dynamic_next_addr
|
|
REG_L a0, (a0)
|
|
ret
|
|
|
|
.section .entry, "ax", %progbits
|
|
.align 3
|
|
.global fw_next_mode
|
|
/*
|
|
* We can only use a0, a1, and a2 registers here.
|
|
* The next address should be returned in 'a0'
|
|
*/
|
|
fw_next_mode:
|
|
la a0, _dynamic_next_mode
|
|
REG_L a0, (a0)
|
|
ret
|
|
|
|
.section .entry, "ax", %progbits
|
|
.align 3
|
|
.global fw_options
|
|
/*
|
|
* We can only use a0, a1, and a2 registers here.
|
|
* The 'a4' register will have default options.
|
|
* The next address should be returned in 'a0'.
|
|
*/
|
|
fw_options:
|
|
la a0, _dynamic_options
|
|
REG_L a0, (a0)
|
|
ret
|
|
|
|
.section .entry, "ax", %progbits
|
|
.align 3
|
|
_dynamic_next_arg1:
|
|
RISCV_PTR 0x0
|
|
_dynamic_next_addr:
|
|
RISCV_PTR 0x0
|
|
_dynamic_next_mode:
|
|
RISCV_PTR PRV_S
|
|
_dynamic_options:
|
|
RISCV_PTR 0x0
|
|
_dynamic_boot_hart:
|
|
RISCV_PTR -1
|