vlc_block_helper.h 11.6 KB
Newer Older
1 2 3
/*****************************************************************************
 * vlc_block_helper.h: Helper functions for data blocks management.
 *****************************************************************************
4
 * Copyright (C) 2003-2017 VLC authors and VideoLAN
5 6 7
 *
 * Authors: Gildas Bazin <gbazin@netcourrier.com>
 *
Jean-Baptiste Kempf's avatar
Jean-Baptiste Kempf committed
8 9 10
 * 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
11 12 13 14
 * (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
15 16
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
 * GNU Lesser General Public License for more details.
17
 *
Jean-Baptiste Kempf's avatar
Jean-Baptiste Kempf committed
18 19 20
 * 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.
21 22
 *****************************************************************************/

23 24
#ifndef VLC_BLOCK_HELPER_H
#define VLC_BLOCK_HELPER_H 1
25

26 27
#include <vlc_block.h>

28 29
typedef struct block_bytestream_t
{
30
    block_t *p_chain;  /**< byte stream head block */
31
    block_t **pp_last; /**< tail ppointer for appends */
32
    block_t *p_block;  /**< byte stream read pointer block */
33 34 35
    size_t   i_block_offset; /**< byte stream read pointer offset within block */
    size_t   i_base_offset; /**< block base offset (previous blocks total size) */
    size_t   i_total;  /**< total bytes over all linked blocks */
36 37 38 39 40
} block_bytestream_t;

/*****************************************************************************
 * block_bytestream_t management
 *****************************************************************************/
41
static inline void block_BytestreamInit( block_bytestream_t *p_bytestream )
42
{
43
    p_bytestream->p_chain = p_bytestream->p_block = NULL;
44
    p_bytestream->pp_last = &p_bytestream->p_chain;
45 46 47
    p_bytestream->i_block_offset = 0;
    p_bytestream->i_base_offset = 0;
    p_bytestream->i_total = 0;
48 49
}

50 51
static inline void block_BytestreamRelease( block_bytestream_t *p_bytestream )
{
52
    block_ChainRelease( p_bytestream->p_chain );
53 54
}

55 56 57 58 59 60
/**
 * It flush all data (read and unread) from a block_bytestream_t.
 */
static inline void block_BytestreamEmpty( block_bytestream_t *p_bytestream )
{
    block_BytestreamRelease( p_bytestream );
61
    block_BytestreamInit( p_bytestream );
62 63 64 65 66
}

/**
 * It flushes all already read data from a block_bytestream_t.
 */
67
static inline void block_BytestreamFlush( block_bytestream_t *p_bytestream )
68
{
69 70 71
    block_t *block = p_bytestream->p_chain;

    while( block != p_bytestream->p_block )
72
    {
73 74
        block_t *p_next = block->p_next;

75 76
        p_bytestream->i_total -= block->i_buffer;
        p_bytestream->i_base_offset -= block->i_buffer;
77 78
        block_Release( block );
        block = p_next;
79
    }
80

81
    while( block != NULL && block->i_buffer == p_bytestream->i_block_offset )
82
    {
83 84
        block_t *p_next = block->p_next;

85
        p_bytestream->i_total -= block->i_buffer;
86 87
        block_Release( block );
        block = p_next;
88
        p_bytestream->i_block_offset = 0;
89
    }
90 91

    p_bytestream->p_chain = p_bytestream->p_block = block;
92 93
    if( p_bytestream->p_chain == NULL )
        p_bytestream->pp_last = &p_bytestream->p_chain;
94 95 96 97 98
}

static inline void block_BytestreamPush( block_bytestream_t *p_bytestream,
                                         block_t *p_block )
{
99
    block_ChainLastAppend( &p_bytestream->pp_last, p_block );
100
    if( !p_bytestream->p_block ) p_bytestream->p_block = p_block;
101 102 103 104 105 106 107 108
    for( ; p_block; p_block = p_block->p_next )
        p_bytestream->i_total += p_block->i_buffer;
}

static inline size_t block_BytestreamRemaining( const block_bytestream_t *p_bytestream )
{
    return ( p_bytestream->i_total > p_bytestream->i_base_offset + p_bytestream->i_block_offset ) ?
             p_bytestream->i_total - p_bytestream->i_base_offset - p_bytestream->i_block_offset : 0;
109 110
}

