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
23static 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
36static 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
43static 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
52static 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
59static 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
68static 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
75static 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
82static 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
91static 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
98static 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
110static 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
117static 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
127static 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
138static 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
148static 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
159static 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
180static 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
187static 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
198static 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
213static 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
224static 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
231static 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
238static 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
291static 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
299static 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
307static 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
315static 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
325static 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