Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 | /* * Copyright (c) 2016 Intel Corporation * * Licensed under the Apache License, Version 2.0 (the "License"); * you may not use this file except in compliance with the License. * You may obtain a copy of the License at * * http://www.apache.org/licenses/LICENSE-2.0 * * Unless required by applicable law or agreed to in writing, software * distributed under the License is distributed on an "AS IS" BASIS, * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. * See the License for the specific language governing permissions and * limitations under the License. */ /** * @file * @brief Nios II C-domain interrupt management code for use with Internal * Interrupt Controller (IIC) */ #include <nanokernel.h> #include <kernel_structs.h> #include <arch/cpu.h> #include <irq.h> #include <misc/printk.h> #include <sw_isr_table.h> #include <misc/kernel_event_logger.h> void _irq_spurious(void *unused) { ARG_UNUSED(unused); printk("Spurious interrupt detected! ipending: %x\n", _nios2_creg_read(NIOS2_CR_IPENDING)); _NanoFatalErrorHandler(_NANO_ERR_SPURIOUS_INT, &_default_esf); } void _arch_irq_enable(unsigned int irq) { uint32_t ienable; int key; key = irq_lock(); ienable = _nios2_creg_read(NIOS2_CR_IENABLE); ienable |= (1 << irq); _nios2_creg_write(NIOS2_CR_IENABLE, ienable); irq_unlock(key); }; void _arch_irq_disable(unsigned int irq) { uint32_t ienable; int key; key = irq_lock(); ienable = _nios2_creg_read(NIOS2_CR_IENABLE); ienable &= ~(1 << irq); _nios2_creg_write(NIOS2_CR_IENABLE, ienable); irq_unlock(key); }; /** * @brief Interrupt demux function * * Given a bitfield of pending interrupts, execute the appropriate handler * * @param ipending Bitfield of interrupts */ void _enter_irq(uint32_t ipending) { int index; _kernel.nested++; #ifdef CONFIG_IRQ_OFFLOAD _irq_do_offload(); #endif while (ipending) { _IsrTableEntry_t *ite; #ifdef CONFIG_KERNEL_EVENT_LOGGER_INTERRUPT _sys_k_event_logger_interrupt(); #endif index = find_lsb_set(ipending) - 1; ipending &= ~(1 << index); ite = &_sw_isr_table[index]; ite->isr(ite->arg); } _kernel.nested--; } |