xiph.h 5.89 KB
Newer Older
1 2 3 4 5 6 7 8
/*****************************************************************************
 * xiph.h: Xiph helpers
 *****************************************************************************
 * Copyright (C) 2010 Laurent Aimar
 * $Id$
 *
 * Authors: Laurent Aimar <fenrir _AT_ videolan _DOT_ org>
 *
Jean-Baptiste Kempf's avatar
Jean-Baptiste Kempf committed
9 10 11
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU Lesser General Public License as published by
 * the Free Software Foundation; either version 2.1 of the License, or
12 13 14 15
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
Jean-Baptiste Kempf's avatar
Jean-Baptiste Kempf committed
16 17
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
 * GNU Lesser General Public License for more details.
18
 *
Jean-Baptiste Kempf's avatar
Jean-Baptiste Kempf committed
19 20 21
 * You should have received a copy of the GNU Lesser General Public License
 * along with this program; if not, write to the Free Software Foundation,
 * Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301, USA.
22 23 24 25 26
 *****************************************************************************/

#include <assert.h>
#define XIPH_MAX_HEADER_COUNT (256)

27 28
/* Temp ffmpeg vorbis format */
static inline bool xiph_IsOldFormat( const void *extra, unsigned int i_extra )
29
{
30 31 32 33
    if ( i_extra >= 6 && GetWBE( extra ) == 30 )
        return true;
    else
        return false;
34 35
}

36
static inline unsigned int xiph_CountHeaders( const void *extra, unsigned int i_extra )
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
    const uint8_t *p_extra = (uint8_t*) extra;
    if ( !i_extra ) return 0;
    if ( xiph_IsOldFormat( extra, i_extra ) )
    {
        /* Check headers count */
        unsigned int overall_len = 6;
        for ( int i=0; i<3; i++ )
        {
            uint16_t i_size = GetWBE( extra );
            p_extra += 2 + i_size;
            if ( overall_len > i_extra - i_size )
                return 0;
            overall_len += i_size;
        }
        return 3;
    }
    else
    {
        return *p_extra + 1;
    }
}

static inline int xiph_SplitHeaders(unsigned packet_size[], void * packet[], unsigned *packet_count,
                                    unsigned extra_size, const void *extra)
{
63
    const uint8_t *current = (const uint8_t *)extra;
64 65 66 67 68
    const uint8_t *end = &current[extra_size];
    if (extra_size < 1)
        return VLC_EGENERIC;

    /* Parse the packet count and their sizes */
69
    const unsigned count = xiph_CountHeaders( current++, extra_size );
70 71
    if (packet_count)
        *packet_count = count;
72 73 74 75 76 77 78 79 80 81

    if ( xiph_IsOldFormat( extra, extra_size ) )
    {
        uint8_t *p_extra = (uint8_t*) extra;
        unsigned int overall_len = count << 1;
        for ( unsigned int i=0; i < count; i++ ) {
            packet_size[i] = GetWBE( p_extra );
            packet[i] = p_extra + 2;
            p_extra += packet_size[i] + 2;
            if (overall_len > extra_size - packet_size[i])
82
                return VLC_EGENERIC;
83
            overall_len += packet_size[i];
84 85
        }
    }
86 87
    else
    {
88
        int size = 0;
89 90 91 92 93 94 95 96 97 98
        for (unsigned i = 0; i < count - 1; i++) {
            packet_size[i] = 0;
            for (;;) {
                if (current >= end)
                    return VLC_EGENERIC;
                packet_size[i] += *current;
                if (*current++ != 255)
                    break;
            }
            size += packet_size[i];
99
        }
100 101 102
        if (end - current < size)
            return VLC_EGENERIC;
        packet_size[count - 1] = end - current - size;
103

104 105 106 107 108 109
        for (unsigned i = 0; i < count; i++)
            if (packet_size[i] > 0) {
                packet[i] = (void *) current;
                current += packet_size[i];
            }
    }
110 111 112 113
    return VLC_SUCCESS;
}

static inline int xiph_PackHeaders(int *extra_size, void **extra,
Pierre Ynard's avatar
Pierre Ynard committed
114
                                   unsigned packet_size[], const void *packet[], unsigned packet_count )
115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161
{
    if (packet_count <= 0 || packet_count > XIPH_MAX_HEADER_COUNT)
        return VLC_EGENERIC;

    /* Compute the size needed for the whole extra data */
    unsigned payload_size = 0;
    unsigned header_size = 1;
    for (unsigned i = 0; i < packet_count; i++) {
        payload_size += packet_size[i];
        if (i < packet_count - 1)
            header_size += 1 + packet_size[i] / 255;
    }

    /* */
    *extra_size = header_size + payload_size;
    *extra = malloc(*extra_size);
    if (*extra == NULL)
        return VLC_ENOMEM;

    /* Write the header */
    uint8_t *current = (uint8_t*)*extra;
    *current++ = packet_count - 1;
    for (unsigned i = 0; i < packet_count - 1; i++) {
        unsigned t = packet_size[i];
        for (;;) {
            if (t >= 255) {
                *current++ = 255;
                t -= 255;
            } else {
                *current++ = t;
                break;
            }
        }
    }

    /* Copy the payloads */
    for (unsigned i = 0; i < packet_count; i++) {
        if (packet_size[i] > 0) {
            memcpy(current, packet[i], packet_size[i]);
            current += packet_size[i];
        }
    }
    assert(current == (uint8_t*)*extra + *extra_size);
    return VLC_SUCCESS;
}

static inline int xiph_AppendHeaders(int *extra_size, void **extra,
Pierre Ynard's avatar
Pierre Ynard committed
162
                                     unsigned size, const void *data)
163 164 165 166 167 168 169 170 171 172 173 174 175
{
    unsigned packet_size[XIPH_MAX_HEADER_COUNT];
    void *packet[XIPH_MAX_HEADER_COUNT];
    unsigned count;
    if (*extra_size > 0 && *extra) {
        if (xiph_SplitHeaders(packet_size, packet, &count, *extra_size, *extra))
            return VLC_EGENERIC;
    } else {
        count = 0;
    }
    if (count >= XIPH_MAX_HEADER_COUNT)
        return VLC_EGENERIC;

176
    void *old = *extra;
177 178

    packet_size[count] = size;
Pierre Ynard's avatar
Pierre Ynard committed
179
    packet[count]      = (void*)data;
Pierre Ynard's avatar
Pierre Ynard committed
180 181
    if (xiph_PackHeaders(extra_size, extra, packet_size,
                         (const void **)packet, count + 1)) {
182 183 184
        *extra_size = 0;
        *extra      = NULL;
    }
185 186

    free(old);
187 188 189 190 191 192

    if (*extra_size <= 0)
        return VLC_EGENERIC;
    return VLC_SUCCESS;
}