Rename pkbpad.c to iobpad.c
[people/oremanj/gpxe.git] / src / net / iobpad.c
1 /*
2  * Copyright (C) 2007 Michael Brown <mbrown@fensystems.co.uk>.
3  *
4  * This program is free software; you can redistribute it and/or
5  * modify it under the terms of the GNU General Public License as
6  * published by the Free Software Foundation; either version 2 of the
7  * License, or any later version.
8  *
9  * This program is distributed in the hope that it will be useful, but
10  * WITHOUT ANY WARRANTY; without even the implied warranty of
11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
12  * General Public License for more details.
13  *
14  * You should have received a copy of the GNU General Public License
15  * along with this program; if not, write to the Free Software
16  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
17  */
18
19 /**
20  * @file
21  *
22  * I/O buffer padding
23  *
24  */
25
26 #include <string.h>
27 #include <gpxe/iobuf.h>
28
29 /**
30  * Pad I/O buffer
31  *
32  * @v iobuf             I/O buffer
33  * @v min_len           Minimum length
34  *
35  * This function pads and aligns I/O buffers, for devices that
36  * aren't capable of padding in hardware, or that require specific
37  * alignment in TX buffers.  The packet data will end up aligned to a
38  * multiple of @c IOB_ALIGN.
39  *
40  * @c min_len must not exceed @v IOB_ZLEN.
41  */
42 void iob_pad ( struct io_buffer *iobuf, size_t min_len ) {
43         void *data;
44         size_t len;
45         size_t headroom;
46         signed int pad_len;
47
48         assert ( min_len <= IOB_ZLEN );
49
50         /* Move packet data to start of I/O buffer.  This will both
51          * align the data (since I/O buffers are aligned to
52          * IOB_ALIGN) and give us sufficient space for the
53          * zero-padding
54          */
55         data = iobuf->data;
56         len = iob_len ( iobuf );
57         headroom = iob_headroom ( iobuf );
58         iob_push ( iobuf, headroom );
59         memmove ( iobuf->data, data, len );
60         iob_unput ( iobuf, headroom );
61
62         /* Pad to minimum packet length */
63         pad_len = ( min_len - iob_len ( iobuf ) );
64         if ( pad_len > 0 )
65                 memset ( iob_put ( iobuf, pad_len ), 0, pad_len );
66 }