modules/access/mms/buffer.c

   1 /*****************************************************************************
   2  * buffer.c: MMS access plug-in
   3  *****************************************************************************
   4  * Copyright (C) 2001-2004 the VideoLAN team
   5  * $Id$
   6  *
   7  * Authors: Laurent Aimar <fenrir@via.ecp.fr>
   8  *
   9  * This program is free software; you can redistribute it and/or modify
  10  * it under the terms of the GNU General Public License as published by
  11  * the Free Software Foundation; either version 2 of the License, or
  12  * (at your option) any later version.
  13  *
  14  * This program is distributed in the hope that it will be useful,
  15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17  * GNU General Public License for more details.
  18  *
  19  * You should have received a copy of the GNU General Public License
  20  * along with this program; if not, write to the Free Software
  21  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301, USA.
  22  *****************************************************************************/
  23
  24 /*****************************************************************************
  25  * Preamble
  26  *****************************************************************************/
  27
  28 #ifdef HAVE_CONFIG_H
  29 # include "config.h"
  30 #endif
  31
  32 #include <vlc_common.h>
  33 #include <vlc_charset.h>
  34
  35 #include "asf.h"
  36 #include "buffer.h"
  37
  38 /*****************************************************************************
  39  * Buffer management functions
  40  *****************************************************************************/
  41 int var_buffer_initwrite( var_buffer_t *p_buf, int i_default_size )
  42 {
  43     p_buf->i_size =  ( i_default_size > 0 ) ? i_default_size : 2048;
  44     p_buf->i_data = 0;
  45     p_buf->p_data = malloc( p_buf->i_size );
  46     return p_buf->p_data ? 0 : -1;
  47 }
  48
  49 int var_buffer_reinitwrite( var_buffer_t *p_buf, int i_default_size )
  50 {
  51     p_buf->i_data = 0;
  52     if( p_buf->i_size < i_default_size )
  53     {
  54         p_buf->i_size = i_default_size;
  55         free( p_buf->p_data );
  56         p_buf->p_data = malloc( p_buf->i_size );
  57     }
  58     if( !p_buf->p_data )
  59     {
  60         p_buf->i_size =  ( i_default_size > 0 ) ? i_default_size : 2048;
  61         p_buf->p_data = malloc( p_buf->i_size );
  62     }
  63     return p_buf->p_data ? 0 : -1;
  64 }
  65
  66 void var_buffer_add8 ( var_buffer_t *p_buf, uint8_t  i_byte )
  67 {
  68     /* check if there is enough data */
  69     if( p_buf->i_data >= p_buf->i_size )
  70     {
  71         p_buf->i_size += 1024;
  72         p_buf->p_data = xrealloc( p_buf->p_data, p_buf->i_size );
  73     }
  74     p_buf->p_data[p_buf->i_data] = i_byte&0xff;
  75     p_buf->i_data++;
  76 }
  77
  78 void var_buffer_add16( var_buffer_t *p_buf, uint16_t i_word )
  79 {
  80     var_buffer_add8( p_buf, i_word&0xff );
  81     var_buffer_add8( p_buf, ( i_word >> 8 )&0xff );
  82 }
  83
  84 void var_buffer_add32( var_buffer_t *p_buf, uint32_t i_dword )
  85 {
  86     var_buffer_add16( p_buf, i_dword&0xffff );
  87     var_buffer_add16( p_buf, ( i_dword >> 16 )&0xffff );
  88 }
  89
  90 void var_buffer_add64( var_buffer_t *p_buf, uint64_t i_long )
  91 {
  92     var_buffer_add32( p_buf, i_long&0xffffffff );
  93     var_buffer_add32( p_buf, ( i_long >> 32 )&0xffffffff );
  94 }
  95
  96 void var_buffer_addmemory( var_buffer_t *p_buf, void *p_mem, int i_mem )
  97 {
  98     /* check if there is enough data */
  99     if( p_buf->i_data + i_mem >= p_buf->i_size )
 100     {
 101         p_buf->i_size += i_mem + 1024;
 102         p_buf->p_data = xrealloc( p_buf->p_data, p_buf->i_size );
 103     }
 104
 105     memcpy( p_buf->p_data + p_buf->i_data, p_mem, i_mem );
 106     p_buf->i_data += i_mem;
 107 }
 108
 109 void var_buffer_addUTF16( var_buffer_t *p_buf, const char *p_str )
 110 {
 111     uint16_t *p_out;
 112     size_t i_out;
 113
 114     if( p_str != NULL )
 115 #ifdef WORDS_BIGENDIAN
 116         p_out = ToCharset( "UTF-16BE", p_str, &i_out );
 117 #else
 118         p_out = ToCharset( "UTF-16LE", p_str, &i_out );
 119 #endif
 120     else
 121         p_out = NULL;
 122     if( p_out == NULL )
 123         i_out = 0;
 124
 125     i_out /= 2;
 126     for( size_t i = 0; i < i_out; i ++ )
 127         var_buffer_add16( p_buf, p_out[i] );
 128     free( p_out );
 129
 130     var_buffer_add16( p_buf, 0 );
 131 }
 132
 133 void var_buffer_free( var_buffer_t *p_buf )
 134 {
 135     free( p_buf->p_data );
 136     p_buf->i_data = 0;
 137     p_buf->i_size = 0;
 138 }
 139
 140 void var_buffer_initread( var_buffer_t *p_buf, void *p_data, int i_data )
 141 {
 142     p_buf->i_size = i_data;
 143     p_buf->i_data = 0;
 144     p_buf->p_data = p_data;
 145 }
 146
 147 uint8_t var_buffer_get8 ( var_buffer_t *p_buf )
 148 {
 149     uint8_t  i_byte;
 150     if( p_buf->i_data >= p_buf->i_size )
 151     {
 152         return( 0 );
 153     }
 154     i_byte = p_buf->p_data[p_buf->i_data];
 155     p_buf->i_data++;
 156     return( i_byte );
 157 }
 158
 159 uint16_t var_buffer_get16( var_buffer_t *p_buf )
 160 {
 161     uint16_t i_b1, i_b2;
 162
 163     i_b1 = var_buffer_get8( p_buf );
 164     i_b2 = var_buffer_get8( p_buf );
 165
 166     return( i_b1 + ( i_b2 << 8 ) );
 167
 168 }
 169
 170 uint32_t var_buffer_get32( var_buffer_t *p_buf )
 171 {
 172     uint32_t i_w1, i_w2;
 173
 174     i_w1 = var_buffer_get16( p_buf );
 175     i_w2 = var_buffer_get16( p_buf );
 176
 177     return( i_w1 + ( i_w2 << 16 ) );
 178 }
 179
 180 uint64_t var_buffer_get64( var_buffer_t *p_buf )
 181 {
 182     uint64_t i_dw1, i_dw2;
 183
 184     i_dw1 = var_buffer_get32( p_buf );
 185     i_dw2 = var_buffer_get32( p_buf );
 186
 187     return( i_dw1 + ( i_dw2 << 32 ) );
 188 }
 189
 190 int var_buffer_getmemory ( var_buffer_t *p_buf, void *p_mem, int64_t i_mem )
 191 {
 192     int i_copy;
 193
 194     i_copy = __MIN( i_mem, p_buf->i_size - p_buf->i_data );
 195     if( i_copy > 0 && p_mem != NULL)
 196     {
 197         memcpy( p_mem, p_buf + p_buf->i_data, i_copy );
 198     }
 199     if( i_copy < 0 )
 200     {
 201         i_copy = 0;
 202     }
 203     p_buf->i_data += i_copy;
 204     return( i_copy );
 205 }
 206
 207 int var_buffer_readempty( var_buffer_t *p_buf )
 208 {
 209     return( ( p_buf->i_data >= p_buf->i_size ) ? 1 : 0 );
 210 }
 211
 212 void var_buffer_getguid( var_buffer_t *p_buf, guid_t *p_guid )
 213 {
 214     int i;
 215
 216     p_guid->Data1 = var_buffer_get32( p_buf );
 217     p_guid->Data2 = var_buffer_get16( p_buf );
 218     p_guid->Data3 = var_buffer_get16( p_buf );
 219
 220     for( i = 0; i < 8; i++ )
 221     {
 222         p_guid->Data4[i] = var_buffer_get8( p_buf );
 223     }
 224 }