diff options
Diffstat (limited to 'firmware/fw_dynamic.S')
-rw-r--r-- | firmware/fw_dynamic.S | 42 |
1 files changed, 42 insertions, 0 deletions
diff --git a/firmware/fw_dynamic.S b/firmware/fw_dynamic.S index cf97b60..ba9394d 100644 --- a/firmware/fw_dynamic.S +++ b/firmware/fw_dynamic.S @@ -19,6 +19,32 @@ _bad_dynamic_info: .align 3 .section .entry, "ax", %progbits + .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 + + .align 3 + .section .entry, "ax", %progbits .global fw_save_info /* * We can only use a0, a1, a2, a3, and a4 registers here. @@ -27,14 +53,19 @@ _bad_dynamic_info: * 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) @@ -44,6 +75,15 @@ fw_save_info: 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 .align 3 @@ -116,3 +156,5 @@ _dynamic_next_mode: RISCV_PTR PRV_S _dynamic_options: RISCV_PTR 0x0 +_dynamic_boot_hart: + RISCV_PTR -1 |