109 lines
2.7 KiB
C
109 lines
2.7 KiB
C
/*
|
|
* Copyright (C) 2012 Michael Brown <mbrown@fensystems.co.uk>.
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License as
|
|
* published by the Free Software Foundation; either version 2 of the
|
|
* License, or (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
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
* General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU 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.
|
|
*/
|
|
|
|
FILE_LICENCE ( GPL2_OR_LATER );
|
|
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <errno.h>
|
|
#include <ipxe/xfer.h>
|
|
#include <ipxe/iobuf.h>
|
|
#include <ipxe/xferbuf.h>
|
|
|
|
/** @file
|
|
*
|
|
* Data transfer buffer
|
|
*
|
|
*/
|
|
|
|
/**
|
|
* Finish using data transfer buffer
|
|
*
|
|
* @v xferbuf Data transfer buffer
|
|
*/
|
|
void xferbuf_done ( struct xfer_buffer *xferbuf ) {
|
|
free ( xferbuf->data );
|
|
xferbuf->data = NULL;
|
|
xferbuf->len = 0;
|
|
xferbuf->pos = 0;
|
|
}
|
|
|
|
/**
|
|
* Ensure that data transfer buffer is large enough for the specified size
|
|
*
|
|
* @v xferbuf Data transfer buffer
|
|
* @v len Required minimum size
|
|
* @ret rc Return status code
|
|
*/
|
|
static int xferbuf_ensure_size ( struct xfer_buffer *xferbuf, size_t len ) {
|
|
void *new_data;
|
|
|
|
/* If buffer is already large enough, do nothing */
|
|
if ( len <= xferbuf->len )
|
|
return 0;
|
|
|
|
/* Extend buffer */
|
|
new_data = realloc ( xferbuf->data, len );
|
|
if ( ! new_data ) {
|
|
DBGC ( xferbuf, "XFERBUF %p could not extend buffer to "
|
|
"%zd bytes\n", xferbuf, len );
|
|
return -ENOSPC;
|
|
}
|
|
xferbuf->data = new_data;
|
|
xferbuf->len = len;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* Add received data to data transfer buffer
|
|
*
|
|
* @v xferbuf Data transfer buffer
|
|
* @v iobuf I/O buffer
|
|
* @v meta Data transfer metadata
|
|
* @ret rc Return status code
|
|
*/
|
|
int xferbuf_deliver ( struct xfer_buffer *xferbuf, struct io_buffer *iobuf,
|
|
struct xfer_metadata *meta ) {
|
|
size_t len;
|
|
size_t max;
|
|
int rc;
|
|
|
|
/* Calculate new buffer position */
|
|
if ( meta->flags & XFER_FL_ABS_OFFSET )
|
|
xferbuf->pos = 0;
|
|
xferbuf->pos += meta->offset;
|
|
|
|
/* Ensure that we have enough buffer space for this data */
|
|
len = iob_len ( iobuf );
|
|
max = ( xferbuf->pos + len );
|
|
if ( ( rc = xferbuf_ensure_size ( xferbuf, max ) ) != 0 )
|
|
goto done;
|
|
|
|
/* Copy data to buffer */
|
|
memcpy ( ( xferbuf->data + xferbuf->pos ), iobuf->data, len );
|
|
|
|
/* Update current buffer position */
|
|
xferbuf->pos += len;
|
|
|
|
done:
|
|
free_iob ( iobuf );
|
|
return rc;
|
|
}
|