1 /*
2  * Copyright 2018 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 <algorithm>
18 #include <stdint.h>
19 
20 #ifdef __ANDROID__
21 #include <audio_utils/primitives.h>
22 #endif
23 
24 #include "AudioProcessorBase.h"
25 #include "SinkI24.h"
26 
27 using namespace flowgraph;
28 
SinkI24(int32_t channelCount)29 SinkI24::SinkI24(int32_t channelCount)
30         : AudioSink(channelCount) {}
31 
read(void * data,int32_t numFrames)32 int32_t SinkI24::read(void *data, int32_t numFrames) {
33     uint8_t *byteData = (uint8_t *) data;
34     const int32_t channelCount = input.getSamplesPerFrame();
35 
36     int32_t framesLeft = numFrames;
37     while (framesLeft > 0) {
38         // Run the graph and pull data through the input port.
39         int32_t framesRead = pull(framesLeft);
40         if (framesRead <= 0) {
41             break;
42         }
43         const float *floatData = input.getBlock();
44         int32_t numSamples = framesRead * channelCount;
45 #ifdef __ANDROID__
46         memcpy_to_p24_from_float(byteData, floatData, numSamples);
47         static const int kBytesPerI24Packed = 3;
48         byteData += numSamples * kBytesPerI24Packed;
49         floatData += numSamples;
50 #else
51         const int32_t kI24PackedMax = 0x007FFFFF;
52         const int32_t kI24PackedMin = 0xFF800000;
53         for (int i = 0; i < numSamples; i++) {
54             int32_t n = (int32_t) (*floatData++ * 0x00800000);
55             n = std::min(kI24PackedMax, std::max(kI24PackedMin, n)); // clip
56             // Write as a packed 24-bit integer in Little Endian format.
57             *byteData++ = (uint8_t) n;
58             *byteData++ = (uint8_t) (n >> 8);
59             *byteData++ = (uint8_t) (n >> 16);
60         }
61 #endif
62         framesLeft -= framesRead;
63     }
64     return numFrames - framesLeft;
65 }
66