git.sur5r.net Git - freertos/blob - FreeRTOS/Demo/CORTEX_M4F_ATSAM4E_Atmel_Studio/src/ASF/sam/utils/fpu/fpu.h

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