mirror of
https://github.com/ARM-software/arm-trusted-firmware.git
synced 2025-04-24 13:55:56 +00:00
e31fb0fa1b
Adding load, authentication, and transfer functionality from FVP R BL1 to BL33, which will be the partner runtime code. Signed-off-by: Lauren Wehrmeister <lauren.wehrmeister@arm.com> Change-Id: I293cad09739dacac0d20dd57c1d98178dbe84d40
48 lines
927 B
C
48 lines
927 B
C
/*
|
|
* Copyright (c) 2021, Arm Limited. All rights reserved.
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
*/
|
|
|
|
#include <errno.h>
|
|
|
|
#include <common/debug.h>
|
|
#include <drivers/arm/sp805.h>
|
|
#include <drivers/cfi/v2m_flash.h>
|
|
#include <plat/arm/common/plat_arm.h>
|
|
#include <platform_def.h>
|
|
|
|
/*
|
|
* FVP_R error handler
|
|
*/
|
|
__dead2 void plat_arm_error_handler(int err)
|
|
{
|
|
int ret;
|
|
|
|
switch (err) {
|
|
case -ENOENT:
|
|
case -EAUTH:
|
|
/* Image load or authentication error. Erase the ToC */
|
|
INFO("Erasing FIP ToC from flash...\n");
|
|
(void)nor_unlock(PLAT_ARM_FLASH_IMAGE_BASE);
|
|
ret = nor_word_program(PLAT_ARM_FLASH_IMAGE_BASE, 0);
|
|
if (ret != 0) {
|
|
ERROR("Cannot erase ToC\n");
|
|
} else {
|
|
INFO("Done\n");
|
|
}
|
|
break;
|
|
default:
|
|
/* Unexpected error */
|
|
break;
|
|
}
|
|
|
|
(void)console_flush();
|
|
|
|
/* Setup the watchdog to reset the system as soon as possible */
|
|
sp805_refresh(ARM_SP805_TWDG_BASE, 1U);
|
|
|
|
while (true) {
|
|
wfi();
|
|
}
|
|
}
|