10 #ifndef EIGEN_COMPLEX_SSE_H
11 #define EIGEN_COMPLEX_SSE_H
20 EIGEN_STRONG_INLINE Packet2cf() {}
21 EIGEN_STRONG_INLINE
explicit Packet2cf(
const __m128& a) : v(a) {}
25 template<>
struct packet_traits<std::complex<float> > : default_packet_traits
27 typedef Packet2cf type;
46 template<>
struct unpacket_traits<Packet2cf> {
typedef std::complex<float> type;
enum {size=2}; };
48 template<> EIGEN_STRONG_INLINE Packet2cf padd<Packet2cf>(
const Packet2cf& a,
const Packet2cf& b) {
return Packet2cf(_mm_add_ps(a.v,b.v)); }
49 template<> EIGEN_STRONG_INLINE Packet2cf psub<Packet2cf>(
const Packet2cf& a,
const Packet2cf& b) {
return Packet2cf(_mm_sub_ps(a.v,b.v)); }
50 template<> EIGEN_STRONG_INLINE Packet2cf pnegate(
const Packet2cf& a)
52 const __m128 mask = _mm_castsi128_ps(_mm_setr_epi32(0x80000000,0x80000000,0x80000000,0x80000000));
53 return Packet2cf(_mm_xor_ps(a.v,mask));
55 template<> EIGEN_STRONG_INLINE Packet2cf pconj(
const Packet2cf& a)
57 const __m128 mask = _mm_castsi128_ps(_mm_setr_epi32(0x00000000,0x80000000,0x00000000,0x80000000));
58 return Packet2cf(_mm_xor_ps(a.v,mask));
61 template<> EIGEN_STRONG_INLINE Packet2cf pmul<Packet2cf>(
const Packet2cf& a,
const Packet2cf& b)
64 #ifdef EIGEN_VECTORIZE_SSE3
65 return Packet2cf(_mm_addsub_ps(_mm_mul_ps(_mm_moveldup_ps(a.v), b.v),
66 _mm_mul_ps(_mm_movehdup_ps(a.v),
67 vec4f_swizzle1(b.v, 1, 0, 3, 2))));
72 const __m128 mask = _mm_castsi128_ps(_mm_setr_epi32(0x80000000,0x00000000,0x80000000,0x00000000));
73 return Packet2cf(_mm_add_ps(_mm_mul_ps(vec4f_swizzle1(a.v, 0, 0, 2, 2), b.v),
74 _mm_xor_ps(_mm_mul_ps(vec4f_swizzle1(a.v, 1, 1, 3, 3),
75 vec4f_swizzle1(b.v, 1, 0, 3, 2)), mask)));
79 template<> EIGEN_STRONG_INLINE Packet2cf pand <Packet2cf>(
const Packet2cf& a,
const Packet2cf& b) {
return Packet2cf(_mm_and_ps(a.v,b.v)); }
80 template<> EIGEN_STRONG_INLINE Packet2cf por <Packet2cf>(
const Packet2cf& a,
const Packet2cf& b) {
return Packet2cf(_mm_or_ps(a.v,b.v)); }
81 template<> EIGEN_STRONG_INLINE Packet2cf pxor <Packet2cf>(
const Packet2cf& a,
const Packet2cf& b) {
return Packet2cf(_mm_xor_ps(a.v,b.v)); }
82 template<> EIGEN_STRONG_INLINE Packet2cf pandnot<Packet2cf>(
const Packet2cf& a,
const Packet2cf& b) {
return Packet2cf(_mm_andnot_ps(a.v,b.v)); }
84 template<> EIGEN_STRONG_INLINE Packet2cf pload <Packet2cf>(
const std::complex<float>* from) { EIGEN_DEBUG_ALIGNED_LOAD
return Packet2cf(pload<Packet4f>(&real_ref(*from))); }
85 template<> EIGEN_STRONG_INLINE Packet2cf ploadu<Packet2cf>(
const std::complex<float>* from) { EIGEN_DEBUG_UNALIGNED_LOAD
return Packet2cf(ploadu<Packet4f>(&real_ref(*from))); }
87 template<> EIGEN_STRONG_INLINE Packet2cf pset1<Packet2cf>(
const std::complex<float>& from)
90 #if EIGEN_GNUC_AT_MOST(4,2)
92 res.v = _mm_loadl_pi(_mm_set1_ps(0.0f), reinterpret_cast<const __m64*>(&from));
94 res.v = _mm_loadl_pi(res.v, (
const __m64*)&from);
96 return Packet2cf(_mm_movelh_ps(res.v,res.v));
99 template<> EIGEN_STRONG_INLINE Packet2cf ploaddup<Packet2cf>(
const std::complex<float>* from) {
return pset1<Packet2cf>(*from); }
101 template<> EIGEN_STRONG_INLINE
void pstore <std::complex<float> >(std::complex<float> * to,
const Packet2cf& from) { EIGEN_DEBUG_ALIGNED_STORE pstore(&real_ref(*to), from.v); }
102 template<> EIGEN_STRONG_INLINE
void pstoreu<std::complex<float> >(std::complex<float> * to,
const Packet2cf& from) { EIGEN_DEBUG_UNALIGNED_STORE pstoreu(&real_ref(*to), from.v); }
104 template<> EIGEN_STRONG_INLINE
void prefetch<std::complex<float> >(
const std::complex<float> * addr) { _mm_prefetch((
const char*)(addr), _MM_HINT_T0); }
106 template<> EIGEN_STRONG_INLINE std::complex<float> pfirst<Packet2cf>(
const Packet2cf& a)
108 #if EIGEN_GNUC_AT_MOST(4,3)
111 EIGEN_ALIGN16 std::complex<float> res[2];
112 _mm_store_ps((
float*)res, a.v);
115 std::complex<float> res;
116 _mm_storel_pi((__m64*)&res, a.v);
121 template<> EIGEN_STRONG_INLINE Packet2cf preverse(
const Packet2cf& a) {
return Packet2cf(_mm_castpd_ps(preverse(_mm_castps_pd(a.v)))); }
123 template<> EIGEN_STRONG_INLINE std::complex<float> predux<Packet2cf>(
const Packet2cf& a)
125 return pfirst(Packet2cf(_mm_add_ps(a.v, _mm_movehl_ps(a.v,a.v))));
128 template<> EIGEN_STRONG_INLINE Packet2cf preduxp<Packet2cf>(
const Packet2cf* vecs)
130 return Packet2cf(_mm_add_ps(_mm_movelh_ps(vecs[0].v,vecs[1].v), _mm_movehl_ps(vecs[1].v,vecs[0].v)));
133 template<> EIGEN_STRONG_INLINE std::complex<float> predux_mul<Packet2cf>(
const Packet2cf& a)
135 return pfirst(pmul(a, Packet2cf(_mm_movehl_ps(a.v,a.v))));
139 struct palign_impl<Offset,Packet2cf>
141 static EIGEN_STRONG_INLINE
void run(Packet2cf& first,
const Packet2cf& second)
145 first.v = _mm_movehl_ps(first.v, first.v);
146 first.v = _mm_movelh_ps(first.v, second.v);
151 template<>
struct conj_helper<Packet2cf, Packet2cf, false,true>
153 EIGEN_STRONG_INLINE Packet2cf pmadd(
const Packet2cf& x,
const Packet2cf& y,
const Packet2cf& c)
const
154 {
return padd(pmul(x,y),c); }
156 EIGEN_STRONG_INLINE Packet2cf pmul(
const Packet2cf& a,
const Packet2cf& b)
const
158 #ifdef EIGEN_VECTORIZE_SSE3
159 return internal::pmul(a, pconj(b));
161 const __m128 mask = _mm_castsi128_ps(_mm_setr_epi32(0x00000000,0x80000000,0x00000000,0x80000000));
162 return Packet2cf(_mm_add_ps(_mm_xor_ps(_mm_mul_ps(vec4f_swizzle1(a.v, 0, 0, 2, 2), b.v), mask),
163 _mm_mul_ps(vec4f_swizzle1(a.v, 1, 1, 3, 3),
164 vec4f_swizzle1(b.v, 1, 0, 3, 2))));
169 template<>
struct conj_helper<Packet2cf, Packet2cf, true,false>
171 EIGEN_STRONG_INLINE Packet2cf pmadd(
const Packet2cf& x,
const Packet2cf& y,
const Packet2cf& c)
const
172 {
return padd(pmul(x,y),c); }
174 EIGEN_STRONG_INLINE Packet2cf pmul(
const Packet2cf& a,
const Packet2cf& b)
const
176 #ifdef EIGEN_VECTORIZE_SSE3
177 return internal::pmul(pconj(a), b);
179 const __m128 mask = _mm_castsi128_ps(_mm_setr_epi32(0x00000000,0x80000000,0x00000000,0x80000000));
180 return Packet2cf(_mm_add_ps(_mm_mul_ps(vec4f_swizzle1(a.v, 0, 0, 2, 2), b.v),
181 _mm_xor_ps(_mm_mul_ps(vec4f_swizzle1(a.v, 1, 1, 3, 3),
182 vec4f_swizzle1(b.v, 1, 0, 3, 2)), mask)));
187 template<>
struct conj_helper<Packet2cf, Packet2cf, true,true>
189 EIGEN_STRONG_INLINE Packet2cf pmadd(
const Packet2cf& x,
const Packet2cf& y,
const Packet2cf& c)
const
190 {
return padd(pmul(x,y),c); }
192 EIGEN_STRONG_INLINE Packet2cf pmul(
const Packet2cf& a,
const Packet2cf& b)
const
194 #ifdef EIGEN_VECTORIZE_SSE3
195 return pconj(internal::pmul(a, b));
197 const __m128 mask = _mm_castsi128_ps(_mm_setr_epi32(0x00000000,0x80000000,0x00000000,0x80000000));
198 return Packet2cf(_mm_sub_ps(_mm_xor_ps(_mm_mul_ps(vec4f_swizzle1(a.v, 0, 0, 2, 2), b.v), mask),
199 _mm_mul_ps(vec4f_swizzle1(a.v, 1, 1, 3, 3),
200 vec4f_swizzle1(b.v, 1, 0, 3, 2))));
205 template<>
struct conj_helper<Packet4f, Packet2cf, false,false>
207 EIGEN_STRONG_INLINE Packet2cf pmadd(
const Packet4f& x,
const Packet2cf& y,
const Packet2cf& c)
const
208 {
return padd(c, pmul(x,y)); }
210 EIGEN_STRONG_INLINE Packet2cf pmul(
const Packet4f& x,
const Packet2cf& y)
const
211 {
return Packet2cf(Eigen::internal::pmul(x, y.v)); }
214 template<>
struct conj_helper<Packet2cf, Packet4f, false,false>
216 EIGEN_STRONG_INLINE Packet2cf pmadd(
const Packet2cf& x,
const Packet4f& y,
const Packet2cf& c)
const
217 {
return padd(c, pmul(x,y)); }
219 EIGEN_STRONG_INLINE Packet2cf pmul(
const Packet2cf& x,
const Packet4f& y)
const
220 {
return Packet2cf(Eigen::internal::pmul(x.v, y)); }
223 template<> EIGEN_STRONG_INLINE Packet2cf pdiv<Packet2cf>(
const Packet2cf& a,
const Packet2cf& b)
226 Packet2cf res = conj_helper<Packet2cf,Packet2cf,false,true>().pmul(a,b);
227 __m128 s = _mm_mul_ps(b.v,b.v);
228 return Packet2cf(_mm_div_ps(res.v,_mm_add_ps(s,_mm_castsi128_ps(_mm_shuffle_epi32(_mm_castps_si128(s), 0xb1)))));
231 EIGEN_STRONG_INLINE Packet2cf pcplxflip(
const Packet2cf& x)
233 return Packet2cf(vec4f_swizzle1(x.v, 1, 0, 3, 2));
240 EIGEN_STRONG_INLINE Packet1cd() {}
241 EIGEN_STRONG_INLINE
explicit Packet1cd(
const __m128d& a) : v(a) {}
245 template<>
struct packet_traits<std::complex<double> > : default_packet_traits
247 typedef Packet1cd type;
266 template<>
struct unpacket_traits<Packet1cd> {
typedef std::complex<double> type;
enum {size=1}; };
268 template<> EIGEN_STRONG_INLINE Packet1cd padd<Packet1cd>(
const Packet1cd& a,
const Packet1cd& b) {
return Packet1cd(_mm_add_pd(a.v,b.v)); }
269 template<> EIGEN_STRONG_INLINE Packet1cd psub<Packet1cd>(
const Packet1cd& a,
const Packet1cd& b) {
return Packet1cd(_mm_sub_pd(a.v,b.v)); }
270 template<> EIGEN_STRONG_INLINE Packet1cd pnegate(
const Packet1cd& a) {
return Packet1cd(pnegate(a.v)); }
271 template<> EIGEN_STRONG_INLINE Packet1cd pconj(
const Packet1cd& a)
273 const __m128d mask = _mm_castsi128_pd(_mm_set_epi32(0x80000000,0x0,0x0,0x0));
274 return Packet1cd(_mm_xor_pd(a.v,mask));
277 template<> EIGEN_STRONG_INLINE Packet1cd pmul<Packet1cd>(
const Packet1cd& a,
const Packet1cd& b)
280 #ifdef EIGEN_VECTORIZE_SSE3
281 return Packet1cd(_mm_addsub_pd(_mm_mul_pd(vec2d_swizzle1(a.v, 0, 0), b.v),
282 _mm_mul_pd(vec2d_swizzle1(a.v, 1, 1),
283 vec2d_swizzle1(b.v, 1, 0))));
285 const __m128d mask = _mm_castsi128_pd(_mm_set_epi32(0x0,0x0,0x80000000,0x0));
286 return Packet1cd(_mm_add_pd(_mm_mul_pd(vec2d_swizzle1(a.v, 0, 0), b.v),
287 _mm_xor_pd(_mm_mul_pd(vec2d_swizzle1(a.v, 1, 1),
288 vec2d_swizzle1(b.v, 1, 0)), mask)));
292 template<> EIGEN_STRONG_INLINE Packet1cd pand <Packet1cd>(
const Packet1cd& a,
const Packet1cd& b) {
return Packet1cd(_mm_and_pd(a.v,b.v)); }
293 template<> EIGEN_STRONG_INLINE Packet1cd por <Packet1cd>(
const Packet1cd& a,
const Packet1cd& b) {
return Packet1cd(_mm_or_pd(a.v,b.v)); }
294 template<> EIGEN_STRONG_INLINE Packet1cd pxor <Packet1cd>(
const Packet1cd& a,
const Packet1cd& b) {
return Packet1cd(_mm_xor_pd(a.v,b.v)); }
295 template<> EIGEN_STRONG_INLINE Packet1cd pandnot<Packet1cd>(
const Packet1cd& a,
const Packet1cd& b) {
return Packet1cd(_mm_andnot_pd(a.v,b.v)); }
298 template<> EIGEN_STRONG_INLINE Packet1cd pload <Packet1cd>(
const std::complex<double>* from)
299 { EIGEN_DEBUG_ALIGNED_LOAD
return Packet1cd(pload<Packet2d>((
const double*)from)); }
300 template<> EIGEN_STRONG_INLINE Packet1cd ploadu<Packet1cd>(
const std::complex<double>* from)
301 { EIGEN_DEBUG_UNALIGNED_LOAD
return Packet1cd(ploadu<Packet2d>((
const double*)from)); }
302 template<> EIGEN_STRONG_INLINE Packet1cd pset1<Packet1cd>(
const std::complex<double>& from)
303 {
return ploadu<Packet1cd>(&from); }
305 template<> EIGEN_STRONG_INLINE Packet1cd ploaddup<Packet1cd>(
const std::complex<double>* from) {
return pset1<Packet1cd>(*from); }
308 template<> EIGEN_STRONG_INLINE
void pstore <std::complex<double> >(std::complex<double> * to,
const Packet1cd& from) { EIGEN_DEBUG_ALIGNED_STORE pstore((
double*)to, from.v); }
309 template<> EIGEN_STRONG_INLINE
void pstoreu<std::complex<double> >(std::complex<double> * to,
const Packet1cd& from) { EIGEN_DEBUG_UNALIGNED_STORE pstoreu((
double*)to, from.v); }
311 template<> EIGEN_STRONG_INLINE
void prefetch<std::complex<double> >(
const std::complex<double> * addr) { _mm_prefetch((
const char*)(addr), _MM_HINT_T0); }
313 template<> EIGEN_STRONG_INLINE std::complex<double> pfirst<Packet1cd>(
const Packet1cd& a)
315 EIGEN_ALIGN16
double res[2];
316 _mm_store_pd(res, a.v);
317 return std::complex<double>(res[0],res[1]);
320 template<> EIGEN_STRONG_INLINE Packet1cd preverse(
const Packet1cd& a) {
return a; }
322 template<> EIGEN_STRONG_INLINE std::complex<double> predux<Packet1cd>(
const Packet1cd& a)
327 template<> EIGEN_STRONG_INLINE Packet1cd preduxp<Packet1cd>(
const Packet1cd* vecs)
332 template<> EIGEN_STRONG_INLINE std::complex<double> predux_mul<Packet1cd>(
const Packet1cd& a)
338 struct palign_impl<Offset,Packet1cd>
340 static EIGEN_STRONG_INLINE
void run(Packet1cd& ,
const Packet1cd& )
347 template<>
struct conj_helper<Packet1cd, Packet1cd, false,true>
349 EIGEN_STRONG_INLINE Packet1cd pmadd(
const Packet1cd& x,
const Packet1cd& y,
const Packet1cd& c)
const
350 {
return padd(pmul(x,y),c); }
352 EIGEN_STRONG_INLINE Packet1cd pmul(
const Packet1cd& a,
const Packet1cd& b)
const
354 #ifdef EIGEN_VECTORIZE_SSE3
355 return internal::pmul(a, pconj(b));
357 const __m128d mask = _mm_castsi128_pd(_mm_set_epi32(0x80000000,0x0,0x0,0x0));
358 return Packet1cd(_mm_add_pd(_mm_xor_pd(_mm_mul_pd(vec2d_swizzle1(a.v, 0, 0), b.v), mask),
359 _mm_mul_pd(vec2d_swizzle1(a.v, 1, 1),
360 vec2d_swizzle1(b.v, 1, 0))));
365 template<>
struct conj_helper<Packet1cd, Packet1cd, true,false>
367 EIGEN_STRONG_INLINE Packet1cd pmadd(
const Packet1cd& x,
const Packet1cd& y,
const Packet1cd& c)
const
368 {
return padd(pmul(x,y),c); }
370 EIGEN_STRONG_INLINE Packet1cd pmul(
const Packet1cd& a,
const Packet1cd& b)
const
372 #ifdef EIGEN_VECTORIZE_SSE3
373 return internal::pmul(pconj(a), b);
375 const __m128d mask = _mm_castsi128_pd(_mm_set_epi32(0x80000000,0x0,0x0,0x0));
376 return Packet1cd(_mm_add_pd(_mm_mul_pd(vec2d_swizzle1(a.v, 0, 0), b.v),
377 _mm_xor_pd(_mm_mul_pd(vec2d_swizzle1(a.v, 1, 1),
378 vec2d_swizzle1(b.v, 1, 0)), mask)));
383 template<>
struct conj_helper<Packet1cd, Packet1cd, true,true>
385 EIGEN_STRONG_INLINE Packet1cd pmadd(
const Packet1cd& x,
const Packet1cd& y,
const Packet1cd& c)
const
386 {
return padd(pmul(x,y),c); }
388 EIGEN_STRONG_INLINE Packet1cd pmul(
const Packet1cd& a,
const Packet1cd& b)
const
390 #ifdef EIGEN_VECTORIZE_SSE3
391 return pconj(internal::pmul(a, b));
393 const __m128d mask = _mm_castsi128_pd(_mm_set_epi32(0x80000000,0x0,0x0,0x0));
394 return Packet1cd(_mm_sub_pd(_mm_xor_pd(_mm_mul_pd(vec2d_swizzle1(a.v, 0, 0), b.v), mask),
395 _mm_mul_pd(vec2d_swizzle1(a.v, 1, 1),
396 vec2d_swizzle1(b.v, 1, 0))));
401 template<>
struct conj_helper<Packet2d, Packet1cd, false,false>
403 EIGEN_STRONG_INLINE Packet1cd pmadd(
const Packet2d& x,
const Packet1cd& y,
const Packet1cd& c)
const
404 {
return padd(c, pmul(x,y)); }
406 EIGEN_STRONG_INLINE Packet1cd pmul(
const Packet2d& x,
const Packet1cd& y)
const
407 {
return Packet1cd(Eigen::internal::pmul(x, y.v)); }
410 template<>
struct conj_helper<Packet1cd, Packet2d, false,false>
412 EIGEN_STRONG_INLINE Packet1cd pmadd(
const Packet1cd& x,
const Packet2d& y,
const Packet1cd& c)
const
413 {
return padd(c, pmul(x,y)); }
415 EIGEN_STRONG_INLINE Packet1cd pmul(
const Packet1cd& x,
const Packet2d& y)
const
416 {
return Packet1cd(Eigen::internal::pmul(x.v, y)); }
419 template<> EIGEN_STRONG_INLINE Packet1cd pdiv<Packet1cd>(
const Packet1cd& a,
const Packet1cd& b)
422 Packet1cd res = conj_helper<Packet1cd,Packet1cd,false,true>().pmul(a,b);
423 __m128d s = _mm_mul_pd(b.v,b.v);
424 return Packet1cd(_mm_div_pd(res.v, _mm_add_pd(s,_mm_shuffle_pd(s, s, 0x1))));
427 EIGEN_STRONG_INLINE Packet1cd pcplxflip(
const Packet1cd& x)
429 return Packet1cd(preverse(x.v));
436 #endif // EIGEN_COMPLEX_SSE_H