comment out some optimized branch
[platform/upstream/flac.git] / src / libFLAC / stream_encoder_framing.c
1 /* libFLAC - Free Lossless Audio Codec library
2  * Copyright (C) 2000,2001,2002,2003,2004,2005,2006,2007  Josh Coalson
3  *
4  * Redistribution and use in source and binary forms, with or without
5  * modification, are permitted provided that the following conditions
6  * are met:
7  *
8  * - Redistributions of source code must retain the above copyright
9  * notice, this list of conditions and the following disclaimer.
10  *
11  * - Redistributions in binary form must reproduce the above copyright
12  * notice, this list of conditions and the following disclaimer in the
13  * documentation and/or other materials provided with the distribution.
14  *
15  * - Neither the name of the Xiph.org Foundation nor the names of its
16  * contributors may be used to endorse or promote products derived from
17  * this software without specific prior written permission.
18  *
19  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
20  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
21  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
22  * A PARTICULAR PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR
23  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
24  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
25  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
26  * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
27  * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
28  * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
29  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30  */
31
32 #if HAVE_CONFIG_H
33 #  include <config.h>
34 #endif
35
36 #include <stdio.h>
37 #include <string.h> /* for strlen() */
38 #include "private/stream_encoder_framing.h"
39 #include "private/crc.h"
40 #include "FLAC/assert.h"
41
42 #ifdef max
43 #undef max
44 #endif
45 #define max(x,y) ((x)>(y)?(x):(y))
46
47 static FLAC__bool add_entropy_coding_method_(FLAC__BitWriter *bw, const FLAC__EntropyCodingMethod *method);
48 static FLAC__bool add_residual_partitioned_rice_(FLAC__BitWriter *bw, const FLAC__int32 residual[], const unsigned residual_samples, const unsigned predictor_order, const unsigned rice_parameters[], const unsigned raw_bits[], const unsigned partition_order);
49
50 FLAC__bool FLAC__add_metadata_block(const FLAC__StreamMetadata *metadata, FLAC__BitWriter *bw)
51 {
52         unsigned i, j;
53         const unsigned vendor_string_length = (unsigned)strlen(FLAC__VENDOR_STRING);
54
55         if(!FLAC__bitwriter_write_raw_uint32(bw, metadata->is_last, FLAC__STREAM_METADATA_IS_LAST_LEN))
56                 return false;
57
58         if(!FLAC__bitwriter_write_raw_uint32(bw, metadata->type, FLAC__STREAM_METADATA_TYPE_LEN))
59                 return false;
60
61         /*
62          * First, for VORBIS_COMMENTs, adjust the length to reflect our vendor string
63          */
64         i = metadata->length;
65         if(metadata->type == FLAC__METADATA_TYPE_VORBIS_COMMENT) {
66                 FLAC__ASSERT(metadata->data.vorbis_comment.vendor_string.length == 0 || 0 != metadata->data.vorbis_comment.vendor_string.entry);
67                 i -= metadata->data.vorbis_comment.vendor_string.length;
68                 i += vendor_string_length;
69         }
70         FLAC__ASSERT(i < (1u << FLAC__STREAM_METADATA_LENGTH_LEN));
71         if(!FLAC__bitwriter_write_raw_uint32(bw, i, FLAC__STREAM_METADATA_LENGTH_LEN))
72                 return false;
73
74         switch(metadata->type) {
75                 case FLAC__METADATA_TYPE_STREAMINFO:
76                         FLAC__ASSERT(metadata->data.stream_info.min_blocksize < (1u << FLAC__STREAM_METADATA_STREAMINFO_MIN_BLOCK_SIZE_LEN));
77                         if(!FLAC__bitwriter_write_raw_uint32(bw, metadata->data.stream_info.min_blocksize, FLAC__STREAM_METADATA_STREAMINFO_MIN_BLOCK_SIZE_LEN))
78                                 return false;
79                         FLAC__ASSERT(metadata->data.stream_info.max_blocksize < (1u << FLAC__STREAM_METADATA_STREAMINFO_MAX_BLOCK_SIZE_LEN));
80                         if(!FLAC__bitwriter_write_raw_uint32(bw, metadata->data.stream_info.max_blocksize, FLAC__STREAM_METADATA_STREAMINFO_MAX_BLOCK_SIZE_LEN))
81                                 return false;
82                         FLAC__ASSERT(metadata->data.stream_info.min_framesize < (1u << FLAC__STREAM_METADATA_STREAMINFO_MIN_FRAME_SIZE_LEN));
83                         if(!FLAC__bitwriter_write_raw_uint32(bw, metadata->data.stream_info.min_framesize, FLAC__STREAM_METADATA_STREAMINFO_MIN_FRAME_SIZE_LEN))
84                                 return false;
85                         FLAC__ASSERT(metadata->data.stream_info.max_framesize < (1u << FLAC__STREAM_METADATA_STREAMINFO_MAX_FRAME_SIZE_LEN));
86                         if(!FLAC__bitwriter_write_raw_uint32(bw, metadata->data.stream_info.max_framesize, FLAC__STREAM_METADATA_STREAMINFO_MAX_FRAME_SIZE_LEN))
87                                 return false;
88                         FLAC__ASSERT(FLAC__format_sample_rate_is_valid(metadata->data.stream_info.sample_rate));
89                         if(!FLAC__bitwriter_write_raw_uint32(bw, metadata->data.stream_info.sample_rate, FLAC__STREAM_METADATA_STREAMINFO_SAMPLE_RATE_LEN))
90                                 return false;
91                         FLAC__ASSERT(metadata->data.stream_info.channels > 0);
92                         FLAC__ASSERT(metadata->data.stream_info.channels <= (1u << FLAC__STREAM_METADATA_STREAMINFO_CHANNELS_LEN));
93                         if(!FLAC__bitwriter_write_raw_uint32(bw, metadata->data.stream_info.channels-1, FLAC__STREAM_METADATA_STREAMINFO_CHANNELS_LEN))
94                                 return false;
95                         FLAC__ASSERT(metadata->data.stream_info.bits_per_sample > 0);
96                         FLAC__ASSERT(metadata->data.stream_info.bits_per_sample <= (1u << FLAC__STREAM_METADATA_STREAMINFO_BITS_PER_SAMPLE_LEN));
97                         if(!FLAC__bitwriter_write_raw_uint32(bw, metadata->data.stream_info.bits_per_sample-1, FLAC__STREAM_METADATA_STREAMINFO_BITS_PER_SAMPLE_LEN))
98                                 return false;
99                         if(!FLAC__bitwriter_write_raw_uint64(bw, metadata->data.stream_info.total_samples, FLAC__STREAM_METADATA_STREAMINFO_TOTAL_SAMPLES_LEN))
100                                 return false;
101                         if(!FLAC__bitwriter_write_byte_block(bw, metadata->data.stream_info.md5sum, 16))
102                                 return false;
103                         break;
104                 case FLAC__METADATA_TYPE_PADDING:
105                         if(!FLAC__bitwriter_write_zeroes(bw, metadata->length * 8))
106                                 return false;
107                         break;
108                 case FLAC__METADATA_TYPE_APPLICATION:
109                         if(!FLAC__bitwriter_write_byte_block(bw, metadata->data.application.id, FLAC__STREAM_METADATA_APPLICATION_ID_LEN / 8))
110                                 return false;
111                         if(!FLAC__bitwriter_write_byte_block(bw, metadata->data.application.data, metadata->length - (FLAC__STREAM_METADATA_APPLICATION_ID_LEN / 8)))
112                                 return false;
113                         break;
114                 case FLAC__METADATA_TYPE_SEEKTABLE:
115                         for(i = 0; i < metadata->data.seek_table.num_points; i++) {
116                                 if(!FLAC__bitwriter_write_raw_uint64(bw, metadata->data.seek_table.points[i].sample_number, FLAC__STREAM_METADATA_SEEKPOINT_SAMPLE_NUMBER_LEN))
117                                         return false;
118                                 if(!FLAC__bitwriter_write_raw_uint64(bw, metadata->data.seek_table.points[i].stream_offset, FLAC__STREAM_METADATA_SEEKPOINT_STREAM_OFFSET_LEN))
119                                         return false;
120                                 if(!FLAC__bitwriter_write_raw_uint32(bw, metadata->data.seek_table.points[i].frame_samples, FLAC__STREAM_METADATA_SEEKPOINT_FRAME_SAMPLES_LEN))
121                                         return false;
122                         }
123                         break;
124                 case FLAC__METADATA_TYPE_VORBIS_COMMENT:
125                         if(!FLAC__bitwriter_write_raw_uint32_little_endian(bw, vendor_string_length))
126                                 return false;
127                         if(!FLAC__bitwriter_write_byte_block(bw, (const FLAC__byte*)FLAC__VENDOR_STRING, vendor_string_length))
128                                 return false;
129                         if(!FLAC__bitwriter_write_raw_uint32_little_endian(bw, metadata->data.vorbis_comment.num_comments))
130                                 return false;
131                         for(i = 0; i < metadata->data.vorbis_comment.num_comments; i++) {
132                                 if(!FLAC__bitwriter_write_raw_uint32_little_endian(bw, metadata->data.vorbis_comment.comments[i].length))
133                                         return false;
134                                 if(!FLAC__bitwriter_write_byte_block(bw, metadata->data.vorbis_comment.comments[i].entry, metadata->data.vorbis_comment.comments[i].length))
135                                         return false;
136                         }
137                         break;
138                 case FLAC__METADATA_TYPE_CUESHEET:
139                         FLAC__ASSERT(FLAC__STREAM_METADATA_CUESHEET_MEDIA_CATALOG_NUMBER_LEN % 8 == 0);
140                         if(!FLAC__bitwriter_write_byte_block(bw, (const FLAC__byte*)metadata->data.cue_sheet.media_catalog_number, FLAC__STREAM_METADATA_CUESHEET_MEDIA_CATALOG_NUMBER_LEN/8))
141                                 return false;
142                         if(!FLAC__bitwriter_write_raw_uint64(bw, metadata->data.cue_sheet.lead_in, FLAC__STREAM_METADATA_CUESHEET_LEAD_IN_LEN))
143                                 return false;
144                         if(!FLAC__bitwriter_write_raw_uint32(bw, metadata->data.cue_sheet.is_cd? 1 : 0, FLAC__STREAM_METADATA_CUESHEET_IS_CD_LEN))
145                                 return false;
146                         if(!FLAC__bitwriter_write_zeroes(bw, FLAC__STREAM_METADATA_CUESHEET_RESERVED_LEN))
147                                 return false;
148                         if(!FLAC__bitwriter_write_raw_uint32(bw, metadata->data.cue_sheet.num_tracks, FLAC__STREAM_METADATA_CUESHEET_NUM_TRACKS_LEN))
149                                 return false;
150                         for(i = 0; i < metadata->data.cue_sheet.num_tracks; i++) {
151                                 const FLAC__StreamMetadata_CueSheet_Track *track = metadata->data.cue_sheet.tracks + i;
152
153                                 if(!FLAC__bitwriter_write_raw_uint64(bw, track->offset, FLAC__STREAM_METADATA_CUESHEET_TRACK_OFFSET_LEN))
154                                         return false;
155                                 if(!FLAC__bitwriter_write_raw_uint32(bw, track->number, FLAC__STREAM_METADATA_CUESHEET_TRACK_NUMBER_LEN))
156                                         return false;
157                                 FLAC__ASSERT(FLAC__STREAM_METADATA_CUESHEET_TRACK_ISRC_LEN % 8 == 0);
158                                 if(!FLAC__bitwriter_write_byte_block(bw, (const FLAC__byte*)track->isrc, FLAC__STREAM_METADATA_CUESHEET_TRACK_ISRC_LEN/8))
159                                         return false;
160                                 if(!FLAC__bitwriter_write_raw_uint32(bw, track->type, FLAC__STREAM_METADATA_CUESHEET_TRACK_TYPE_LEN))
161                                         return false;
162                                 if(!FLAC__bitwriter_write_raw_uint32(bw, track->pre_emphasis, FLAC__STREAM_METADATA_CUESHEET_TRACK_PRE_EMPHASIS_LEN))
163                                         return false;
164                                 if(!FLAC__bitwriter_write_zeroes(bw, FLAC__STREAM_METADATA_CUESHEET_TRACK_RESERVED_LEN))
165                                         return false;
166                                 if(!FLAC__bitwriter_write_raw_uint32(bw, track->num_indices, FLAC__STREAM_METADATA_CUESHEET_TRACK_NUM_INDICES_LEN))
167                                         return false;
168                                 for(j = 0; j < track->num_indices; j++) {
169                                         const FLAC__StreamMetadata_CueSheet_Index *index = track->indices + j;
170
171                                         if(!FLAC__bitwriter_write_raw_uint64(bw, index->offset, FLAC__STREAM_METADATA_CUESHEET_INDEX_OFFSET_LEN))
172                                                 return false;
173                                         if(!FLAC__bitwriter_write_raw_uint32(bw, index->number, FLAC__STREAM_METADATA_CUESHEET_INDEX_NUMBER_LEN))
174                                                 return false;
175                                         if(!FLAC__bitwriter_write_zeroes(bw, FLAC__STREAM_METADATA_CUESHEET_INDEX_RESERVED_LEN))
176                                                 return false;
177                                 }
178                         }
179                         break;
180                 case FLAC__METADATA_TYPE_PICTURE:
181                         {
182                                 size_t len;
183                                 if(!FLAC__bitwriter_write_raw_uint32(bw, metadata->data.picture.type, FLAC__STREAM_METADATA_PICTURE_TYPE_LEN))
184                                         return false;
185                                 len = strlen(metadata->data.picture.mime_type);
186                                 if(!FLAC__bitwriter_write_raw_uint32(bw, len, FLAC__STREAM_METADATA_PICTURE_MIME_TYPE_LENGTH_LEN))
187                                         return false;
188                                 if(!FLAC__bitwriter_write_byte_block(bw, (const FLAC__byte*)metadata->data.picture.mime_type, len))
189                                         return false;
190                                 len = strlen((const char *)metadata->data.picture.description);
191                                 if(!FLAC__bitwriter_write_raw_uint32(bw, len, FLAC__STREAM_METADATA_PICTURE_DESCRIPTION_LENGTH_LEN))
192                                         return false;
193                                 if(!FLAC__bitwriter_write_byte_block(bw, metadata->data.picture.description, len))
194                                         return false;
195                                 if(!FLAC__bitwriter_write_raw_uint32(bw, metadata->data.picture.width, FLAC__STREAM_METADATA_PICTURE_WIDTH_LEN))
196                                         return false;
197                                 if(!FLAC__bitwriter_write_raw_uint32(bw, metadata->data.picture.height, FLAC__STREAM_METADATA_PICTURE_HEIGHT_LEN))
198                                         return false;
199                                 if(!FLAC__bitwriter_write_raw_uint32(bw, metadata->data.picture.depth, FLAC__STREAM_METADATA_PICTURE_DEPTH_LEN))
200                                         return false;
201                                 if(!FLAC__bitwriter_write_raw_uint32(bw, metadata->data.picture.colors, FLAC__STREAM_METADATA_PICTURE_COLORS_LEN))
202                                         return false;
203                                 if(!FLAC__bitwriter_write_raw_uint32(bw, metadata->data.picture.data_length, FLAC__STREAM_METADATA_PICTURE_DATA_LENGTH_LEN))
204                                         return false;
205                                 if(!FLAC__bitwriter_write_byte_block(bw, metadata->data.picture.data, metadata->data.picture.data_length))
206                                         return false;
207                         }
208                         break;
209                 default:
210                         if(!FLAC__bitwriter_write_byte_block(bw, metadata->data.unknown.data, metadata->length))
211                                 return false;
212                         break;
213         }
214
215         FLAC__ASSERT(FLAC__bitwriter_is_byte_aligned(bw));
216         return true;
217 }
218
219 FLAC__bool FLAC__frame_add_header(const FLAC__FrameHeader *header, FLAC__BitWriter *bw)
220 {
221         unsigned u, blocksize_hint, sample_rate_hint;
222         FLAC__byte crc;
223
224         FLAC__ASSERT(FLAC__bitwriter_is_byte_aligned(bw));
225
226         if(!FLAC__bitwriter_write_raw_uint32(bw, FLAC__FRAME_HEADER_SYNC, FLAC__FRAME_HEADER_SYNC_LEN))
227                 return false;
228
229         if(!FLAC__bitwriter_write_raw_uint32(bw, 0, FLAC__FRAME_HEADER_RESERVED_LEN))
230                 return false;
231
232         if(!FLAC__bitwriter_write_raw_uint32(bw, 0, FLAC__FRAME_HEADER_BLOCKING_STRATEGY_LEN))
233                 return false;
234
235         FLAC__ASSERT(header->blocksize > 0 && header->blocksize <= FLAC__MAX_BLOCK_SIZE);
236         /* when this assertion holds true, any legal blocksize can be expressed in the frame header */
237         FLAC__ASSERT(FLAC__MAX_BLOCK_SIZE <= 65535u);
238         blocksize_hint = 0;
239         switch(header->blocksize) {
240                 case   192: u = 1; break;
241                 case   576: u = 2; break;
242                 case  1152: u = 3; break;
243                 case  2304: u = 4; break;
244                 case  4608: u = 5; break;
245                 case   256: u = 8; break;
246                 case   512: u = 9; break;
247                 case  1024: u = 10; break;
248                 case  2048: u = 11; break;
249                 case  4096: u = 12; break;
250                 case  8192: u = 13; break;
251                 case 16384: u = 14; break;
252                 case 32768: u = 15; break;
253                 default:
254                         if(header->blocksize <= 0x100)
255                                 blocksize_hint = u = 6;
256                         else if(header->blocksize <= 0x10000)
257                                 blocksize_hint = u = 7;
258                         else
259                                 u = 0;
260                         break;
261         }
262         if(!FLAC__bitwriter_write_raw_uint32(bw, u, FLAC__FRAME_HEADER_BLOCK_SIZE_LEN))
263                 return false;
264
265         FLAC__ASSERT(FLAC__format_sample_rate_is_valid(header->sample_rate));
266         sample_rate_hint = 0;
267         switch(header->sample_rate) {
268                 case  8000: u = 4; break;
269                 case 16000: u = 5; break;
270                 case 22050: u = 6; break;
271                 case 24000: u = 7; break;
272                 case 32000: u = 8; break;
273                 case 44100: u = 9; break;
274                 case 48000: u = 10; break;
275                 case 96000: u = 11; break;
276                 default:
277                         if(header->sample_rate <= 255000 && header->sample_rate % 1000 == 0)
278                                 sample_rate_hint = u = 12;
279                         else if(header->sample_rate % 10 == 0)
280                                 sample_rate_hint = u = 14;
281                         else if(header->sample_rate <= 0xffff)
282                                 sample_rate_hint = u = 13;
283                         else
284                                 u = 0;
285                         break;
286         }
287         if(!FLAC__bitwriter_write_raw_uint32(bw, u, FLAC__FRAME_HEADER_SAMPLE_RATE_LEN))
288                 return false;
289
290         FLAC__ASSERT(header->channels > 0 && header->channels <= (1u << FLAC__STREAM_METADATA_STREAMINFO_CHANNELS_LEN) && header->channels <= FLAC__MAX_CHANNELS);
291         switch(header->channel_assignment) {
292                 case FLAC__CHANNEL_ASSIGNMENT_INDEPENDENT:
293                         u = header->channels - 1;
294                         break;
295                 case FLAC__CHANNEL_ASSIGNMENT_LEFT_SIDE:
296                         FLAC__ASSERT(header->channels == 2);
297                         u = 8;
298                         break;
299                 case FLAC__CHANNEL_ASSIGNMENT_RIGHT_SIDE:
300                         FLAC__ASSERT(header->channels == 2);
301                         u = 9;
302                         break;
303                 case FLAC__CHANNEL_ASSIGNMENT_MID_SIDE:
304                         FLAC__ASSERT(header->channels == 2);
305                         u = 10;
306                         break;
307                 default:
308                         FLAC__ASSERT(0);
309         }
310         if(!FLAC__bitwriter_write_raw_uint32(bw, u, FLAC__FRAME_HEADER_CHANNEL_ASSIGNMENT_LEN))
311                 return false;
312
313         FLAC__ASSERT(header->bits_per_sample > 0 && header->bits_per_sample <= (1u << FLAC__STREAM_METADATA_STREAMINFO_BITS_PER_SAMPLE_LEN));
314         switch(header->bits_per_sample) {
315                 case 8 : u = 1; break;
316                 case 12: u = 2; break;
317                 case 16: u = 4; break;
318                 case 20: u = 5; break;
319                 case 24: u = 6; break;
320                 default: u = 0; break;
321         }
322         if(!FLAC__bitwriter_write_raw_uint32(bw, u, FLAC__FRAME_HEADER_BITS_PER_SAMPLE_LEN))
323                 return false;
324
325         if(!FLAC__bitwriter_write_raw_uint32(bw, 0, FLAC__FRAME_HEADER_ZERO_PAD_LEN))
326                 return false;
327
328         FLAC__ASSERT(header->number_type == FLAC__FRAME_NUMBER_TYPE_FRAME_NUMBER);
329         if(!FLAC__bitwriter_write_utf8_uint32(bw, header->number.frame_number))
330                 return false;
331
332         if(blocksize_hint)
333                 if(!FLAC__bitwriter_write_raw_uint32(bw, header->blocksize-1, (blocksize_hint==6)? 8:16))
334                         return false;
335
336         switch(sample_rate_hint) {
337                 case 12:
338                         if(!FLAC__bitwriter_write_raw_uint32(bw, header->sample_rate / 1000, 8))
339                                 return false;
340                         break;
341                 case 13:
342                         if(!FLAC__bitwriter_write_raw_uint32(bw, header->sample_rate, 16))
343                                 return false;
344                         break;
345                 case 14:
346                         if(!FLAC__bitwriter_write_raw_uint32(bw, header->sample_rate / 10, 16))
347                                 return false;
348                         break;
349         }
350
351         /* write the CRC */
352         if(!FLAC__bitwriter_get_write_crc8(bw, &crc))
353                 return false;
354         if(!FLAC__bitwriter_write_raw_uint32(bw, crc, FLAC__FRAME_HEADER_CRC_LEN))
355                 return false;
356
357         return true;
358 }
359
360 FLAC__bool FLAC__subframe_add_constant(const FLAC__Subframe_Constant *subframe, unsigned subframe_bps, unsigned wasted_bits, FLAC__BitWriter *bw)
361 {
362         FLAC__bool ok;
363
364         ok =
365                 FLAC__bitwriter_write_raw_uint32(bw, FLAC__SUBFRAME_TYPE_CONSTANT_BYTE_ALIGNED_MASK | (wasted_bits? 1:0), FLAC__SUBFRAME_ZERO_PAD_LEN + FLAC__SUBFRAME_TYPE_LEN + FLAC__SUBFRAME_WASTED_BITS_FLAG_LEN) &&
366                 (wasted_bits? FLAC__bitwriter_write_unary_unsigned(bw, wasted_bits-1) : true) &&
367                 FLAC__bitwriter_write_raw_int32(bw, subframe->value, subframe_bps)
368         ;
369
370         return ok;
371 }
372
373 FLAC__bool FLAC__subframe_add_fixed(const FLAC__Subframe_Fixed *subframe, unsigned residual_samples, unsigned subframe_bps, unsigned wasted_bits, FLAC__BitWriter *bw)
374 {
375         unsigned i;
376
377         if(!FLAC__bitwriter_write_raw_uint32(bw, FLAC__SUBFRAME_TYPE_FIXED_BYTE_ALIGNED_MASK | (subframe->order<<1) | (wasted_bits? 1:0), FLAC__SUBFRAME_ZERO_PAD_LEN + FLAC__SUBFRAME_TYPE_LEN + FLAC__SUBFRAME_WASTED_BITS_FLAG_LEN))
378                 return false;
379         if(wasted_bits)
380                 if(!FLAC__bitwriter_write_unary_unsigned(bw, wasted_bits-1))
381                         return false;
382
383         for(i = 0; i < subframe->order; i++)
384                 if(!FLAC__bitwriter_write_raw_int32(bw, subframe->warmup[i], subframe_bps))
385                         return false;
386
387         if(!add_entropy_coding_method_(bw, &subframe->entropy_coding_method))
388                 return false;
389         switch(subframe->entropy_coding_method.type) {
390                 case FLAC__ENTROPY_CODING_METHOD_PARTITIONED_RICE:
391                         if(!add_residual_partitioned_rice_(bw, subframe->residual, residual_samples, subframe->order, subframe->entropy_coding_method.data.partitioned_rice.contents->parameters, subframe->entropy_coding_method.data.partitioned_rice.contents->raw_bits, subframe->entropy_coding_method.data.partitioned_rice.order))
392                                 return false;
393                         break;
394                 default:
395                         FLAC__ASSERT(0);
396         }
397
398         return true;
399 }
400
401 FLAC__bool FLAC__subframe_add_lpc(const FLAC__Subframe_LPC *subframe, unsigned residual_samples, unsigned subframe_bps, unsigned wasted_bits, FLAC__BitWriter *bw)
402 {
403         unsigned i;
404
405         if(!FLAC__bitwriter_write_raw_uint32(bw, FLAC__SUBFRAME_TYPE_LPC_BYTE_ALIGNED_MASK | ((subframe->order-1)<<1) | (wasted_bits? 1:0), FLAC__SUBFRAME_ZERO_PAD_LEN + FLAC__SUBFRAME_TYPE_LEN + FLAC__SUBFRAME_WASTED_BITS_FLAG_LEN))
406                 return false;
407         if(wasted_bits)
408                 if(!FLAC__bitwriter_write_unary_unsigned(bw, wasted_bits-1))
409                         return false;
410
411         for(i = 0; i < subframe->order; i++)
412                 if(!FLAC__bitwriter_write_raw_int32(bw, subframe->warmup[i], subframe_bps))
413                         return false;
414
415         if(!FLAC__bitwriter_write_raw_uint32(bw, subframe->qlp_coeff_precision-1, FLAC__SUBFRAME_LPC_QLP_COEFF_PRECISION_LEN))
416                 return false;
417         if(!FLAC__bitwriter_write_raw_int32(bw, subframe->quantization_level, FLAC__SUBFRAME_LPC_QLP_SHIFT_LEN))
418                 return false;
419         for(i = 0; i < subframe->order; i++)
420                 if(!FLAC__bitwriter_write_raw_int32(bw, subframe->qlp_coeff[i], subframe->qlp_coeff_precision))
421                         return false;
422
423         if(!add_entropy_coding_method_(bw, &subframe->entropy_coding_method))
424                 return false;
425         switch(subframe->entropy_coding_method.type) {
426                 case FLAC__ENTROPY_CODING_METHOD_PARTITIONED_RICE:
427                         if(!add_residual_partitioned_rice_(bw, subframe->residual, residual_samples, subframe->order, subframe->entropy_coding_method.data.partitioned_rice.contents->parameters, subframe->entropy_coding_method.data.partitioned_rice.contents->raw_bits, subframe->entropy_coding_method.data.partitioned_rice.order))
428                                 return false;
429                         break;
430                 default:
431                         FLAC__ASSERT(0);
432         }
433
434         return true;
435 }
436
437 FLAC__bool FLAC__subframe_add_verbatim(const FLAC__Subframe_Verbatim *subframe, unsigned samples, unsigned subframe_bps, unsigned wasted_bits, FLAC__BitWriter *bw)
438 {
439         unsigned i;
440         const FLAC__int32 *signal = subframe->data;
441
442         if(!FLAC__bitwriter_write_raw_uint32(bw, FLAC__SUBFRAME_TYPE_VERBATIM_BYTE_ALIGNED_MASK | (wasted_bits? 1:0), FLAC__SUBFRAME_ZERO_PAD_LEN + FLAC__SUBFRAME_TYPE_LEN + FLAC__SUBFRAME_WASTED_BITS_FLAG_LEN))
443                 return false;
444         if(wasted_bits)
445                 if(!FLAC__bitwriter_write_unary_unsigned(bw, wasted_bits-1))
446                         return false;
447
448         for(i = 0; i < samples; i++)
449                 if(!FLAC__bitwriter_write_raw_int32(bw, signal[i], subframe_bps))
450                         return false;
451
452         return true;
453 }
454
455 FLAC__bool add_entropy_coding_method_(FLAC__BitWriter *bw, const FLAC__EntropyCodingMethod *method)
456 {
457         if(!FLAC__bitwriter_write_raw_uint32(bw, method->type, FLAC__ENTROPY_CODING_METHOD_TYPE_LEN))
458                 return false;
459         switch(method->type) {
460                 case FLAC__ENTROPY_CODING_METHOD_PARTITIONED_RICE:
461                         if(!FLAC__bitwriter_write_raw_uint32(bw, method->data.partitioned_rice.order, FLAC__ENTROPY_CODING_METHOD_PARTITIONED_RICE_ORDER_LEN))
462                                 return false;
463                         break;
464                 default:
465                         FLAC__ASSERT(0);
466         }
467         return true;
468 }
469
470 FLAC__bool add_residual_partitioned_rice_(FLAC__BitWriter *bw, const FLAC__int32 residual[], const unsigned residual_samples, const unsigned predictor_order, const unsigned rice_parameters[], const unsigned raw_bits[], const unsigned partition_order)
471 {
472         if(partition_order == 0) {
473                 unsigned i;
474
475                 if(!FLAC__bitwriter_write_raw_uint32(bw, rice_parameters[0], FLAC__ENTROPY_CODING_METHOD_PARTITIONED_RICE_PARAMETER_LEN))
476                         return false;
477                 if(rice_parameters[0] < FLAC__ENTROPY_CODING_METHOD_PARTITIONED_RICE_ESCAPE_PARAMETER) {
478                         if(!FLAC__bitwriter_write_rice_signed_block(bw, residual, residual_samples, rice_parameters[0]))
479                                 return false;
480                 }
481                 else {
482                         if(!FLAC__bitwriter_write_raw_uint32(bw, raw_bits[0], FLAC__ENTROPY_CODING_METHOD_PARTITIONED_RICE_RAW_LEN))
483                                 return false;
484                         for(i = 0; i < residual_samples; i++) {
485                                 if(!FLAC__bitwriter_write_raw_int32(bw, residual[i], raw_bits[0]))
486                                         return false;
487                         }
488                 }
489                 return true;
490         }
491         else {
492                 unsigned i, j, k = 0, k_last = 0;
493                 unsigned partition_samples;
494                 const unsigned default_partition_samples = (residual_samples+predictor_order) >> partition_order;
495                 for(i = 0; i < (1u<<partition_order); i++) {
496                         if(!FLAC__bitwriter_write_raw_uint32(bw, rice_parameters[i], FLAC__ENTROPY_CODING_METHOD_PARTITIONED_RICE_PARAMETER_LEN))
497                                 return false;
498                         partition_samples = default_partition_samples;
499                         if(i == 0)
500                                 partition_samples -= predictor_order;
501                         k += partition_samples;
502                         if(rice_parameters[i] < FLAC__ENTROPY_CODING_METHOD_PARTITIONED_RICE_ESCAPE_PARAMETER) {
503                                 if(!FLAC__bitwriter_write_rice_signed_block(bw, residual+k_last, k-k_last, rice_parameters[i]))
504                                         return false;
505                         }
506                         else {
507                                 if(!FLAC__bitwriter_write_raw_uint32(bw, raw_bits[i], FLAC__ENTROPY_CODING_METHOD_PARTITIONED_RICE_RAW_LEN))
508                                         return false;
509                                 for(j = k_last; j < k; j++) {
510                                         if(!FLAC__bitwriter_write_raw_int32(bw, residual[j], raw_bits[i]))
511                                                 return false;
512                                 }
513                         }
514                         k_last = k;
515                 }
516                 return true;
517         }
518 }