fpu.h

Go to the documentation of this file.

/*
 * Support and FAQ: visit <a href="https://www.microchip.com/support/">Microchip Support</a>
 */

#ifndef _FPU_H_INCLUDED_
#define _FPU_H_INCLUDED_

#include <compiler.h>

#define ADDR_CPACR 0xE000ED88

#define REG_CPACR  (*((volatile uint32_t *)ADDR_CPACR))

__always_inline static void fpu_enable(void)
{
        irqflags_t flags;
        flags = cpu_irq_save();
        REG_CPACR |=  (0xFu << 20);
        __DSB();
        __ISB();
        cpu_irq_restore(flags);
}

__always_inline static void fpu_disable(void)
{
        irqflags_t flags;
        flags = cpu_irq_save();
        REG_CPACR &= ~(0xFu << 20);
        __DSB();
        __ISB();
        cpu_irq_restore(flags);
}

__always_inline static bool fpu_is_enabled(void)
{
        return (REG_CPACR & (0xFu << 20));
}

#endif /* _FPU_H_INCLUDED_ */