111
VLC_USED
112 113 114 115 116 117 118
static inline block_t *block_BytestreamPop( block_bytestream_t *p_bytestream )
{
    block_t *p_block;

    block_BytestreamFlush( p_bytestream );

    p_block = p_bytestream->p_block;
119
    if( unlikely( p_block == NULL ) )
120 121 122 123 124
    {
        return NULL;
    }
    else if( !p_block->p_next )
    {
125 126 127 128
        p_block->p_buffer += p_bytestream->i_block_offset;
        p_block->i_buffer -= p_bytestream->i_block_offset;
        p_bytestream->i_block_offset = 0;
        p_bytestream->i_total = 0;
129
        p_bytestream->p_chain = p_bytestream->p_block = NULL;
130
        p_bytestream->pp_last = &p_bytestream->p_chain;
131 132
        return p_block;
    }
133

134 135 136
    while( p_block->p_next && p_block->p_next->p_next )
        p_block = p_block->p_next;

137 138 139
    block_t *p_block_old = p_block;
    p_block = p_block->p_next;
    p_block_old->p_next = NULL;
140
    p_bytestream->pp_last = &p_block_old->p_next;
141 142
    if( p_block )
        p_bytestream->i_total -= p_block->i_buffer;
143 144

    return p_block;
145 146
}

147
static inline int block_WaitBytes( block_bytestream_t *p_bytestream,
148
                                   size_t i_data )
149
{
150 151 152
    if( block_BytestreamRemaining( p_bytestream ) >= i_data )
        return VLC_SUCCESS;
    return VLC_EGENERIC;
153 154 155
}

static inline int block_PeekBytes( block_bytestream_t *p_bytestream,
156
                                   uint8_t *p_data, size_t i_data )
157
{
158
    if( block_BytestreamRemaining( p_bytestream ) < i_data )
159 160 161
        return VLC_EGENERIC;

    /* Copy the data */
162 163 164
    size_t i_offset = p_bytestream->i_block_offset;
    size_t i_size = i_data;
    for( block_t *p_block = p_bytestream->p_block;
165 166
         p_block != NULL; p_block = p_block->p_next )
    {
167
        size_t i_copy = __MIN( i_size, p_block->i_buffer - i_offset );
168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184
        i_size -= i_copy;

        if( i_copy )
        {
            memcpy( p_data, p_block->p_buffer + i_offset, i_copy );
            p_data += i_copy;
        }

        i_offset = 0;

        if( !i_size ) break;
    }

    return VLC_SUCCESS;
}

static inline int block_GetBytes( block_bytestream_t *p_bytestream,
185
                                  uint8_t *p_data, size_t i_data )
186
{
187
    if( block_BytestreamRemaining( p_bytestream ) < i_data )
188 189 190
        return VLC_EGENERIC;

    /* Copy the data */
191 192 193 194
    size_t i_offset = p_bytestream->i_block_offset;
    size_t i_size = i_data;
    size_t i_copy = 0;
    block_t *p_block;
195 196 197 198 199 200
    for( p_block = p_bytestream->p_block;
         p_block != NULL; p_block = p_block->p_next )
    {
        i_copy = __MIN( i_size, p_block->i_buffer - i_offset );
        i_size -= i_copy;

201
        if( i_copy && p_data != NULL )
202 203 204 205 206
        {
            memcpy( p_data, p_block->p_buffer + i_offset, i_copy );
            p_data += i_copy;
        }

207 208
        if( i_size == 0 )
            break;
209

210
        p_bytestream->i_base_offset += p_block->i_buffer;
211
        i_offset = 0;
212 213 214
    }

    p_bytestream->p_block = p_block;
215
    p_bytestream->i_block_offset = i_offset + i_copy;
216 217 218 219

    return VLC_SUCCESS;
}

220 221
static inline int block_SkipBytes( block_bytestream_t *p_bytestream,
                                   size_t i_data )
222
{
223 224
    return block_GetBytes( p_bytestream, NULL, i_data );
}
225

226 227 228 229
static inline int block_SkipByte( block_bytestream_t *p_bytestream )
{
    return block_GetBytes( p_bytestream, NULL, 1 );
}
230

