| /* |
| * 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 <nano_private.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); |
| }; |
| |
| |
| int _arch_irq_connect_dynamic(unsigned int irq, |
| unsigned int priority, |
| void (*routine)(void *parameter), |
| void *parameter, |
| uint32_t flags) |
| { |
| ARG_UNUSED(irq); |
| ARG_UNUSED(priority); |
| ARG_UNUSED(routine); |
| ARG_UNUSED(parameter); |
| ARG_UNUSED(flags); |
| |
| /* STUB. May never implement this, part of a deprecated API */ |
| return -1; |
| }; |
| |
| /** |
| * @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; |
| |
| #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); |
| } |
| } |
| |