sergiotarxz/nuttx
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

libc: Implement fesetround & fegetround for arm

Browse Source 
Signed-off-by: Huang Qi <huangqi3@xiaomi.com>
This commit is contained in:
Huang Qi 2021-06-24 17:57:17 +08:00 committed by Alan Carvalho de Assis
parent c4b0a85841
commit fe992a5b6c
3 changed files with 166 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

44
include/fenv.h Normal file
View File

@ -0,0 +1,44 @@
/****************************************************************************
* include/fenv.h
*
* Licensed to the Apache Software Foundation (ASF) under one or more
* contributor license agreements. See the NOTICE file distributed with
* this work for additional information regarding copyright ownership. The
* ASF licenses this file to you under the Apache License, Version 2.0 (the
* "License"); you may not use this file except in compliance with the
* License. You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
* License for the specific language governing permissions and limitations
* under the License.
*
****************************************************************************/
#ifndef __INCLUDE_FENV_H
#define __INCLUDE_FENV_H
/****************************************************************************
* Included Files
****************************************************************************/
/****************************************************************************
* Pre-processor Definitions
****************************************************************************/
#define FE_TONEAREST 0
#define FE_DOWNWARD 1
#define FE_UPWARD 2
#define FE_TOWARDZERO 3
/****************************************************************************
* Public Function Prototypes
****************************************************************************/
int fegetround(void);
int fesetround(int round);
#endif /* __INCLUDE_FENV_H */

2
libs/libc/machine/arm/Make.defs
View File

@ -46,5 +46,7 @@ ifeq ($(CONFIG_CXX_EXCEPTION),y)
CSRCS += gnu_unwind_find_exidx.c
endif
CSRCS += arm_fenv.c
DEPPATH += --dep-path machine/arm
VPATH += :machine/arm

120
libs/libc/machine/arm/arm_fenv.c Normal file
View File

@ -0,0 +1,120 @@
/****************************************************************************
* libs/libc/machine/arm/arm_fenv.c
*
* Licensed to the Apache Software Foundation (ASF) under one or more
* contributor license agreements. See the NOTICE file distributed with
* this work for additional information regarding copyright ownership. The
* ASF licenses this file to you under the Apache License, Version 2.0 (the
* "License"); you may not use this file except in compliance with the
* License. You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
* License for the specific language governing permissions and limitations
* under the License.
*
****************************************************************************/
/****************************************************************************
* Included Files
****************************************************************************/
#include <assert.h>
#include <fenv.h>
/****************************************************************************
* Pre-processor Definitions
****************************************************************************/
#define ARM_FPSCR_TONEAREST 0x00000000
#define ARM_FPSCR_DOWNWARD 0x00400000
#define ARM_FPSCR_UPWARD 0x00800000
#define ARM_FPSCR_TOWARDZERO 0x00c00000
#define ARM_FPSCR_ROUNDMASK 0x00c00000
#define SET_FPSCR(__r) __asm __volatile("vmrs %0, fpscr" : "=&r"(__r))
#define GET_FPSCR(__r) __asm __volatile("vmsr fpscr, %0" : : "r"(__r))
/****************************************************************************
* Public Functions
****************************************************************************/
int fegetround(void)
{
int ret = FE_TONEAREST;
#ifndef __SOFTFP__
int fpscr = 0;
GET_FPSCR(fpscr);
fpscr &= ARM_FPSCR_ROUNDMASK;
switch (fpscr)
{
case ARM_FPSCR_TONEAREST:
ret = FE_TONEAREST;
break;
case ARM_FPSCR_DOWNWARD:
ret = FE_DOWNWARD;
break;
case ARM_FPSCR_UPWARD:
ret = FE_UPWARD;
break;
case ARM_FPSCR_TOWARDZERO:
ret = FE_TOWARDZERO;
break;
default:
assert(0);
break;
}
#endif
return ret;
}
int fesetround(int round)
{
#ifndef __SOFTFP__
int fpscr = 0;
GET_FPSCR(fpscr);
fpscr &= ~(ARM_FPSCR_ROUNDMASK);
switch (fpscr)
{
case FE_TONEAREST:
round = ARM_FPSCR_TONEAREST;
break;
case FE_DOWNWARD:
round = ARM_FPSCR_DOWNWARD;
break;
case FE_UPWARD:
round = ARM_FPSCR_UPWARD;
break;
case FE_TOWARDZERO:
round = ARM_FPSCR_TOWARDZERO;
break;
default:
assert(0);
break;
}
fpscr |= round;
SET_FPSCR(fpscr);
#endif
return (0);
}