231 232 233 234 235 236
static inline int block_PeekOffsetBytes( block_bytestream_t *p_bytestream,
    size_t i_peek_offset, uint8_t *p_data, size_t i_data )
{
    /* Check we have that much data, ignoring read offset */
    if( p_bytestream->i_total < i_peek_offset ||
        p_bytestream->i_total - i_peek_offset < i_data )
237 238 239 240 241 242
    {
        /* Not enough data, bail out */
        return VLC_EGENERIC;
    }

    /* Find the right place */
243 244 245 246
    size_t i_offset = p_bytestream->i_block_offset;
    size_t i_size = i_peek_offset;
    size_t i_copy = 0;
    block_t *p_block;
247 248 249 250 251 252 253
    for( p_block = p_bytestream->p_block;
         p_block != NULL; p_block = p_block->p_next )
    {
        i_copy = __MIN( i_size, p_block->i_buffer - i_offset );
        i_size -= i_copy;

        if( !i_size ) break;
254 255

        i_offset = 0;
256 257 258
    }

    /* Copy the data */
259
    i_offset += i_copy;
260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279
    i_size = i_data;
    for( ; p_block != NULL; p_block = p_block->p_next )
    {
        i_copy = __MIN( i_size, p_block->i_buffer - i_offset );
        i_size -= i_copy;

        if( i_copy )
        {
            memcpy( p_data, p_block->p_buffer + i_offset, i_copy );
            p_data += i_copy;
        }

        i_offset = 0;

        if( !i_size ) break;
    }

    return VLC_SUCCESS;
}

280
typedef const uint8_t * (*block_startcode_helper_t)( const uint8_t *, const uint8_t * );
281
typedef bool (*block_startcode_matcher_t)( uint8_t, size_t, const uint8_t * );
282

283
static inline int block_FindStartcodeFromOffset(
284
    block_bytestream_t *p_bytestream, size_t *pi_offset,
285
    const uint8_t *p_startcode, int i_startcode_length,
286 287
    block_startcode_helper_t p_startcode_helper,
    block_startcode_matcher_t p_startcode_matcher )
288 289
{
    block_t *p_block, *p_block_backup = 0;
290
    ssize_t i_size = 0;
291
    size_t i_offset, i_offset_backup = 0;
292 293 294
    int i_caller_offset_backup = 0, i_match;

    /* Find the right place */
295
    i_size = *pi_offset + p_bytestream->i_block_offset;
296 297 298 299 300 301 302
    for( p_block = p_bytestream->p_block;
         p_block != NULL; p_block = p_block->p_next )
    {
        i_size -= p_block->i_buffer;
        if( i_size < 0 ) break;
    }

303
    if( unlikely( i_size >= 0 ) )
304 305 306 307 308 309
    {
        /* Not enough data, bail out */
        return VLC_EGENERIC;
    }

    /* Begin the search.
Sam Hocevar's avatar
Sam Hocevar committed
310
     * We first look for an occurrence of the 1st startcode byte and
311
     * if found, we do a more thorough check. */
312
    i_size += p_block->i_buffer;
313 314 315 316 317 318
    *pi_offset -= i_size;
    i_match = 0;
    for( ; p_block != NULL; p_block = p_block->p_next )
    {
        for( i_offset = i_size; i_offset < p_block->i_buffer; i_offset++ )
        {
319 320 321 322 323 324 325 326 327 328 329 330 331 332 333
            /* Use optimized helper when possible */
            if( p_startcode_helper && !i_match &&
               (p_block->i_buffer - i_offset) > ((size_t)i_startcode_length - 1) )
            {
                const uint8_t *p_res = p_startcode_helper( &p_block->p_buffer[i_offset],
                                                           &p_block->p_buffer[p_block->i_buffer] );
                if( p_res )
                {
                    *pi_offset += i_offset + (p_res - &p_block->p_buffer[i_offset]);
                    return VLC_SUCCESS;
                }
                /* Then parsing boundary with legacy code */
                i_offset = p_block->i_buffer - (i_startcode_length - 1);
            }

334 335 336 337
            bool b_matched = ( p_startcode_matcher )
                           ? p_startcode_matcher( p_block->p_buffer[i_offset], i_match, p_startcode )
                           : p_block->p_buffer[i_offset] == p_startcode[i_match];
            if( b_matched )
338
            {
339
                if( i_match == 0 )
340 341 342 343 344 345 346 347 348 349 350 351 352 353 354
                {
                    p_block_backup = p_block;
                    i_offset_backup = i_offset;
                    i_caller_offset_backup = *pi_offset;
                }

                if( i_match + 1 == i_startcode_length )
                {
                    /* We have it */
                    *pi_offset += i_offset - i_match;
                    return VLC_SUCCESS;
                }

                i_match++;
            }
355
            else if ( i_match > 0 )
356 357 358 359 360 361 362 363 364 365 366 367 368
            {
                /* False positive */
                p_block = p_block_backup;
                i_offset = i_offset_backup;
                *pi_offset = i_caller_offset_backup;
                i_match = 0;
            }

        }
        i_size = 0;
        *pi_offset += i_offset;
    }

369
    *pi_offset -= i_match;
370 371 372
    return VLC_EGENERIC;
}

373
#endif /* VLC_BLOCK_HELPER_H */