1 /****************************************************************************** 2 * * 3 * Copyright (C) 2018 The Android Open Source Project 4 * 5 * Licensed under the Apache License, Version 2.0 (the "License"); 6 * you may not use this file except in compliance with the License. 7 * You may obtain a copy of the License at: 8 * 9 * http://www.apache.org/licenses/LICENSE-2.0 10 * 11 * Unless required by applicable law or agreed to in writing, software 12 * distributed under the License is distributed on an "AS IS" BASIS, 13 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 14 * See the License for the specific language governing permissions and 15 * limitations under the License. 16 * 17 ***************************************************************************** 18 * Originally developed and contributed by Ittiam Systems Pvt. Ltd, Bangalore 19 */ 20 #ifndef IXHEAACD_BASIC_OPS16_H 21 #define IXHEAACD_BASIC_OPS16_H 22 23 static PLATFORM_INLINE WORD16 ixheaacd_sat16(WORD32 op1) { 24 WORD16 var_out; 25 26 if (op1 > 0X00007fffL) { 27 var_out = MAX_16; 28 } else if (op1 < (WORD32)0xffff8000L) { 29 var_out = (WORD16)(-32768); 30 } else { 31 var_out = (WORD16)(op1); 32 } 33 return (var_out); 34 } 35 36 static PLATFORM_INLINE WORD16 ixheaacd_add16(WORD16 op1, WORD16 op2) { 37 WORD16 var_out; 38 39 var_out = ((WORD16)(op1 + op2)); 40 return (var_out); 41 } 42 43 static PLATFORM_INLINE WORD16 ixheaacd_add16_sat(WORD16 op1, WORD16 op2) { 44 WORD16 var_out; 45 WORD32 sum; 46 47 sum = (WORD32)op1 + (WORD32)op2; 48 var_out = ixheaacd_sat16(sum); 49 return (var_out); 50 } 51 52 static PLATFORM_INLINE WORD16 ixheaacd_sub16(WORD16 op1, WORD16 op2) { 53 WORD16 var_out; 54 55 var_out = ((WORD16)(op1 - op2)); 56 return (var_out); 57 } 58 59 static PLATFORM_INLINE WORD16 ixheaacd_sub16_sat(WORD16 op1, WORD16 op2) { 60 WORD16 var_out; 61 WORD32 diff; 62 63 diff = (WORD32)op1 - op2; 64 var_out = ixheaacd_sat16(diff); 65 return (var_out); 66 } 67 68 static PLATFORM_INLINE WORD16 ixheaacd_mult16(WORD16 op1, WORD16 op2) { 69 WORD16 var_out; 70 71 var_out = ((WORD16)(((WORD32)op1 * (WORD32)op2) >> 16)); 72 return (var_out); 73 } 74 75 static PLATFORM_INLINE WORD16 ixheaacd_mult16_shl(WORD16 op1, WORD16 op2) { 76 WORD16 var_out; 77 78 var_out = ((WORD16)(((WORD32)op1 * (WORD32)op2) >> 15)); 79 return (var_out); 80 } 81 82 static PLATFORM_INLINE WORD16 ixheaacd_mult16_shl_sat(WORD16 op1, WORD16 op2) { 83 WORD16 var_out; 84 WORD32 temp; 85 86 temp = ((WORD32)(((WORD32)op1 * (WORD32)op2) >> 15)); 87 var_out = ixheaacd_sat16(temp); 88 return (var_out); 89 } 90 91 static PLATFORM_INLINE WORD16 ixheaacd_shl16(WORD16 op1, WORD16 shift) { 92 WORD16 var_out; 93 94 var_out = (WORD16)(op1 << shift); 95 return (var_out); 96 } 97 98 static PLATFORM_INLINE WORD16 ixheaacd_shl16_sat(WORD16 op1, WORD16 shift) { 99 WORD16 var_out; 100 WORD32 temp; 101 102 if (shift > 15) { 103 shift = 15; 104 } 105 temp = (WORD32)(op1 << shift); 106 var_out = ixheaacd_sat16(temp); 107 return (var_out); 108 } 109 110 static PLATFORM_INLINE WORD16 ixheaacd_shr16(WORD16 op1, WORD16 shift) { 111 WORD16 var_out; 112 113 var_out = ((WORD16)(op1 >> shift)); 114 return (var_out); 115 } 116 117 static PLATFORM_INLINE WORD16 shl16_dir(WORD16 op1, WORD16 shift) { 118 WORD16 var_out; 119 if (shift > 0) { 120 var_out = ixheaacd_shl16(op1, shift); 121 } else { 122 var_out = ixheaacd_shr16(op1, (WORD16)(-shift)); 123 } 124 return (var_out); 125 } 126 127 static PLATFORM_INLINE WORD16 shr16_dir(WORD16 op1, WORD16 shift) { 128 WORD16 var_out; 129 130 if (shift < 0) { 131 var_out = ixheaacd_shl16(op1, (WORD16)(-shift)); 132 } else { 133 var_out = ixheaacd_shr16(op1, shift); 134 } 135 return (var_out); 136 } 137 138 static PLATFORM_INLINE WORD16 shl16_dir_sat(WORD16 op1, WORD16 shift) { 139 WORD16 var_out; 140 if (shift > 0) { 141 var_out = ixheaacd_shl16_sat(op1, shift); 142 } else { 143 var_out = ixheaacd_shr16(op1, (WORD16)(-shift)); 144 } 145 return (var_out); 146 } 147 148 static PLATFORM_INLINE WORD16 ixheaacd_shr16_dir_sat(WORD16 op1, WORD16 shift) { 149 WORD16 var_out; 150 151 if (shift < 0) { 152 var_out = ixheaacd_shl16_sat(op1, (WORD16)(-shift)); 153 } else { 154 var_out = ixheaacd_shr16(op1, shift); 155 } 156 return (var_out); 157 } 158 159 static PLATFORM_INLINE WORD16 norm16(WORD16 op1) { 160 WORD16 var_out; 161 162 if (0 == op1) { 163 var_out = 0; 164 } else { 165 if ((WORD16)0xffff == op1) { 166 var_out = 15; 167 } else { 168 if (op1 < 0) { 169 op1 = (WORD16)(~op1); 170 } 171 for (var_out = 0; op1 < 0x4000; var_out++) { 172 op1 <<= 1; 173 } 174 } 175 } 176 177 return (var_out); 178 } 179 180 static PLATFORM_INLINE WORD16 bin_expo16(WORD16 op1) { 181 WORD16 var_out; 182 183 var_out = ((WORD16)(15 - norm16(op1))); 184 return (var_out); 185 } 186 187 static PLATFORM_INLINE WORD16 ixheaacd_abs16(WORD16 op1) { 188 WORD16 var_out; 189 190 if (op1 < 0) { 191 var_out = (WORD16)(-op1); 192 } else { 193 var_out = op1; 194 } 195 return (var_out); 196 } 197 198 static PLATFORM_INLINE WORD16 ixheaacd_abs16_sat(WORD16 op1) { 199 WORD16 var_out; 200 201 if (-32768 == op1) { 202 var_out = MAX_16; 203 } else { 204 if (op1 < 0) { 205 var_out = (WORD16)(-op1); 206 } else { 207 var_out = op1; 208 } 209 } 210 return (var_out); 211 } 212 213 static PLATFORM_INLINE WORD16 ixheaacd_negate16(WORD16 op1) { 214 WORD16 var_out; 215 216 if (-32768 == op1) { 217 var_out = MAX_16; 218 } else { 219 var_out = (WORD16)(-op1); 220 } 221 return (var_out); 222 } 223 224 static PLATFORM_INLINE WORD16 ixheaacd_min16(WORD16 op1, WORD16 op2) { 225 WORD16 var_out; 226 227 var_out = op1 < op2 ? op1 : op2; 228 return (var_out); 229 } 230 231 static PLATFORM_INLINE WORD16 ixheaacd_max16(WORD16 op1, WORD16 op2) { 232 WORD16 var_out; 233 234 var_out = op1 > op2 ? op1 : op2; 235 return (var_out); 236 } 237 238 static PLATFORM_INLINE WORD16 div16(WORD16 op1, WORD16 op2, WORD16 *q_format) { 239 WORD32 quotient; 240 UWORD16 mantissa_nr, mantissa_dr; 241 WORD16 sign = 0; 242 243 LOOPIDX i; 244 WORD16 q_nr, q_dr; 245 246 mantissa_nr = op1; 247 mantissa_dr = op2; 248 quotient = 0; 249 250 if (op1 < 0 && op2 != 0) { 251 op1 = -op1; 252 sign = (WORD16)(sign ^ -1); 253 } 254 255 if (op2 < 0) { 256 op2 = -op2; 257 sign = (WORD16)(sign ^ -1); 258 } 259 260 if (op2 == 0) { 261 *q_format = 0; 262 return (op1); 263 } 264 265 quotient = 0; 266 267 q_nr = norm16(op1); 268 mantissa_nr = (UWORD16)op1 << (q_nr); 269 q_dr = norm16(op2); 270 mantissa_dr = (UWORD16)op2 << (q_dr); 271 *q_format = (WORD16)(14 + q_nr - q_dr); 272 273 for (i = 0; i < 15; i++) { 274 quotient = quotient << 1; 275 276 if (mantissa_nr >= mantissa_dr) { 277 mantissa_nr = mantissa_nr - mantissa_dr; 278 quotient += 1; 279 } 280 281 mantissa_nr = (UWORD32)mantissa_nr << 1; 282 } 283 284 if (sign < 0) { 285 quotient = -quotient; 286 } 287 288 return (WORD16)quotient; 289 } 290 291 static PLATFORM_INLINE WORD16 mac16(WORD16 c, WORD16 op1, WORD16 op2) { 292 WORD16 var_out; 293 294 var_out = ixheaacd_mult16(op1, op2); 295 var_out = ixheaacd_add16(c, var_out); 296 return (var_out); 297 } 298 299 static PLATFORM_INLINE WORD16 mac16_sat(WORD16 c, WORD16 op1, WORD16 op2) { 300 WORD16 var_out; 301 302 var_out = ixheaacd_mult16(op1, op2); 303 var_out = ixheaacd_add16_sat(c, var_out); 304 return (var_out); 305 } 306 307 static PLATFORM_INLINE WORD16 mac16_shl(WORD16 c, WORD16 op1, WORD16 op2) { 308 WORD16 var_out; 309 310 var_out = ixheaacd_mult16_shl(op1, op2); 311 var_out = ixheaacd_add16(c, var_out); 312 return (var_out); 313 } 314 315 static PLATFORM_INLINE WORD16 mac16_shl_sat(WORD16 c, WORD16 op1, WORD16 op2) { 316 WORD16 var_out; 317 WORD32 temp; 318 319 temp = ((WORD32)op1 * (WORD32)op2) >> 15; 320 temp += c; 321 var_out = ixheaacd_sat16(temp); 322 return (var_out); 323 } 324 325 static PLATFORM_INLINE WORD16 ixheaacd_round16(WORD32 op1) { 326 WORD16 var_out; 327 328 var_out = (WORD16)(ixheaacd_add32_sat(op1, 0x8000) >> 16); 329 return (var_out); 330 } 331 #endif 332
