blob: 3f981bc8c7ed218d1653281147675c18e71d865c [file] [log] [blame]
mtkleinc9adb052015-03-30 10:50:27 -07001/*
2 * Copyright 2015 Google Inc.
3 *
4 * Use of this source code is governed by a BSD-style license that can be
5 * found in the LICENSE file.
6 */
7
8#ifndef SkNx_sse_DEFINED
9#define SkNx_sse_DEFINED
10
mtkleine18fa442016-06-09 13:40:56 -070011#include <immintrin.h>
mtklein244a6532016-04-19 14:21:30 -070012
mtkleinc9adb052015-03-30 10:50:27 -070013// This file may assume <= SSE2, but must check SK_CPU_SSE_LEVEL for anything more recent.
mtkleine4c0bee2016-02-09 10:35:27 -080014// If you do, make sure this is in a static inline function... anywhere else risks violating ODR.
mtkleinaa999cb2015-05-22 17:18:21 -070015
Mike Klein1e764642016-10-14 17:09:03 -040016namespace {
17
mtkleinc9adb052015-03-30 10:50:27 -070018template <>
mtklein6c221b42015-11-20 13:53:19 -080019class SkNx<2, float> {
mtkleinc9adb052015-03-30 10:50:27 -070020public:
Mike Klein7c78f3a2016-10-19 09:21:11 -040021 AI SkNx(const __m128& vec) : fVec(vec) {}
mtkleinc9adb052015-03-30 10:50:27 -070022
Mike Klein7c78f3a2016-10-19 09:21:11 -040023 AI SkNx() {}
24 AI SkNx(float val) : fVec(_mm_set1_ps(val)) {}
25 AI static SkNx Load(const void* ptr) {
mtklein507ef6d2016-01-31 08:02:47 -080026 return _mm_castsi128_ps(_mm_loadl_epi64((const __m128i*)ptr));
mtkleinc9adb052015-03-30 10:50:27 -070027 }
Mike Klein7c78f3a2016-10-19 09:21:11 -040028 AI SkNx(float a, float b) : fVec(_mm_setr_ps(a,b,0,0)) {}
mtkleinc9adb052015-03-30 10:50:27 -070029
Mike Klein7c78f3a2016-10-19 09:21:11 -040030 AI void store(void* ptr) const { _mm_storel_pi((__m64*)ptr, fVec); }
mtkleinc9adb052015-03-30 10:50:27 -070031
Mike Klein7c78f3a2016-10-19 09:21:11 -040032 AI SkNx operator + (const SkNx& o) const { return _mm_add_ps(fVec, o.fVec); }
33 AI SkNx operator - (const SkNx& o) const { return _mm_sub_ps(fVec, o.fVec); }
34 AI SkNx operator * (const SkNx& o) const { return _mm_mul_ps(fVec, o.fVec); }
35 AI SkNx operator / (const SkNx& o) const { return _mm_div_ps(fVec, o.fVec); }
mtkleinc9adb052015-03-30 10:50:27 -070036
Mike Klein7c78f3a2016-10-19 09:21:11 -040037 AI SkNx operator == (const SkNx& o) const { return _mm_cmpeq_ps (fVec, o.fVec); }
38 AI SkNx operator != (const SkNx& o) const { return _mm_cmpneq_ps(fVec, o.fVec); }
39 AI SkNx operator < (const SkNx& o) const { return _mm_cmplt_ps (fVec, o.fVec); }
40 AI SkNx operator > (const SkNx& o) const { return _mm_cmpgt_ps (fVec, o.fVec); }
41 AI SkNx operator <= (const SkNx& o) const { return _mm_cmple_ps (fVec, o.fVec); }
42 AI SkNx operator >= (const SkNx& o) const { return _mm_cmpge_ps (fVec, o.fVec); }
mtkleinc9adb052015-03-30 10:50:27 -070043
Mike Klein7c78f3a2016-10-19 09:21:11 -040044 AI static SkNx Min(const SkNx& l, const SkNx& r) { return _mm_min_ps(l.fVec, r.fVec); }
45 AI static SkNx Max(const SkNx& l, const SkNx& r) { return _mm_max_ps(l.fVec, r.fVec); }
mtkleinc9adb052015-03-30 10:50:27 -070046
Mike Klein7c78f3a2016-10-19 09:21:11 -040047 AI SkNx sqrt() const { return _mm_sqrt_ps (fVec); }
48 AI SkNx rsqrt() const { return _mm_rsqrt_ps(fVec); }
49 AI SkNx invert() const { return _mm_rcp_ps(fVec); }
mtkleinc9adb052015-03-30 10:50:27 -070050
Mike Klein7c78f3a2016-10-19 09:21:11 -040051 AI float operator[](int k) const {
mtkleinc9adb052015-03-30 10:50:27 -070052 SkASSERT(0 <= k && k < 2);
53 union { __m128 v; float fs[4]; } pun = {fVec};
mtkleina156a8f2015-04-03 06:16:13 -070054 return pun.fs[k&1];
mtkleinc9adb052015-03-30 10:50:27 -070055 }
56
Mike Klein7c78f3a2016-10-19 09:21:11 -040057 AI bool allTrue() const { return 0xff == (_mm_movemask_epi8(_mm_castps_si128(fVec)) & 0xff); }
58 AI bool anyTrue() const { return 0x00 != (_mm_movemask_epi8(_mm_castps_si128(fVec)) & 0xff); }
mtkleinb5e86112015-06-24 15:18:39 -070059
mtkleinc9adb052015-03-30 10:50:27 -070060 __m128 fVec;
61};
62
63template <>
mtklein6c221b42015-11-20 13:53:19 -080064class SkNx<4, float> {
mtkleinc9adb052015-03-30 10:50:27 -070065public:
Mike Klein7c78f3a2016-10-19 09:21:11 -040066 AI SkNx(const __m128& vec) : fVec(vec) {}
mtkleinc9adb052015-03-30 10:50:27 -070067
Mike Klein7c78f3a2016-10-19 09:21:11 -040068 AI SkNx() {}
69 AI SkNx(float val) : fVec( _mm_set1_ps(val) ) {}
70 AI SkNx(float a, float b, float c, float d) : fVec(_mm_setr_ps(a,b,c,d)) {}
mtkleinc9adb052015-03-30 10:50:27 -070071
Mike Klein7c78f3a2016-10-19 09:21:11 -040072 AI static SkNx Load(const void* ptr) { return _mm_loadu_ps((const float*)ptr); }
73 AI void store(void* ptr) const { _mm_storeu_ps((float*)ptr, fVec); }
mtklein9db43ac2015-12-01 07:10:21 -080074
Mike Klein7c78f3a2016-10-19 09:21:11 -040075 AI static void Load4(const void* ptr, SkNx* r, SkNx* g, SkNx* b, SkNx* a) {
Mike Klein33cbfd72016-10-06 11:09:27 -040076 __m128 v0 = _mm_loadu_ps(((float*)ptr) + 0),
77 v1 = _mm_loadu_ps(((float*)ptr) + 4),
78 v2 = _mm_loadu_ps(((float*)ptr) + 8),
79 v3 = _mm_loadu_ps(((float*)ptr) + 12);
80 _MM_TRANSPOSE4_PS(v0, v1, v2, v3);
81 *r = v0;
82 *g = v1;
83 *b = v2;
84 *a = v3;
85 }
Mike Klein7c78f3a2016-10-19 09:21:11 -040086 AI static void Store4(void* dst, const SkNx& r, const SkNx& g, const SkNx& b, const SkNx& a) {
Mike Klein33cbfd72016-10-06 11:09:27 -040087 __m128 v0 = r.fVec,
88 v1 = g.fVec,
89 v2 = b.fVec,
90 v3 = a.fVec;
91 _MM_TRANSPOSE4_PS(v0, v1, v2, v3);
92 _mm_storeu_ps(((float*) dst) + 0, v0);
93 _mm_storeu_ps(((float*) dst) + 4, v1);
94 _mm_storeu_ps(((float*) dst) + 8, v2);
95 _mm_storeu_ps(((float*) dst) + 12, v3);
96 }
97
Mike Klein7c78f3a2016-10-19 09:21:11 -040098 AI SkNx operator + (const SkNx& o) const { return _mm_add_ps(fVec, o.fVec); }
99 AI SkNx operator - (const SkNx& o) const { return _mm_sub_ps(fVec, o.fVec); }
100 AI SkNx operator * (const SkNx& o) const { return _mm_mul_ps(fVec, o.fVec); }
101 AI SkNx operator / (const SkNx& o) const { return _mm_div_ps(fVec, o.fVec); }
mtkleinc9adb052015-03-30 10:50:27 -0700102
Mike Klein7c78f3a2016-10-19 09:21:11 -0400103 AI SkNx operator == (const SkNx& o) const { return _mm_cmpeq_ps (fVec, o.fVec); }
104 AI SkNx operator != (const SkNx& o) const { return _mm_cmpneq_ps(fVec, o.fVec); }
105 AI SkNx operator < (const SkNx& o) const { return _mm_cmplt_ps (fVec, o.fVec); }
106 AI SkNx operator > (const SkNx& o) const { return _mm_cmpgt_ps (fVec, o.fVec); }
107 AI SkNx operator <= (const SkNx& o) const { return _mm_cmple_ps (fVec, o.fVec); }
108 AI SkNx operator >= (const SkNx& o) const { return _mm_cmpge_ps (fVec, o.fVec); }
mtkleinc9adb052015-03-30 10:50:27 -0700109
Mike Klein7c78f3a2016-10-19 09:21:11 -0400110 AI static SkNx Min(const SkNx& l, const SkNx& r) { return _mm_min_ps(l.fVec, r.fVec); }
111 AI static SkNx Max(const SkNx& l, const SkNx& r) { return _mm_max_ps(l.fVec, r.fVec); }
mtkleinc9adb052015-03-30 10:50:27 -0700112
Mike Klein7c78f3a2016-10-19 09:21:11 -0400113 AI SkNx abs() const { return _mm_andnot_ps(_mm_set1_ps(-0.0f), fVec); }
114 AI SkNx floor() const {
mtklein5608e2e2016-07-11 09:59:21 -0700115 #if SK_CPU_SSE_LEVEL >= SK_CPU_SSE_LEVEL_SSE41
116 return _mm_floor_ps(fVec);
117 #else
mtklein244a6532016-04-19 14:21:30 -0700118 // Emulate _mm_floor_ps() with SSE2:
119 // - roundtrip through integers via truncation
120 // - subtract 1 if that's too big (possible for negative values).
121 // This restricts the domain of our inputs to a maximum somehwere around 2^31.
122 // Seems plenty big.
123 __m128 roundtrip = _mm_cvtepi32_ps(_mm_cvttps_epi32(fVec));
124 __m128 too_big = _mm_cmpgt_ps(roundtrip, fVec);
125 return _mm_sub_ps(roundtrip, _mm_and_ps(too_big, _mm_set1_ps(1.0f)));
mtklein5608e2e2016-07-11 09:59:21 -0700126 #endif
mtklein244a6532016-04-19 14:21:30 -0700127 }
mtkleinc33065a2016-01-15 12:16:40 -0800128
Mike Klein7c78f3a2016-10-19 09:21:11 -0400129 AI SkNx sqrt() const { return _mm_sqrt_ps (fVec); }
130 AI SkNx rsqrt() const { return _mm_rsqrt_ps(fVec); }
131 AI SkNx invert() const { return _mm_rcp_ps(fVec); }
mtkleinc9adb052015-03-30 10:50:27 -0700132
Mike Klein7c78f3a2016-10-19 09:21:11 -0400133 AI float operator[](int k) const {
mtkleinc9adb052015-03-30 10:50:27 -0700134 SkASSERT(0 <= k && k < 4);
135 union { __m128 v; float fs[4]; } pun = {fVec};
mtkleina156a8f2015-04-03 06:16:13 -0700136 return pun.fs[k&3];
mtkleinc9adb052015-03-30 10:50:27 -0700137 }
138
Mike Klein7c78f3a2016-10-19 09:21:11 -0400139 AI bool allTrue() const { return 0xffff == _mm_movemask_epi8(_mm_castps_si128(fVec)); }
140 AI bool anyTrue() const { return 0x0000 != _mm_movemask_epi8(_mm_castps_si128(fVec)); }
mtkleinb5e86112015-06-24 15:18:39 -0700141
Mike Klein7c78f3a2016-10-19 09:21:11 -0400142 AI SkNx thenElse(const SkNx& t, const SkNx& e) const {
mtklein5608e2e2016-07-11 09:59:21 -0700143 #if SK_CPU_SSE_LEVEL >= SK_CPU_SSE_LEVEL_SSE41
msarettd2809572016-06-20 06:07:45 -0700144 return _mm_blendv_ps(e.fVec, t.fVec, fVec);
mtklein5608e2e2016-07-11 09:59:21 -0700145 #else
mtklein2aab22a2015-06-26 10:46:31 -0700146 return _mm_or_ps(_mm_and_ps (fVec, t.fVec),
147 _mm_andnot_ps(fVec, e.fVec));
mtklein5608e2e2016-07-11 09:59:21 -0700148 #endif
mtklein2aab22a2015-06-26 10:46:31 -0700149 }
150
mtkleinc9adb052015-03-30 10:50:27 -0700151 __m128 fVec;
152};
153
mtklein115acee2015-04-14 14:02:52 -0700154template <>
mtkleind05a8752016-07-29 10:10:15 -0700155class SkNx<4, int32_t> {
mtklein8273ca42016-02-09 11:32:51 -0800156public:
Mike Klein7c78f3a2016-10-19 09:21:11 -0400157 AI SkNx(const __m128i& vec) : fVec(vec) {}
mtklein8273ca42016-02-09 11:32:51 -0800158
Mike Klein7c78f3a2016-10-19 09:21:11 -0400159 AI SkNx() {}
160 AI SkNx(int32_t val) : fVec(_mm_set1_epi32(val)) {}
161 AI static SkNx Load(const void* ptr) { return _mm_loadu_si128((const __m128i*)ptr); }
162 AI SkNx(int32_t a, int32_t b, int32_t c, int32_t d) : fVec(_mm_setr_epi32(a,b,c,d)) {}
mtklein8273ca42016-02-09 11:32:51 -0800163
Mike Klein7c78f3a2016-10-19 09:21:11 -0400164 AI void store(void* ptr) const { _mm_storeu_si128((__m128i*)ptr, fVec); }
mtklein8273ca42016-02-09 11:32:51 -0800165
Mike Klein7c78f3a2016-10-19 09:21:11 -0400166 AI SkNx operator + (const SkNx& o) const { return _mm_add_epi32(fVec, o.fVec); }
167 AI SkNx operator - (const SkNx& o) const { return _mm_sub_epi32(fVec, o.fVec); }
168 AI SkNx operator * (const SkNx& o) const {
mtklein8273ca42016-02-09 11:32:51 -0800169 __m128i mul20 = _mm_mul_epu32(fVec, o.fVec),
170 mul31 = _mm_mul_epu32(_mm_srli_si128(fVec, 4), _mm_srli_si128(o.fVec, 4));
171 return _mm_unpacklo_epi32(_mm_shuffle_epi32(mul20, _MM_SHUFFLE(0,0,2,0)),
172 _mm_shuffle_epi32(mul31, _MM_SHUFFLE(0,0,2,0)));
173 }
174
Mike Klein7c78f3a2016-10-19 09:21:11 -0400175 AI SkNx operator & (const SkNx& o) const { return _mm_and_si128(fVec, o.fVec); }
176 AI SkNx operator | (const SkNx& o) const { return _mm_or_si128(fVec, o.fVec); }
177 AI SkNx operator ^ (const SkNx& o) const { return _mm_xor_si128(fVec, o.fVec); }
mtklein64f061a2016-06-17 12:09:16 -0700178
Mike Klein7c78f3a2016-10-19 09:21:11 -0400179 AI SkNx operator << (int bits) const { return _mm_slli_epi32(fVec, bits); }
180 AI SkNx operator >> (int bits) const { return _mm_srai_epi32(fVec, bits); }
mtklein8273ca42016-02-09 11:32:51 -0800181
Mike Klein7c78f3a2016-10-19 09:21:11 -0400182 AI SkNx operator == (const SkNx& o) const { return _mm_cmpeq_epi32 (fVec, o.fVec); }
183 AI SkNx operator < (const SkNx& o) const { return _mm_cmplt_epi32 (fVec, o.fVec); }
184 AI SkNx operator > (const SkNx& o) const { return _mm_cmpgt_epi32 (fVec, o.fVec); }
mtklein58e389b2016-07-15 07:00:11 -0700185
Mike Klein7c78f3a2016-10-19 09:21:11 -0400186 AI int32_t operator[](int k) const {
mtklein8273ca42016-02-09 11:32:51 -0800187 SkASSERT(0 <= k && k < 4);
mtkleind05a8752016-07-29 10:10:15 -0700188 union { __m128i v; int32_t is[4]; } pun = {fVec};
mtklein8273ca42016-02-09 11:32:51 -0800189 return pun.is[k&3];
190 }
mtklein8273ca42016-02-09 11:32:51 -0800191
Mike Klein7c78f3a2016-10-19 09:21:11 -0400192 AI SkNx thenElse(const SkNx& t, const SkNx& e) const {
mtklein58e389b2016-07-15 07:00:11 -0700193 #if SK_CPU_SSE_LEVEL >= SK_CPU_SSE_LEVEL_SSE41
194 return _mm_blendv_epi8(e.fVec, t.fVec, fVec);
195 #else
196 return _mm_or_si128(_mm_and_si128 (fVec, t.fVec),
197 _mm_andnot_si128(fVec, e.fVec));
198 #endif
199 }
200
mtklein8273ca42016-02-09 11:32:51 -0800201 __m128i fVec;
202};
203
204template <>
mtkleind05a8752016-07-29 10:10:15 -0700205class SkNx<4, uint32_t> {
206public:
Mike Klein7c78f3a2016-10-19 09:21:11 -0400207 AI SkNx(const __m128i& vec) : fVec(vec) {}
mtkleind05a8752016-07-29 10:10:15 -0700208
Mike Klein7c78f3a2016-10-19 09:21:11 -0400209 AI SkNx() {}
210 AI SkNx(uint32_t val) : fVec(_mm_set1_epi32(val)) {}
211 AI static SkNx Load(const void* ptr) { return _mm_loadu_si128((const __m128i*)ptr); }
212 AI SkNx(uint32_t a, uint32_t b, uint32_t c, uint32_t d) : fVec(_mm_setr_epi32(a,b,c,d)) {}
mtkleind05a8752016-07-29 10:10:15 -0700213
Mike Klein7c78f3a2016-10-19 09:21:11 -0400214 AI void store(void* ptr) const { _mm_storeu_si128((__m128i*)ptr, fVec); }
mtkleind05a8752016-07-29 10:10:15 -0700215
Mike Klein7c78f3a2016-10-19 09:21:11 -0400216 AI SkNx operator + (const SkNx& o) const { return _mm_add_epi32(fVec, o.fVec); }
217 AI SkNx operator - (const SkNx& o) const { return _mm_sub_epi32(fVec, o.fVec); }
mtkleind05a8752016-07-29 10:10:15 -0700218 // Not quite sure how to best do operator * in SSE2. We probably don't use it.
219
Mike Klein7c78f3a2016-10-19 09:21:11 -0400220 AI SkNx operator & (const SkNx& o) const { return _mm_and_si128(fVec, o.fVec); }
221 AI SkNx operator | (const SkNx& o) const { return _mm_or_si128(fVec, o.fVec); }
222 AI SkNx operator ^ (const SkNx& o) const { return _mm_xor_si128(fVec, o.fVec); }
mtkleind05a8752016-07-29 10:10:15 -0700223
Mike Klein7c78f3a2016-10-19 09:21:11 -0400224 AI SkNx operator << (int bits) const { return _mm_slli_epi32(fVec, bits); }
225 AI SkNx operator >> (int bits) const { return _mm_srli_epi32(fVec, bits); }
mtkleind05a8752016-07-29 10:10:15 -0700226
Mike Klein7c78f3a2016-10-19 09:21:11 -0400227 AI SkNx operator == (const SkNx& o) const { return _mm_cmpeq_epi32 (fVec, o.fVec); }
mtkleind05a8752016-07-29 10:10:15 -0700228 // operator < and > take a little extra fiddling to make work for unsigned ints.
229
Mike Klein7c78f3a2016-10-19 09:21:11 -0400230 AI uint32_t operator[](int k) const {
mtkleind05a8752016-07-29 10:10:15 -0700231 SkASSERT(0 <= k && k < 4);
232 union { __m128i v; uint32_t us[4]; } pun = {fVec};
233 return pun.us[k&3];
234 }
235
Mike Klein7c78f3a2016-10-19 09:21:11 -0400236 AI SkNx thenElse(const SkNx& t, const SkNx& e) const {
mtkleind05a8752016-07-29 10:10:15 -0700237 #if SK_CPU_SSE_LEVEL >= SK_CPU_SSE_LEVEL_SSE41
238 return _mm_blendv_epi8(e.fVec, t.fVec, fVec);
239 #else
240 return _mm_or_si128(_mm_and_si128 (fVec, t.fVec),
241 _mm_andnot_si128(fVec, e.fVec));
242 #endif
243 }
244
245 __m128i fVec;
246};
247
248
249template <>
mtklein6c221b42015-11-20 13:53:19 -0800250class SkNx<4, uint16_t> {
mtklein115acee2015-04-14 14:02:52 -0700251public:
Mike Klein7c78f3a2016-10-19 09:21:11 -0400252 AI SkNx(const __m128i& vec) : fVec(vec) {}
mtklein115acee2015-04-14 14:02:52 -0700253
Mike Klein7c78f3a2016-10-19 09:21:11 -0400254 AI SkNx() {}
255 AI SkNx(uint16_t val) : fVec(_mm_set1_epi16(val)) {}
256 AI SkNx(uint16_t a, uint16_t b, uint16_t c, uint16_t d)
257 : fVec(_mm_setr_epi16(a,b,c,d,0,0,0,0)) {}
mtklein115acee2015-04-14 14:02:52 -0700258
Mike Klein7c78f3a2016-10-19 09:21:11 -0400259 AI static SkNx Load(const void* ptr) { return _mm_loadl_epi64((const __m128i*)ptr); }
260 AI void store(void* ptr) const { _mm_storel_epi64((__m128i*)ptr, fVec); }
mtklein115acee2015-04-14 14:02:52 -0700261
Mike Klein7c78f3a2016-10-19 09:21:11 -0400262 AI static void Load4(const void* ptr, SkNx* r, SkNx* g, SkNx* b, SkNx* a) {
Mike Klein33cbfd72016-10-06 11:09:27 -0400263 __m128i lo = _mm_loadu_si128(((__m128i*)ptr) + 0),
264 hi = _mm_loadu_si128(((__m128i*)ptr) + 1);
265 __m128i even = _mm_unpacklo_epi16(lo, hi), // r0 r2 g0 g2 b0 b2 a0 a2
266 odd = _mm_unpackhi_epi16(lo, hi); // r1 r3 ...
267 __m128i rg = _mm_unpacklo_epi16(even, odd), // r0 r1 r2 r3 g0 g1 g2 g3
268 ba = _mm_unpackhi_epi16(even, odd); // b0 b1 ... a0 a1 ...
269 *r = rg;
270 *g = _mm_srli_si128(rg, 8);
271 *b = ba;
272 *a = _mm_srli_si128(ba, 8);
273 }
Matt Sarett7a090c42017-01-17 12:22:48 -0500274 AI static void Load3(const void* ptr, SkNx* r, SkNx* g, SkNx* b) {
275 // The idea here is to get 4 vectors that are R G B _ _ _ _ _.
276 // The second load is at a funny location to make sure we don't read past
277 // the bounds of memory. This is fine, we just need to shift it a little bit.
278 const uint8_t* ptr8 = (const uint8_t*) ptr;
279 __m128i rgb0 = _mm_loadu_si128((const __m128i*) (ptr8 + 0));
280 __m128i rgb1 = _mm_srli_si128(rgb0, 3*2);
281 __m128i rgb2 = _mm_srli_si128(_mm_loadu_si128((const __m128i*) (ptr8 + 4*2)), 2*2);
282 __m128i rgb3 = _mm_srli_si128(rgb2, 3*2);
283
284 __m128i rrggbb01 = _mm_unpacklo_epi16(rgb0, rgb1);
285 __m128i rrggbb23 = _mm_unpacklo_epi16(rgb2, rgb3);
286 *r = _mm_unpacklo_epi32(rrggbb01, rrggbb23);
287 *g = _mm_srli_si128(r->fVec, 4*2);
288 *b = _mm_unpackhi_epi32(rrggbb01, rrggbb23);
289 }
Mike Klein7c78f3a2016-10-19 09:21:11 -0400290 AI static void Store4(void* dst, const SkNx& r, const SkNx& g, const SkNx& b, const SkNx& a) {
Mike Klein33cbfd72016-10-06 11:09:27 -0400291 __m128i rg = _mm_unpacklo_epi16(r.fVec, g.fVec);
292 __m128i ba = _mm_unpacklo_epi16(b.fVec, a.fVec);
293 __m128i lo = _mm_unpacklo_epi32(rg, ba);
294 __m128i hi = _mm_unpackhi_epi32(rg, ba);
295 _mm_storeu_si128(((__m128i*) dst) + 0, lo);
296 _mm_storeu_si128(((__m128i*) dst) + 1, hi);
297 }
298
Mike Klein7c78f3a2016-10-19 09:21:11 -0400299 AI SkNx operator + (const SkNx& o) const { return _mm_add_epi16(fVec, o.fVec); }
300 AI SkNx operator - (const SkNx& o) const { return _mm_sub_epi16(fVec, o.fVec); }
301 AI SkNx operator * (const SkNx& o) const { return _mm_mullo_epi16(fVec, o.fVec); }
Matt Sarett379938e2017-01-12 18:34:29 -0500302 AI SkNx operator & (const SkNx& o) const { return _mm_and_si128(fVec, o.fVec); }
303 AI SkNx operator | (const SkNx& o) const { return _mm_or_si128(fVec, o.fVec); }
mtklein115acee2015-04-14 14:02:52 -0700304
Mike Klein7c78f3a2016-10-19 09:21:11 -0400305 AI SkNx operator << (int bits) const { return _mm_slli_epi16(fVec, bits); }
306 AI SkNx operator >> (int bits) const { return _mm_srli_epi16(fVec, bits); }
mtklein115acee2015-04-14 14:02:52 -0700307
Mike Klein7c78f3a2016-10-19 09:21:11 -0400308 AI uint16_t operator[](int k) const {
mtklein115acee2015-04-14 14:02:52 -0700309 SkASSERT(0 <= k && k < 4);
mtkleine4c0bee2016-02-09 10:35:27 -0800310 union { __m128i v; uint16_t us[8]; } pun = {fVec};
311 return pun.us[k&3];
mtklein115acee2015-04-14 14:02:52 -0700312 }
mtkleind2ffd362015-05-12 06:11:21 -0700313
mtklein115acee2015-04-14 14:02:52 -0700314 __m128i fVec;
315};
316
317template <>
mtklein6c221b42015-11-20 13:53:19 -0800318class SkNx<8, uint16_t> {
mtklein115acee2015-04-14 14:02:52 -0700319public:
Mike Klein7c78f3a2016-10-19 09:21:11 -0400320 AI SkNx(const __m128i& vec) : fVec(vec) {}
mtklein115acee2015-04-14 14:02:52 -0700321
Mike Klein7c78f3a2016-10-19 09:21:11 -0400322 AI SkNx() {}
323 AI SkNx(uint16_t val) : fVec(_mm_set1_epi16(val)) {}
324 AI SkNx(uint16_t a, uint16_t b, uint16_t c, uint16_t d,
325 uint16_t e, uint16_t f, uint16_t g, uint16_t h)
326 : fVec(_mm_setr_epi16(a,b,c,d,e,f,g,h)) {}
mtklein115acee2015-04-14 14:02:52 -0700327
Mike Klein7c78f3a2016-10-19 09:21:11 -0400328 AI static SkNx Load(const void* ptr) { return _mm_loadu_si128((const __m128i*)ptr); }
329 AI void store(void* ptr) const { _mm_storeu_si128((__m128i*)ptr, fVec); }
mtklein115acee2015-04-14 14:02:52 -0700330
Mike Klein7c78f3a2016-10-19 09:21:11 -0400331 AI static void Load4(const void* ptr, SkNx* r, SkNx* g, SkNx* b, SkNx* a) {
Mike Klein04adfda2016-10-12 09:52:55 -0400332 // TODO: AVX2 version
333 __m128i _01 = _mm_loadu_si128(((__m128i*)ptr) + 0),
334 _23 = _mm_loadu_si128(((__m128i*)ptr) + 1),
335 _45 = _mm_loadu_si128(((__m128i*)ptr) + 2),
336 _67 = _mm_loadu_si128(((__m128i*)ptr) + 3);
337
338 __m128i _02 = _mm_unpacklo_epi16(_01, _23), // r0 r2 g0 g2 b0 b2 a0 a2
339 _13 = _mm_unpackhi_epi16(_01, _23), // r1 r3 g1 g3 b1 b3 a1 a3
340 _46 = _mm_unpacklo_epi16(_45, _67),
341 _57 = _mm_unpackhi_epi16(_45, _67);
342
343 __m128i rg0123 = _mm_unpacklo_epi16(_02, _13), // r0 r1 r2 r3 g0 g1 g2 g3
344 ba0123 = _mm_unpackhi_epi16(_02, _13), // b0 b1 b2 b3 a0 a1 a2 a3
345 rg4567 = _mm_unpacklo_epi16(_46, _57),
346 ba4567 = _mm_unpackhi_epi16(_46, _57);
347
348 *r = _mm_unpacklo_epi64(rg0123, rg4567);
349 *g = _mm_unpackhi_epi64(rg0123, rg4567);
350 *b = _mm_unpacklo_epi64(ba0123, ba4567);
351 *a = _mm_unpackhi_epi64(ba0123, ba4567);
352 }
Mike Klein7c78f3a2016-10-19 09:21:11 -0400353 AI static void Store4(void* ptr, const SkNx& r, const SkNx& g, const SkNx& b, const SkNx& a) {
Mike Klein04adfda2016-10-12 09:52:55 -0400354 // TODO: AVX2 version
355 __m128i rg0123 = _mm_unpacklo_epi16(r.fVec, g.fVec), // r0 g0 r1 g1 r2 g2 r3 g3
356 rg4567 = _mm_unpackhi_epi16(r.fVec, g.fVec), // r4 g4 r5 g5 r6 g6 r7 g7
357 ba0123 = _mm_unpacklo_epi16(b.fVec, a.fVec),
358 ba4567 = _mm_unpackhi_epi16(b.fVec, a.fVec);
359
360 _mm_storeu_si128((__m128i*)ptr + 0, _mm_unpacklo_epi32(rg0123, ba0123));
361 _mm_storeu_si128((__m128i*)ptr + 1, _mm_unpackhi_epi32(rg0123, ba0123));
362 _mm_storeu_si128((__m128i*)ptr + 2, _mm_unpacklo_epi32(rg4567, ba4567));
363 _mm_storeu_si128((__m128i*)ptr + 3, _mm_unpackhi_epi32(rg4567, ba4567));
364 }
365
Mike Klein7c78f3a2016-10-19 09:21:11 -0400366 AI SkNx operator + (const SkNx& o) const { return _mm_add_epi16(fVec, o.fVec); }
367 AI SkNx operator - (const SkNx& o) const { return _mm_sub_epi16(fVec, o.fVec); }
368 AI SkNx operator * (const SkNx& o) const { return _mm_mullo_epi16(fVec, o.fVec); }
Matt Sarett379938e2017-01-12 18:34:29 -0500369 AI SkNx operator & (const SkNx& o) const { return _mm_and_si128(fVec, o.fVec); }
370 AI SkNx operator | (const SkNx& o) const { return _mm_or_si128(fVec, o.fVec); }
mtklein115acee2015-04-14 14:02:52 -0700371
Mike Klein7c78f3a2016-10-19 09:21:11 -0400372 AI SkNx operator << (int bits) const { return _mm_slli_epi16(fVec, bits); }
373 AI SkNx operator >> (int bits) const { return _mm_srli_epi16(fVec, bits); }
mtklein115acee2015-04-14 14:02:52 -0700374
Mike Klein7c78f3a2016-10-19 09:21:11 -0400375 AI static SkNx Min(const SkNx& a, const SkNx& b) {
mtklein27e517a2015-05-14 17:53:04 -0700376 // No unsigned _mm_min_epu16, so we'll shift into a space where we can use the
377 // signed version, _mm_min_epi16, then shift back.
378 const uint16_t top = 0x8000; // Keep this separate from _mm_set1_epi16 or MSVC will whine.
379 const __m128i top_8x = _mm_set1_epi16(top);
380 return _mm_add_epi8(top_8x, _mm_min_epi16(_mm_sub_epi8(a.fVec, top_8x),
381 _mm_sub_epi8(b.fVec, top_8x)));
382 }
383
Mike Klein7c78f3a2016-10-19 09:21:11 -0400384 AI SkNx thenElse(const SkNx& t, const SkNx& e) const {
mtklein4be181e2015-07-14 10:54:19 -0700385 return _mm_or_si128(_mm_and_si128 (fVec, t.fVec),
386 _mm_andnot_si128(fVec, e.fVec));
387 }
388
Mike Klein7c78f3a2016-10-19 09:21:11 -0400389 AI uint16_t operator[](int k) const {
mtklein115acee2015-04-14 14:02:52 -0700390 SkASSERT(0 <= k && k < 8);
mtkleine4c0bee2016-02-09 10:35:27 -0800391 union { __m128i v; uint16_t us[8]; } pun = {fVec};
392 return pun.us[k&7];
mtklein115acee2015-04-14 14:02:52 -0700393 }
mtkleind2ffd362015-05-12 06:11:21 -0700394
395 __m128i fVec;
396};
397
398template <>
mtklein6f37b4a2015-12-14 11:25:18 -0800399class SkNx<4, uint8_t> {
400public:
Mike Klein7c78f3a2016-10-19 09:21:11 -0400401 AI SkNx() {}
402 AI SkNx(const __m128i& vec) : fVec(vec) {}
403 AI SkNx(uint8_t a, uint8_t b, uint8_t c, uint8_t d)
herbfd5a2602016-03-01 07:01:23 -0800404 : fVec(_mm_setr_epi8(a,b,c,d, 0,0,0,0, 0,0,0,0, 0,0,0,0)) {}
405
406
Mike Klein7c78f3a2016-10-19 09:21:11 -0400407 AI static SkNx Load(const void* ptr) { return _mm_cvtsi32_si128(*(const int*)ptr); }
408 AI void store(void* ptr) const { *(int*)ptr = _mm_cvtsi128_si32(fVec); }
mtklein6f37b4a2015-12-14 11:25:18 -0800409
Mike Klein7c78f3a2016-10-19 09:21:11 -0400410 AI uint8_t operator[](int k) const {
herbfd5a2602016-03-01 07:01:23 -0800411 SkASSERT(0 <= k && k < 4);
412 union { __m128i v; uint8_t us[16]; } pun = {fVec};
413 return pun.us[k&3];
414 }
415
mtklein6f37b4a2015-12-14 11:25:18 -0800416 // TODO as needed
417
418 __m128i fVec;
419};
420
421template <>
mtklein6c221b42015-11-20 13:53:19 -0800422class SkNx<16, uint8_t> {
mtkleind2ffd362015-05-12 06:11:21 -0700423public:
Mike Klein7c78f3a2016-10-19 09:21:11 -0400424 AI SkNx(const __m128i& vec) : fVec(vec) {}
mtkleind2ffd362015-05-12 06:11:21 -0700425
Mike Klein7c78f3a2016-10-19 09:21:11 -0400426 AI SkNx() {}
427 AI SkNx(uint8_t val) : fVec(_mm_set1_epi8(val)) {}
428 AI static SkNx Load(const void* ptr) { return _mm_loadu_si128((const __m128i*)ptr); }
429 AI SkNx(uint8_t a, uint8_t b, uint8_t c, uint8_t d,
430 uint8_t e, uint8_t f, uint8_t g, uint8_t h,
431 uint8_t i, uint8_t j, uint8_t k, uint8_t l,
432 uint8_t m, uint8_t n, uint8_t o, uint8_t p)
mtkleind2ffd362015-05-12 06:11:21 -0700433 : fVec(_mm_setr_epi8(a,b,c,d, e,f,g,h, i,j,k,l, m,n,o,p)) {}
434
Mike Klein7c78f3a2016-10-19 09:21:11 -0400435 AI void store(void* ptr) const { _mm_storeu_si128((__m128i*)ptr, fVec); }
mtkleind2ffd362015-05-12 06:11:21 -0700436
Mike Klein7c78f3a2016-10-19 09:21:11 -0400437 AI SkNx saturatedAdd(const SkNx& o) const { return _mm_adds_epu8(fVec, o.fVec); }
mtklein6cbf18c2015-05-12 15:48:09 -0700438
Mike Klein7c78f3a2016-10-19 09:21:11 -0400439 AI SkNx operator + (const SkNx& o) const { return _mm_add_epi8(fVec, o.fVec); }
440 AI SkNx operator - (const SkNx& o) const { return _mm_sub_epi8(fVec, o.fVec); }
mtkleind2ffd362015-05-12 06:11:21 -0700441
Mike Klein7c78f3a2016-10-19 09:21:11 -0400442 AI static SkNx Min(const SkNx& a, const SkNx& b) { return _mm_min_epu8(a.fVec, b.fVec); }
443 AI SkNx operator < (const SkNx& o) const {
mtkleinb5e86112015-06-24 15:18:39 -0700444 // There's no unsigned _mm_cmplt_epu8, so we flip the sign bits then use a signed compare.
445 auto flip = _mm_set1_epi8(char(0x80));
446 return _mm_cmplt_epi8(_mm_xor_si128(flip, fVec), _mm_xor_si128(flip, o.fVec));
447 }
mtklein27e517a2015-05-14 17:53:04 -0700448
Mike Klein7c78f3a2016-10-19 09:21:11 -0400449 AI uint8_t operator[](int k) const {
mtkleind2ffd362015-05-12 06:11:21 -0700450 SkASSERT(0 <= k && k < 16);
mtkleine4c0bee2016-02-09 10:35:27 -0800451 union { __m128i v; uint8_t us[16]; } pun = {fVec};
452 return pun.us[k&15];
mtkleind2ffd362015-05-12 06:11:21 -0700453 }
454
Mike Klein7c78f3a2016-10-19 09:21:11 -0400455 AI SkNx thenElse(const SkNx& t, const SkNx& e) const {
mtkleinb5e86112015-06-24 15:18:39 -0700456 return _mm_or_si128(_mm_and_si128 (fVec, t.fVec),
457 _mm_andnot_si128(fVec, e.fVec));
458 }
459
mtklein115acee2015-04-14 14:02:52 -0700460 __m128i fVec;
461};
mtkleinc9adb052015-03-30 10:50:27 -0700462
Mike Klein04adfda2016-10-12 09:52:55 -0400463#if SK_CPU_SSE_LEVEL >= SK_CPU_SSE_LEVEL_AVX2
464
Mike Klein04adfda2016-10-12 09:52:55 -0400465 template <>
466 class SkNx<8, uint8_t> {
467 public:
Mike Klein7c78f3a2016-10-19 09:21:11 -0400468 AI SkNx(const __m128i& vec) : fVec(vec) {}
Mike Klein04adfda2016-10-12 09:52:55 -0400469
Mike Klein7c78f3a2016-10-19 09:21:11 -0400470 AI SkNx() {}
471 AI SkNx(uint8_t v) : fVec(_mm_set1_epi8(v)) {}
472 AI SkNx(uint8_t a, uint8_t b, uint8_t c, uint8_t d,
473 uint8_t e, uint8_t f, uint8_t g, uint8_t h)
Mike Klein04adfda2016-10-12 09:52:55 -0400474 : fVec(_mm_setr_epi8(a,b,c,d, e,f,g,h, 0,0,0,0, 0,0,0,0)) {}
475
476
Mike Klein7c78f3a2016-10-19 09:21:11 -0400477 AI static SkNx Load(const void* ptr) { return _mm_loadl_epi64((const __m128i*)ptr); }
478 AI void store(void* ptr) const { _mm_storel_epi64((__m128i*)ptr, fVec); }
Mike Klein04adfda2016-10-12 09:52:55 -0400479
Mike Klein7c78f3a2016-10-19 09:21:11 -0400480 AI uint8_t operator[](int k) const {
Mike Klein04adfda2016-10-12 09:52:55 -0400481 SkASSERT(0 <= k && k < 8);
482 union { __m128i v; uint8_t us[16]; } pun = {fVec};
483 return pun.us[k&7];
484 }
485
486 __m128i fVec;
487 };
488
489 template <>
490 class SkNx<8, int32_t> {
491 public:
Mike Klein7c78f3a2016-10-19 09:21:11 -0400492 AI SkNx(const __m256i& vec) : fVec(vec) {}
Mike Klein04adfda2016-10-12 09:52:55 -0400493
Mike Klein7c78f3a2016-10-19 09:21:11 -0400494 AI SkNx() {}
495 AI SkNx(int32_t v) : fVec(_mm256_set1_epi32(v)) {}
496 AI SkNx(int32_t a, int32_t b, int32_t c, int32_t d,
497 int32_t e, int32_t f, int32_t g, int32_t h)
Mike Klein04adfda2016-10-12 09:52:55 -0400498 : fVec(_mm256_setr_epi32(a,b,c,d, e,f,g,h)) {}
499
Mike Klein7c78f3a2016-10-19 09:21:11 -0400500 AI static SkNx Load(const void* ptr) { return _mm256_loadu_si256((const __m256i*)ptr); }
501 AI void store(void* ptr) const { _mm256_storeu_si256((__m256i*)ptr, fVec); }
Mike Klein04adfda2016-10-12 09:52:55 -0400502
Mike Klein7c78f3a2016-10-19 09:21:11 -0400503 AI SkNx operator + (const SkNx& o) const { return _mm256_add_epi32(fVec, o.fVec); }
504 AI SkNx operator - (const SkNx& o) const { return _mm256_sub_epi32(fVec, o.fVec); }
505 AI SkNx operator * (const SkNx& o) const { return _mm256_mullo_epi32(fVec, o.fVec); }
Mike Klein04adfda2016-10-12 09:52:55 -0400506
Mike Klein7c78f3a2016-10-19 09:21:11 -0400507 AI SkNx operator & (const SkNx& o) const { return _mm256_and_si256(fVec, o.fVec); }
508 AI SkNx operator | (const SkNx& o) const { return _mm256_or_si256(fVec, o.fVec); }
509 AI SkNx operator ^ (const SkNx& o) const { return _mm256_xor_si256(fVec, o.fVec); }
Mike Klein04adfda2016-10-12 09:52:55 -0400510
Mike Klein7c78f3a2016-10-19 09:21:11 -0400511 AI SkNx operator << (int bits) const { return _mm256_slli_epi32(fVec, bits); }
512 AI SkNx operator >> (int bits) const { return _mm256_srai_epi32(fVec, bits); }
Mike Klein04adfda2016-10-12 09:52:55 -0400513
Mike Klein7c78f3a2016-10-19 09:21:11 -0400514 AI int32_t operator[](int k) const {
Mike Klein04adfda2016-10-12 09:52:55 -0400515 SkASSERT(0 <= k && k < 8);
516 union { __m256i v; int32_t is[8]; } pun = {fVec};
517 return pun.is[k&7];
518 }
519
520 __m256i fVec;
521 };
522
523 template <>
524 class SkNx<8, uint32_t> {
525 public:
Mike Klein7c78f3a2016-10-19 09:21:11 -0400526 AI SkNx(const __m256i& vec) : fVec(vec) {}
Mike Klein04adfda2016-10-12 09:52:55 -0400527
Mike Klein7c78f3a2016-10-19 09:21:11 -0400528 AI SkNx() {}
529 AI SkNx(uint32_t v) : fVec(_mm256_set1_epi32(v)) {}
530 AI SkNx(uint32_t a, uint32_t b, uint32_t c, uint32_t d,
531 uint32_t e, uint32_t f, uint32_t g, uint32_t h)
Mike Klein04adfda2016-10-12 09:52:55 -0400532 : fVec(_mm256_setr_epi32(a,b,c,d, e,f,g,h)) {}
533
Mike Klein7c78f3a2016-10-19 09:21:11 -0400534 AI static SkNx Load(const void* ptr) { return _mm256_loadu_si256((const __m256i*)ptr); }
535 AI void store(void* ptr) const { _mm256_storeu_si256((__m256i*)ptr, fVec); }
Mike Klein04adfda2016-10-12 09:52:55 -0400536
Mike Klein7c78f3a2016-10-19 09:21:11 -0400537 AI SkNx operator + (const SkNx& o) const { return _mm256_add_epi32(fVec, o.fVec); }
538 AI SkNx operator - (const SkNx& o) const { return _mm256_sub_epi32(fVec, o.fVec); }
539 AI SkNx operator * (const SkNx& o) const { return _mm256_mullo_epi32(fVec, o.fVec); }
Mike Klein04adfda2016-10-12 09:52:55 -0400540
Mike Klein7c78f3a2016-10-19 09:21:11 -0400541 AI SkNx operator & (const SkNx& o) const { return _mm256_and_si256(fVec, o.fVec); }
542 AI SkNx operator | (const SkNx& o) const { return _mm256_or_si256(fVec, o.fVec); }
543 AI SkNx operator ^ (const SkNx& o) const { return _mm256_xor_si256(fVec, o.fVec); }
Mike Klein04adfda2016-10-12 09:52:55 -0400544
Mike Klein7c78f3a2016-10-19 09:21:11 -0400545 AI SkNx operator << (int bits) const { return _mm256_slli_epi32(fVec, bits); }
546 AI SkNx operator >> (int bits) const { return _mm256_srli_epi32(fVec, bits); }
Mike Klein04adfda2016-10-12 09:52:55 -0400547
Mike Klein7c78f3a2016-10-19 09:21:11 -0400548 AI uint32_t operator[](int k) const {
Mike Klein04adfda2016-10-12 09:52:55 -0400549 SkASSERT(0 <= k && k < 8);
550 union { __m256i v; uint32_t us[8]; } pun = {fVec};
551 return pun.us[k&7];
552 }
553
554 __m256i fVec;
555 };
556
mtkleina4a44882016-11-04 13:20:07 -0700557 // _mm256_unpack{lo,hi}_pd() auto-casting to and from __m256d.
558 AI static __m256 unpacklo_pd(__m256 x, __m256 y) {
559 return _mm256_castpd_ps(_mm256_unpacklo_pd(_mm256_castps_pd(x), _mm256_castps_pd(y)));
560 }
561 AI static __m256 unpackhi_pd(__m256 x, __m256 y) {
562 return _mm256_castpd_ps(_mm256_unpackhi_pd(_mm256_castps_pd(x), _mm256_castps_pd(y)));
563 }
564
Mike Klein04adfda2016-10-12 09:52:55 -0400565 template <>
566 class SkNx<8, float> {
567 public:
Mike Klein7c78f3a2016-10-19 09:21:11 -0400568 AI SkNx(const __m256& vec) : fVec(vec) {}
Mike Klein04adfda2016-10-12 09:52:55 -0400569
Mike Klein7c78f3a2016-10-19 09:21:11 -0400570 AI SkNx() {}
571 AI SkNx(float val) : fVec(_mm256_set1_ps(val)) {}
572 AI SkNx(float a, float b, float c, float d,
573 float e, float f, float g, float h) : fVec(_mm256_setr_ps(a,b,c,d,e,f,g,h)) {}
Mike Klein04adfda2016-10-12 09:52:55 -0400574
Mike Klein7c78f3a2016-10-19 09:21:11 -0400575 AI static SkNx Load(const void* ptr) { return _mm256_loadu_ps((const float*)ptr); }
576 AI void store(void* ptr) const { _mm256_storeu_ps((float*)ptr, fVec); }
Mike Klein04adfda2016-10-12 09:52:55 -0400577
mtkleina4a44882016-11-04 13:20:07 -0700578 AI static void Store4(void* ptr,
579 const SkNx& r, const SkNx& g, const SkNx& b, const SkNx& a) {
580 __m256 rg0145 = _mm256_unpacklo_ps(r.fVec, g.fVec), // r0 g0 r1 g1 | r4 g4 r5 g5
581 rg2367 = _mm256_unpackhi_ps(r.fVec, g.fVec), // r2 ... | r6 ...
582 ba0145 = _mm256_unpacklo_ps(b.fVec, a.fVec), // b0 a0 b1 a1 | b4 a4 b5 a5
583 ba2367 = _mm256_unpackhi_ps(b.fVec, a.fVec); // b2 ... | b6 ...
584
585 __m256 _04 = unpacklo_pd(rg0145, ba0145), // r0 g0 b0 a0 | r4 g4 b4 a4
586 _15 = unpackhi_pd(rg0145, ba0145), // r1 ... | r5 ...
587 _26 = unpacklo_pd(rg2367, ba2367), // r2 ... | r6 ...
588 _37 = unpackhi_pd(rg2367, ba2367); // r3 ... | r7 ...
589
Matt Sarettd0520422017-01-06 17:30:55 -0500590 __m256 _01 = _mm256_permute2f128_ps(_04, _15, 32), // 32 == 0010 0000 == lo, lo
591 _23 = _mm256_permute2f128_ps(_26, _37, 32),
592 _45 = _mm256_permute2f128_ps(_04, _15, 49), // 49 == 0011 0001 == hi, hi
593 _67 = _mm256_permute2f128_ps(_26, _37, 49);
mtkleina4a44882016-11-04 13:20:07 -0700594
595 _mm256_storeu_ps((float*)ptr + 0*8, _01);
596 _mm256_storeu_ps((float*)ptr + 1*8, _23);
597 _mm256_storeu_ps((float*)ptr + 2*8, _45);
598 _mm256_storeu_ps((float*)ptr + 3*8, _67);
599 }
600
Mike Klein7c78f3a2016-10-19 09:21:11 -0400601 AI SkNx operator+(const SkNx& o) const { return _mm256_add_ps(fVec, o.fVec); }
602 AI SkNx operator-(const SkNx& o) const { return _mm256_sub_ps(fVec, o.fVec); }
603 AI SkNx operator*(const SkNx& o) const { return _mm256_mul_ps(fVec, o.fVec); }
604 AI SkNx operator/(const SkNx& o) const { return _mm256_div_ps(fVec, o.fVec); }
Mike Klein04adfda2016-10-12 09:52:55 -0400605
Mike Klein7c78f3a2016-10-19 09:21:11 -0400606 AI SkNx operator==(const SkNx& o) const { return _mm256_cmp_ps(fVec, o.fVec, _CMP_EQ_OQ); }
607 AI SkNx operator!=(const SkNx& o) const { return _mm256_cmp_ps(fVec, o.fVec, _CMP_NEQ_OQ); }
608 AI SkNx operator <(const SkNx& o) const { return _mm256_cmp_ps(fVec, o.fVec, _CMP_LT_OQ); }
609 AI SkNx operator >(const SkNx& o) const { return _mm256_cmp_ps(fVec, o.fVec, _CMP_GT_OQ); }
610 AI SkNx operator<=(const SkNx& o) const { return _mm256_cmp_ps(fVec, o.fVec, _CMP_LE_OQ); }
611 AI SkNx operator>=(const SkNx& o) const { return _mm256_cmp_ps(fVec, o.fVec, _CMP_GE_OQ); }
Mike Klein04adfda2016-10-12 09:52:55 -0400612
Mike Klein7c78f3a2016-10-19 09:21:11 -0400613 AI static SkNx Min(const SkNx& l, const SkNx& r) { return _mm256_min_ps(l.fVec, r.fVec); }
614 AI static SkNx Max(const SkNx& l, const SkNx& r) { return _mm256_max_ps(l.fVec, r.fVec); }
Mike Klein04adfda2016-10-12 09:52:55 -0400615
Mike Klein7c78f3a2016-10-19 09:21:11 -0400616 AI SkNx sqrt() const { return _mm256_sqrt_ps (fVec); }
617 AI SkNx rsqrt() const { return _mm256_rsqrt_ps(fVec); }
618 AI SkNx invert() const { return _mm256_rcp_ps (fVec); }
Mike Klein04adfda2016-10-12 09:52:55 -0400619
Mike Klein2e35e8a2016-11-18 15:47:22 -0500620 AI SkNx abs() const { return _mm256_andnot_ps(_mm256_set1_ps(-0.0f), fVec); }
Mike Kleinb273fc42016-11-17 15:42:22 -0500621 AI SkNx floor() const { return _mm256_floor_ps(fVec); }
622
Mike Klein7c78f3a2016-10-19 09:21:11 -0400623 AI float operator[](int k) const {
Mike Klein04adfda2016-10-12 09:52:55 -0400624 SkASSERT(0 <= k && k < 8);
625 union { __m256 v; float fs[8]; } pun = {fVec};
626 return pun.fs[k&7];
627 }
628
Mike Klein7c78f3a2016-10-19 09:21:11 -0400629 AI SkNx thenElse(const SkNx& t, const SkNx& e) const {
Mike Klein04adfda2016-10-12 09:52:55 -0400630 return _mm256_blendv_ps(e.fVec, t.fVec, fVec);
631 }
632
633 __m256 fVec;
634 };
635
Mike Klein7c78f3a2016-10-19 09:21:11 -0400636 AI static void SkNx_split(const Sk8f& v, Sk4f* lo, Sk4f* hi) {
Mike Klein04adfda2016-10-12 09:52:55 -0400637 *lo = _mm256_extractf128_ps(v.fVec, 0);
638 *hi = _mm256_extractf128_ps(v.fVec, 1);
639 }
640
Mike Klein7c78f3a2016-10-19 09:21:11 -0400641 AI static Sk8f SkNx_join(const Sk4f& lo, const Sk4f& hi) {
Mike Klein04adfda2016-10-12 09:52:55 -0400642 return _mm256_insertf128_ps(_mm256_castps128_ps256(lo.fVec), hi.fVec, 1);
643 }
644
Mike Klein7c78f3a2016-10-19 09:21:11 -0400645 AI static Sk8f SkNx_fma(const Sk8f& a, const Sk8f& b, const Sk8f& c) {
Mike Klein04adfda2016-10-12 09:52:55 -0400646 return _mm256_fmadd_ps(a.fVec, b.fVec, c.fVec);
647 }
648
Mike Klein06a65e22016-11-17 12:39:09 -0500649 template<> AI /*static*/ Sk8i SkNx_cast<int>(const Sk8b& src) {
650 return _mm256_cvtepu8_epi32(src.fVec);
651 }
652
Mike Klein7c78f3a2016-10-19 09:21:11 -0400653 template<> AI /*static*/ Sk8f SkNx_cast<float>(const Sk8b& src) {
Mike Klein06a65e22016-11-17 12:39:09 -0500654 return _mm256_cvtepi32_ps(SkNx_cast<int>(src).fVec);
Mike Klein04adfda2016-10-12 09:52:55 -0400655 }
656
Matt Sarett379938e2017-01-12 18:34:29 -0500657 template<> AI /*static*/ Sk8i SkNx_cast<int>(const Sk8h& src) {
658 return _mm256_cvtepu16_epi32(src.fVec);
659 }
660
661 template<> AI /*static*/ Sk8f SkNx_cast<float>(const Sk8h& src) {
662 return _mm256_cvtepi32_ps(SkNx_cast<int>(src).fVec);
663 }
664
Mike Klein7c78f3a2016-10-19 09:21:11 -0400665 template<> AI /*static*/ Sk8f SkNx_cast<float>(const Sk8i& src) {
Mike Klein04adfda2016-10-12 09:52:55 -0400666 return _mm256_cvtepi32_ps(src.fVec);
667 }
668
Mike Klein7c78f3a2016-10-19 09:21:11 -0400669 template<> AI /*static*/ Sk8i SkNx_cast<int>(const Sk8f& src) {
Mike Klein04adfda2016-10-12 09:52:55 -0400670 return _mm256_cvttps_epi32(src.fVec);
671 }
672
Mike Klein7c78f3a2016-10-19 09:21:11 -0400673 template<> AI /*static*/ Sk8h SkNx_cast<uint16_t>(const Sk8i& src) {
Mike Klein04adfda2016-10-12 09:52:55 -0400674 __m128i lo = _mm256_extractf128_si256(src.fVec, 0),
675 hi = _mm256_extractf128_si256(src.fVec, 1);
676 return _mm_packus_epi32(lo, hi);
677 }
Mike Kleine71b1672017-01-13 07:59:23 -0500678 template<> AI /*static*/ Sk8b SkNx_cast<uint8_t>(const Sk8i& src) {
679 auto _16 = SkNx_cast<uint16_t>(src);
680 return _mm_packus_epi16(_16.fVec, _16.fVec);
681 }
Mike Klein04adfda2016-10-12 09:52:55 -0400682
Mike Klein04adfda2016-10-12 09:52:55 -0400683#endif
684
Mike Klein7c78f3a2016-10-19 09:21:11 -0400685template<> AI /*static*/ Sk4f SkNx_cast<float, int32_t>(const Sk4i& src) {
mtklein0cf795f2016-02-17 07:23:36 -0800686 return _mm_cvtepi32_ps(src.fVec);
687}
Mike Klein7c78f3a2016-10-19 09:21:11 -0400688template<> AI /*static*/ Sk4f SkNx_cast<float, uint32_t>(const Sk4u& src) {
mtkleind05a8752016-07-29 10:10:15 -0700689 return SkNx_cast<float>(Sk4i::Load(&src));
690}
mtklein0cf795f2016-02-17 07:23:36 -0800691
Mike Klein7c78f3a2016-10-19 09:21:11 -0400692template <> AI /*static*/ Sk4i SkNx_cast<int32_t, float>(const Sk4f& src) {
mtklein0cf795f2016-02-17 07:23:36 -0800693 return _mm_cvttps_epi32(src.fVec);
694}
mtklein6c221b42015-11-20 13:53:19 -0800695
Mike Klein7c78f3a2016-10-19 09:21:11 -0400696template<> AI /*static*/ Sk4h SkNx_cast<uint16_t, int32_t>(const Sk4i& src) {
mtklein036e1832016-07-15 07:45:53 -0700697#if 0 && SK_CPU_SSE_LEVEL >= SK_CPU_SSE_LEVEL_SSE41
698 // TODO: This seems to be causing code generation problems. Investigate?
699 return _mm_packus_epi32(src.fVec);
700#elif SK_CPU_SSE_LEVEL >= SK_CPU_SSE_LEVEL_SSSE3
mtklein629f25a2016-02-08 05:54:38 -0800701 // With SSSE3, we can just shuffle the low 2 bytes from each lane right into place.
702 const int _ = ~0;
mtklein036e1832016-07-15 07:45:53 -0700703 return _mm_shuffle_epi8(src.fVec, _mm_setr_epi8(0,1, 4,5, 8,9, 12,13, _,_,_,_,_,_,_,_));
mtklein629f25a2016-02-08 05:54:38 -0800704#else
mtklein036e1832016-07-15 07:45:53 -0700705 // With SSE2, we have to sign extend our input, making _mm_packs_epi32 do the pack we want.
706 __m128i x = _mm_srai_epi32(_mm_slli_epi32(src.fVec, 16), 16);
707 return _mm_packs_epi32(x,x);
mtklein629f25a2016-02-08 05:54:38 -0800708#endif
mtklein2d340f22016-02-06 19:38:39 -0800709}
710
Mike Klein7c78f3a2016-10-19 09:21:11 -0400711template<> AI /*static*/ Sk4h SkNx_cast<uint16_t, float>(const Sk4f& src) {
mtkleind05a8752016-07-29 10:10:15 -0700712 return SkNx_cast<uint16_t>(SkNx_cast<int32_t>(src));
mtklein036e1832016-07-15 07:45:53 -0700713}
714
Mike Klein7c78f3a2016-10-19 09:21:11 -0400715template<> AI /*static*/ Sk4b SkNx_cast<uint8_t, float>(const Sk4f& src) {
mtklein97120a72016-02-12 14:19:06 -0800716 auto _32 = _mm_cvttps_epi32(src.fVec);
717#if SK_CPU_SSE_LEVEL >= SK_CPU_SSE_LEVEL_SSSE3
718 const int _ = ~0;
719 return _mm_shuffle_epi8(_32, _mm_setr_epi8(0,4,8,12, _,_,_,_, _,_,_,_, _,_,_,_));
720#else
721 auto _16 = _mm_packus_epi16(_32, _32);
722 return _mm_packus_epi16(_16, _16);
723#endif
mtkleinc1eb3112016-02-11 08:10:22 -0800724}
725
Mike Klein06a65e22016-11-17 12:39:09 -0500726template<> AI /*static*/ Sk4i SkNx_cast<int32_t, uint8_t>(const Sk4b& src) {
mtklein97120a72016-02-12 14:19:06 -0800727#if SK_CPU_SSE_LEVEL >= SK_CPU_SSE_LEVEL_SSSE3
728 const int _ = ~0;
Mike Klein06a65e22016-11-17 12:39:09 -0500729 return _mm_shuffle_epi8(src.fVec, _mm_setr_epi8(0,_,_,_, 1,_,_,_, 2,_,_,_, 3,_,_,_));
mtklein97120a72016-02-12 14:19:06 -0800730#else
Mike Klein06a65e22016-11-17 12:39:09 -0500731 auto _16 = _mm_unpacklo_epi8(src.fVec, _mm_setzero_si128());
732 return _mm_unpacklo_epi16(_16, _mm_setzero_si128());
mtklein97120a72016-02-12 14:19:06 -0800733#endif
Mike Klein06a65e22016-11-17 12:39:09 -0500734}
735
736template<> AI /*static*/ Sk4f SkNx_cast<float, uint8_t>(const Sk4b& src) {
737 return _mm_cvtepi32_ps(SkNx_cast<int32_t>(src).fVec);
mtkleinc1eb3112016-02-11 08:10:22 -0800738}
mtklein97120a72016-02-12 14:19:06 -0800739
Mike Klein7c78f3a2016-10-19 09:21:11 -0400740template<> AI /*static*/ Sk4f SkNx_cast<float, uint16_t>(const Sk4h& src) {
mtklein97120a72016-02-12 14:19:06 -0800741 auto _32 = _mm_unpacklo_epi16(src.fVec, _mm_setzero_si128());
742 return _mm_cvtepi32_ps(_32);
mtklein2d340f22016-02-06 19:38:39 -0800743}
744
Mike Klein7c78f3a2016-10-19 09:21:11 -0400745template<> AI /*static*/ Sk16b SkNx_cast<uint8_t, float>(const Sk16f& src) {
mtkleinf8f90e42016-03-21 10:04:46 -0700746 Sk8f ab, cd;
747 SkNx_split(src, &ab, &cd);
748
749 Sk4f a,b,c,d;
750 SkNx_split(ab, &a, &b);
751 SkNx_split(cd, &c, &d);
752
753 return _mm_packus_epi16(_mm_packus_epi16(_mm_cvttps_epi32(a.fVec),
754 _mm_cvttps_epi32(b.fVec)),
755 _mm_packus_epi16(_mm_cvttps_epi32(c.fVec),
756 _mm_cvttps_epi32(d.fVec)));
mtklein97120a72016-02-12 14:19:06 -0800757}
758
Mike Klein7c78f3a2016-10-19 09:21:11 -0400759template<> AI /*static*/ Sk4h SkNx_cast<uint16_t, uint8_t>(const Sk4b& src) {
mtklein97120a72016-02-12 14:19:06 -0800760 return _mm_unpacklo_epi8(src.fVec, _mm_setzero_si128());
761}
762
Mike Klein7c78f3a2016-10-19 09:21:11 -0400763template<> AI /*static*/ Sk4b SkNx_cast<uint8_t, uint16_t>(const Sk4h& src) {
mtklein97120a72016-02-12 14:19:06 -0800764 return _mm_packus_epi16(src.fVec, src.fVec);
mtklein550e9b02016-01-20 11:55:51 -0800765}
766
Mike Klein7c78f3a2016-10-19 09:21:11 -0400767template<> AI /*static*/ Sk4i SkNx_cast<int32_t, uint16_t>(const Sk4h& src) {
mtklein58e389b2016-07-15 07:00:11 -0700768 return _mm_unpacklo_epi16(src.fVec, _mm_setzero_si128());
769}
770
Mike Klein7c78f3a2016-10-19 09:21:11 -0400771template<> AI /*static*/ Sk4b SkNx_cast<uint8_t, int32_t>(const Sk4i& src) {
msarett7d3ff712016-07-12 14:55:45 -0700772 return _mm_packus_epi16(_mm_packus_epi16(src.fVec, src.fVec), src.fVec);
773}
774
Mike Klein7c78f3a2016-10-19 09:21:11 -0400775template<> AI /*static*/ Sk4i SkNx_cast<int32_t, uint32_t>(const Sk4u& src) {
msarett15ee3de2016-08-02 11:30:30 -0700776 return src.fVec;
777}
778
Mike Klein7c78f3a2016-10-19 09:21:11 -0400779AI static Sk4i Sk4f_round(const Sk4f& x) {
msarett7d3ff712016-07-12 14:55:45 -0700780 return _mm_cvtps_epi32(x.fVec);
781}
782
Mike Klein1e764642016-10-14 17:09:03 -0400783} // namespace
784
mtkleinc9adb052015-03-30 10:50:27 -0700785#endif//SkNx_sse_DEFINED