aboutsummaryrefslogtreecommitdiff
path: root/src/flowgraph/SinkI24.cpp
blob: b944b770b5087d3f3ba79b6f25e7fb8ad5bd5c5a (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
/*
 * Copyright 2018 The Android Open Source Project
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *      http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */

#include <algorithm>
#include <unistd.h>


#include "FlowGraphNode.h"
#include "SinkI24.h"

#if FLOWGRAPH_ANDROID_INTERNAL
#include <audio_utils/primitives.h>
#endif

using namespace flowgraph;

SinkI24::SinkI24(int32_t channelCount)
        : FlowGraphSink(channelCount) {}

int32_t SinkI24::read(int64_t framePosition, void *data, int32_t numFrames) {
    uint8_t *byteData = (uint8_t *) data;
    const int32_t channelCount = input.getSamplesPerFrame();

    int32_t framesLeft = numFrames;
    while (framesLeft > 0) {
        // Run the graph and pull data through the input port.
        int32_t framesRead = pullData(framePosition, framesLeft);
        if (framesRead <= 0) {
            break;
        }
        const float *floatData = input.getBuffer();
        int32_t numSamples = framesRead * channelCount;
#if FLOWGRAPH_ANDROID_INTERNAL
        memcpy_to_p24_from_float(byteData, floatData, numSamples);
        static const int kBytesPerI24Packed = 3;
        byteData += numSamples * kBytesPerI24Packed;
        floatData += numSamples;
#else
        const int32_t kI24PackedMax = 0x007FFFFF;
        const int32_t kI24PackedMin = 0xFF800000;
        for (int i = 0; i < numSamples; i++) {
            int32_t n = (int32_t) (*floatData++ * 0x00800000);
            n = std::min(kI24PackedMax, std::max(kI24PackedMin, n)); // clip
            // Write as a packed 24-bit integer in Little Endian format.
            *byteData++ = (uint8_t) n;
            *byteData++ = (uint8_t) (n >> 8);
            *byteData++ = (uint8_t) (n >> 16);
        }
#endif
        framesLeft -= framesRead;
        framePosition += framesRead;
    }
    return numFrames - framesLeft;
}