URL
https://opencores.org/ocsvn/openrisc_me/openrisc_me/trunk
Subversion Repositories openrisc_me
[/] [openrisc/] [trunk/] [gnu-src/] [gcc-4.5.1/] [gcc/] [config/] [rs6000/] [si2vmx.h] - Rev 282
Compare with Previous | Blame | View Log
/* Cell BEA specific SPU intrinsics to PPU/VMX intrinsics Copyright (C) 2007, 2009 Free Software Foundation, Inc. This file is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 3 of the License, or (at your option) any later version. This file is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. Under Section 7 of GPL version 3, you are granted additional permissions described in the GCC Runtime Library Exception, version 3.1, as published by the Free Software Foundation. You should have received a copy of the GNU General Public License and a copy of the GCC Runtime Library Exception along with this program; see the files COPYING3 and COPYING.RUNTIME respectively. If not, see <http://www.gnu.org/licenses/>. */ #ifndef _SI2VMX_H_ #define _SI2VMX_H_ 1 #ifndef __SPU__ #include <stdlib.h> #include <vec_types.h> /* Specify a default halt action for spu_hcmpeq and spu_hcmpgt intrinsics. * Users can override the action by defining it prior to including this * header file. */ #ifndef SPU_HALT_ACTION #define SPU_HALT_ACTION abort() #endif /* Specify a default stop action for the spu_stop intrinsic. * Users can override the action by defining it prior to including this * header file. */ #ifndef SPU_STOP_ACTION #define SPU_STOP_ACTION abort() #endif /* Specify a default action for unsupported intrinsic. * Users can override the action by defining it prior to including this * header file. */ #ifndef SPU_UNSUPPORTED_ACTION #define SPU_UNSUPPORTED_ACTION abort() #endif /* Casting intrinsics - from scalar to quadword */ static __inline qword si_from_uchar(unsigned char c) { union { qword q; unsigned char c[16]; } x; x.c[3] = c; return (x.q); } static __inline qword si_from_char(signed char c) { union { qword q; signed char c[16]; } x; x.c[3] = c; return (x.q); } static __inline qword si_from_ushort(unsigned short s) { union { qword q; unsigned short s[8]; } x; x.s[1] = s; return (x.q); } static __inline qword si_from_short(short s) { union { qword q; short s[8]; } x; x.s[1] = s; return (x.q); } static __inline qword si_from_uint(unsigned int i) { union { qword q; unsigned int i[4]; } x; x.i[0] = i; return (x.q); } static __inline qword si_from_int(int i) { union { qword q; int i[4]; } x; x.i[0] = i; return (x.q); } static __inline qword si_from_ullong(unsigned long long l) { union { qword q; unsigned long long l[2]; } x; x.l[0] = l; return (x.q); } static __inline qword si_from_llong(long long l) { union { qword q; long long l[2]; } x; x.l[0] = l; return (x.q); } static __inline qword si_from_float(float f) { union { qword q; float f[4]; } x; x.f[0] = f; return (x.q); } static __inline qword si_from_double(double d) { union { qword q; double d[2]; } x; x.d[0] = d; return (x.q); } static __inline qword si_from_ptr(void *ptr) { union { qword q; void *p; } x; x.p = ptr; return (x.q); } /* Casting intrinsics - from quadword to scalar */ static __inline unsigned char si_to_uchar(qword q) { union { qword q; unsigned char c[16]; } x; x.q = q; return (x.c[3]); } static __inline signed char si_to_char(qword q) { union { qword q; signed char c[16]; } x; x.q = q; return (x.c[3]); } static __inline unsigned short si_to_ushort(qword q) { union { qword q; unsigned short s[8]; } x; x.q = q; return (x.s[1]); } static __inline short si_to_short(qword q) { union { qword q; short s[8]; } x; x.q = q; return (x.s[1]); } static __inline unsigned int si_to_uint(qword q) { union { qword q; unsigned int i[4]; } x; x.q = q; return (x.i[0]); } static __inline int si_to_int(qword q) { union { qword q; int i[4]; } x; x.q = q; return (x.i[0]); } static __inline unsigned long long si_to_ullong(qword q) { union { qword q; unsigned long long l[2]; } x; x.q = q; return (x.l[0]); } static __inline long long si_to_llong(qword q) { union { qword q; long long l[2]; } x; x.q = q; return (x.l[0]); } static __inline float si_to_float(qword q) { union { qword q; float f[4]; } x; x.q = q; return (x.f[0]); } static __inline double si_to_double(qword q) { union { qword q; double d[2]; } x; x.q = q; return (x.d[0]); } static __inline void * si_to_ptr(qword q) { union { qword q; void *p; } x; x.q = q; return (x.p); } /* Absolute difference */ static __inline qword si_absdb(qword a, qword b) { vec_uchar16 ac, bc, dc; ac = (vec_uchar16)(a); bc = (vec_uchar16)(b); dc = vec_sel(vec_sub(bc, ac), vec_sub(ac, bc), vec_cmpgt(ac, bc)); return ((qword)(dc)); } /* Add intrinsics */ #define si_a(_a, _b) ((qword)(vec_add((vec_uint4)(_a), (vec_uint4)(_b)))) #define si_ah(_a, _b) ((qword)(vec_add((vec_ushort8)(_a), (vec_ushort8)(_b)))) static __inline qword si_ai(qword a, int b) { return ((qword)(vec_add((vec_int4)(a), vec_splat((vec_int4)(si_from_int(b)), 0)))); } static __inline qword si_ahi(qword a, short b) { return ((qword)(vec_add((vec_short8)(a), vec_splat((vec_short8)(si_from_short(b)), 1)))); } #define si_fa(_a, _b) ((qword)(vec_add((vec_float4)(_a), (vec_float4)(_b)))) static __inline qword si_dfa(qword a, qword b) { union { vec_double2 v; double d[2]; } ad, bd, dd; ad.v = (vec_double2)(a); bd.v = (vec_double2)(b); dd.d[0] = ad.d[0] + bd.d[0]; dd.d[1] = ad.d[1] + bd.d[1]; return ((qword)(dd.v)); } /* Add word extended */ #define si_addx(_a, _b, _c) ((qword)(vec_add(vec_add((vec_uint4)(_a), (vec_uint4)(_b)), \ vec_and((vec_uint4)(_c), vec_splat_u32(1))))) /* Bit-wise AND */ #define si_and(_a, _b) ((qword)(vec_and((vec_uint4)(_a), (vec_uint4)(_b)))) static __inline qword si_andbi(qword a, signed char b) { return ((qword)(vec_and((vec_char16)(a), vec_splat((vec_char16)(si_from_char(b)), 3)))); } static __inline qword si_andhi(qword a, signed short b) { return ((qword)(vec_and((vec_short8)(a), vec_splat((vec_short8)(si_from_short(b)), 1)))); } static __inline qword si_andi(qword a, signed int b) { return ((qword)(vec_and((vec_int4)(a), vec_splat((vec_int4)(si_from_int(b)), 0)))); } /* Bit-wise AND with complement */ #define si_andc(_a, _b) ((qword)(vec_andc((vec_uchar16)(_a), (vec_uchar16)(_b)))) /* Average byte vectors */ #define si_avgb(_a, _b) ((qword)(vec_avg((vec_uchar16)(_a), (vec_uchar16)(_b)))) /* Branch indirect and set link on external data */ #define si_bisled(_func) /* not mappable */ #define si_bisledd(_func) /* not mappable */ #define si_bislede(_func) /* not mappable */ /* Borrow generate */ #define si_bg(_a, _b) ((qword)(vec_subc((vec_uint4)(_b), (vec_uint4)(_a)))) #define si_bgx(_a, _b, _c) ((qword)(vec_and(vec_or(vec_cmpgt((vec_uint4)(_b), (vec_uint4)(_a)), \ vec_and(vec_cmpeq((vec_uint4)(_b), (vec_uint4)(_a)), \ (vec_uint4)(_c))), vec_splat_u32(1)))) /* Compare absolute equal */ static __inline qword si_fcmeq(qword a, qword b) { vec_float4 msb = (vec_float4)((vec_uint4){0x80000000, 0x80000000, 0x80000000, 0x80000000}); return ((qword)(vec_cmpeq(vec_andc((vec_float4)(a), msb), vec_andc((vec_float4)(b), msb)))); } static __inline qword si_dfcmeq(qword a, qword b) { vec_uint4 sign_mask= (vec_uint4) { 0x7FFFFFFF, 0xFFFFFFFF, 0x7FFFFFFF, 0xFFFFFFFF }; vec_uint4 nan_mask = (vec_uint4) { 0x7FF00000, 0x00000000, 0x7FF00000, 0x00000000 }; vec_uchar16 hihi_promote = (vec_uchar16) { 0,1,2,3, 16,17,18,19, 8,9,10,11, 24,25,26,27}; vec_uint4 biteq; vec_uint4 aabs; vec_uint4 babs; vec_uint4 a_gt; vec_uint4 ahi_inf; vec_uint4 anan; vec_uint4 result; union { vec_uchar16 v; int i[4]; } x; /* Shift 4 bytes */ x.i[3] = 4 << 3; /* Mask out sign bits */ aabs = vec_and((vec_uint4)a,sign_mask); babs = vec_and((vec_uint4)b,sign_mask); /* A) Check for bit equality, store in high word */ biteq = (vec_uint4) vec_cmpeq((vec_uint4)aabs,(vec_uint4)babs); biteq = vec_and(biteq,(vec_uint4)vec_slo((vec_uchar16)biteq,x.v)); /* B) Check if a is NaN, store in high word B1) If the high word is greater than max_exp (indicates a NaN) B2) If the low word is greater than 0 */ a_gt = (vec_uint4)vec_cmpgt(aabs,nan_mask); /* B3) Check if the high word is equal to the inf exponent */ ahi_inf = (vec_uint4)vec_cmpeq(aabs,nan_mask); /* anan = B1[hi] or (B2[lo] and B3[hi]) */ anan = (vec_uint4)vec_or(a_gt,vec_and((vec_uint4)vec_slo((vec_uchar16)a_gt,x.v),ahi_inf)); /* result = A and not B */ result = vec_andc(biteq, anan); /* Promote high words to 64 bits and return */ return ((qword)(vec_perm((vec_uchar16)result, (vec_uchar16)result, hihi_promote))); } /* Compare absolute greater than */ static __inline qword si_fcmgt(qword a, qword b) { vec_float4 msb = (vec_float4)((vec_uint4){0x80000000, 0x80000000, 0x80000000, 0x80000000}); return ((qword)(vec_cmpgt(vec_andc((vec_float4)(a), msb), vec_andc((vec_float4)(b), msb)))); } static __inline qword si_dfcmgt(qword a, qword b) { vec_uchar16 splat_hi = (vec_uchar16) { 0,1,2,3, 0,1,2,3, 8,9,10,11, 8,9,10,11 }; vec_uint4 nan_mask = (vec_uint4) { 0x7FF00000, 0x0, 0x7FF00000, 0x0 }; vec_uint4 sign_mask = (vec_uint4) { 0x7FFFFFFF, 0xFFFFFFFF, 0x7FFFFFFF, 0xFFFFFFFF }; union { vec_uchar16 v; int i[4]; } x; /* Shift 4 bytes */ x.i[3] = 4 << 3; // absolute value of a,b vec_uint4 aabs = vec_and((vec_uint4)a, sign_mask); vec_uint4 babs = vec_and((vec_uint4)b, sign_mask); // check if a is nan vec_uint4 a_inf = (vec_uint4)vec_cmpeq(aabs, nan_mask); vec_uint4 a_nan = (vec_uint4)vec_cmpgt(aabs, nan_mask); a_nan = vec_or(a_nan, vec_and((vec_uint4)vec_slo((vec_uchar16)a_nan,x.v),a_inf)); a_nan = (vec_uint4)vec_perm((vec_uchar16)a_nan, (vec_uchar16)a_nan, splat_hi); // check if b is nan vec_uint4 b_inf = (vec_uint4)vec_cmpeq(babs, nan_mask); vec_uint4 b_nan = (vec_uint4)vec_cmpgt(babs, nan_mask); b_nan = vec_or(b_nan, vec_and((vec_uint4)vec_slo((vec_uchar16)b_nan,x.v),b_inf)); b_nan = (vec_uint4)vec_perm((vec_uchar16)b_nan, (vec_uchar16)b_nan, splat_hi); // A) Check if the exponents are different vec_uint4 gt_hi = (vec_uint4)vec_cmpgt(aabs,babs); // B) Check if high word equal, and low word greater vec_uint4 gt_lo = (vec_uint4)vec_cmpgt((vec_uint4)aabs, (vec_uint4)babs); vec_uint4 eq = (vec_uint4)vec_cmpeq(aabs, babs); vec_uint4 eqgt = vec_and(eq,vec_slo(gt_lo,x.v)); // If either A or B is true, return true (unless NaNs detected) vec_uint4 r = vec_or(gt_hi, eqgt); // splat the high words of the comparison step r = (vec_uint4)vec_perm((vec_uchar16)r,(vec_uchar16)r,splat_hi); // correct for NaNs in input return ((qword)vec_andc(r,vec_or(a_nan,b_nan))); } /* Compare equal */ static __inline qword si_ceqb(qword a, qword b) { return ((qword)(vec_cmpeq((vec_uchar16)(a), (vec_uchar16)(b)))); } static __inline qword si_ceqh(qword a, qword b) { return ((qword)(vec_cmpeq((vec_ushort8)(a), (vec_ushort8)(b)))); } static __inline qword si_ceq(qword a, qword b) { return ((qword)(vec_cmpeq((vec_uint4)(a), (vec_uint4)(b)))); } static __inline qword si_fceq(qword a, qword b) { return ((qword)(vec_cmpeq((vec_float4)(a), (vec_float4)(b)))); } static __inline qword si_ceqbi(qword a, signed char b) { return ((qword)(vec_cmpeq((vec_char16)(a), vec_splat((vec_char16)(si_from_char(b)), 3)))); } static __inline qword si_ceqhi(qword a, signed short b) { return ((qword)(vec_cmpeq((vec_short8)(a), vec_splat((vec_short8)(si_from_short(b)), 1)))); } static __inline qword si_ceqi(qword a, signed int b) { return ((qword)(vec_cmpeq((vec_int4)(a), vec_splat((vec_int4)(si_from_int(b)), 0)))); } static __inline qword si_dfceq(qword a, qword b) { vec_uint4 sign_mask= (vec_uint4) { 0x7FFFFFFF, 0xFFFFFFFF, 0x7FFFFFFF, 0xFFFFFFFF }; vec_uint4 nan_mask = (vec_uint4) { 0x7FF00000, 0x00000000, 0x7FF00000, 0x00000000 }; vec_uchar16 hihi_promote = (vec_uchar16) { 0,1,2,3, 16,17,18,19, 8,9,10,11, 24,25,26,27}; vec_uint4 biteq; vec_uint4 aabs; vec_uint4 babs; vec_uint4 a_gt; vec_uint4 ahi_inf; vec_uint4 anan; vec_uint4 iszero; vec_uint4 result; union { vec_uchar16 v; int i[4]; } x; /* Shift 4 bytes */ x.i[3] = 4 << 3; /* A) Check for bit equality, store in high word */ biteq = (vec_uint4) vec_cmpeq((vec_uint4)a,(vec_uint4)b); biteq = vec_and(biteq,(vec_uint4)vec_slo((vec_uchar16)biteq,x.v)); /* Mask out sign bits */ aabs = vec_and((vec_uint4)a,sign_mask); babs = vec_and((vec_uint4)b,sign_mask); /* B) Check if a is NaN, store in high word B1) If the high word is greater than max_exp (indicates a NaN) B2) If the low word is greater than 0 */ a_gt = (vec_uint4)vec_cmpgt(aabs,nan_mask); /* B3) Check if the high word is equal to the inf exponent */ ahi_inf = (vec_uint4)vec_cmpeq(aabs,nan_mask); /* anan = B1[hi] or (B2[lo] and B3[hi]) */ anan = (vec_uint4)vec_or(a_gt,vec_and((vec_uint4)vec_slo((vec_uchar16)a_gt,x.v),ahi_inf)); /* C) Check for 0 = -0 special case */ iszero =(vec_uint4)vec_cmpeq((vec_uint4)vec_or(aabs,babs),(vec_uint4)vec_splat_u32(0)); iszero = vec_and(iszero,(vec_uint4)vec_slo((vec_uchar16)iszero,x.v)); /* result = (A or C) and not B */ result = vec_or(biteq,iszero); result = vec_andc(result, anan); /* Promote high words to 64 bits and return */ return ((qword)(vec_perm((vec_uchar16)result, (vec_uchar16)result, hihi_promote))); } /* Compare greater than */ static __inline qword si_cgtb(qword a, qword b) { return ((qword)(vec_cmpgt((vec_char16)(a), (vec_char16)(b)))); } static __inline qword si_cgth(qword a, qword b) { return ((qword)(vec_cmpgt((vec_short8)(a), (vec_short8)(b)))); } static __inline qword si_cgt(qword a, qword b) { return ((qword)(vec_cmpgt((vec_int4)(a), (vec_int4)(b)))); } static __inline qword si_clgtb(qword a, qword b) { return ((qword)(vec_cmpgt((vec_uchar16)(a), (vec_uchar16)(b)))); } static __inline qword si_clgth(qword a, qword b) { return ((qword)(vec_cmpgt((vec_ushort8)(a), (vec_ushort8)(b)))); } static __inline qword si_clgt(qword a, qword b) { return ((qword)(vec_cmpgt((vec_uint4)(a), (vec_uint4)(b)))); } static __inline qword si_fcgt(qword a, qword b) { return ((qword)(vec_cmpgt((vec_float4)(a), (vec_float4)(b)))); } static __inline qword si_dfcgt(qword a, qword b) { vec_uchar16 splat_hi = (vec_uchar16) { 0,1,2,3, 0,1,2,3, 8,9,10,11, 8,9,10,11 }; vec_uchar16 borrow_shuffle = (vec_uchar16) { 4,5,6,7, 192,192,192,192, 12,13,14,15, 192,192,192,192 }; vec_uint4 nan_mask = (vec_uint4) { 0x7FF00000, 0x0, 0x7FF00000, 0x0 }; vec_uint4 sign_mask = (vec_uint4) { 0x7FFFFFFF, 0xFFFFFFFF, 0x7FFFFFFF, 0xFFFFFFFF }; union { vec_uchar16 v; int i[4]; } x; /* Shift 4 bytes */ x.i[3] = 4 << 3; // absolute value of a,b vec_uint4 aabs = vec_and((vec_uint4)a, sign_mask); vec_uint4 babs = vec_and((vec_uint4)b, sign_mask); // check if a is nan vec_uint4 a_inf = (vec_uint4)vec_cmpeq(aabs, nan_mask); vec_uint4 a_nan = (vec_uint4)vec_cmpgt(aabs, nan_mask); a_nan = vec_or(a_nan, vec_and((vec_uint4)vec_slo((vec_uchar16)a_nan,x.v),a_inf)); a_nan = (vec_uint4)vec_perm((vec_uchar16)a_nan, (vec_uchar16)a_nan, splat_hi); // check if b is nan vec_uint4 b_inf = (vec_uint4)vec_cmpeq(babs, nan_mask); vec_uint4 b_nan = (vec_uint4)vec_cmpgt(babs, nan_mask); b_nan = vec_or(b_nan, vec_and((vec_uint4)vec_slo((vec_uchar16)b_nan,x.v),b_inf)); b_nan = (vec_uint4)vec_perm((vec_uchar16)b_nan, (vec_uchar16)b_nan, splat_hi); // sign of a vec_uint4 asel = (vec_uint4)vec_sra((vec_int4)(a), (vec_uint4)vec_splat(((vec_uint4)si_from_int(31)), 0)); asel = (vec_uint4)vec_perm((vec_uchar16)asel,(vec_uchar16)asel,splat_hi); // sign of b vec_uint4 bsel = (vec_uint4)vec_sra((vec_int4)(b), (vec_uint4)vec_splat(((vec_uint4)si_from_int(31)), 0)); bsel = (vec_uint4)vec_perm((vec_uchar16)bsel,(vec_uchar16)bsel,splat_hi); // negative a vec_uint4 abor = vec_subc((vec_uint4)vec_splat_u32(0), aabs); vec_uchar16 pat = vec_sel(((vec_uchar16){0, 1, 2, 3, 4, 5, 6, 7, 8, 9,10,11,12,13,14,15}), vec_sr(borrow_shuffle, vec_splat_u8(3)), vec_sra(borrow_shuffle, vec_splat_u8(7))); abor = (vec_uint4)(vec_perm(vec_perm((vec_uchar16)abor, (vec_uchar16)abor, borrow_shuffle),((vec_uchar16){0, 0, 0, 0, 0, 0, 0, 0, 0xFF, 0xFF, 0xFF, 0xFF, 0x80, 0x80, 0x80, 0x80}),pat)); vec_uint4 aneg = vec_add(vec_add(vec_splat_u32(0), vec_nor(aabs, aabs)), vec_and(abor, vec_splat_u32(1))); // pick the one we want vec_int4 aval = (vec_int4)vec_sel((vec_uchar16)aabs, (vec_uchar16)aneg, (vec_uchar16)asel); // negative b vec_uint4 bbor = vec_subc((vec_uint4)vec_splat_u32(0), babs); bbor = (vec_uint4)(vec_perm(vec_perm((vec_uchar16)bbor, (vec_uchar16)bbor, borrow_shuffle),((vec_uchar16){0, 0, 0, 0, 0, 0, 0, 0, 0xFF, 0xFF, 0xFF, 0xFF, 0x80, 0x80, 0x80, 0x80}),pat)); vec_uint4 bneg = vec_add(vec_nor(babs, babs), vec_and(bbor, vec_splat_u32(1))); // pick the one we want vec_int4 bval=(vec_int4)vec_sel((vec_uchar16)babs, (vec_uchar16)bneg, (vec_uchar16)bsel); // A) Check if the exponents are different vec_uint4 gt_hi = (vec_uint4)vec_cmpgt(aval,bval); // B) Check if high word equal, and low word greater vec_uint4 gt_lo = (vec_uint4)vec_cmpgt((vec_uint4)aval, (vec_uint4)bval); vec_uint4 eq = (vec_uint4)vec_cmpeq(aval, bval); vec_uint4 eqgt = vec_and(eq,vec_slo(gt_lo,x.v)); // If either A or B is true, return true (unless NaNs detected) vec_uint4 r = vec_or(gt_hi, eqgt); // splat the high words of the comparison step r = (vec_uint4)vec_perm((vec_uchar16)r,(vec_uchar16)r,splat_hi); // correct for NaNs in input return ((qword)vec_andc(r,vec_or(a_nan,b_nan))); } static __inline qword si_cgtbi(qword a, signed char b) { return ((qword)(vec_cmpgt((vec_char16)(a), vec_splat((vec_char16)(si_from_char(b)), 3)))); } static __inline qword si_cgthi(qword a, signed short b) { return ((qword)(vec_cmpgt((vec_short8)(a), vec_splat((vec_short8)(si_from_short(b)), 1)))); } static __inline qword si_cgti(qword a, signed int b) { return ((qword)(vec_cmpgt((vec_int4)(a), vec_splat((vec_int4)(si_from_int(b)), 0)))); } static __inline qword si_clgtbi(qword a, unsigned char b) { return ((qword)(vec_cmpgt((vec_uchar16)(a), vec_splat((vec_uchar16)(si_from_uchar(b)), 3)))); } static __inline qword si_clgthi(qword a, unsigned short b) { return ((qword)(vec_cmpgt((vec_ushort8)(a), vec_splat((vec_ushort8)(si_from_ushort(b)), 1)))); } static __inline qword si_clgti(qword a, unsigned int b) { return ((qword)(vec_cmpgt((vec_uint4)(a), vec_splat((vec_uint4)(si_from_uint(b)), 0)))); } static __inline qword si_dftsv(qword a, char b) { vec_uchar16 splat_hi = (vec_uchar16) { 0,1,2,3, 0,1,2,3, 8,9,10,11, 8,9,10,11 }; vec_uint4 sign_mask = (vec_uint4) { 0x7FFFFFFF, 0xFFFFFFFF, 0x7FFFFFFF, 0xFFFFFFFF }; vec_uint4 result = (vec_uint4){0}; vec_uint4 sign = (vec_uint4)vec_sra((vec_int4)(a), (vec_uint4)vec_splat(((vec_uint4)si_from_int(31)), 0)); sign = (vec_uint4)vec_perm((vec_uchar16)sign,(vec_uchar16)sign,splat_hi); vec_uint4 aabs = vec_and((vec_uint4)a,sign_mask); union { vec_uchar16 v; int i[4]; } x; /* Shift 4 bytes */ x.i[3] = 4 << 3; /* Nan or +inf or -inf */ if (b & 0x70) { vec_uint4 nan_mask = (vec_uint4) { 0x7FF00000, 0x0, 0x7FF00000, 0x0 }; vec_uint4 a_inf = (vec_uint4)vec_cmpeq(aabs, nan_mask); /* NaN */ if (b & 0x40) { vec_uint4 a_nan = (vec_uint4)vec_cmpgt(aabs, nan_mask); a_nan = vec_or(a_nan, vec_and((vec_uint4)vec_slo((vec_uchar16)a_nan,x.v),a_inf)); a_nan = (vec_uint4)vec_perm((vec_uchar16)a_nan, (vec_uchar16)a_nan, splat_hi); result = vec_or(result, a_nan); } /* inf */ if (b & 0x30) { a_inf = vec_and((vec_uint4)vec_slo((vec_uchar16)a_inf,x.v), a_inf); a_inf = (vec_uint4)vec_perm((vec_uchar16)a_inf, (vec_uchar16)a_inf, splat_hi); /* +inf */ if (b & 0x20) result = vec_or(vec_andc(a_inf, sign), result); /* -inf */ if (b & 0x10) result = vec_or(vec_and(a_inf, sign), result); } } /* 0 or denorm */ if (b & 0xF) { vec_uint4 iszero =(vec_uint4)vec_cmpeq(aabs,(vec_uint4)vec_splat_u32(0)); iszero = vec_and(iszero,(vec_uint4)vec_slo((vec_uchar16)iszero,x.v)); /* denorm */ if (b & 0x3) { vec_uint4 denorm_mask = (vec_uint4){0xFFFFF, 0xFFFFF, 0xFFFFF, 0xFFFFF}; vec_uint4 isdenorm = vec_nor((vec_uint4)vec_cmpgt(aabs, denorm_mask), iszero); isdenorm = (vec_uint4)vec_perm((vec_uchar16)isdenorm, (vec_uchar16)isdenorm, splat_hi); /* +denorm */ if (b & 0x2) result = vec_or(vec_andc(isdenorm, sign), result); /* -denorm */ if (b & 0x1) result = vec_or(vec_and(isdenorm, sign), result); } /* 0 */ if (b & 0xC) { iszero = (vec_uint4)vec_perm((vec_uchar16)iszero, (vec_uchar16)iszero, splat_hi); /* +0 */ if (b & 0x8) result = vec_or(vec_andc(iszero, sign), result); /* -0 */ if (b & 0x4) result = vec_or(vec_and(iszero, sign), result); } } return ((qword)result); } /* Carry generate */ #define si_cg(_a, _b) ((qword)(vec_addc((vec_uint4)(_a), (vec_uint4)(_b)))) #define si_cgx(_a, _b, _c) ((qword)(vec_or(vec_addc((vec_uint4)(_a), (vec_uint4)(_b)), \ vec_addc(vec_add((vec_uint4)(_a), (vec_uint4)(_b)), \ vec_and((vec_uint4)(_c), vec_splat_u32(1)))))) /* Count ones for bytes */ static __inline qword si_cntb(qword a) { vec_uchar16 nib_cnt = (vec_uchar16){0, 1, 1, 2, 1, 2, 2, 3, 1, 2, 2, 3, 2, 3, 3, 4}; vec_uchar16 four = { 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4 }; vec_uchar16 av; av = (vec_uchar16)(a); return ((qword)(vec_add(vec_perm(nib_cnt, nib_cnt, av), vec_perm(nib_cnt, nib_cnt, vec_sr (av, four))))); } /* Count ones for bytes */ static __inline qword si_clz(qword a) { vec_uchar16 av; vec_uchar16 cnt_hi, cnt_lo, cnt, tmp1, tmp2, tmp3; vec_uchar16 four = vec_splat_u8(4); vec_uchar16 nib_cnt = (vec_uchar16){4, 3, 2, 2, 1, 1, 1, 1, 0, 0, 0, 0, 0, 0, 0, 0}; vec_uchar16 eight = vec_splat_u8(8); vec_uchar16 sixteen = (vec_uchar16){16,16,16,16,16,16,16,16,16,16,16,16,16,16,16,16}; vec_uchar16 twentyfour = (vec_uchar16){24,24,24,24,24,24,24,24,24,24,24,24,24,24,24,24}; av = (vec_uchar16)(a); cnt_hi = vec_perm(nib_cnt, nib_cnt, vec_sr(av, four)); cnt_lo = vec_perm(nib_cnt, nib_cnt, av); cnt = vec_add(cnt_hi, vec_and(cnt_lo, vec_cmpeq(cnt_hi, four))); tmp1 = (vec_uchar16)vec_sl((vec_uint4)(cnt), (vec_uint4)(eight)); tmp2 = (vec_uchar16)vec_sl((vec_uint4)(cnt), (vec_uint4)(sixteen)); tmp3 = (vec_uchar16)vec_sl((vec_uint4)(cnt), (vec_uint4)(twentyfour)); cnt = vec_add(cnt, vec_and(tmp1, vec_cmpeq(cnt, eight))); cnt = vec_add(cnt, vec_and(tmp2, vec_cmpeq(cnt, sixteen))); cnt = vec_add(cnt, vec_and(tmp3, vec_cmpeq(cnt, twentyfour))); return (qword)((vec_sr((vec_uint4)(cnt), (vec_uint4)(twentyfour)))); } /* Convert to float */ #define si_cuflt(_a, _b) ((qword)(vec_ctf((vec_uint4)(_a), _b))) #define si_csflt(_a, _b) ((qword)(vec_ctf((vec_int4)(_a), _b))) /* Convert to signed int */ #define si_cflts(_a, _b) ((qword)(vec_cts((vec_float4)(_a), _b))) /* Convert to unsigned int */ #define si_cfltu(_a, _b) ((qword)(vec_ctu((vec_float4)(_a), _b))) /* Synchronize */ #define si_dsync() /* do nothing */ #define si_sync() /* do nothing */ #define si_syncc() /* do nothing */ /* Equivalence */ static __inline qword si_eqv(qword a, qword b) { vec_uchar16 d; d = vec_xor((vec_uchar16)(a), (vec_uchar16)(b)); return ((qword)(vec_nor(d, d))); } /* Extend */ static __inline qword si_xsbh(qword a) { vec_char16 av; av = (vec_char16)(a); return ((qword)(vec_unpackh(vec_perm(av, av, ((vec_uchar16){1, 3, 5, 7, 9,11,13,15, 0, 0, 0, 0, 0, 0, 0, 0}))))); } static __inline qword si_xshw(qword a) { vec_short8 av; av = (vec_short8)(a); return ((qword)(vec_unpackh(vec_perm(av, av, ((vec_uchar16){2, 3, 6, 7, 10,11,14,15, 0, 0, 0, 0, 0, 0, 0, 0}))))); } static __inline qword si_xswd(qword a) { vec_int4 av; av = (vec_int4)(a); return ((qword)(vec_perm(av, vec_sra(av, ((vec_uint4){31,31,31,31})), ((vec_uchar16){20, 21, 22, 23, 4, 5, 6, 7, 28, 29, 30, 31, 12, 13, 14, 15})))); } static __inline qword si_fesd(qword a) { union { double d[2]; vec_double2 vd; } out; union { float f[4]; vec_float4 vf; } in; in.vf = (vec_float4)(a); out.d[0] = (double)(in.f[0]); out.d[1] = (double)(in.f[2]); return ((qword)(out.vd)); } /* Gather */ static __inline qword si_gbb(qword a) { vec_uchar16 bits; vec_uint4 bytes; bits = vec_sl(vec_and((vec_uchar16)(a), vec_splat_u8(1)), ((vec_uchar16){7, 6, 5, 4, 3, 2, 1, 0, 7, 6, 5, 4, 3, 2, 1, 0})); bytes = (vec_uint4)vec_sum2s((vec_int4)(vec_sum4s(bits, ((vec_uint4){0}))), ((vec_int4){0})); return ((qword)(vec_perm(bytes, bytes, ((vec_uchar16){0, 0, 7,15, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0})))); } static __inline qword si_gbh(qword a) { vec_ushort8 bits; vec_uint4 bytes; bits = vec_sl(vec_and((vec_ushort8)(a), vec_splat_u16(1)), ((vec_ushort8){7, 6, 5, 4, 3, 2, 1, 0})); bytes = (vec_uint4)vec_sums((vec_int4)(vec_sum4s((vec_short8)(bits), (vec_int4){0})), (vec_int4){0}); return ((qword)(vec_sld(bytes, bytes, 12))); } static __inline qword si_gb(qword a) { vec_uint4 bits; vec_uint4 bytes; bits = vec_sl(vec_and((vec_uint4)(a), vec_splat_u32(1)), ((vec_uint4){3, 2, 1, 0})); bytes = (vec_uint4)vec_sums((vec_int4)(bits), ((vec_int4){0})); return ((qword)(vec_sld(bytes, bytes, 12))); } /* Compare and halt */ static __inline void si_heq(qword a, qword b) { union { vector unsigned int v; unsigned int i[4]; } aa, bb; aa.v = (vector unsigned int)(a); bb.v = (vector unsigned int)(b); if (aa.i[0] == bb.i[0]) { SPU_HALT_ACTION; }; } static __inline void si_heqi(qword a, unsigned int b) { union { vector unsigned int v; unsigned int i[4]; } aa; aa.v = (vector unsigned int)(a); if (aa.i[0] == b) { SPU_HALT_ACTION; }; } static __inline void si_hgt(qword a, qword b) { union { vector signed int v; signed int i[4]; } aa, bb; aa.v = (vector signed int)(a); bb.v = (vector signed int)(b); if (aa.i[0] > bb.i[0]) { SPU_HALT_ACTION; }; } static __inline void si_hgti(qword a, signed int b) { union { vector signed int v; signed int i[4]; } aa; aa.v = (vector signed int)(a); if (aa.i[0] > b) { SPU_HALT_ACTION; }; } static __inline void si_hlgt(qword a, qword b) { union { vector unsigned int v; unsigned int i[4]; } aa, bb; aa.v = (vector unsigned int)(a); bb.v = (vector unsigned int)(b); if (aa.i[0] > bb.i[0]) { SPU_HALT_ACTION; }; } static __inline void si_hlgti(qword a, unsigned int b) { union { vector unsigned int v; unsigned int i[4]; } aa; aa.v = (vector unsigned int)(a); if (aa.i[0] > b) { SPU_HALT_ACTION; }; } /* Multiply and Add */ static __inline qword si_mpya(qword a, qword b, qword c) { return ((qword)(vec_msum(vec_and((vec_short8)(a), ((vec_short8){0, -1, 0, -1, 0, -1, 0, -1})), (vec_short8)(b), (vec_int4)(c)))); } static __inline qword si_fma(qword a, qword b, qword c) { return ((qword)(vec_madd((vec_float4)(a), (vec_float4)(b), (vec_float4)(c)))); } static __inline qword si_dfma(qword a, qword b, qword c) { union { vec_double2 v; double d[2]; } aa, bb, cc, dd; aa.v = (vec_double2)(a); bb.v = (vec_double2)(b); cc.v = (vec_double2)(c); dd.d[0] = aa.d[0] * bb.d[0] + cc.d[0]; dd.d[1] = aa.d[1] * bb.d[1] + cc.d[1]; return ((qword)(dd.v)); } /* Form Mask */ #define si_fsmbi(_a) si_fsmb(si_from_int(_a)) static __inline qword si_fsmb(qword a) { vec_char16 mask; vec_ushort8 in; in = (vec_ushort8)(a); mask = (vec_char16)(vec_perm(in, in, ((vec_uchar16){2, 2, 2, 2, 2, 2, 2, 2, 3, 3, 3, 3, 3, 3, 3, 3}))); return ((qword)(vec_sra(vec_sl(mask, ((vec_uchar16){0, 1, 2, 3, 4, 5, 6, 7, 0, 1, 2, 3, 4, 5, 6, 7})), vec_splat_u8(7)))); } static __inline qword si_fsmh(qword a) { vec_uchar16 in; vec_short8 mask; in = (vec_uchar16)(a); mask = (vec_short8)(vec_splat(in, 3)); return ((qword)(vec_sra(vec_sl(mask, ((vec_ushort8){0, 1, 2, 3, 4, 5, 6, 7})), vec_splat_u16(15)))); } static __inline qword si_fsm(qword a) { vec_uchar16 in; vec_int4 mask; in = (vec_uchar16)(a); mask = (vec_int4)(vec_splat(in, 3)); return ((qword)(vec_sra(vec_sl(mask, ((vec_uint4){28, 29, 30, 31})), ((vec_uint4){31,31,31,31})))); } /* Move from/to registers */ #define si_fscrrd() ((qword)((vec_uint4){0})) #define si_fscrwr(_a) #define si_mfspr(_reg) ((qword)((vec_uint4){0})) #define si_mtspr(_reg, _a) /* Multiply High High Add */ static __inline qword si_mpyhha(qword a, qword b, qword c) { return ((qword)(vec_add(vec_mule((vec_short8)(a), (vec_short8)(b)), (vec_int4)(c)))); } static __inline qword si_mpyhhau(qword a, qword b, qword c) { return ((qword)(vec_add(vec_mule((vec_ushort8)(a), (vec_ushort8)(b)), (vec_uint4)(c)))); } /* Multiply Subtract */ static __inline qword si_fms(qword a, qword b, qword c) { return ((qword)(vec_madd((vec_float4)(a), (vec_float4)(b), vec_sub(((vec_float4){0.0f}), (vec_float4)(c))))); } static __inline qword si_dfms(qword a, qword b, qword c) { union { vec_double2 v; double d[2]; } aa, bb, cc, dd; aa.v = (vec_double2)(a); bb.v = (vec_double2)(b); cc.v = (vec_double2)(c); dd.d[0] = aa.d[0] * bb.d[0] - cc.d[0]; dd.d[1] = aa.d[1] * bb.d[1] - cc.d[1]; return ((qword)(dd.v)); } /* Multiply */ static __inline qword si_fm(qword a, qword b) { return ((qword)(vec_madd((vec_float4)(a), (vec_float4)(b), ((vec_float4){0.0f})))); } static __inline qword si_dfm(qword a, qword b) { union { vec_double2 v; double d[2]; } aa, bb, dd; aa.v = (vec_double2)(a); bb.v = (vec_double2)(b); dd.d[0] = aa.d[0] * bb.d[0]; dd.d[1] = aa.d[1] * bb.d[1]; return ((qword)(dd.v)); } /* Multiply High */ static __inline qword si_mpyh(qword a, qword b) { vec_uint4 sixteen = (vec_uint4){16, 16, 16, 16}; return ((qword)(vec_sl(vec_mule((vec_short8)(a), (vec_short8)(vec_sl((vec_uint4)(b), sixteen))), sixteen))); } /* Multiply High High */ static __inline qword si_mpyhh(qword a, qword b) { return ((qword)(vec_mule((vec_short8)(a), (vec_short8)(b)))); } static __inline qword si_mpyhhu(qword a, qword b) { return ((qword)(vec_mule((vec_ushort8)(a), (vec_ushort8)(b)))); } /* Multiply Odd */ static __inline qword si_mpy(qword a, qword b) { return ((qword)(vec_mulo((vec_short8)(a), (vec_short8)(b)))); } static __inline qword si_mpyu(qword a, qword b) { return ((qword)(vec_mulo((vec_ushort8)(a), (vec_ushort8)(b)))); } static __inline qword si_mpyi(qword a, short b) { return ((qword)(vec_mulo((vec_short8)(a), vec_splat((vec_short8)(si_from_short(b)), 1)))); } static __inline qword si_mpyui(qword a, unsigned short b) { return ((qword)(vec_mulo((vec_ushort8)(a), vec_splat((vec_ushort8)(si_from_ushort(b)), 1)))); } /* Multiply and Shift Right */ static __inline qword si_mpys(qword a, qword b) { return ((qword)(vec_sra(vec_mulo((vec_short8)(a), (vec_short8)(b)), ((vec_uint4){16,16,16,16})))); } /* Nand */ static __inline qword si_nand(qword a, qword b) { vec_uchar16 d; d = vec_and((vec_uchar16)(a), (vec_uchar16)(b)); return ((qword)(vec_nor(d, d))); } /* Negative Multiply Add */ static __inline qword si_dfnma(qword a, qword b, qword c) { union { vec_double2 v; double d[2]; } aa, bb, cc, dd; aa.v = (vec_double2)(a); bb.v = (vec_double2)(b); cc.v = (vec_double2)(c); dd.d[0] = -cc.d[0] - aa.d[0] * bb.d[0]; dd.d[1] = -cc.d[1] - aa.d[1] * bb.d[1]; return ((qword)(dd.v)); } /* Negative Multiply and Subtract */ static __inline qword si_fnms(qword a, qword b, qword c) { return ((qword)(vec_nmsub((vec_float4)(a), (vec_float4)(b), (vec_float4)(c)))); } static __inline qword si_dfnms(qword a, qword b, qword c) { union { vec_double2 v; double d[2]; } aa, bb, cc, dd; aa.v = (vec_double2)(a); bb.v = (vec_double2)(b); cc.v = (vec_double2)(c); dd.d[0] = cc.d[0] - aa.d[0] * bb.d[0]; dd.d[1] = cc.d[1] - aa.d[1] * bb.d[1]; return ((qword)(dd.v)); } /* Nor */ static __inline qword si_nor(qword a, qword b) { return ((qword)(vec_nor((vec_uchar16)(a), (vec_uchar16)(b)))); } /* Or */ static __inline qword si_or(qword a, qword b) { return ((qword)(vec_or((vec_uchar16)(a), (vec_uchar16)(b)))); } static __inline qword si_orbi(qword a, unsigned char b) { return ((qword)(vec_or((vec_uchar16)(a), vec_splat((vec_uchar16)(si_from_uchar(b)), 3)))); } static __inline qword si_orhi(qword a, unsigned short b) { return ((qword)(vec_or((vec_ushort8)(a), vec_splat((vec_ushort8)(si_from_ushort(b)), 1)))); } static __inline qword si_ori(qword a, unsigned int b) { return ((qword)(vec_or((vec_uint4)(a), vec_splat((vec_uint4)(si_from_uint(b)), 0)))); } /* Or Complement */ static __inline qword si_orc(qword a, qword b) { return ((qword)(vec_or((vec_uchar16)(a), vec_nor((vec_uchar16)(b), (vec_uchar16)(b))))); } /* Or Across */ static __inline qword si_orx(qword a) { vec_uchar16 tmp; tmp = (vec_uchar16)(a); tmp = vec_or(tmp, vec_sld(tmp, tmp, 8)); tmp = vec_or(tmp, vec_sld(tmp, tmp, 4)); return ((qword)(vec_and(tmp, ((vec_uchar16){0xFF,0xFF,0xFF,0xFF, 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00})))); } /* Estimates */ static __inline qword si_frest(qword a) { return ((qword)(vec_re((vec_float4)(a)))); } static __inline qword si_frsqest(qword a) { return ((qword)(vec_rsqrte((vec_float4)(a)))); } #define si_fi(_a, _d) (_d) /* Channel Read and Write */ #define si_rdch(_channel) ((qword)(vec_splat_u8(0))) /* not mappable */ #define si_rchcnt(_channel) ((qword)(vec_splat_u8(0))) /* not mappable */ #define si_wrch(_channel, _a) /* not mappable */ /* Rotate Left */ static __inline qword si_roth(qword a, qword b) { return ((qword)(vec_rl((vec_ushort8)(a), (vec_ushort8)(b)))); } static __inline qword si_rot(qword a, qword b) { return ((qword)(vec_rl((vec_uint4)(a), (vec_uint4)(b)))); } static __inline qword si_rothi(qword a, int b) { return ((qword)(vec_rl((vec_ushort8)(a), vec_splat((vec_ushort8)(si_from_int(b)), 1)))); } static __inline qword si_roti(qword a, int b) { return ((qword)(vec_rl((vec_uint4)(a), vec_splat((vec_uint4)(si_from_int(b)), 0)))); } /* Rotate Left with Mask */ static __inline qword si_rothm(qword a, qword b) { vec_ushort8 neg_b; vec_ushort8 mask; neg_b = (vec_ushort8)vec_sub(vec_splat_s16(0), (vec_short8)(b)); mask = vec_sra(vec_sl(neg_b, vec_splat_u16(11)), vec_splat_u16(15)); return ((qword)(vec_andc(vec_sr((vec_ushort8)(a), neg_b), mask))); } static __inline qword si_rotm(qword a, qword b) { vec_uint4 neg_b; vec_uint4 mask; neg_b = (vec_uint4)vec_sub(vec_splat_s32(0), (vec_int4)(b)); mask = vec_sra(vec_sl(neg_b, ((vec_uint4){26,26,26,26})), ((vec_uint4){31,31,31,31})); return ((qword)(vec_andc(vec_sr((vec_uint4)(a), neg_b), mask))); } static __inline qword si_rothmi(qword a, int b) { vec_ushort8 neg_b; vec_ushort8 mask; neg_b = vec_splat((vec_ushort8)(si_from_int(-b)), 1); mask = vec_sra(vec_sl(neg_b, vec_splat_u16(11)), vec_splat_u16(15)); return ((qword)(vec_andc(vec_sr((vec_ushort8)(a), neg_b), mask))); } static __inline qword si_rotmi(qword a, int b) { vec_uint4 neg_b; vec_uint4 mask; neg_b = vec_splat((vec_uint4)(si_from_int(-b)), 0); mask = vec_sra(vec_sl(neg_b, ((vec_uint4){26,26,26,26})), ((vec_uint4){31,31,31,31})); return ((qword)(vec_andc(vec_sr((vec_uint4)(a), neg_b), mask))); } /* Rotate Left Algebraic with Mask */ static __inline qword si_rotmah(qword a, qword b) { vec_ushort8 neg_b; vec_ushort8 mask; neg_b = (vec_ushort8)vec_sub(vec_splat_s16(0), (vec_short8)(b)); mask = vec_sra(vec_sl(neg_b, vec_splat_u16(11)), vec_splat_u16(15)); return ((qword)(vec_sra((vec_short8)(a), (vec_ushort8)vec_or(neg_b, mask)))); } static __inline qword si_rotma(qword a, qword b) { vec_uint4 neg_b; vec_uint4 mask; neg_b = (vec_uint4)vec_sub(vec_splat_s32(0), (vec_int4)(b)); mask = vec_sra(vec_sl(neg_b, ((vec_uint4){26,26,26,26})), ((vec_uint4){31,31,31,31})); return ((qword)(vec_sra((vec_int4)(a), (vec_uint4)vec_or(neg_b, mask)))); } static __inline qword si_rotmahi(qword a, int b) { vec_ushort8 neg_b; vec_ushort8 mask; neg_b = vec_splat((vec_ushort8)(si_from_int(-b)), 1); mask = vec_sra(vec_sl(neg_b, vec_splat_u16(11)), vec_splat_u16(15)); return ((qword)(vec_sra((vec_short8)(a), (vec_ushort8)vec_or(neg_b, mask)))); } static __inline qword si_rotmai(qword a, int b) { vec_uint4 neg_b; vec_uint4 mask; neg_b = vec_splat((vec_uint4)(si_from_int(-b)), 0); mask = vec_sra(vec_sl(neg_b, ((vec_uint4){26,26,26,26})), ((vec_uint4){31,31,31,31})); return ((qword)(vec_sra((vec_int4)(a), (vec_uint4)vec_or(neg_b, mask)))); } /* Rotate Left Quadword by Bytes with Mask */ static __inline qword si_rotqmbyi(qword a, int count) { union { vec_uchar16 v; int i[4]; } x; vec_uchar16 mask; count = 0 - count; x.i[3] = count << 3; mask = (count & 0x10) ? vec_splat_u8(0) : vec_splat_u8(-1); return ((qword)(vec_and(vec_sro((vec_uchar16)(a), x.v), mask))); } static __inline qword si_rotqmby(qword a, qword count) { union { vec_uchar16 v; int i[4]; } x; int cnt; vec_uchar16 mask; x.v = (vec_uchar16)(count); x.i[0] = cnt = (0 - x.i[0]) << 3; x.v = vec_splat(x.v, 3); mask = (cnt & 0x80) ? vec_splat_u8(0) : vec_splat_u8(-1); return ((qword)(vec_and(vec_sro((vec_uchar16)(a), x.v), mask))); } /* Rotate Left Quadword by Bytes */ static __inline qword si_rotqbyi(qword a, int count) { union { vec_uchar16 v; int i[4]; } left, right; count <<= 3; left.i[3] = count; right.i[3] = 0 - count; return ((qword)(vec_or(vec_slo((vec_uchar16)(a), left.v), vec_sro((vec_uchar16)(a), right.v)))); } static __inline qword si_rotqby(qword a, qword count) { vec_uchar16 left, right; left = vec_sl(vec_splat((vec_uchar16)(count), 3), vec_splat_u8(3)); right = vec_sub(vec_splat_u8(0), left); return ((qword)(vec_or(vec_slo((vec_uchar16)(a), left), vec_sro((vec_uchar16)(a), right)))); } /* Rotate Left Quadword by Bytes Bit Count */ static __inline qword si_rotqbybi(qword a, qword count) { vec_uchar16 left, right; left = vec_splat((vec_uchar16)(count), 3); right = vec_sub(vec_splat_u8(7), left); return ((qword)(vec_or(vec_slo((vec_uchar16)(a), left), vec_sro((vec_uchar16)(a), right)))); } /* Rotate Left Quadword by Bytes Bit Count */ static __inline qword si_rotqbii(qword a, int count) { vec_uchar16 x, y; vec_uchar16 result; x = vec_splat((vec_uchar16)(si_from_int(count & 7)), 3); y = (vec_uchar16)(vec_sr((vec_uint4)vec_sro((vec_uchar16)(a), ((vec_uchar16)((vec_uint4){0,0,0,120}))), (vec_uint4)vec_sub(vec_splat_u8(8), x))); result = vec_or(vec_sll((qword)(a), x), y); return ((qword)(result)); } static __inline qword si_rotqbi(qword a, qword count) { vec_uchar16 x, y; vec_uchar16 result; x = vec_and(vec_splat((vec_uchar16)(count), 3), vec_splat_u8(7)); y = (vec_uchar16)(vec_sr((vec_uint4)vec_sro((vec_uchar16)(a), ((vec_uchar16)((vec_uint4){0,0,0,120}))), (vec_uint4)vec_sub(vec_splat_u8(8), x))); result = vec_or(vec_sll((qword)(a), x), y); return ((qword)(result)); } /* Rotate Left Quadword and Mask by Bits */ static __inline qword si_rotqmbii(qword a, int count) { return ((qword)(vec_srl((vec_uchar16)(a), vec_splat((vec_uchar16)(si_from_int(0 - count)), 3)))); } static __inline qword si_rotqmbi(qword a, qword count) { return ((qword)(vec_srl((vec_uchar16)(a), vec_sub(vec_splat_u8(0), vec_splat((vec_uchar16)(count), 3))))); } /* Rotate Left Quadword and Mask by Bytes with Bit Count */ static __inline qword si_rotqmbybi(qword a, qword count) { union { vec_uchar16 v; int i[4]; } x; int cnt; vec_uchar16 mask; x.v = (vec_uchar16)(count); x.i[0] = cnt = 0 - (x.i[0] & ~7); x.v = vec_splat(x.v, 3); mask = (cnt & 0x80) ? vec_splat_u8(0) : vec_splat_u8(-1); return ((qword)(vec_and(vec_sro((vec_uchar16)(a), x.v), mask))); } /* Round Double to Float */ static __inline qword si_frds(qword a) { union { vec_float4 v; float f[4]; } d; union { vec_double2 v; double d[2]; } in; in.v = (vec_double2)(a); d.v = (vec_float4){0.0f}; d.f[0] = (float)in.d[0]; d.f[2] = (float)in.d[1]; return ((qword)(d.v)); } /* Select Bits */ static __inline qword si_selb(qword a, qword b, qword c) { return ((qword)(vec_sel((vec_uchar16)(a), (vec_uchar16)(b), (vec_uchar16)(c)))); } /* Shuffle Bytes */ static __inline qword si_shufb(qword a, qword b, qword pattern) { vec_uchar16 pat; pat = vec_sel(((vec_uchar16){0, 1, 2, 3, 4, 5, 6, 7, 8, 9,10,11,12,13,14,15}), vec_sr((vec_uchar16)(pattern), vec_splat_u8(3)), vec_sra((vec_uchar16)(pattern), vec_splat_u8(7))); return ((qword)(vec_perm(vec_perm(a, b, pattern), ((vec_uchar16){0, 0, 0, 0, 0, 0, 0, 0, 0xFF, 0xFF, 0xFF, 0xFF, 0x80, 0x80, 0x80, 0x80}), pat))); } /* Shift Left */ static __inline qword si_shlh(qword a, qword b) { vec_ushort8 mask; mask = (vec_ushort8)vec_sra(vec_sl((vec_ushort8)(b), vec_splat_u16(11)), vec_splat_u16(15)); return ((qword)(vec_andc(vec_sl((vec_ushort8)(a), (vec_ushort8)(b)), mask))); } static __inline qword si_shl(qword a, qword b) { vec_uint4 mask; mask = (vec_uint4)vec_sra(vec_sl((vec_uint4)(b), ((vec_uint4){26,26,26,26})), ((vec_uint4){31,31,31,31})); return ((qword)(vec_andc(vec_sl((vec_uint4)(a), (vec_uint4)(b)), mask))); } static __inline qword si_shlhi(qword a, unsigned int b) { vec_ushort8 mask; vec_ushort8 bv; bv = vec_splat((vec_ushort8)(si_from_int(b)), 1); mask = (vec_ushort8)vec_sra(vec_sl(bv, vec_splat_u16(11)), vec_splat_u16(15)); return ((qword)(vec_andc(vec_sl((vec_ushort8)(a), bv), mask))); } static __inline qword si_shli(qword a, unsigned int b) { vec_uint4 bv; vec_uint4 mask; bv = vec_splat((vec_uint4)(si_from_uint(b)), 0); mask = (vec_uint4)vec_sra(vec_sl(bv, ((vec_uint4){26,26,26,26})), ((vec_uint4){31,31,31,31})); return ((qword)(vec_andc(vec_sl((vec_uint4)(a), bv), mask))); } /* Shift Left Quadword */ static __inline qword si_shlqbii(qword a, unsigned int count) { vec_uchar16 x; x = vec_splat((vec_uchar16)(si_from_uint(count)), 3); return ((qword)(vec_sll((vec_uchar16)(a), x))); } static __inline qword si_shlqbi(qword a, qword count) { vec_uchar16 x; x = vec_splat((vec_uchar16)(count), 3); return ((qword)(vec_sll((vec_uchar16)(a), x))); } /* Shift Left Quadword by Bytes */ static __inline qword si_shlqbyi(qword a, unsigned int count) { union { vec_uchar16 v; int i[4]; } x; vec_uchar16 mask; x.i[3] = count << 3; mask = (count & 0x10) ? vec_splat_u8(0) : vec_splat_u8(-1); return ((qword)(vec_and(vec_slo((vec_uchar16)(a), x.v), mask))); } static __inline qword si_shlqby(qword a, qword count) { union { vec_uchar16 v; unsigned int i[4]; } x; unsigned int cnt; vec_uchar16 mask; x.v = vec_sl(vec_splat((vec_uchar16)(count), 3), vec_splat_u8(3)); cnt = x.i[0]; mask = (cnt & 0x80) ? vec_splat_u8(0) : vec_splat_u8(-1); return ((qword)(vec_and(vec_slo((vec_uchar16)(a), x.v), mask))); } /* Shift Left Quadword by Bytes with Bit Count */ static __inline qword si_shlqbybi(qword a, qword count) { union { vec_uchar16 v; int i[4]; } x; unsigned int cnt; vec_uchar16 mask; x.v = vec_splat((vec_uchar16)(count), 3); cnt = x.i[0]; mask = (cnt & 0x80) ? vec_splat_u8(0) : vec_splat_u8(-1); return ((qword)(vec_and(vec_slo((vec_uchar16)(a), x.v), mask))); } /* Stop and Signal */ #define si_stop(_type) SPU_STOP_ACTION #define si_stopd(a, b, c) SPU_STOP_ACTION /* Subtract */ static __inline qword si_sfh(qword a, qword b) { return ((qword)(vec_sub((vec_ushort8)(b), (vec_ushort8)(a)))); } static __inline qword si_sf(qword a, qword b) { return ((qword)(vec_sub((vec_uint4)(b), (vec_uint4)(a)))); } static __inline qword si_fs(qword a, qword b) { return ((qword)(vec_sub((vec_float4)(a), (vec_float4)(b)))); } static __inline qword si_dfs(qword a, qword b) { union { vec_double2 v; double d[2]; } aa, bb, dd; aa.v = (vec_double2)(a); bb.v = (vec_double2)(b); dd.d[0] = aa.d[0] - bb.d[0]; dd.d[1] = aa.d[1] - bb.d[1]; return ((qword)(dd.v)); } static __inline qword si_sfhi(qword a, short b) { return ((qword)(vec_sub(vec_splat((vec_short8)(si_from_short(b)), 1), (vec_short8)(a)))); } static __inline qword si_sfi(qword a, int b) { return ((qword)(vec_sub(vec_splat((vec_int4)(si_from_int(b)), 0), (vec_int4)(a)))); } /* Subtract word extended */ #define si_sfx(_a, _b, _c) ((qword)(vec_add(vec_add((vec_uint4)(_b), \ vec_nor((vec_uint4)(_a), (vec_uint4)(_a))), \ vec_and((vec_uint4)(_c), vec_splat_u32(1))))) /* Sum Bytes into Shorts */ static __inline qword si_sumb(qword a, qword b) { vec_uint4 zero = (vec_uint4){0}; vec_ushort8 sum_a, sum_b; sum_a = (vec_ushort8)vec_sum4s((vec_uchar16)(a), zero); sum_b = (vec_ushort8)vec_sum4s((vec_uchar16)(b), zero); return ((qword)(vec_perm(sum_a, sum_b, ((vec_uchar16){18, 19, 2, 3, 22, 23, 6, 7, 26, 27, 10, 11, 30, 31, 14, 15})))); } /* Exclusive OR */ static __inline qword si_xor(qword a, qword b) { return ((qword)(vec_xor((vec_uchar16)(a), (vec_uchar16)(b)))); } static __inline qword si_xorbi(qword a, unsigned char b) { return ((qword)(vec_xor((vec_uchar16)(a), vec_splat((vec_uchar16)(si_from_uchar(b)), 3)))); } static __inline qword si_xorhi(qword a, unsigned short b) { return ((qword)(vec_xor((vec_ushort8)(a), vec_splat((vec_ushort8)(si_from_ushort(b)), 1)))); } static __inline qword si_xori(qword a, unsigned int b) { return ((qword)(vec_xor((vec_uint4)(a), vec_splat((vec_uint4)(si_from_uint(b)), 0)))); } /* Generate Controls for Sub-Quadword Insertion */ static __inline qword si_cbd(qword a, int imm) { union { vec_uint4 v; unsigned char c[16]; } shmask; shmask.v = ((vec_uint4){0x10111213, 0x14151617, 0x18191A1B, 0x1C1D1E1F}); shmask.c[(si_to_uint(a) + (unsigned int)(imm)) & 0xF] = 0x03; return ((qword)(shmask.v)); } static __inline qword si_cdd(qword a, int imm) { union { vec_uint4 v; unsigned long long ll[2]; } shmask; shmask.v = ((vec_uint4){0x10111213, 0x14151617, 0x18191A1B, 0x1C1D1E1F}); shmask.ll[((si_to_uint(a) + (unsigned int)(imm)) >> 3) & 0x1] = 0x0001020304050607ULL; return ((qword)(shmask.v)); } static __inline qword si_chd(qword a, int imm) { union { vec_uint4 v; unsigned short s[8]; } shmask; shmask.v = ((vec_uint4){0x10111213, 0x14151617, 0x18191A1B, 0x1C1D1E1F}); shmask.s[((si_to_uint(a) + (unsigned int)(imm)) >> 1) & 0x7] = 0x0203; return ((qword)(shmask.v)); } static __inline qword si_cwd(qword a, int imm) { union { vec_uint4 v; unsigned int i[4]; } shmask; shmask.v = ((vec_uint4){0x10111213, 0x14151617, 0x18191A1B, 0x1C1D1E1F}); shmask.i[((si_to_uint(a) + (unsigned int)(imm)) >> 2) & 0x3] = 0x00010203; return ((qword)(shmask.v)); } static __inline qword si_cbx(qword a, qword b) { union { vec_uint4 v; unsigned char c[16]; } shmask; shmask.v = ((vec_uint4){0x10111213, 0x14151617, 0x18191A1B, 0x1C1D1E1F}); shmask.c[si_to_uint((qword)(vec_add((vec_uint4)(a), (vec_uint4)(b)))) & 0xF] = 0x03; return ((qword)(shmask.v)); } static __inline qword si_cdx(qword a, qword b) { union { vec_uint4 v; unsigned long long ll[2]; } shmask; shmask.v = ((vec_uint4){0x10111213, 0x14151617, 0x18191A1B, 0x1C1D1E1F}); shmask.ll[(si_to_uint((qword)(vec_add((vec_uint4)(a), (vec_uint4)(b)))) >> 3) & 0x1] = 0x0001020304050607ULL; return ((qword)(shmask.v)); } static __inline qword si_chx(qword a, qword b) { union { vec_uint4 v; unsigned short s[8]; } shmask; shmask.v = ((vec_uint4){0x10111213, 0x14151617, 0x18191A1B, 0x1C1D1E1F}); shmask.s[(si_to_uint((qword)(vec_add((vec_uint4)(a), (vec_uint4)(b)))) >> 1) & 0x7] = 0x0203; return ((qword)(shmask.v)); } static __inline qword si_cwx(qword a, qword b) { union { vec_uint4 v; unsigned int i[4]; } shmask; shmask.v = ((vec_uint4){0x10111213, 0x14151617, 0x18191A1B, 0x1C1D1E1F}); shmask.i[(si_to_uint((qword)(vec_add((vec_uint4)(a), (vec_uint4)(b)))) >> 2) & 0x3] = 0x00010203; return ((qword)(shmask.v)); } /* Constant Formation */ static __inline qword si_il(signed short imm) { return ((qword)(vec_splat((vec_int4)(si_from_int((signed int)(imm))), 0))); } static __inline qword si_ila(unsigned int imm) { return ((qword)(vec_splat((vec_uint4)(si_from_uint(imm)), 0))); } static __inline qword si_ilh(signed short imm) { return ((qword)(vec_splat((vec_short8)(si_from_short(imm)), 1))); } static __inline qword si_ilhu(signed short imm) { return ((qword)(vec_splat((vec_uint4)(si_from_uint((unsigned int)(imm) << 16)), 0))); } static __inline qword si_iohl(qword a, unsigned short imm) { return ((qword)(vec_or((vec_uint4)(a), vec_splat((vec_uint4)(si_from_uint((unsigned int)(imm))), 0)))); } /* No Operation */ #define si_lnop() /* do nothing */ #define si_nop() /* do nothing */ /* Memory Load and Store */ static __inline qword si_lqa(unsigned int imm) { return ((qword)(vec_ld(0, (vector unsigned char *)(imm)))); } static __inline qword si_lqd(qword a, unsigned int imm) { return ((qword)(vec_ld(si_to_uint(a) & ~0xF, (vector unsigned char *)(imm)))); } static __inline qword si_lqr(unsigned int imm) { return ((qword)(vec_ld(0, (vector unsigned char *)(imm)))); } static __inline qword si_lqx(qword a, qword b) { return ((qword)(vec_ld(si_to_uint((qword)(vec_add((vec_uint4)(a), (vec_uint4)(b)))), (vector unsigned char *)(0)))); } static __inline void si_stqa(qword a, unsigned int imm) { vec_st((vec_uchar16)(a), 0, (vector unsigned char *)(imm)); } static __inline void si_stqd(qword a, qword b, unsigned int imm) { vec_st((vec_uchar16)(a), si_to_uint(b) & ~0xF, (vector unsigned char *)(imm)); } static __inline void si_stqr(qword a, unsigned int imm) { vec_st((vec_uchar16)(a), 0, (vector unsigned char *)(imm)); } static __inline void si_stqx(qword a, qword b, qword c) { vec_st((vec_uchar16)(a), si_to_uint((qword)(vec_add((vec_uint4)(b), (vec_uint4)(c)))), (vector unsigned char *)(0)); } #endif /* !__SPU__ */ #endif /* !_SI2VMX_H_ */