git.sur5r.net Git - freertos/blob - FreeRTOS/Demo/CORTEX_M4F_MSP432_LaunchPad_IAR_CCS_Keil/driverlib/fpu.c

   1 /*
   2  * -------------------------------------------
   3  *    MSP432 DriverLib - v01_04_00_18
   4  * -------------------------------------------
   5  *
   6  * --COPYRIGHT--,BSD,BSD
   7  * Copyright (c) 2015, Texas Instruments Incorporated
   8  * All rights reserved.
   9  *
  10  * Redistribution and use in source and binary forms, with or without
  11  * modification, are permitted provided that the following conditions
  12  * are met:
  13  *
  14  * *  Redistributions of source code must retain the above copyright
  15  *    notice, this list of conditions and the following disclaimer.
  16  *
  17  * *  Redistributions in binary form must reproduce the above copyright
  18  *    notice, this list of conditions and the following disclaimer in the
  19  *    documentation and/or other materials provided with the distribution.
  20  *
  21  * *  Neither the name of Texas Instruments Incorporated nor the names of
  22  *    its contributors may be used to endorse or promote products derived
  23  *    from this software without specific prior written permission.
  24  *
  25  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  26  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
  27  * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
  28  * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
  29  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
  30  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
  31  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
  32  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
  33  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
  34  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
  35  * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  36  * --/COPYRIGHT--*/
  37 #include <fpu.h>
  38
  39 void FPU_enableModule(void)
  40 {
  41     //
  42     // Enable the coprocessors used by the floating-point unit.
  43     //
  44     SCB->CPACR = ((SCB->CPACR & ~(SCB_CPACR_CP11_M | SCB_CPACR_CP10_M))
  45             | SCB_CPACR_CP11_M | SCB_CPACR_CP10_M);
  46 }
  47
  48 void FPU_disableModule(void)
  49 {
  50     //
  51     // Disable the coprocessors used by the floating-point unit.
  52     //
  53     SCB->CPACR = ((SCB->CPACR & ~(SCB_CPACR_CP10_M | SCB_CPACR_CP11_M)));
  54 }
  55
  56 void FPU_enableStacking(void)
  57 {
  58     //
  59     // Enable automatic state preservation for the floating-point unit, and
  60     // disable lazy state preservation (meaning that the floating-point state
  61     // is always stacked when floating-point instructions are used).
  62     //
  63     FPU->FPCCR = (FPU->FPCCR & ~FPU_FPCCR_LSPEN) | FPU_FPCCR_ASPEN;
  64 }
  65
  66 void FPU_enableLazyStacking(void)
  67 {
  68     //
  69     // Enable automatic and lazy state preservation for the floating-point
  70     // unit.
  71     //
  72     FPU->FPCCR |= FPU_FPCCR_ASPEN | FPU_FPCCR_LSPEN;
  73 }
  74
  75 void FPU_disableStacking(void)
  76 {
  77     //
  78     // Disable automatic and lazy state preservation for the floating-point
  79     // unit.
  80     //
  81     FPU->FPCCR &= ~(FPU_FPCCR_ASPEN | FPU_FPCCR_LSPEN);
  82 }
  83
  84 void FPU_setHalfPrecisionMode(uint32_t mode)
  85 {
  86     //
  87     // Set the half-precision floating-point format.
  88     //
  89     FPU->FPDSCR = (FPU->FPDSCR & ~(FPU_FPDSCR_AHP_Msk)) | mode;
  90 }
  91
  92 void FPU_setNaNMode(uint32_t mode)
  93 {
  94     //
  95     // Set the NaN mode.
  96     //
  97     FPU->FPDSCR = (FPU->FPDSCR & ~(FPU_FPDSCR_DN_Msk)) | mode;
  98 }
  99
 100 void FPU_setFlushToZeroMode(uint32_t mode)
 101 {
 102     //
 103     // Set the flush-to-zero mode.
 104     //
 105     FPU->FPDSCR = (FPU->FPDSCR & ~(FPU_FPDSCR_FZ_Msk)) | mode;
 106 }
 107
 108 void FPU_setRoundingMode(uint32_t mode)
 109 {
 110     //
 111     // Set the rounding mode.
 112     //
 113     FPU->FPDSCR = (FPU->FPDSCR & ~(FPU_FPDSCR_RMode_Msk)) | mode;
 114 }
 115