Juan Castillo | b6132f1 | 2015-10-06 14:01:35 +0100 | [diff] [blame] | 1 | /* |
Roberto Vargas | 2ca18d9 | 2018-02-12 12:36:17 +0000 | [diff] [blame] | 2 | * Copyright (c) 2015-2018, ARM Limited and Contributors. All rights reserved. |
Juan Castillo | b6132f1 | 2015-10-06 14:01:35 +0100 | [diff] [blame] | 3 | * |
dp-arm | fa3cf0b | 2017-05-03 09:38:09 +0100 | [diff] [blame] | 4 | * SPDX-License-Identifier: BSD-3-Clause |
Juan Castillo | b6132f1 | 2015-10-06 14:01:35 +0100 | [diff] [blame] | 5 | */ |
| 6 | |
Juan Castillo | b6132f1 | 2015-10-06 14:01:35 +0100 | [diff] [blame] | 7 | #include <errno.h> |
Juan Castillo | b6132f1 | 2015-10-06 14:01:35 +0100 | [diff] [blame] | 8 | #include <stdint.h> |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 9 | |
| 10 | #include <platform_def.h> |
| 11 | |
| 12 | #include <arch_helpers.h> |
| 13 | #include <common/debug.h> |
| 14 | #include <drivers/cfi/v2m_flash.h> |
| 15 | #include <drivers/console.h> |
| 16 | #include <plat/common/platform.h> |
| 17 | |
| 18 | #include <plat_arm.h> |
Juan Castillo | b6132f1 | 2015-10-06 14:01:35 +0100 | [diff] [blame] | 19 | |
Sathees Balya | 2257607 | 2018-09-03 17:41:13 +0100 | [diff] [blame] | 20 | #pragma weak plat_arm_error_handler |
| 21 | |
Juan Castillo | b6132f1 | 2015-10-06 14:01:35 +0100 | [diff] [blame] | 22 | /* |
Soby Mathew | 9427357 | 2018-03-07 11:32:04 +0000 | [diff] [blame] | 23 | * ARM common implementation for error handler |
Juan Castillo | b6132f1 | 2015-10-06 14:01:35 +0100 | [diff] [blame] | 24 | */ |
Sathees Balya | 2257607 | 2018-09-03 17:41:13 +0100 | [diff] [blame] | 25 | void __dead2 plat_arm_error_handler(int err) |
Juan Castillo | b6132f1 | 2015-10-06 14:01:35 +0100 | [diff] [blame] | 26 | { |
| 27 | int ret; |
| 28 | |
| 29 | switch (err) { |
| 30 | case -ENOENT: |
| 31 | case -EAUTH: |
| 32 | /* Image load or authentication error. Erase the ToC */ |
| 33 | INFO("Erasing FIP ToC from flash...\n"); |
Antonio Nino Diaz | 6971f00 | 2018-11-06 13:14:21 +0000 | [diff] [blame] | 34 | (void)nor_unlock(PLAT_ARM_FIP_BASE); |
Juan Castillo | b6132f1 | 2015-10-06 14:01:35 +0100 | [diff] [blame] | 35 | ret = nor_word_program(PLAT_ARM_FIP_BASE, 0); |
Soby Mathew | 9427357 | 2018-03-07 11:32:04 +0000 | [diff] [blame] | 36 | if (ret != 0) { |
Juan Castillo | b6132f1 | 2015-10-06 14:01:35 +0100 | [diff] [blame] | 37 | ERROR("Cannot erase ToC\n"); |
| 38 | } else { |
| 39 | INFO("Done\n"); |
| 40 | } |
| 41 | break; |
| 42 | default: |
| 43 | /* Unexpected error */ |
| 44 | break; |
| 45 | } |
| 46 | |
Soby Mathew | 9427357 | 2018-03-07 11:32:04 +0000 | [diff] [blame] | 47 | (void)console_flush(); |
| 48 | |
Juan Castillo | b6132f1 | 2015-10-06 14:01:35 +0100 | [diff] [blame] | 49 | /* Loop until the watchdog resets the system */ |
| 50 | for (;;) |
Sandrine Bailleux | 628198b | 2016-08-18 09:24:40 +0100 | [diff] [blame] | 51 | wfi(); |
Juan Castillo | b6132f1 | 2015-10-06 14:01:35 +0100 | [diff] [blame] | 52 | } |
Sathees Balya | 2257607 | 2018-09-03 17:41:13 +0100 | [diff] [blame] | 53 | |
| 54 | void __dead2 plat_error_handler(int err) |
| 55 | { |
| 56 | plat_arm_error_handler(err); |
| 57 | } |