Manish Pandey | d27b37d | 2021-03-02 14:41:58 +0000 | [diff] [blame] | 1 | /* |
Madhukar Pappireddy | 7caaa4a | 2022-01-28 17:01:35 -0600 | [diff] [blame] | 2 | * Copyright (c) 2021-2022, Arm Limited. All rights reserved. |
Manish Pandey | d27b37d | 2021-03-02 14:41:58 +0000 | [diff] [blame] | 3 | * |
| 4 | * SPDX-License-Identifier: BSD-3-Clause |
| 5 | */ |
| 6 | |
| 7 | #include <debug.h> |
| 8 | |
Madhukar Pappireddy | cd183ef | 2021-08-05 15:34:07 -0500 | [diff] [blame] | 9 | #include "cactus_message_loop.h" |
| 10 | #include "cactus_test_cmds.h" |
| 11 | #include <drivers/arm/sp805.h> |
Manish Pandey | d27b37d | 2021-03-02 14:41:58 +0000 | [diff] [blame] | 12 | #include <ffa_helpers.h> |
| 13 | #include <sp_helpers.h> |
Madhukar Pappireddy | cd183ef | 2021-08-05 15:34:07 -0500 | [diff] [blame] | 14 | #include "spm_common.h" |
Manish Pandey | 58971b6 | 2020-09-21 21:10:38 +0100 | [diff] [blame] | 15 | #include <spm_helpers.h> |
Manish Pandey | d27b37d | 2021-03-02 14:41:58 +0000 | [diff] [blame] | 16 | |
Madhukar Pappireddy | cd183ef | 2021-08-05 15:34:07 -0500 | [diff] [blame] | 17 | #include <platform_def.h> |
Manish Pandey | f7aafef | 2021-03-03 11:31:47 +0000 | [diff] [blame] | 18 | |
J-Alves | a076d4c | 2021-10-19 16:06:15 +0100 | [diff] [blame] | 19 | #define NOTIFICATION_PENDING_INTERRUPT_INTID 5 |
| 20 | |
| 21 | extern void notification_pending_interrupt_handler(void); |
| 22 | |
Daniel Boulby | e79d207 | 2021-03-03 11:34:53 +0000 | [diff] [blame] | 23 | extern ffa_id_t g_ffa_id; |
Madhukar Pappireddy | ca1e201 | 2022-06-22 17:05:09 -0500 | [diff] [blame^] | 24 | static uint32_t managed_exit_interrupt_id; |
Manish Pandey | f7aafef | 2021-03-03 11:31:47 +0000 | [diff] [blame] | 25 | |
Madhukar Pappireddy | f4c8e8d | 2022-02-15 15:52:53 -0600 | [diff] [blame] | 26 | /* Secure virtual interrupt that was last handled by Cactus SP. */ |
| 27 | uint32_t last_serviced_interrupt[PLATFORM_CORE_COUNT]; |
| 28 | |
Madhukar Pappireddy | 7caaa4a | 2022-01-28 17:01:35 -0600 | [diff] [blame] | 29 | extern spinlock_t sp_handler_lock[NUM_VINT_ID]; |
| 30 | |
Madhukar Pappireddy | ca1e201 | 2022-06-22 17:05:09 -0500 | [diff] [blame^] | 31 | /* |
| 32 | * Managed exit ID discoverable by querying the SPMC through |
| 33 | * FFA_FEATURES API. |
| 34 | */ |
| 35 | void discover_managed_exit_interrupt_id(void) |
| 36 | { |
| 37 | struct ffa_value ffa_ret; |
| 38 | |
| 39 | /* Interrupt ID value is returned through register W2. */ |
| 40 | ffa_ret = ffa_features(FFA_FEATURE_MEI); |
| 41 | managed_exit_interrupt_id = ffa_feature_intid(ffa_ret); |
| 42 | |
| 43 | VERBOSE("Discovered managed exit interrupt ID: %d\n", |
| 44 | managed_exit_interrupt_id); |
| 45 | } |
| 46 | |
Madhukar Pappireddy | cd183ef | 2021-08-05 15:34:07 -0500 | [diff] [blame] | 47 | void cactus_interrupt_handler(void) |
Manish Pandey | f7aafef | 2021-03-03 11:31:47 +0000 | [diff] [blame] | 48 | { |
Madhukar Pappireddy | cd183ef | 2021-08-05 15:34:07 -0500 | [diff] [blame] | 49 | uint32_t intid = spm_interrupt_get(); |
Madhukar Pappireddy | f4c8e8d | 2022-02-15 15:52:53 -0600 | [diff] [blame] | 50 | unsigned int core_pos = get_current_core_id(); |
Manish Pandey | f7aafef | 2021-03-03 11:31:47 +0000 | [diff] [blame] | 51 | |
Madhukar Pappireddy | cd183ef | 2021-08-05 15:34:07 -0500 | [diff] [blame] | 52 | switch (intid) { |
| 53 | case MANAGED_EXIT_INTERRUPT_ID: |
| 54 | /* |
| 55 | * A secure partition performs its housekeeping and sends a |
| 56 | * direct response to signal interrupt completion. |
| 57 | * This is a pure virtual interrupt, no need for deactivation. |
| 58 | */ |
| 59 | cactus_response(g_ffa_id, HYP_ID, MANAGED_EXIT_INTERRUPT_ID); |
| 60 | break; |
| 61 | case IRQ_TWDOG_INTID: |
| 62 | /* |
| 63 | * Interrupt triggered due to Trusted watchdog timer expiry. |
| 64 | * Clear the interrupt and stop the timer. |
| 65 | */ |
Olivier Deprez | b92d91b | 2022-03-16 17:14:26 +0100 | [diff] [blame] | 66 | VERBOSE("Trusted WatchDog timer stopped\n"); |
Madhukar Pappireddy | cd183ef | 2021-08-05 15:34:07 -0500 | [diff] [blame] | 67 | sp805_twdog_stop(); |
Manish Pandey | d27b37d | 2021-03-02 14:41:58 +0000 | [diff] [blame] | 68 | |
Madhukar Pappireddy | cd183ef | 2021-08-05 15:34:07 -0500 | [diff] [blame] | 69 | /* Perform secure interrupt de-activation. */ |
| 70 | spm_interrupt_deactivate(intid); |
Manish Pandey | d27b37d | 2021-03-02 14:41:58 +0000 | [diff] [blame] | 71 | |
Madhukar Pappireddy | cd183ef | 2021-08-05 15:34:07 -0500 | [diff] [blame] | 72 | break; |
J-Alves | a076d4c | 2021-10-19 16:06:15 +0100 | [diff] [blame] | 73 | case NOTIFICATION_PENDING_INTERRUPT_INTID: |
| 74 | notification_pending_interrupt_handler(); |
| 75 | break; |
Madhukar Pappireddy | cd183ef | 2021-08-05 15:34:07 -0500 | [diff] [blame] | 76 | default: |
| 77 | /* |
| 78 | * Currently the only source of secure interrupt is Trusted |
| 79 | * Watchdog timer. |
| 80 | */ |
| 81 | ERROR("%s: Interrupt ID %x not handled!\n", __func__, |
| 82 | intid); |
| 83 | panic(); |
Manish Pandey | f7aafef | 2021-03-03 11:31:47 +0000 | [diff] [blame] | 84 | } |
Madhukar Pappireddy | 7caaa4a | 2022-01-28 17:01:35 -0600 | [diff] [blame] | 85 | |
Madhukar Pappireddy | f4c8e8d | 2022-02-15 15:52:53 -0600 | [diff] [blame] | 86 | last_serviced_interrupt[core_pos] = intid; |
| 87 | |
Madhukar Pappireddy | 7caaa4a | 2022-01-28 17:01:35 -0600 | [diff] [blame] | 88 | /* Invoke the tail end handler registered by the SP. */ |
| 89 | spin_lock(&sp_handler_lock[intid]); |
| 90 | if (sp_interrupt_tail_end_handler[intid]) { |
| 91 | sp_interrupt_tail_end_handler[intid](); |
| 92 | } |
| 93 | spin_unlock(&sp_handler_lock[intid]); |
Manish Pandey | d27b37d | 2021-03-02 14:41:58 +0000 | [diff] [blame] | 94 | } |