1*1b2596b5SMatthias Ringwald /**
2*1b2596b5SMatthias Ringwald * \file
3*1b2596b5SMatthias Ringwald *
4*1b2596b5SMatthias Ringwald * \brief FPU support for SAM.
5*1b2596b5SMatthias Ringwald *
6*1b2596b5SMatthias Ringwald * Copyright (c) 2014-2015 Atmel Corporation. All rights reserved.
7*1b2596b5SMatthias Ringwald *
8*1b2596b5SMatthias Ringwald * \asf_license_start
9*1b2596b5SMatthias Ringwald *
10*1b2596b5SMatthias Ringwald * \page License
11*1b2596b5SMatthias Ringwald *
12*1b2596b5SMatthias Ringwald * Redistribution and use in source and binary forms, with or without
13*1b2596b5SMatthias Ringwald * modification, are permitted provided that the following conditions are met:
14*1b2596b5SMatthias Ringwald *
15*1b2596b5SMatthias Ringwald * 1. Redistributions of source code must retain the above copyright notice,
16*1b2596b5SMatthias Ringwald * this list of conditions and the following disclaimer.
17*1b2596b5SMatthias Ringwald *
18*1b2596b5SMatthias Ringwald * 2. Redistributions in binary form must reproduce the above copyright notice,
19*1b2596b5SMatthias Ringwald * this list of conditions and the following disclaimer in the documentation
20*1b2596b5SMatthias Ringwald * and/or other materials provided with the distribution.
21*1b2596b5SMatthias Ringwald *
22*1b2596b5SMatthias Ringwald * 3. The name of Atmel may not be used to endorse or promote products derived
23*1b2596b5SMatthias Ringwald * from this software without specific prior written permission.
24*1b2596b5SMatthias Ringwald *
25*1b2596b5SMatthias Ringwald * 4. This software may only be redistributed and used in connection with an
26*1b2596b5SMatthias Ringwald * Atmel microcontroller product.
27*1b2596b5SMatthias Ringwald *
28*1b2596b5SMatthias Ringwald * THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR IMPLIED
29*1b2596b5SMatthias Ringwald * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
30*1b2596b5SMatthias Ringwald * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
31*1b2596b5SMatthias Ringwald * EXPRESSLY AND SPECIFICALLY DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR
32*1b2596b5SMatthias Ringwald * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
33*1b2596b5SMatthias Ringwald * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
34*1b2596b5SMatthias Ringwald * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
35*1b2596b5SMatthias Ringwald * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
36*1b2596b5SMatthias Ringwald * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
37*1b2596b5SMatthias Ringwald * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
38*1b2596b5SMatthias Ringwald * POSSIBILITY OF SUCH DAMAGE.
39*1b2596b5SMatthias Ringwald *
40*1b2596b5SMatthias Ringwald * \asf_license_stop
41*1b2596b5SMatthias Ringwald *
42*1b2596b5SMatthias Ringwald */
43*1b2596b5SMatthias Ringwald /*
44*1b2596b5SMatthias Ringwald * Support and FAQ: visit <a href="http://www.atmel.com/design-support/">Atmel Support</a>
45*1b2596b5SMatthias Ringwald */
46*1b2596b5SMatthias Ringwald
47*1b2596b5SMatthias Ringwald #ifndef _FPU_H_INCLUDED_
48*1b2596b5SMatthias Ringwald #define _FPU_H_INCLUDED_
49*1b2596b5SMatthias Ringwald
50*1b2596b5SMatthias Ringwald #include <compiler.h>
51*1b2596b5SMatthias Ringwald
52*1b2596b5SMatthias Ringwald /** Address for ARM CPACR */
53*1b2596b5SMatthias Ringwald #define ADDR_CPACR 0xE000ED88
54*1b2596b5SMatthias Ringwald
55*1b2596b5SMatthias Ringwald /** CPACR Register */
56*1b2596b5SMatthias Ringwald #define REG_CPACR (*((volatile uint32_t *)ADDR_CPACR))
57*1b2596b5SMatthias Ringwald
58*1b2596b5SMatthias Ringwald /**
59*1b2596b5SMatthias Ringwald * \brief Enable FPU
60*1b2596b5SMatthias Ringwald */
fpu_enable(void)61*1b2596b5SMatthias Ringwald __always_inline static void fpu_enable(void)
62*1b2596b5SMatthias Ringwald {
63*1b2596b5SMatthias Ringwald irqflags_t flags;
64*1b2596b5SMatthias Ringwald flags = cpu_irq_save();
65*1b2596b5SMatthias Ringwald REG_CPACR |= (0xFu << 20);
66*1b2596b5SMatthias Ringwald __DSB();
67*1b2596b5SMatthias Ringwald __ISB();
68*1b2596b5SMatthias Ringwald cpu_irq_restore(flags);
69*1b2596b5SMatthias Ringwald }
70*1b2596b5SMatthias Ringwald
71*1b2596b5SMatthias Ringwald /**
72*1b2596b5SMatthias Ringwald * \brief Disable FPU
73*1b2596b5SMatthias Ringwald */
fpu_disable(void)74*1b2596b5SMatthias Ringwald __always_inline static void fpu_disable(void)
75*1b2596b5SMatthias Ringwald {
76*1b2596b5SMatthias Ringwald irqflags_t flags;
77*1b2596b5SMatthias Ringwald flags = cpu_irq_save();
78*1b2596b5SMatthias Ringwald REG_CPACR &= ~(0xFu << 20);
79*1b2596b5SMatthias Ringwald __DSB();
80*1b2596b5SMatthias Ringwald __ISB();
81*1b2596b5SMatthias Ringwald cpu_irq_restore(flags);
82*1b2596b5SMatthias Ringwald }
83*1b2596b5SMatthias Ringwald
84*1b2596b5SMatthias Ringwald /**
85*1b2596b5SMatthias Ringwald * \brief Check if FPU is enabled
86*1b2596b5SMatthias Ringwald *
87*1b2596b5SMatthias Ringwald * \return Return ture if FPU is enabled, otherwise return false.
88*1b2596b5SMatthias Ringwald */
fpu_is_enabled(void)89*1b2596b5SMatthias Ringwald __always_inline static bool fpu_is_enabled(void)
90*1b2596b5SMatthias Ringwald {
91*1b2596b5SMatthias Ringwald return (REG_CPACR & (0xFu << 20));
92*1b2596b5SMatthias Ringwald }
93*1b2596b5SMatthias Ringwald
94*1b2596b5SMatthias Ringwald #endif /* _FPU_H_INCLUDED_ */
95