| 1 | /* |
| 2 | Copyright (c) 2012, Broadcom Europe Ltd |
| 3 | All rights reserved. |
| 4 | |
| 5 | Redistribution and use in source and binary forms, with or without |
| 6 | modification, are permitted provided that the following conditions are met: |
| 7 | * Redistributions of source code must retain the above copyright |
| 8 | notice, this list of conditions and the following disclaimer. |
| 9 | * Redistributions in binary form must reproduce the above copyright |
| 10 | notice, this list of conditions and the following disclaimer in the |
| 11 | documentation and/or other materials provided with the distribution. |
| 12 | * Neither the name of the copyright holder nor the |
| 13 | names of its contributors may be used to endorse or promote products |
| 14 | derived from this software without specific prior written permission. |
| 15 | |
| 16 | THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND |
| 17 | ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED |
| 18 | WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE |
| 19 | DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY |
| 20 | DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES |
| 21 | (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; |
| 22 | LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND |
| 23 | ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
| 24 | (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS |
| 25 | SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| 26 | */ |
| 27 | |
| 28 | #include <stdlib.h> |
| 29 | #include <string.h> |
| 30 | #include <stdio.h> |
| 31 | #include <limits.h> |
| 32 | |
| 33 | #include "containers/containers.h" |
| 34 | #include "containers/core/containers_common.h" |
| 35 | #include "containers/core/containers_io.h" |
| 36 | #include "containers/core/containers_uri.h" |
| 37 | |
| 38 | /** Native byte order word */ |
| 39 | #define NATIVE_BYTE_ORDER 0x50415753 |
| 40 | /** Reverse of native byte order - need to swap bytes around */ |
| 41 | #define SWAP_BYTE_ORDER 0x53574150 |
| 42 | |
| 43 | typedef struct VC_CONTAINER_IO_MODULE_T |
| 44 | { |
| 45 | FILE *stream; |
| 46 | bool is_native_order; |
| 47 | } VC_CONTAINER_IO_MODULE_T; |
| 48 | |
| 49 | /** List of recognised schemes. |
| 50 | * Note: always use lower case for the scheme name. */ |
| 51 | static const char * recognised_schemes[] = { |
| 52 | "rtp" , "rtppkt" , "rtsp" , "rtsppkt" , "pktfile" , |
| 53 | }; |
| 54 | |
| 55 | VC_CONTAINER_STATUS_T vc_container_io_pktfile_open( VC_CONTAINER_IO_T *, const char *, |
| 56 | VC_CONTAINER_IO_MODE_T ); |
| 57 | |
| 58 | /*****************************************************************************/ |
| 59 | static bool recognise_scheme(const char *scheme) |
| 60 | { |
| 61 | size_t ii; |
| 62 | |
| 63 | if (!scheme) |
| 64 | return false; |
| 65 | |
| 66 | for (ii = 0; ii < countof(recognised_schemes); ii++) |
| 67 | { |
| 68 | if (strcmp(recognised_schemes[ii], scheme) == 0) |
| 69 | return true; |
| 70 | } |
| 71 | |
| 72 | return false; |
| 73 | } |
| 74 | |
| 75 | /*****************************************************************************/ |
| 76 | static uint32_t swap_byte_order( uint32_t value ) |
| 77 | { |
| 78 | /* Reverse the order of the bytes in the word */ |
| 79 | return ((value << 24) | ((value & 0xFF00) << 8) | ((value >> 8) & 0xFF00) | (value >> 24)); |
| 80 | } |
| 81 | |
| 82 | /*****************************************************************************/ |
| 83 | static VC_CONTAINER_STATUS_T io_pktfile_close( VC_CONTAINER_IO_T *p_ctx ) |
| 84 | { |
| 85 | VC_CONTAINER_IO_MODULE_T *module = p_ctx->module; |
| 86 | fclose(module->stream); |
| 87 | free(module); |
| 88 | return VC_CONTAINER_SUCCESS; |
| 89 | } |
| 90 | |
| 91 | /*****************************************************************************/ |
| 92 | static size_t io_pktfile_read(VC_CONTAINER_IO_T *p_ctx, void *buffer, size_t size) |
| 93 | { |
| 94 | VC_CONTAINER_IO_MODULE_T *module = p_ctx->module; |
| 95 | uint32_t length = 0; |
| 96 | size_t ret; |
| 97 | |
| 98 | ret = fread(&length, 1, sizeof(length), module->stream); |
| 99 | if (ret != sizeof(length)) |
| 100 | { |
| 101 | if( feof(module->stream) ) p_ctx->status = VC_CONTAINER_ERROR_EOS; |
| 102 | else p_ctx->status = VC_CONTAINER_ERROR_FAILED; |
| 103 | return 0; |
| 104 | } |
| 105 | |
| 106 | if (!module->is_native_order) |
| 107 | length = swap_byte_order(length); |
| 108 | |
| 109 | if (length > 1<<20) |
| 110 | { |
| 111 | p_ctx->status = VC_CONTAINER_ERROR_FAILED; |
| 112 | return 0; |
| 113 | } |
| 114 | |
| 115 | if (size > length) |
| 116 | size = length; |
| 117 | ret = fread(buffer, 1, size, module->stream); |
| 118 | if(ret != size) |
| 119 | { |
| 120 | if( feof(module->stream) ) p_ctx->status = VC_CONTAINER_ERROR_EOS; |
| 121 | else p_ctx->status = VC_CONTAINER_ERROR_FAILED; |
| 122 | } |
| 123 | else if (length > size) |
| 124 | { |
| 125 | /* Not enough space to read all the packet, so skip to the next one. */ |
| 126 | length -= size; |
| 127 | vc_container_assert((long)length > 0); |
| 128 | fseek(module->stream, (long)length, SEEK_CUR); |
| 129 | } |
| 130 | |
| 131 | return ret; |
| 132 | } |
| 133 | |
| 134 | /*****************************************************************************/ |
| 135 | static size_t io_pktfile_write(VC_CONTAINER_IO_T *p_ctx, const void *buffer, size_t size) |
| 136 | { |
| 137 | uint32_t size_word; |
| 138 | size_t ret; |
| 139 | |
| 140 | if (size >= 0xFFFFFFFFUL) |
| 141 | size_word = 0xFFFFFFFFUL; |
| 142 | else |
| 143 | size_word = (uint32_t)size; |
| 144 | |
| 145 | ret = fwrite(&size_word, 1, sizeof(size_word), p_ctx->module->stream); |
| 146 | if (ret != sizeof(size_word)) |
| 147 | { |
| 148 | p_ctx->status = VC_CONTAINER_ERROR_FAILED; |
| 149 | return 0; |
| 150 | } |
| 151 | |
| 152 | ret = fwrite(buffer, 1, size_word, p_ctx->module->stream); |
| 153 | if (ret != size_word) |
| 154 | p_ctx->status = VC_CONTAINER_ERROR_FAILED; |
| 155 | if (fflush(p_ctx->module->stream) != 0) |
| 156 | p_ctx->status = VC_CONTAINER_ERROR_FAILED; |
| 157 | |
| 158 | return ret; |
| 159 | } |
| 160 | |
| 161 | /*****************************************************************************/ |
| 162 | static FILE *open_file(VC_CONTAINER_IO_T *ctx, VC_CONTAINER_IO_MODE_T mode, |
| 163 | VC_CONTAINER_STATUS_T *p_status) |
| 164 | { |
| 165 | const char *psz_mode = mode == VC_CONTAINER_IO_MODE_WRITE ? "wb+" : "rb" ; |
| 166 | FILE *stream = 0; |
| 167 | const char *port, *path; |
| 168 | |
| 169 | /* Treat empty port or path strings as not defined */ |
| 170 | port = vc_uri_port(ctx->uri_parts); |
| 171 | if (port && !*port) |
| 172 | port = NULL; |
| 173 | |
| 174 | path = vc_uri_path(ctx->uri_parts); |
| 175 | if (path && !*path) |
| 176 | path = NULL; |
| 177 | |
| 178 | /* Require the port to be undefined and the path to be defined */ |
| 179 | if (port || !path) { *p_status = VC_CONTAINER_ERROR_URI_OPEN_FAILED; goto error; } |
| 180 | |
| 181 | if (!recognise_scheme(vc_uri_scheme(ctx->uri_parts))) |
| 182 | { *p_status = VC_CONTAINER_ERROR_URI_NOT_FOUND; goto error; } |
| 183 | |
| 184 | stream = fopen(path, psz_mode); |
| 185 | if(!stream) { *p_status = VC_CONTAINER_ERROR_URI_NOT_FOUND; goto error; } |
| 186 | |
| 187 | *p_status = VC_CONTAINER_SUCCESS; |
| 188 | return stream; |
| 189 | |
| 190 | error: |
| 191 | return NULL; |
| 192 | } |
| 193 | |
| 194 | /*****************************************************************************/ |
| 195 | static VC_CONTAINER_STATUS_T write_byte_order(FILE *stream) |
| 196 | { |
| 197 | /* Simple byte order header word */ |
| 198 | uint32_t value = NATIVE_BYTE_ORDER; |
| 199 | |
| 200 | if (fwrite(&value, 1, sizeof(value), stream) != sizeof(value)) |
| 201 | return VC_CONTAINER_ERROR_OUT_OF_SPACE; |
| 202 | |
| 203 | return VC_CONTAINER_SUCCESS; |
| 204 | } |
| 205 | |
| 206 | /*****************************************************************************/ |
| 207 | static VC_CONTAINER_STATUS_T read_byte_order(FILE *stream, bool *is_native) |
| 208 | { |
| 209 | uint32_t value; |
| 210 | |
| 211 | if (fread(&value, 1, sizeof(value), stream) != sizeof(value)) |
| 212 | return VC_CONTAINER_ERROR_EOS; |
| 213 | |
| 214 | switch (value) |
| 215 | { |
| 216 | case NATIVE_BYTE_ORDER: *is_native = true; break; |
| 217 | case SWAP_BYTE_ORDER: *is_native = false; break; |
| 218 | default: return VC_CONTAINER_ERROR_CORRUPTED; |
| 219 | } |
| 220 | |
| 221 | return VC_CONTAINER_SUCCESS; |
| 222 | } |
| 223 | |
| 224 | /*****************************************************************************/ |
| 225 | VC_CONTAINER_STATUS_T vc_container_io_pktfile_open( VC_CONTAINER_IO_T *p_ctx, |
| 226 | const char *unused, VC_CONTAINER_IO_MODE_T mode ) |
| 227 | { |
| 228 | VC_CONTAINER_STATUS_T status = VC_CONTAINER_SUCCESS; |
| 229 | VC_CONTAINER_IO_MODULE_T *module = 0; |
| 230 | FILE *stream = 0; |
| 231 | bool is_native_order = true; |
| 232 | VC_CONTAINER_PARAM_UNUSED(unused); |
| 233 | |
| 234 | stream = open_file(p_ctx, mode, &status); |
| 235 | if (status != VC_CONTAINER_SUCCESS) goto error; |
| 236 | |
| 237 | if (mode == VC_CONTAINER_IO_MODE_WRITE) |
| 238 | status = write_byte_order(stream); |
| 239 | else |
| 240 | status = read_byte_order(stream, &is_native_order); |
| 241 | if (status != VC_CONTAINER_SUCCESS) goto error; |
| 242 | |
| 243 | module = malloc( sizeof(*module) ); |
| 244 | if(!module) { status = VC_CONTAINER_ERROR_OUT_OF_MEMORY; goto error; } |
| 245 | memset(module, 0, sizeof(*module)); |
| 246 | |
| 247 | p_ctx->module = module; |
| 248 | module->stream = stream; |
| 249 | module->is_native_order = is_native_order; |
| 250 | p_ctx->pf_close = io_pktfile_close; |
| 251 | p_ctx->pf_read = io_pktfile_read; |
| 252 | p_ctx->pf_write = io_pktfile_write; |
| 253 | |
| 254 | /* Do not allow caching by I/O core, as this will merge packets in the cache. */ |
| 255 | p_ctx->capabilities = VC_CONTAINER_IO_CAPS_CANT_SEEK; |
| 256 | return VC_CONTAINER_SUCCESS; |
| 257 | |
| 258 | error: |
| 259 | if(stream) fclose(stream); |
| 260 | return status; |
| 261 | } |
| 262 | |