forked from len0rd/rockbox
arm: add NVIC utility functions
Change-Id: I85567251fb00dec0f38be2a63261ad5509f4ec4f
This commit is contained in:
parent
d14ddcafd5
commit
d68efd3363
1 changed files with 90 additions and 0 deletions
90
firmware/target/arm/nvic-arm.h
Normal file
90
firmware/target/arm/nvic-arm.h
Normal file
|
@ -0,0 +1,90 @@
|
||||||
|
/***************************************************************************
|
||||||
|
* __________ __ ___.
|
||||||
|
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
||||||
|
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
||||||
|
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
||||||
|
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
||||||
|
* \/ \/ \/ \/ \/
|
||||||
|
* $Id$
|
||||||
|
*
|
||||||
|
* Copyright (C) 2025 by Aidan MacDonald
|
||||||
|
*
|
||||||
|
* This program is free software; you can redistribute it and/or
|
||||||
|
* modify it under the terms of the GNU General Public License
|
||||||
|
* as published by the Free Software Foundation; either version 2
|
||||||
|
* of the License, or (at your option) any later version.
|
||||||
|
*
|
||||||
|
* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
|
||||||
|
* KIND, either express or implied.
|
||||||
|
*
|
||||||
|
****************************************************************************/
|
||||||
|
#ifndef __NVIC_ARM_H__
|
||||||
|
#define __NVIC_ARM_H__
|
||||||
|
|
||||||
|
#include "system.h"
|
||||||
|
#include "cortex-m/nvic.h"
|
||||||
|
|
||||||
|
#define NVIC_MAX_PRIO 0xFF
|
||||||
|
|
||||||
|
static inline void nvic_enable_irq(int nr)
|
||||||
|
{
|
||||||
|
int reg = nr / 32;
|
||||||
|
int bit = nr % 32;
|
||||||
|
|
||||||
|
cm_write(NVIC_ISER(reg), BIT_N(bit));
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void nvic_disable_irq(int nr)
|
||||||
|
{
|
||||||
|
int reg = nr / 32;
|
||||||
|
int bit = nr % 32;
|
||||||
|
|
||||||
|
cm_write(NVIC_ICER(reg), BIT_N(bit));
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void nvic_set_pending_irq(int nr)
|
||||||
|
{
|
||||||
|
int reg = nr / 32;
|
||||||
|
int bit = nr % 32;
|
||||||
|
|
||||||
|
cm_write(NVIC_ISPR(reg), BIT_N(bit));
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void nvic_clear_pending_irq(int nr)
|
||||||
|
{
|
||||||
|
int reg = nr / 32;
|
||||||
|
int bit = nr % 32;
|
||||||
|
|
||||||
|
cm_write(NVIC_ICPR(reg), BIT_N(bit));
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline bool nvic_is_active_irq(int nr)
|
||||||
|
{
|
||||||
|
int reg = nr / 32;
|
||||||
|
int bit = nr % 32;
|
||||||
|
|
||||||
|
return cm_read(NVIC_IABR(reg)) & BIT_N(bit);
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline bool nvic_is_enabled_irq(int nr)
|
||||||
|
{
|
||||||
|
int reg = nr / 32;
|
||||||
|
int bit = nr % 32;
|
||||||
|
|
||||||
|
return cm_read(NVIC_ISER(reg)) & BIT_N(bit);
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void nvic_set_irq_priority(int nr, int prio)
|
||||||
|
{
|
||||||
|
int reg = nr / 4;
|
||||||
|
int shift = (nr % 4) * 8;
|
||||||
|
|
||||||
|
uint32_t val = cm_read(NVIC_IPR(reg));
|
||||||
|
|
||||||
|
val &= NVIC_MAX_PRIO << shift;
|
||||||
|
val |= (prio & NVIC_MAX_PRIO) << shift;
|
||||||
|
|
||||||
|
cm_write(NVIC_IPR(reg), val);
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif /* __NVIC_ARM_H__ */
|
Loading…
Add table
Add a link
Reference in a new issue