59 lines
1.5 KiB
C
59 lines
1.5 KiB
C
|
/* Copyright 2023 The ChromiumOS Authors
|
||
|
|
* SPDX-License-Identifier: Apache-2.0
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <zephyr/irq.h>
|
||
|
|
#include <zephyr/devicetree.h>
|
||
|
|
#include <zephyr/device.h>
|
||
|
|
|
||
|
|
bool intc_mtk_adsp_get_enable(const struct device *dev, int irq);
|
||
|
|
void intc_mtk_adsp_set_enable(const struct device *dev, int irq, bool val);
|
||
|
|
|
||
|
|
/* Sort of annoying: assumes there are exactly two controller devices
|
||
|
|
* and that their instance IDs (i.e. the order in which they appear in
|
||
|
|
* the .dts file) match their order in the _sw_isr_table[]. A better
|
||
|
|
* scheme would be able to enumerate the tree at runtime.
|
||
|
|
*/
|
||
|
|
static const struct device *irq_dev(unsigned int *irq_inout)
|
||
|
|
{
|
||
|
|
/* Controller 0 is on Xtensa vector 1, controller 1 on vector 23. */
|
||
|
|
if ((*irq_inout & 0xff) == 1) {
|
||
|
|
*irq_inout >>= 8;
|
||
|
|
return DEVICE_DT_GET(DT_INST(0, mediatek_adsp_intc));
|
||
|
|
}
|
||
|
|
__ASSERT_NO_MSG((*irq_inout & 0xff) == 23);
|
||
|
|
*irq_inout = (*irq_inout >> 8) - 1;
|
||
|
|
return DEVICE_DT_GET(DT_INST(1, mediatek_adsp_intc));
|
||
|
|
}
|
||
|
|
|
||
|
|
void z_soc_irq_enable(unsigned int irq)
|
||
|
|
{
|
||
|
|
/* First 32 IRQs are the Xtensa architectural vectors, */
|
||
|
|
if (irq < 32) {
|
||
|
|
xtensa_irq_enable(irq);
|
||
|
|
} else {
|
||
|
|
const struct device *dev = irq_dev(&irq);
|
||
|
|
|
||
|
|
intc_mtk_adsp_set_enable(dev, irq, true);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void z_soc_irq_disable(unsigned int irq)
|
||
|
|
{
|
||
|
|
if (irq < 32) {
|
||
|
|
xtensa_irq_disable(irq);
|
||
|
|
} else {
|
||
|
|
const struct device *dev = irq_dev(&irq);
|
||
|
|
|
||
|
|
intc_mtk_adsp_set_enable(dev, irq, false);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
int z_soc_irq_is_enabled(unsigned int irq)
|
||
|
|
{
|
||
|
|
if (irq < 32) {
|
||
|
|
return xtensa_irq_is_enabled(irq);
|
||
|
|
}
|
||
|
|
return intc_mtk_adsp_get_enable(irq_dev(&irq), irq);
|
||
|
|
}
|