1/* 2 * Copyright (c) 2010 ARM Limited 3 * All rights reserved 4 * 5 * The license below extends only to copyright in the software and shall 6 * not be construed as granting a license to any other intellectual 7 * property including but not limited to intellectual property relating 8 * to a hardware implementation of the functionality of the software --- 29 unchanged lines hidden (view full) --- 38 */ 39 40#ifndef __ARCH_ARM_INSTS_VFP_HH__ 41#define __ARCH_ARM_INSTS_VFP_HH__ 42 43#include "arch/arm/insts/misc.hh" 44#include "arch/arm/miscregs.hh" 45#include <fenv.h> |
46#include <cmath> |
47 48enum VfpMicroMode { 49 VfpNotAMicroop, 50 VfpMicroop, 51 VfpFirstMicroop, 52 VfpLastMicroop 53}; 54 --- 42 unchanged lines hidden (view full) --- 97enum VfpRoundingMode 98{ 99 VfpRoundNearest = 0, 100 VfpRoundUpward = 1, 101 VfpRoundDown = 2, 102 VfpRoundZero = 3 103}; 104 |
105template <class fpType> 106static inline void 107vfpFlushToZero(uint32_t &_fpscr, fpType &op) 108{ 109 FPSCR fpscr = _fpscr; 110 if (fpscr.fz == 1 && (std::fpclassify(op) == FP_SUBNORMAL)) { 111 fpscr.idc = 1; 112 op = 0; 113 } 114 _fpscr = fpscr; 115} 116 117template <class fpType> 118static inline void 119vfpFlushToZero(uint32_t &fpscr, fpType &op1, fpType &op2) 120{ 121 vfpFlushToZero(fpscr, op1); 122 vfpFlushToZero(fpscr, op2); 123} 124 |
125static inline uint64_t 126vfpFpSToFixed(float val, bool isSigned, bool half, uint8_t imm) 127{ 128 fesetround(FeRoundZero); 129 val = val * powf(2.0, imm); 130 __asm__ __volatile__("" : "=m" (val) : "m" (val)); 131 feclearexcept(FeAllExceptions); |
132 __asm__ __volatile__("" : "=m" (val) : "m" (val)); 133 float origVal = val; 134 val = rintf(val); 135 int fpType = std::fpclassify(val); 136 if (fpType == FP_SUBNORMAL || fpType == FP_NAN) { 137 if (fpType == FP_NAN) { 138 feraiseexcept(FeInvalid); 139 } 140 val = 0.0; 141 } else if (origVal != val) { 142 feraiseexcept(FeInexact); 143 } 144 |
145 if (isSigned) { 146 if (half) { 147 if ((double)val < (int16_t)(1 << 15)) { 148 feraiseexcept(FeInvalid); |
149 feclearexcept(FeInexact); |
150 return (int16_t)(1 << 15); 151 } 152 if ((double)val > (int16_t)mask(15)) { 153 feraiseexcept(FeInvalid); |
154 feclearexcept(FeInexact); |
155 return (int16_t)mask(15); 156 } 157 return (int16_t)val; 158 } else { 159 if ((double)val < (int32_t)(1 << 31)) { 160 feraiseexcept(FeInvalid); |
161 feclearexcept(FeInexact); |
162 return (int32_t)(1 << 31); 163 } 164 if ((double)val > (int32_t)mask(31)) { 165 feraiseexcept(FeInvalid); |
166 feclearexcept(FeInexact); |
167 return (int32_t)mask(31); 168 } 169 return (int32_t)val; 170 } 171 } else { 172 if (half) { 173 if ((double)val < 0) { 174 feraiseexcept(FeInvalid); |
175 feclearexcept(FeInexact); |
176 return 0; 177 } 178 if ((double)val > (mask(16))) { 179 feraiseexcept(FeInvalid); |
180 feclearexcept(FeInexact); |
181 return mask(16); 182 } 183 return (uint16_t)val; 184 } else { 185 if ((double)val < 0) { 186 feraiseexcept(FeInvalid); |
187 feclearexcept(FeInexact); |
188 return 0; 189 } 190 if ((double)val > (mask(32))) { 191 feraiseexcept(FeInvalid); |
192 feclearexcept(FeInexact); |
193 return mask(32); 194 } 195 return (uint32_t)val; 196 } 197 } 198} 199 200static inline float 201vfpUFixedToFpS(uint32_t val, bool half, uint8_t imm) 202{ 203 fesetround(FeRoundNearest); 204 if (half) 205 val = (uint16_t)val; |
206 float scale = powf(2.0, imm); 207 __asm__ __volatile__("" : "=m" (scale) : "m" (scale)); 208 feclearexcept(FeAllExceptions); 209 __asm__ __volatile__("" : "=m" (scale) : "m" (scale)); 210 return val / scale; |
211} 212 213static inline float 214vfpSFixedToFpS(int32_t val, bool half, uint8_t imm) 215{ 216 fesetround(FeRoundNearest); 217 if (half) 218 val = sext<16>(val & mask(16)); |
219 float scale = powf(2.0, imm); 220 __asm__ __volatile__("" : "=m" (scale) : "m" (scale)); 221 feclearexcept(FeAllExceptions); 222 __asm__ __volatile__("" : "=m" (scale) : "m" (scale)); 223 return val / scale; |
224} 225 226static inline uint64_t 227vfpFpDToFixed(double val, bool isSigned, bool half, uint8_t imm) 228{ |
229 fesetround(FeRoundNearest); |
230 val = val * pow(2.0, imm); 231 __asm__ __volatile__("" : "=m" (val) : "m" (val)); |
232 fesetround(FeRoundZero); |
233 feclearexcept(FeAllExceptions); |
234 __asm__ __volatile__("" : "=m" (val) : "m" (val)); 235 double origVal = val; 236 val = rint(val); 237 int fpType = std::fpclassify(val); 238 if (fpType == FP_SUBNORMAL || fpType == FP_NAN) { 239 if (fpType == FP_NAN) { 240 feraiseexcept(FeInvalid); 241 } 242 val = 0.0; 243 } else if (origVal != val) { 244 feraiseexcept(FeInexact); 245 } |
246 if (isSigned) { 247 if (half) { 248 if (val < (int16_t)(1 << 15)) { 249 feraiseexcept(FeInvalid); |
250 feclearexcept(FeInexact); |
251 return (int16_t)(1 << 15); 252 } 253 if (val > (int16_t)mask(15)) { 254 feraiseexcept(FeInvalid); |
255 feclearexcept(FeInexact); |
256 return (int16_t)mask(15); 257 } 258 return (int16_t)val; 259 } else { 260 if (val < (int32_t)(1 << 31)) { 261 feraiseexcept(FeInvalid); |
262 feclearexcept(FeInexact); |
263 return (int32_t)(1 << 31); 264 } 265 if (val > (int32_t)mask(31)) { 266 feraiseexcept(FeInvalid); |
267 feclearexcept(FeInexact); |
268 return (int32_t)mask(31); 269 } 270 return (int32_t)val; 271 } 272 } else { 273 if (half) { 274 if (val < 0) { 275 feraiseexcept(FeInvalid); |
276 feclearexcept(FeInexact); |
277 return 0; 278 } 279 if (val > mask(16)) { 280 feraiseexcept(FeInvalid); |
281 feclearexcept(FeInexact); |
282 return mask(16); 283 } 284 return (uint16_t)val; 285 } else { 286 if (val < 0) { 287 feraiseexcept(FeInvalid); |
288 feclearexcept(FeInexact); |
289 return 0; 290 } 291 if (val > mask(32)) { 292 feraiseexcept(FeInvalid); |
293 feclearexcept(FeInexact); |
294 return mask(32); 295 } 296 return (uint32_t)val; 297 } 298 } 299} 300 301static inline double 302vfpUFixedToFpD(uint32_t val, bool half, uint8_t imm) 303{ 304 fesetround(FeRoundNearest); 305 if (half) 306 val = (uint16_t)val; |
307 double scale = pow(2.0, imm); 308 __asm__ __volatile__("" : "=m" (scale) : "m" (scale)); 309 feclearexcept(FeAllExceptions); 310 __asm__ __volatile__("" : "=m" (scale) : "m" (scale)); 311 return val / scale; |
312} 313 314static inline double 315vfpSFixedToFpD(int32_t val, bool half, uint8_t imm) 316{ 317 fesetround(FeRoundNearest); 318 if (half) 319 val = sext<16>(val & mask(16)); |
320 double scale = pow(2.0, imm); 321 __asm__ __volatile__("" : "=m" (scale) : "m" (scale)); 322 feclearexcept(FeAllExceptions); 323 __asm__ __volatile__("" : "=m" (scale) : "m" (scale)); 324 return val / scale; |
325} 326 327typedef int VfpSavedState; 328 329static inline VfpSavedState 330prepVfpFpscr(FPSCR fpscr) 331{ 332 int roundingMode = fegetround(); --- 152 unchanged lines hidden --- |