12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835 |
- #include "config.h"
- #if !PJMEDIA_LIBG7221_FUNCS_INLINED || \
- (PJMEDIA_LIBG7221_FUNCS_INLINED && defined(__BASIC_OP_H__))
- #include "typedef.h"
- #include "basic_op.h"
- #include <pj/assert.h>
- #if (WMOPS)
- #include "count.h"
- extern BASIC_OP multiCounter[MAXCOUNTERS];
- extern int currCounter;
- #endif
- #if INCLUDE_UNSAFE
- Flag g7221_Overflow = 0;
- Flag g7221_Carry = 0;
- #endif
- LIBG7221_DEF(Word16) shr (Word16 var1, Word16 var2)
- {
- if (var2 < 0)
- {
- if (var2 < -16)
- var2 = -16;
- return shl_nocheck(var1, (Word16) -var2);
- }
- else
- {
- return shr_nocheck(var1, var2);
- }
- }
- LIBG7221_DEF(Word16) shl (Word16 var1, Word16 var2)
- {
- if (var2 < 0)
- {
- return shr_nocheck(var1, (Word16) -var2);
- }
- else
- {
- return shl_nocheck(var1, var2);
- }
- }
- LIBG7221_DEF(Word16) mult (Word16 var1, Word16 var2)
- {
- Word16 var_out;
- Word32 L_product;
- L_product = (Word32) var1 *(Word32) var2;
- L_product = (L_product & (Word32) 0xffff8000L) >> 15;
- if (L_product & (Word32) 0x00010000L)
- L_product = L_product | (Word32) 0xffff0000L;
- var_out = saturate (L_product);
- #if (WMOPS)
- multiCounter[currCounter].mult++;
- #endif
- return (var_out);
- }
- LIBG7221_DEF(Word32) L_msu (Word32 L_var3, Word16 var1, Word16 var2)
- {
- Word32 L_var_out;
- Word32 L_product;
- L_product = L_mult (var1, var2);
- #if (WMOPS)
- multiCounter[currCounter].L_mult--;
- #endif
- L_var_out = L_sub (L_var3, L_product);
- #if (WMOPS)
- multiCounter[currCounter].L_sub--;
- multiCounter[currCounter].L_msu++;
- #endif
- return (L_var_out);
- }
- #if INCLUDE_UNSAFE
- LIBG7221_DEF(Word32) L_macNs (Word32 L_var3, Word16 var1, Word16 var2)
- {
- Word32 L_var_out;
- L_var_out = L_mult (var1, var2);
- #if (WMOPS)
- multiCounter[currCounter].L_mult--;
- #endif
- L_var_out = L_add_c (L_var3, L_var_out);
- #if (WMOPS)
- multiCounter[currCounter].L_add_c--;
- multiCounter[currCounter].L_macNs++;
- #endif
- return (L_var_out);
- }
- #endif
- #if INCLUDE_UNSAFE
- LIBG7221_DEF(Word32) L_msuNs (Word32 L_var3, Word16 var1, Word16 var2)
- {
- Word32 L_var_out;
- L_var_out = L_mult (var1, var2);
- #if (WMOPS)
- multiCounter[currCounter].L_mult--;
- #endif
- L_var_out = L_sub_c (L_var3, L_var_out);
- #if (WMOPS)
- multiCounter[currCounter].L_sub_c--;
- multiCounter[currCounter].L_msuNs++;
- #endif
- return (L_var_out);
- }
- #endif
- #if INCLUDE_UNSAFE
- LIBG7221_DEF(Word32) L_add_c (Word32 L_var1, Word32 L_var2)
- {
- Word32 L_var_out;
- Word32 L_test;
- Flag carry_int = 0;
- L_var_out = L_var1 + L_var2 + GET_CARRY();
- L_test = L_var1 + L_var2;
- if ((L_var1 > 0) && (L_var2 > 0) && (L_test < 0))
- {
- SET_OVERFLOW(1);
- carry_int = 0;
- }
- else
- {
- if ((L_var1 < 0) && (L_var2 < 0))
- {
- if (L_test >= 0)
- {
- SET_OVERFLOW(1);
- carry_int = 1;
- }
- else
- {
- SET_OVERFLOW(0);
- carry_int = 1;
- }
- }
- else
- {
- if (((L_var1 ^ L_var2) < 0) && (L_test >= 0))
- {
- SET_OVERFLOW(0);
- carry_int = 1;
- }
- else
- {
- SET_OVERFLOW(0);
- carry_int = 0;
- }
- }
- }
- if (GET_CARRY())
- {
- if (L_test == MAX_32)
- {
- SET_OVERFLOW(1);
- SET_CARRY(carry_int);
- }
- else
- {
- if (L_test == (Word32) 0xFFFFFFFFL)
- {
- SET_CARRY(1);
- }
- else
- {
- SET_CARRY(carry_int);
- }
- }
- }
- else
- {
- SET_CARRY(carry_int);
- }
- #if (WMOPS)
- multiCounter[currCounter].L_add_c++;
- #endif
- return (L_var_out);
- }
- #endif
- #if INCLUDE_UNSAFE
- LIBG7221_DEF(Word32) L_sub_c (Word32 L_var1, Word32 L_var2)
- {
- Word32 L_var_out;
- Word32 L_test;
- Flag carry_int = 0;
- if (GET_CARRY())
- {
- SET_CARRY(0);
- if (L_var2 != MIN_32)
- {
- L_var_out = L_add_c (L_var1, -L_var2);
- #if (WMOPS)
- multiCounter[currCounter].L_add_c--;
- #endif
- }
- else
- {
- L_var_out = L_var1 - L_var2;
- if (L_var1 > 0L)
- {
- SET_OVERFLOW(1);
- SET_CARRY(0);
- }
- }
- }
- else
- {
- L_var_out = L_var1 - L_var2 - (Word32) 0X00000001L;
- L_test = L_var1 - L_var2;
- if ((L_test < 0) && (L_var1 > 0) && (L_var2 < 0))
- {
- SET_OVERFLOW(1);
- carry_int = 0;
- }
- else if ((L_test > 0) && (L_var1 < 0) && (L_var2 > 0))
- {
- SET_OVERFLOW(1);
- carry_int = 1;
- }
- else if ((L_test > 0) && ((L_var1 ^ L_var2) > 0))
- {
- SET_OVERFLOW(0);
- carry_int = 1;
- }
- if (L_test == MIN_32)
- {
- SET_OVERFLOW(1);
- SET_CARRY(carry_int);
- }
- else
- {
- SET_CARRY(carry_int);
- }
- }
- #if (WMOPS)
- multiCounter[currCounter].L_sub_c++;
- #endif
- return (L_var_out);
- }
- #endif
- LIBG7221_DEF(Word32) L_negate (Word32 L_var1)
- {
- Word32 L_var_out;
- L_var_out = (L_var1 == MIN_32) ? MAX_32 : -L_var1;
- #if (WMOPS)
- multiCounter[currCounter].L_negate++;
- #endif
- return (L_var_out);
- }
- LIBG7221_DEF(Word16) mult_r (Word16 var1, Word16 var2)
- {
- Word16 var_out;
- Word32 L_product_arr;
- L_product_arr = (Word32) var1 *(Word32) var2;
- L_product_arr += (Word32) 0x00004000L;
- L_product_arr &= (Word32) 0xffff8000L;
- L_product_arr >>= 15;
- if (L_product_arr & (Word32) 0x00010000L)
- {
- L_product_arr |= (Word32) 0xffff0000L;
- }
- var_out = saturate (L_product_arr);
- #if (WMOPS)
- multiCounter[currCounter].mult_r++;
- #endif
- return (var_out);
- }
- LIBG7221_DEF(Word16) shr_r (Word16 var1, Word16 var2)
- {
- Word16 var_out;
- if (var2 > 15)
- {
- var_out = 0;
- }
- else
- {
- var_out = shr (var1, var2);
- #if (WMOPS)
- multiCounter[currCounter].shr--;
- #endif
- if (var2 > 0)
- {
- if ((var1 & ((Word16) 1 << (var2 - 1))) != 0)
- {
- var_out++;
- }
- }
- }
- #if (WMOPS)
- multiCounter[currCounter].shr_r++;
- #endif
- return (var_out);
- }
- LIBG7221_DEF(Word16) mac_r (Word32 L_var3, Word16 var1, Word16 var2)
- {
- Word16 var_out;
- L_var3 = L_mac (L_var3, var1, var2);
- #if (WMOPS)
- multiCounter[currCounter].L_mac--;
- #endif
- L_var3 = L_add (L_var3, (Word32) 0x00008000L);
- #if (WMOPS)
- multiCounter[currCounter].L_add--;
- #endif
- var_out = extract_h (L_var3);
- #if (WMOPS)
- multiCounter[currCounter].extract_h--;
- multiCounter[currCounter].mac_r++;
- #endif
- return (var_out);
- }
- LIBG7221_DEF(Word16) msu_r (Word32 L_var3, Word16 var1, Word16 var2)
- {
- Word16 var_out;
- L_var3 = L_msu (L_var3, var1, var2);
- #if (WMOPS)
- multiCounter[currCounter].L_msu--;
- #endif
- L_var3 = L_add (L_var3, (Word32) 0x00008000L);
- #if (WMOPS)
- multiCounter[currCounter].L_add--;
- #endif
- var_out = extract_h (L_var3);
- #if (WMOPS)
- multiCounter[currCounter].extract_h--;
- multiCounter[currCounter].msu_r++;
- #endif
- return (var_out);
- }
- LIBG7221_DEF(Word32) L_deposit_h (Word16 var1)
- {
- Word32 L_var_out;
- L_var_out = (Word32) var1 << 16;
- #if (WMOPS)
- multiCounter[currCounter].L_deposit_h++;
- #endif
- return (L_var_out);
- }
- LIBG7221_DEF(Word32) L_deposit_l (Word16 var1)
- {
- Word32 L_var_out;
- L_var_out = (Word32) var1;
- #if (WMOPS)
- multiCounter[currCounter].L_deposit_l++;
- #endif
- return (L_var_out);
- }
- LIBG7221_DEF(Word32) L_shr_r (Word32 L_var1, Word16 var2)
- {
- Word32 L_var_out;
- if (var2 > 31)
- {
- L_var_out = 0;
- }
- else
- {
- L_var_out = L_shr (L_var1, var2);
- #if (WMOPS)
- multiCounter[currCounter].L_shr--;
- #endif
- if (var2 > 0)
- {
- if ((L_var1 & ((Word32) 1 << (var2 - 1))) != 0)
- {
- L_var_out++;
- }
- }
- }
- #if (WMOPS)
- multiCounter[currCounter].L_shr_r++;
- #endif
- return (L_var_out);
- }
- LIBG7221_DEF(Word32) L_abs (Word32 L_var1)
- {
- Word32 L_var_out;
- if (L_var1 == MIN_32)
- {
- L_var_out = MAX_32;
- }
- else
- {
- if (L_var1 < 0)
- {
- L_var_out = -L_var1;
- }
- else
- {
- L_var_out = L_var1;
- }
- }
- #if (WMOPS)
- multiCounter[currCounter].L_abs++;
- #endif
- return (L_var_out);
- }
- LIBG7221_DEF(Word16) norm_s (Word16 var1)
- {
- Word16 var_out;
- if (var1 == 0)
- {
- var_out = 0;
- }
- else
- {
- if ((UWord16)var1 == (UWord16)0xffff)
- {
- var_out = 15;
- }
- else
- {
- if (var1 < 0)
- {
- var1 = (Word16)(~var1);
- }
- for (var_out = 0; var1 < 0x4000; var_out++)
- {
- var1 <<= 1;
- }
- }
- }
- #if (WMOPS)
- multiCounter[currCounter].norm_s++;
- #endif
- return (var_out);
- }
- LIBG7221_DEF(Word16) div_s (Word16 var1, Word16 var2)
- {
- Word16 var_out = 0;
- Word16 iteration;
- Word32 L_num;
- Word32 L_denom;
- if ((var1 > var2) || (var1 < 0) || (var2 < 0))
- {
-
-
- pj_assert(!"Division Error");
- }
- if (var2 == 0)
- {
-
-
- assert(!"Division by 0");
- }
- if (var1 == 0)
- {
- var_out = 0;
- }
- else
- {
- if (var1 == var2)
- {
- var_out = MAX_16;
- }
- else
- {
- L_num = L_deposit_l (var1);
- #if (WMOPS)
- multiCounter[currCounter].L_deposit_l--;
- #endif
- L_denom = L_deposit_l (var2);
- #if (WMOPS)
- multiCounter[currCounter].L_deposit_l--;
- #endif
- for (iteration = 0; iteration < 15; iteration++)
- {
- var_out <<= 1;
- L_num <<= 1;
- if (L_num >= L_denom)
- {
- L_num = L_sub (L_num, L_denom);
- #if (WMOPS)
- multiCounter[currCounter].L_sub--;
- #endif
- var_out = add (var_out, 1);
- #if (WMOPS)
- multiCounter[currCounter].add--;
- #endif
- }
- }
- }
- }
- #if (WMOPS)
- multiCounter[currCounter].div_s++;
- #endif
- return (var_out);
- }
- LIBG7221_DEF(Word16) norm_l (Word32 L_var1)
- {
- Word16 var_out;
- if (L_var1 == 0)
- {
- var_out = 0;
- }
- else
- {
- if (L_var1 == (Word32) 0xffffffffL)
- {
- var_out = 31;
- }
- else
- {
- if (L_var1 < 0)
- {
- L_var1 = ~L_var1;
- }
- for (var_out = 0; L_var1 < (Word32) 0x40000000L; var_out++)
- {
- L_var1 <<= 1;
- }
- }
- }
- #if (WMOPS)
- multiCounter[currCounter].norm_l++;
- #endif
- return (var_out);
- }
- LIBG7221_DEF(Word32) L_mls (Word32 Lv, Word16 v)
- {
- Word32 Temp ;
- Temp = Lv & (Word32) 0x0000ffff ;
- Temp = Temp * (Word32) v ;
- Temp = L_shr_nocheck( Temp, (Word16) 15 ) ;
- Temp = L_mac( Temp, v, extract_h(Lv) ) ;
- #if (WMOPS)
- multiCounter[currCounter].L_shr--;
- multiCounter[currCounter].L_mac--;
- multiCounter[currCounter].extract_h--;
- multiCounter[currCounter].L_mls++;
- #endif
- return Temp ;
- }
- LIBG7221_DEF(Word16) div_l (Word32 L_num, Word16 den)
- {
- Word16 var_out = (Word16)0;
- Word32 L_den;
- Word16 iteration;
- #if (WMOPS)
- multiCounter[currCounter].div_l++;
- #endif
- if ( den == (Word16) 0 ) {
-
-
- assert(!"Division by 0");
- }
- if ( (L_num < (Word32) 0) || (den < (Word16) 0) ) {
-
-
- assert(!"Division Error");
- }
- L_den = L_deposit_h( den ) ;
- #if (WMOPS)
- multiCounter[currCounter].L_deposit_h--;
- #endif
- if ( L_num >= L_den ){
- return MAX_16 ;
- }
- else {
- L_num = L_shr_nocheck(L_num, (Word16)1) ;
- L_den = L_shr_nocheck(L_den, (Word16)1);
- #if (WMOPS)
- multiCounter[currCounter].L_shr-=2;
- #endif
- for(iteration=(Word16)0; iteration< (Word16)15;iteration++) {
- var_out = shl_nocheck( var_out, (Word16)1);
- L_num = L_shl_nocheck( L_num, (Word16)1);
- #if (WMOPS)
- multiCounter[currCounter].shl--;
- multiCounter[currCounter].L_shl--;
- #endif
- if (L_num >= L_den) {
- L_num = L_sub(L_num,L_den);
- var_out = add(var_out, (Word16)1);
- #if (WMOPS)
- multiCounter[currCounter].L_sub--;
- multiCounter[currCounter].add--;
- #endif
- }
- }
- return var_out;
- }
- }
- LIBG7221_DEF(Word16) i_mult (Word16 a, Word16 b)
- {
- #ifdef ORIGINAL_G7231
- return a*b ;
- #else
- register Word32 c=a*b;
- #if (WMOPS)
- multiCounter[currCounter].i_mult++;
- #endif
- return saturate(c) ;
- #endif
- }
- LIBG7221_DEF(Word32) L_mult0 (Word16 var1,Word16 var2)
- {
- Word32 L_var_out;
- L_var_out = (Word32)var1 * (Word32)var2;
- #if (WMOPS)
- multiCounter[currCounter].L_mult0++;
- #endif
- return(L_var_out);
- }
- LIBG7221_DEF(Word32) L_mac0 (Word32 L_var3, Word16 var1, Word16 var2)
- {
- Word32 L_var_out;
- Word32 L_product;
- L_product = L_mult0(var1,var2);
- L_var_out = L_add(L_var3,L_product);
- #if (WMOPS)
- multiCounter[currCounter].L_mac0++;
- multiCounter[currCounter].L_mult0--;
- multiCounter[currCounter].L_add--;
- #endif
- return(L_var_out);
- }
- LIBG7221_DEF(Word32) L_msu0 (Word32 L_var3, Word16 var1, Word16 var2)
- {
- Word32 L_var_out;
- Word32 L_product;
- L_product = L_mult0(var1,var2);
- L_var_out = L_sub(L_var3,L_product);
- #if (WMOPS)
- multiCounter[currCounter].L_msu0++;
- multiCounter[currCounter].L_mult0--;
- multiCounter[currCounter].L_sub--;
- #endif
- return(L_var_out);
- }
- LIBG7221_DEF(UWord32) LU_shl (UWord32 L_var1, Word16 var2)
- {
- Word16 neg_var2;
- UWord32 L_var_out = 0;
- if (var2 <= 0)
- {
- if (var2 < -32)
- var2 = -32;
- neg_var2 = negate(var2);
- L_var_out = LU_shr (L_var1, neg_var2);
- #if (WMOPS)
- multiCounter[currCounter].negate--;
- multiCounter[currCounter].LU_shr--;
- #endif
- }
- else
- {
- for (; var2 > 0; var2--)
- {
- if (L_var1 > (UWord32) 0X7fffffffL)
- {
- SET_OVERFLOW(1);
- L_var_out = UMAX_32;
- break;
- }
- else
- {
- if (L_var1 < (UWord32) 0x00000001L)
- {
- SET_OVERFLOW(1);
- L_var_out = (UWord32)MIN_32;
- break;
- }
- }
- L_var1 *= 2;
- L_var_out = L_var1;
- }
- }
- #if (WMOPS)
- multiCounter[currCounter].LU_shl++;
- #endif
- return (L_var_out);
- }
- LIBG7221_DEF(UWord32) LU_shr (UWord32 L_var1, Word16 var2)
- {
- Word16 neg_var2;
- UWord32 L_var_out;
- if (var2 < 0)
- {
- if (var2 < -32)
- var2 = -32;
- neg_var2 = negate(var2);
- L_var_out = LU_shl (L_var1, neg_var2);
- #if (WMOPS)
- multiCounter[currCounter].negate--;
- multiCounter[currCounter].LU_shl--;
- #endif
- }
- else
- {
- if (var2 >= 32)
- {
- L_var_out = 0L;
- }
- else
- {
- L_var_out = L_var1 >> var2;
- }
- }
- #if (WMOPS)
- multiCounter[currCounter].LU_shr++;
- #endif
- return (L_var_out);
- }
- #endif
|