deps/libretro-common/include/gfx/math/vector_2.h

   1 /* Copyright  (C) 2010-2020 The RetroArch team
   2  *
   3  * ---------------------------------------------------------------------------------------
   4  * The following license statement only applies to this file (vector_2.h).
   5  * ---------------------------------------------------------------------------------------
   6  *
   7  * Permission is hereby granted, free of charge,
   8  * to any person obtaining a copy of this software and associated documentation files (the "Software"),
   9  * to deal in the Software without restriction, including without limitation the rights to
  10  * use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of the Software,
  11  * and to permit persons to whom the Software is furnished to do so, subject to the following conditions:
  12  *
  13  * The above copyright notice and this permission notice shall be included in all copies or substantial portions of the Software.
  14  *
  15  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED,
  16  * INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  17  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
  18  * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
  19  * WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  20  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
  21  */
  22
  23 #ifndef __LIBRETRO_SDK_GFX_MATH_VECTOR_2_H__
  24 #define __LIBRETRO_SDK_GFX_MATH_VECTOR_2_H__
  25
  26 #include <stdint.h>
  27 #include <math.h>
  28
  29 #include <retro_common_api.h>
  30 #include <retro_inline.h>
  31
  32 RETRO_BEGIN_DECLS
  33
  34 typedef float vec2_t[2];
  35
  36 #define vec2_dot(a, b)   ((a[0] * b[0]) + (a[1] * b[1]))
  37
  38 #define vec2_cross(a, b) ((a[0]*b[1]) - (a[1]*b[0]))
  39
  40 #define vec2_add(dst, src) \
  41    dst[0] += src[0]; \
  42    dst[1] += src[1]
  43
  44 #define vec2_subtract(dst, src) \
  45    dst[0] -= src[0]; \
  46    dst[1] -= src[1]
  47
  48 #define vec2_copy(dst, src) \
  49    dst[0] = src[0]; \
  50    dst[1] = src[1]
  51
  52 static INLINE float overflow(void)
  53 {
  54    unsigned i;
  55    volatile float f = 1e10;
  56
  57    for (i = 0; i < 10; ++i)
  58       f *= f;
  59    return f;
  60 }
  61
  62 static INLINE int16_t tofloat16(float f)
  63 {
  64         union uif32
  65    {
  66       float f;
  67       uint32_t i;
  68    };
  69
  70    int i, s, e, m;
  71    union uif32 Entry;
  72    Entry.f = f;
  73    i       = (int)Entry.i;
  74    s       =  (i >> 16) & 0x00008000;
  75    e       = ((i >> 23) & 0x000000ff) - (127 - 15);
  76    m       =   i        & 0x007fffff;
  77
  78    if (e <= 0)
  79    {
  80       if (e < -10)
  81          return (int16_t)(s);
  82
  83       m = (m | 0x00800000) >> (1 - e);
  84
  85       if (m & 0x00001000)
  86          m += 0x00002000;
  87
  88       return (int16_t)(s | (m >> 13));
  89    }
  90
  91    if (e == 0xff - (127 - 15))
  92    {
  93       if (m == 0)
  94          return (int16_t)(s | 0x7c00);
  95
  96       m >>= 13;
  97
  98       return (int16_t)(s | 0x7c00 | m | (m == 0));
  99    }
 100
 101    if (m &  0x00001000)
 102    {
 103       m += 0x00002000;
 104
 105       if (m & 0x00800000)
 106       {
 107          m =  0;
 108          e += 1;
 109       }
 110    }
 111
 112    if (e > 30)
 113    {
 114       overflow();
 115
 116       return (int16_t)(s | 0x7c00);
 117    }
 118
 119    return (int16_t)(s | (e << 10) | (m >> 13));
 120 }
 121
 122 static INLINE unsigned int vec2_packHalf2x16(float vec0, float vec1)
 123 {
 124    union
 125    {
 126       int16_t in[2];
 127       unsigned int out;
 128    } u;
 129
 130    u.in[0] = tofloat16(vec0);
 131    u.in[1] = tofloat16(vec1);
 132
 133    return u.out;
 134 }
 135
 136 RETRO_END_DECLS
 137
 138 #endif