Debian Codegraph @

bwa-apache2/scalar_sse.h

raw
1 #ifndef SCALAR_SSE_H
2 #define SCALAR_SSE_H
3
4 #include <assert.h>
5 #include <stdint.h>
6 #include <string.h>
7
8 typedef union m128i {
9 uint8_t u8[16];
10 int16_t i16[8];
11 } __m128i;
12
13 static inline __m128i _mm_set1_epi32(int32_t n) {
14 assert(n >= 0 && n <= 255);
15 __m128i r; memset(&r, n, sizeof r); return r;
16 }
17
18 static inline __m128i _mm_load_si128(const __m128i *ptr) { __m128i r; memcpy(&r, ptr, sizeof r); return r; }
19 static inline void _mm_store_si128(__m128i *ptr, __m128i a) { memcpy(ptr, &a, sizeof a); }
20
21 static inline int m128i_allzero(__m128i a) {
22 static const char zero[] = "\0\0\0\0\0\0\0\0\0\0\0\0\0\0\0\0";
23 return memcmp(&a, zero, sizeof a) == 0;
24 }
25
26 static inline __m128i _mm_slli_si128(__m128i a, int n) {
27 int i;
28 memmove(&a.u8[n], &a.u8[0], 16 - n);
29 for (i = 0; i < n; i++) a.u8[i] = 0;
30 return a;
31 }
32
33 static inline __m128i _mm_adds_epu8(__m128i a, __m128i b) {
34 int i;
35 for (i = 0; i < 16; i++) {
36 uint16_t aa = a.u8[i];
37 aa += b.u8[i];
38 a.u8[i] = (aa < 256)? aa : 255;
39 }
40 return a;
41 }
42
43 static inline __m128i _mm_max_epu8(__m128i a, __m128i b) {
44 int i;
45 for (i = 0; i < 16; i++)
46 if (a.u8[i] < b.u8[i]) a.u8[i] = b.u8[i];
47 return a;
48 }
49
50 static inline uint8_t m128i_max_u8(__m128i a) {
51 uint8_t max = 0;
52 int i;
53 for (i = 0; i < 16; i++)
54 if (max < a.u8[i]) max = a.u8[i];
55 return max;
56 }
57
58 static inline __m128i _mm_set1_epi8(int8_t n) { __m128i r; memset(&r, n, sizeof r); return r; }
59
60 static inline __m128i _mm_subs_epu8(__m128i a, __m128i b) {
61 int i;
62 for (i = 0; i < 16; i++) {
63 int16_t aa = a.u8[i];
64 aa -= b.u8[i];
65 a.u8[i] = (aa >= 0)? aa : 0;
66 }
67 return a;
68 }
69
70 static inline __m128i _mm_adds_epi16(__m128i a, __m128i b) {
71 int i;
72 for (i = 0; i < 8; i++) {
73 int32_t aa = a.i16[i];
74 aa += b.i16[i];
75 a.i16[i] = (aa < 32768)? aa : 32767;
76 }
77 return a;
78 }
79
80 static inline __m128i _mm_cmpgt_epi16(__m128i a, __m128i b) {
81 int i;
82 for (i = 0; i < 8; i++)
83 a.i16[i] = (a.i16[i] > b.i16[i])? 0xffff : 0x0000;
84 return a;
85 }
86
87 static inline __m128i _mm_max_epi16(__m128i a, __m128i b) {
88 int i;
89 for (i = 0; i < 8; i++)
90 if (a.i16[i] < b.i16[i]) a.i16[i] = b.i16[i];
91 return a;
92 }
93
94 static inline __m128i _mm_set1_epi16(int16_t n) {
95 __m128i r;
96 r.i16[0] = r.i16[1] = r.i16[2] = r.i16[3] =
97 r.i16[4] = r.i16[5] = r.i16[6] = r.i16[7] = n;
98 return r;
99 }
100
101 static inline int16_t m128i_max_s16(__m128i a) {
102 int16_t max = -32768;
103 int i;
104 for (i = 0; i < 8; i++)
105 if (max < a.i16[i]) max = a.i16[i];
106 return max;
107 }
108
109 static inline __m128i _mm_subs_epu16(__m128i a, __m128i b) {
110 int i;
111 for (i = 0; i < 8; i++) {
112 int32_t aa = a.i16[i];
113 aa -= b.i16[i];
114 a.i16[i] = (aa >= 0)? aa : 0;
115 }
116 return a;
117 }
118
119 #endif