1 // SPDX-License-Identifier: BSD-2-Clause 2 /* 3 * Copyright (c) 2022, Linaro Limited 4 */ 5 6 #include <assert.h> 7 #include <compiler.h> 8 #include <config.h> 9 #include <drivers/hfic.h> 10 #include <hafnium.h> 11 #include <kernel/interrupt.h> 12 #include <kernel/panic.h> 13 #include <kernel/thread.h> 14 15 struct hfic_data { 16 struct itr_chip chip; 17 }; 18 19 static struct hfic_data hfic_data __nex_bss; 20 21 static void hfic_op_add(struct itr_chip *chip __unused, size_t it __unused, 22 uint32_t type __unused, uint32_t prio __unused) 23 { 24 } 25 26 static void hfic_op_enable(struct itr_chip *chip __unused, size_t it) 27 { 28 uint32_t res __maybe_unused = 0; 29 30 res = thread_hvc(HF_INTERRUPT_ENABLE, it, HF_ENABLE, 31 HF_INTERRUPT_TYPE_IRQ); 32 assert(!res); 33 } 34 35 static void hfic_op_disable(struct itr_chip *chip __unused, size_t it) 36 { 37 uint32_t res __maybe_unused = 0; 38 39 res = thread_hvc(HF_INTERRUPT_ENABLE, it, HF_DISABLE, 40 HF_INTERRUPT_TYPE_IRQ); 41 assert(!res); 42 } 43 44 static const struct itr_ops hfic_ops = { 45 .add = hfic_op_add, 46 .mask = hfic_op_disable, 47 .unmask = hfic_op_enable, 48 .enable = hfic_op_enable, 49 .disable = hfic_op_disable, 50 }; 51 52 void hfic_init(void) 53 { 54 hfic_data.chip.ops = &hfic_ops; 55 interrupt_main_init(&hfic_data.chip); 56 } 57 58 /* Override interrupt_main_handler() with driver implementation */ 59 void interrupt_main_handler(void) 60 { 61 uint32_t id = 0; 62 uint32_t res __maybe_unused = 0; 63 64 id = thread_hvc(HF_INTERRUPT_GET, 0, 0, 0); 65 if (id == HF_INVALID_INTID) { 66 DMSG("ignoring invalid interrupt %#"PRIx32, id); 67 return; 68 } 69 70 interrupt_call_handlers(&hfic_data.chip, id); 71 72 res = thread_hvc(HF_INTERRUPT_DEACTIVATE, id, id, 0); 73 assert(!res); 74 } 75