1*ec779b8eSAndroid Build Coastguard Worker /*
2*ec779b8eSAndroid Build Coastguard Worker * Copyright (C) 2010 The Android Open Source Project
3*ec779b8eSAndroid Build Coastguard Worker *
4*ec779b8eSAndroid Build Coastguard Worker * Licensed under the Apache License, Version 2.0 (the "License");
5*ec779b8eSAndroid Build Coastguard Worker * you may not use this file except in compliance with the License.
6*ec779b8eSAndroid Build Coastguard Worker * You may obtain a copy of the License at
7*ec779b8eSAndroid Build Coastguard Worker *
8*ec779b8eSAndroid Build Coastguard Worker * http://www.apache.org/licenses/LICENSE-2.0
9*ec779b8eSAndroid Build Coastguard Worker *
10*ec779b8eSAndroid Build Coastguard Worker * Unless required by applicable law or agreed to in writing, software
11*ec779b8eSAndroid Build Coastguard Worker * distributed under the License is distributed on an "AS IS" BASIS,
12*ec779b8eSAndroid Build Coastguard Worker * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13*ec779b8eSAndroid Build Coastguard Worker * See the License for the specific language governing permissions and
14*ec779b8eSAndroid Build Coastguard Worker * limitations under the License.
15*ec779b8eSAndroid Build Coastguard Worker */
16*ec779b8eSAndroid Build Coastguard Worker
17*ec779b8eSAndroid Build Coastguard Worker #include "ABitReader.h"
18*ec779b8eSAndroid Build Coastguard Worker
19*ec779b8eSAndroid Build Coastguard Worker #include <media/stagefright/foundation/ADebug.h>
20*ec779b8eSAndroid Build Coastguard Worker
21*ec779b8eSAndroid Build Coastguard Worker namespace android {
22*ec779b8eSAndroid Build Coastguard Worker
ABitReader(const uint8_t * data,size_t size)23*ec779b8eSAndroid Build Coastguard Worker ABitReader::ABitReader(const uint8_t *data, size_t size)
24*ec779b8eSAndroid Build Coastguard Worker : mData(data),
25*ec779b8eSAndroid Build Coastguard Worker mSize(size),
26*ec779b8eSAndroid Build Coastguard Worker mReservoir(0),
27*ec779b8eSAndroid Build Coastguard Worker mNumBitsLeft(0),
28*ec779b8eSAndroid Build Coastguard Worker mOverRead(false) {
29*ec779b8eSAndroid Build Coastguard Worker }
30*ec779b8eSAndroid Build Coastguard Worker
~ABitReader()31*ec779b8eSAndroid Build Coastguard Worker ABitReader::~ABitReader() {
32*ec779b8eSAndroid Build Coastguard Worker }
33*ec779b8eSAndroid Build Coastguard Worker
fillReservoir()34*ec779b8eSAndroid Build Coastguard Worker bool ABitReader::fillReservoir() {
35*ec779b8eSAndroid Build Coastguard Worker if (mSize == 0) {
36*ec779b8eSAndroid Build Coastguard Worker mOverRead = true;
37*ec779b8eSAndroid Build Coastguard Worker return false;
38*ec779b8eSAndroid Build Coastguard Worker }
39*ec779b8eSAndroid Build Coastguard Worker
40*ec779b8eSAndroid Build Coastguard Worker mReservoir = 0;
41*ec779b8eSAndroid Build Coastguard Worker size_t i;
42*ec779b8eSAndroid Build Coastguard Worker for (i = 0; mSize > 0 && i < 4; ++i) {
43*ec779b8eSAndroid Build Coastguard Worker mReservoir = (mReservoir << 8) | *mData;
44*ec779b8eSAndroid Build Coastguard Worker
45*ec779b8eSAndroid Build Coastguard Worker ++mData;
46*ec779b8eSAndroid Build Coastguard Worker --mSize;
47*ec779b8eSAndroid Build Coastguard Worker }
48*ec779b8eSAndroid Build Coastguard Worker
49*ec779b8eSAndroid Build Coastguard Worker mNumBitsLeft = 8 * i;
50*ec779b8eSAndroid Build Coastguard Worker mReservoir <<= 32 - mNumBitsLeft;
51*ec779b8eSAndroid Build Coastguard Worker return true;
52*ec779b8eSAndroid Build Coastguard Worker }
53*ec779b8eSAndroid Build Coastguard Worker
getBits(size_t n)54*ec779b8eSAndroid Build Coastguard Worker uint32_t ABitReader::getBits(size_t n) {
55*ec779b8eSAndroid Build Coastguard Worker uint32_t ret;
56*ec779b8eSAndroid Build Coastguard Worker CHECK(getBitsGraceful(n, &ret));
57*ec779b8eSAndroid Build Coastguard Worker return ret;
58*ec779b8eSAndroid Build Coastguard Worker }
59*ec779b8eSAndroid Build Coastguard Worker
getBitsWithFallback(size_t n,uint32_t fallback)60*ec779b8eSAndroid Build Coastguard Worker uint32_t ABitReader::getBitsWithFallback(size_t n, uint32_t fallback) {
61*ec779b8eSAndroid Build Coastguard Worker uint32_t ret = fallback;
62*ec779b8eSAndroid Build Coastguard Worker (void)getBitsGraceful(n, &ret);
63*ec779b8eSAndroid Build Coastguard Worker return ret;
64*ec779b8eSAndroid Build Coastguard Worker }
65*ec779b8eSAndroid Build Coastguard Worker
getBitsGraceful(size_t n,uint32_t * out)66*ec779b8eSAndroid Build Coastguard Worker bool ABitReader::getBitsGraceful(size_t n, uint32_t *out) {
67*ec779b8eSAndroid Build Coastguard Worker if (n > 32) {
68*ec779b8eSAndroid Build Coastguard Worker return false;
69*ec779b8eSAndroid Build Coastguard Worker }
70*ec779b8eSAndroid Build Coastguard Worker
71*ec779b8eSAndroid Build Coastguard Worker uint32_t result = 0;
72*ec779b8eSAndroid Build Coastguard Worker while (n > 0) {
73*ec779b8eSAndroid Build Coastguard Worker if (mNumBitsLeft == 0) {
74*ec779b8eSAndroid Build Coastguard Worker if (!fillReservoir()) {
75*ec779b8eSAndroid Build Coastguard Worker return false;
76*ec779b8eSAndroid Build Coastguard Worker }
77*ec779b8eSAndroid Build Coastguard Worker }
78*ec779b8eSAndroid Build Coastguard Worker
79*ec779b8eSAndroid Build Coastguard Worker size_t m = n;
80*ec779b8eSAndroid Build Coastguard Worker if (m > mNumBitsLeft) {
81*ec779b8eSAndroid Build Coastguard Worker m = mNumBitsLeft;
82*ec779b8eSAndroid Build Coastguard Worker }
83*ec779b8eSAndroid Build Coastguard Worker
84*ec779b8eSAndroid Build Coastguard Worker result = (result << m) | (mReservoir >> (32 - m));
85*ec779b8eSAndroid Build Coastguard Worker mReservoir <<= m;
86*ec779b8eSAndroid Build Coastguard Worker mNumBitsLeft -= m;
87*ec779b8eSAndroid Build Coastguard Worker
88*ec779b8eSAndroid Build Coastguard Worker n -= m;
89*ec779b8eSAndroid Build Coastguard Worker }
90*ec779b8eSAndroid Build Coastguard Worker
91*ec779b8eSAndroid Build Coastguard Worker *out = result;
92*ec779b8eSAndroid Build Coastguard Worker return true;
93*ec779b8eSAndroid Build Coastguard Worker }
94*ec779b8eSAndroid Build Coastguard Worker
skipBits(size_t n)95*ec779b8eSAndroid Build Coastguard Worker bool ABitReader::skipBits(size_t n) {
96*ec779b8eSAndroid Build Coastguard Worker uint32_t dummy;
97*ec779b8eSAndroid Build Coastguard Worker while (n > 32) {
98*ec779b8eSAndroid Build Coastguard Worker if (!getBitsGraceful(32, &dummy)) {
99*ec779b8eSAndroid Build Coastguard Worker return false;
100*ec779b8eSAndroid Build Coastguard Worker }
101*ec779b8eSAndroid Build Coastguard Worker n -= 32;
102*ec779b8eSAndroid Build Coastguard Worker }
103*ec779b8eSAndroid Build Coastguard Worker
104*ec779b8eSAndroid Build Coastguard Worker if (n > 0) {
105*ec779b8eSAndroid Build Coastguard Worker return getBitsGraceful(n, &dummy);
106*ec779b8eSAndroid Build Coastguard Worker }
107*ec779b8eSAndroid Build Coastguard Worker return true;
108*ec779b8eSAndroid Build Coastguard Worker }
109*ec779b8eSAndroid Build Coastguard Worker
putBits(uint32_t x,size_t n)110*ec779b8eSAndroid Build Coastguard Worker void ABitReader::putBits(uint32_t x, size_t n) {
111*ec779b8eSAndroid Build Coastguard Worker if (mOverRead) {
112*ec779b8eSAndroid Build Coastguard Worker return;
113*ec779b8eSAndroid Build Coastguard Worker }
114*ec779b8eSAndroid Build Coastguard Worker
115*ec779b8eSAndroid Build Coastguard Worker CHECK_LE(n, 32u);
116*ec779b8eSAndroid Build Coastguard Worker
117*ec779b8eSAndroid Build Coastguard Worker while (mNumBitsLeft + n > 32) {
118*ec779b8eSAndroid Build Coastguard Worker mNumBitsLeft -= 8;
119*ec779b8eSAndroid Build Coastguard Worker --mData;
120*ec779b8eSAndroid Build Coastguard Worker ++mSize;
121*ec779b8eSAndroid Build Coastguard Worker }
122*ec779b8eSAndroid Build Coastguard Worker
123*ec779b8eSAndroid Build Coastguard Worker mReservoir = (mReservoir >> n) | (x << (32 - n));
124*ec779b8eSAndroid Build Coastguard Worker mNumBitsLeft += n;
125*ec779b8eSAndroid Build Coastguard Worker }
126*ec779b8eSAndroid Build Coastguard Worker
numBitsLeft() const127*ec779b8eSAndroid Build Coastguard Worker size_t ABitReader::numBitsLeft() const {
128*ec779b8eSAndroid Build Coastguard Worker return mSize * 8 + mNumBitsLeft;
129*ec779b8eSAndroid Build Coastguard Worker }
130*ec779b8eSAndroid Build Coastguard Worker
data() const131*ec779b8eSAndroid Build Coastguard Worker const uint8_t *ABitReader::data() const {
132*ec779b8eSAndroid Build Coastguard Worker return mData - (mNumBitsLeft + 7) / 8;
133*ec779b8eSAndroid Build Coastguard Worker }
134*ec779b8eSAndroid Build Coastguard Worker
NALBitReader(const uint8_t * data,size_t size)135*ec779b8eSAndroid Build Coastguard Worker NALBitReader::NALBitReader(const uint8_t *data, size_t size)
136*ec779b8eSAndroid Build Coastguard Worker : ABitReader(data, size),
137*ec779b8eSAndroid Build Coastguard Worker mNumZeros(0) {
138*ec779b8eSAndroid Build Coastguard Worker }
139*ec779b8eSAndroid Build Coastguard Worker
atLeastNumBitsLeft(size_t n) const140*ec779b8eSAndroid Build Coastguard Worker bool NALBitReader::atLeastNumBitsLeft(size_t n) const {
141*ec779b8eSAndroid Build Coastguard Worker // check against raw size and reservoir bits first
142*ec779b8eSAndroid Build Coastguard Worker size_t numBits = numBitsLeft();
143*ec779b8eSAndroid Build Coastguard Worker if (n > numBits) {
144*ec779b8eSAndroid Build Coastguard Worker return false;
145*ec779b8eSAndroid Build Coastguard Worker }
146*ec779b8eSAndroid Build Coastguard Worker
147*ec779b8eSAndroid Build Coastguard Worker ssize_t numBitsRemaining = (ssize_t)n - (ssize_t)mNumBitsLeft;
148*ec779b8eSAndroid Build Coastguard Worker
149*ec779b8eSAndroid Build Coastguard Worker size_t size = mSize;
150*ec779b8eSAndroid Build Coastguard Worker const uint8_t *data = mData;
151*ec779b8eSAndroid Build Coastguard Worker int32_t numZeros = mNumZeros;
152*ec779b8eSAndroid Build Coastguard Worker while (size > 0 && numBitsRemaining > 0) {
153*ec779b8eSAndroid Build Coastguard Worker bool isEmulationPreventionByte = (numZeros >= 2 && *data == 3);
154*ec779b8eSAndroid Build Coastguard Worker
155*ec779b8eSAndroid Build Coastguard Worker if (*data == 0) {
156*ec779b8eSAndroid Build Coastguard Worker ++numZeros;
157*ec779b8eSAndroid Build Coastguard Worker } else {
158*ec779b8eSAndroid Build Coastguard Worker numZeros = 0;
159*ec779b8eSAndroid Build Coastguard Worker }
160*ec779b8eSAndroid Build Coastguard Worker
161*ec779b8eSAndroid Build Coastguard Worker if (!isEmulationPreventionByte) {
162*ec779b8eSAndroid Build Coastguard Worker numBitsRemaining -= 8;
163*ec779b8eSAndroid Build Coastguard Worker }
164*ec779b8eSAndroid Build Coastguard Worker
165*ec779b8eSAndroid Build Coastguard Worker ++data;
166*ec779b8eSAndroid Build Coastguard Worker --size;
167*ec779b8eSAndroid Build Coastguard Worker }
168*ec779b8eSAndroid Build Coastguard Worker
169*ec779b8eSAndroid Build Coastguard Worker return (numBitsRemaining <= 0);
170*ec779b8eSAndroid Build Coastguard Worker }
171*ec779b8eSAndroid Build Coastguard Worker
fillReservoir()172*ec779b8eSAndroid Build Coastguard Worker bool NALBitReader::fillReservoir() {
173*ec779b8eSAndroid Build Coastguard Worker if (mSize == 0) {
174*ec779b8eSAndroid Build Coastguard Worker mOverRead = true;
175*ec779b8eSAndroid Build Coastguard Worker return false;
176*ec779b8eSAndroid Build Coastguard Worker }
177*ec779b8eSAndroid Build Coastguard Worker
178*ec779b8eSAndroid Build Coastguard Worker mReservoir = 0;
179*ec779b8eSAndroid Build Coastguard Worker size_t i = 0;
180*ec779b8eSAndroid Build Coastguard Worker while (mSize > 0 && i < 4) {
181*ec779b8eSAndroid Build Coastguard Worker bool isEmulationPreventionByte = (mNumZeros >= 2 && *mData == 3);
182*ec779b8eSAndroid Build Coastguard Worker
183*ec779b8eSAndroid Build Coastguard Worker if (*mData == 0) {
184*ec779b8eSAndroid Build Coastguard Worker ++mNumZeros;
185*ec779b8eSAndroid Build Coastguard Worker } else {
186*ec779b8eSAndroid Build Coastguard Worker mNumZeros = 0;
187*ec779b8eSAndroid Build Coastguard Worker }
188*ec779b8eSAndroid Build Coastguard Worker
189*ec779b8eSAndroid Build Coastguard Worker // skip emulation_prevention_three_byte
190*ec779b8eSAndroid Build Coastguard Worker if (!isEmulationPreventionByte) {
191*ec779b8eSAndroid Build Coastguard Worker mReservoir = (mReservoir << 8) | *mData;
192*ec779b8eSAndroid Build Coastguard Worker ++i;
193*ec779b8eSAndroid Build Coastguard Worker }
194*ec779b8eSAndroid Build Coastguard Worker
195*ec779b8eSAndroid Build Coastguard Worker ++mData;
196*ec779b8eSAndroid Build Coastguard Worker --mSize;
197*ec779b8eSAndroid Build Coastguard Worker }
198*ec779b8eSAndroid Build Coastguard Worker
199*ec779b8eSAndroid Build Coastguard Worker mNumBitsLeft = 8 * i;
200*ec779b8eSAndroid Build Coastguard Worker mReservoir <<= 32 - mNumBitsLeft;
201*ec779b8eSAndroid Build Coastguard Worker return true;
202*ec779b8eSAndroid Build Coastguard Worker }
203*ec779b8eSAndroid Build Coastguard Worker
204*ec779b8eSAndroid Build Coastguard Worker } // namespace android
205