1 /* 2 * Copyright (C) 2011 The Android Open Source Project 3 * 4 * Licensed under the Apache License, Version 2.0 (the "License"); 5 * you may not use this file except in compliance with the License. 6 * You may obtain a copy of the License at 7 * 8 * http://www.apache.org/licenses/LICENSE-2.0 9 * 10 * Unless required by applicable law or agreed to in writing, software 11 * distributed under the License is distributed on an "AS IS" BASIS, 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 13 * See the License for the specific language governing permissions and 14 * limitations under the License. 15 */ 16 17 #include <audio_utils/primitives.h> 18 19 void ditherAndClamp(int32_t* out, int32_t const *sums, size_t c) 20 { 21 size_t i; 22 for (i=0 ; i<c ; i++) { 23 int32_t l = *sums++; 24 int32_t r = *sums++; 25 int32_t nl = l >> 12; 26 int32_t nr = r >> 12; 27 l = clamp16(nl); 28 r = clamp16(nr); 29 *out++ = (r<<16) | (l & 0xFFFF); 30 } 31 } 32 33 void memcpy_to_i16_from_u8(int16_t *dst, const uint8_t *src, size_t count) 34 { 35 dst += count; 36 src += count; 37 while (count--) { 38 *--dst = (int16_t)(*--src - 0x80) << 8; 39 } 40 } 41 42 void memcpy_to_u8_from_i16(uint8_t *dst, const int16_t *src, size_t count) 43 { 44 while (count--) { 45 *dst++ = (*src++ >> 8) + 0x80; 46 } 47 } 48 49 void downmix_to_mono_i16_from_stereo_i16(int16_t *dst, const int16_t *src, size_t count) 50 { 51 while (count--) { 52 *dst++ = (int16_t)(((int32_t)src[0] + (int32_t)src[1]) >> 1); 53 src += 2; 54 } 55 } 56 57 void upmix_to_stereo_i16_from_mono_i16(int16_t *dst, const int16_t *src, size_t count) 58 { 59 while (count--) { 60 int32_t temp = *src++; 61 dst[0] = temp; 62 dst[1] = temp; 63 dst += 2; 64 } 65 } 66