Index: src/opus.c |
diff --git a/src/opus.c b/src/opus.c |
index 170bc4b6e5040bbeee2ded6673a4fb500fc77c12..30890b9cbfd6f61cb3e8276df7a4f4fa9df32961 100644 |
--- a/src/opus.c |
+++ b/src/opus.c |
@@ -39,6 +39,8 @@ OPUS_EXPORT void opus_pcm_soft_clip(float *_x, int N, int C, float *declip_mem) |
int i; |
float *x; |
+ if (C<1 || N<1 || !_x || !declip_mem) return; |
+ |
/* First thing: saturate everything to +/- 2 which is the highest level our |
non-linearity can handle. At the point where the signal reaches +/-2, |
the derivative will be zero anyway, so this doesn't introduce any |
@@ -144,3 +146,184 @@ int encode_size(int size, unsigned char *data) |
} |
} |
+static int parse_size(const unsigned char *data, opus_int32 len, opus_int16 *size) |
+{ |
+ if (len<1) |
+ { |
+ *size = -1; |
+ return -1; |
+ } else if (data[0]<252) |
+ { |
+ *size = data[0]; |
+ return 1; |
+ } else if (len<2) |
+ { |
+ *size = -1; |
+ return -1; |
+ } else { |
+ *size = 4*data[1] + data[0]; |
+ return 2; |
+ } |
+} |
+ |
+int opus_packet_parse_impl(const unsigned char *data, opus_int32 len, |
+ int self_delimited, unsigned char *out_toc, |
+ const unsigned char *frames[48], opus_int16 size[48], |
+ int *payload_offset, opus_int32 *packet_offset) |
+{ |
+ int i, bytes; |
+ int count; |
+ int cbr; |
+ unsigned char ch, toc; |
+ int framesize; |
+ opus_int32 last_size; |
+ opus_int32 pad = 0; |
+ const unsigned char *data0 = data; |
+ |
+ if (size==NULL) |
+ return OPUS_BAD_ARG; |
+ |
+ framesize = opus_packet_get_samples_per_frame(data, 48000); |
+ |
+ cbr = 0; |
+ toc = *data++; |
+ len--; |
+ last_size = len; |
+ switch (toc&0x3) |
+ { |
+ /* One frame */ |
+ case 0: |
+ count=1; |
+ break; |
+ /* Two CBR frames */ |
+ case 1: |
+ count=2; |
+ cbr = 1; |
+ if (!self_delimited) |
+ { |
+ if (len&0x1) |
+ return OPUS_INVALID_PACKET; |
+ last_size = len/2; |
+ /* If last_size doesn't fit in size[0], we'll catch it later */ |
+ size[0] = (opus_int16)last_size; |
+ } |
+ break; |
+ /* Two VBR frames */ |
+ case 2: |
+ count = 2; |
+ bytes = parse_size(data, len, size); |
+ len -= bytes; |
+ if (size[0]<0 || size[0] > len) |
+ return OPUS_INVALID_PACKET; |
+ data += bytes; |
+ last_size = len-size[0]; |
+ break; |
+ /* Multiple CBR/VBR frames (from 0 to 120 ms) */ |
+ default: /*case 3:*/ |
+ if (len<1) |
+ return OPUS_INVALID_PACKET; |
+ /* Number of frames encoded in bits 0 to 5 */ |
+ ch = *data++; |
+ count = ch&0x3F; |
+ if (count <= 0 || framesize*count > 5760) |
+ return OPUS_INVALID_PACKET; |
+ len--; |
+ /* Padding flag is bit 6 */ |
+ if (ch&0x40) |
+ { |
+ int p; |
+ do { |
+ int tmp; |
+ if (len<=0) |
+ return OPUS_INVALID_PACKET; |
+ p = *data++; |
+ len--; |
+ tmp = p==255 ? 254: p; |
+ len -= tmp; |
+ pad += tmp; |
+ } while (p==255); |
+ } |
+ if (len<0) |
+ return OPUS_INVALID_PACKET; |
+ /* VBR flag is bit 7 */ |
+ cbr = !(ch&0x80); |
+ if (!cbr) |
+ { |
+ /* VBR case */ |
+ last_size = len; |
+ for (i=0;i<count-1;i++) |
+ { |
+ bytes = parse_size(data, len, size+i); |
+ len -= bytes; |
+ if (size[i]<0 || size[i] > len) |
+ return OPUS_INVALID_PACKET; |
+ data += bytes; |
+ last_size -= bytes+size[i]; |
+ } |
+ if (last_size<0) |
+ return OPUS_INVALID_PACKET; |
+ } else if (!self_delimited) |
+ { |
+ /* CBR case */ |
+ last_size = len/count; |
+ if (last_size*count!=len) |
+ return OPUS_INVALID_PACKET; |
+ for (i=0;i<count-1;i++) |
+ size[i] = (opus_int16)last_size; |
+ } |
+ break; |
+ } |
+ /* Self-delimited framing has an extra size for the last frame. */ |
+ if (self_delimited) |
+ { |
+ bytes = parse_size(data, len, size+count-1); |
+ len -= bytes; |
+ if (size[count-1]<0 || size[count-1] > len) |
+ return OPUS_INVALID_PACKET; |
+ data += bytes; |
+ /* For CBR packets, apply the size to all the frames. */ |
+ if (cbr) |
+ { |
+ if (size[count-1]*count > len) |
+ return OPUS_INVALID_PACKET; |
+ for (i=0;i<count-1;i++) |
+ size[i] = size[count-1]; |
+ } else if (bytes+size[count-1] > last_size) |
+ return OPUS_INVALID_PACKET; |
+ } else |
+ { |
+ /* Because it's not encoded explicitly, it's possible the size of the |
+ last packet (or all the packets, for the CBR case) is larger than |
+ 1275. Reject them here.*/ |
+ if (last_size > 1275) |
+ return OPUS_INVALID_PACKET; |
+ size[count-1] = (opus_int16)last_size; |
+ } |
+ |
+ if (payload_offset) |
+ *payload_offset = (int)(data-data0); |
+ |
+ for (i=0;i<count;i++) |
+ { |
+ if (frames) |
+ frames[i] = data; |
+ data += size[i]; |
+ } |
+ |
+ if (packet_offset) |
+ *packet_offset = pad+(opus_int32)(data-data0); |
+ |
+ if (out_toc) |
+ *out_toc = toc; |
+ |
+ return count; |
+} |
+ |
+int opus_packet_parse(const unsigned char *data, opus_int32 len, |
+ unsigned char *out_toc, const unsigned char *frames[48], |
+ opus_int16 size[48], int *payload_offset) |
+{ |
+ return opus_packet_parse_impl(data, len, 0, out_toc, |
+ frames, size, payload_offset, NULL); |
+} |
+ |