Add GPS integrity checks and GPS IMU ESKF fusion tools
This commit is contained in:
@@ -15,7 +15,21 @@ void bsp_plic_set_priority(uint32_t irq_id, uint32_t priority)
|
||||
|
||||
void bsp_plic_enable(uint32_t irq_id)
|
||||
{
|
||||
bsp_write32(PLIC_ENABLE0, bsp_read32(PLIC_ENABLE0) | (1u << irq_id));
|
||||
if (irq_id < 32u) {
|
||||
bsp_write32(PLIC_ENABLE0, bsp_read32(PLIC_ENABLE0) | (1u << irq_id));
|
||||
}
|
||||
}
|
||||
|
||||
void bsp_plic_disable(uint32_t irq_id)
|
||||
{
|
||||
if (irq_id < 32u) {
|
||||
bsp_write32(PLIC_ENABLE0, bsp_read32(PLIC_ENABLE0) & ~(1u << irq_id));
|
||||
}
|
||||
}
|
||||
|
||||
void bsp_plic_disable_all(void)
|
||||
{
|
||||
bsp_write32(PLIC_ENABLE0, 0u);
|
||||
}
|
||||
|
||||
void bsp_plic_set_threshold(uint32_t threshold)
|
||||
|
||||
@@ -5,6 +5,8 @@
|
||||
|
||||
void bsp_plic_set_priority(uint32_t irq_id, uint32_t priority);
|
||||
void bsp_plic_enable(uint32_t irq_id);
|
||||
void bsp_plic_disable(uint32_t irq_id);
|
||||
void bsp_plic_disable_all(void);
|
||||
void bsp_plic_set_threshold(uint32_t threshold);
|
||||
uint32_t bsp_plic_claim(void);
|
||||
void bsp_plic_complete(uint32_t irq_id);
|
||||
|
||||
Reference in New Issue
Block a user