|
@@ -0,0 +1,66 @@
|
|
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
|
+ * Packet buffer padding
|
|
23
|
+ *
|
|
24
|
+ */
|
|
25
|
+
|
|
26
|
+#include <string.h>
|
|
27
|
+#include <gpxe/pkbuff.h>
|
|
28
|
+
|
|
29
|
+/**
|
|
30
|
+ * Pad packet buffer
|
|
31
|
+ *
|
|
32
|
+ * @v pkb Packet buffer
|
|
33
|
+ * @v min_len Minimum length
|
|
34
|
+ *
|
|
35
|
+ * This function pads and aligns packet 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 PKB_ALIGN.
|
|
39
|
+ *
|
|
40
|
+ * @c min_len must not exceed @v PKB_ZLEN.
|
|
41
|
+ */
|
|
42
|
+void pkb_pad ( struct pk_buff *pkb, 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 <= PKB_ZLEN );
|
|
49
|
+
|
|
50
|
+ /* Move packet data to start of packet buffer. This will both
|
|
51
|
+ * align the data (since packet buffers are aligned to
|
|
52
|
+ * PKB_ALIGN) and give us sufficient space for the
|
|
53
|
+ * zero-padding
|
|
54
|
+ */
|
|
55
|
+ data = pkb->data;
|
|
56
|
+ len = pkb_len ( pkb );
|
|
57
|
+ headroom = pkb_headroom ( pkb );
|
|
58
|
+ pkb_push ( pkb, headroom );
|
|
59
|
+ memmove ( pkb->data, data, len );
|
|
60
|
+ pkb_unput ( pkb, headroom );
|
|
61
|
+
|
|
62
|
+ /* Pad to minimum packet length */
|
|
63
|
+ pad_len = ( min_len - pkb_len ( pkb ) );
|
|
64
|
+ if ( pad_len > 0 )
|
|
65
|
+ memset ( pkb_put ( pkb, pad_len ), 0, pad_len );
|
|
66
|
+}
|