bgp: Parse BGP extended message support capability

[tcpdump] / cpack.c

diff --git a/cpack.c b/cpack.c
index d2e765d4900042520b4f2931d971b33e950f7773..9be7b47d85121f929fe339306e70be7b500fa681 100644 (file)
--- a/cpack.c
+++ b/cpack.c
@@ -28,17 +28,20 @@
  */
 
 #ifdef HAVE_CONFIG_H
  */
 
 #ifdef HAVE_CONFIG_H

-#include "config.h"
+#include <config.h>

 #endif
 
 #include <stdlib.h>
 #endif
 
 #include <stdlib.h>

-#include <tcpdump-stdinc.h>
+#include <string.h>
+#include "netdissect-stdinc.h"

 
 

-#include "cpack.h"
+#include "netdissect.h"

 #include "extract.h"
 
 #include "extract.h"
 

-static u_int8_t *
-cpack_next_boundary(u_int8_t *buf, u_int8_t *p, size_t alignment)
+#include "cpack.h"
+
+const uint8_t *
+nd_cpack_next_boundary(const uint8_t *buf, const uint8_t *p, size_t alignment)

 {
        size_t misalignment = (size_t)(p - buf) % alignment;
 
 {
        size_t misalignment = (size_t)(p - buf) % alignment;
 


@@ -52,13 +55,13 @@ cpack_next_boundary(u_int8_t *buf, u_int8_t *p, size_t alignment)
  * wordsize bytes remain in the buffer after the boundary.  Otherwise,
  * return a pointer to the boundary.
  */
  * wordsize bytes remain in the buffer after the boundary.  Otherwise,
  * return a pointer to the boundary.
  */

-static u_int8_t *
-cpack_align_and_reserve(struct cpack_state *cs, size_t wordsize)
+const uint8_t *
+nd_cpack_align_and_reserve(struct cpack_state *cs, size_t wordsize)

 {
 {

-       u_int8_t *next;
+       const uint8_t *next;

 
        /* Ensure alignment. */
 
        /* Ensure alignment. */

-       next = cpack_next_boundary(cs->c_buf, cs->c_next, wordsize);
+       next = nd_cpack_next_boundary(cs->c_buf, cs->c_next, wordsize);

 
        /* Too little space for wordsize bytes? */
        if (next - cs->c_buf + wordsize > cs->c_len)
 
        /* Too little space for wordsize bytes? */
        if (next - cs->c_buf + wordsize > cs->c_len)


@@ -67,8 +70,19 @@ cpack_align_and_reserve(struct cpack_state *cs, size_t wordsize)
        return next;
 }
 
        return next;
 }
 

+/* Advance by N bytes without returning them. */

 int
 int

-cpack_init(struct cpack_state *cs, u_int8_t *buf, size_t buflen)
+nd_cpack_advance(struct cpack_state *cs, const size_t toskip)
+{
+       /* No space left? */
+       if (cs->c_next - cs->c_buf + toskip > cs->c_len)
+               return -1;
+       cs->c_next += toskip;
+       return 0;
+}
+
+int
+nd_cpack_init(struct cpack_state *cs, const uint8_t *buf, size_t buflen)

 {
        memset(cs, 0, sizeof(*cs));
 
 {
        memset(cs, 0, sizeof(*cs));
 


@@ -81,63 +95,126 @@ cpack_init(struct cpack_state *cs, u_int8_t *buf, size_t buflen)
 
 /* Unpack a 64-bit unsigned integer. */
 int
 
 /* Unpack a 64-bit unsigned integer. */
 int

-cpack_uint64(struct cpack_state *cs, u_int64_t *u)
+nd_cpack_uint64(netdissect_options *ndo, struct cpack_state *cs, uint64_t *u)

 {
 {

-       u_int8_t *next;
+       const uint8_t *next;

 
 

-       if ((next = cpack_align_and_reserve(cs, sizeof(*u))) == NULL)
+       if ((next = nd_cpack_align_and_reserve(cs, sizeof(*u))) == NULL)

                return -1;
 
                return -1;
 

-       *u = EXTRACT_LE_64BITS(next);
+       *u = GET_LE_U_8(next);

 
 

-       /* Move pointer past the u_int64_t. */
+       /* Move pointer past the uint64_t. */
+       cs->c_next = next + sizeof(*u);
+       return 0;
+}
+
+/* Unpack a 64-bit signed integer. */
+int
+nd_cpack_int64(netdissect_options *ndo, struct cpack_state *cs, int64_t *u)
+{
+       const uint8_t *next;
+
+       if ((next = nd_cpack_align_and_reserve(cs, sizeof(*u))) == NULL)
+               return -1;
+
+       *u = GET_LE_S_8(next);
+
+       /* Move pointer past the int64_t. */

        cs->c_next = next + sizeof(*u);
        return 0;
 }
 
 /* Unpack a 32-bit unsigned integer. */
 int
        cs->c_next = next + sizeof(*u);
        return 0;
 }
 
 /* Unpack a 32-bit unsigned integer. */
 int

-cpack_uint32(struct cpack_state *cs, u_int32_t *u)
+nd_cpack_uint32(netdissect_options *ndo, struct cpack_state *cs, uint32_t *u)
+{
+       const uint8_t *next;
+
+       if ((next = nd_cpack_align_and_reserve(cs, sizeof(*u))) == NULL)
+               return -1;
+
+       *u = GET_LE_U_4(next);
+
+       /* Move pointer past the uint32_t. */
+       cs->c_next = next + sizeof(*u);
+       return 0;
+}
+
+/* Unpack a 32-bit signed integer. */
+int
+nd_cpack_int32(netdissect_options *ndo, struct cpack_state *cs, int32_t *u)

 {
 {

-       u_int8_t *next;
+       const uint8_t *next;

 
 

-       if ((next = cpack_align_and_reserve(cs, sizeof(*u))) == NULL)
+       if ((next = nd_cpack_align_and_reserve(cs, sizeof(*u))) == NULL)

                return -1;
 
                return -1;
 

-       *u = EXTRACT_LE_32BITS(next);
+       *u = GET_LE_S_4(next);

 
 

-       /* Move pointer past the u_int32_t. */
+       /* Move pointer past the int32_t. */

        cs->c_next = next + sizeof(*u);
        return 0;
 }
 
 /* Unpack a 16-bit unsigned integer. */
 int
        cs->c_next = next + sizeof(*u);
        return 0;
 }
 
 /* Unpack a 16-bit unsigned integer. */
 int

-cpack_uint16(struct cpack_state *cs, u_int16_t *u)
+nd_cpack_uint16(netdissect_options *ndo, struct cpack_state *cs, uint16_t *u)

 {
 {

-       u_int8_t *next;
+       const uint8_t *next;

 
 

-       if ((next = cpack_align_and_reserve(cs, sizeof(*u))) == NULL)
+       if ((next = nd_cpack_align_and_reserve(cs, sizeof(*u))) == NULL)

                return -1;
 
                return -1;
 

-       *u = EXTRACT_LE_16BITS(next);
+       *u = GET_LE_U_2(next);

 
 

-       /* Move pointer past the u_int16_t. */
+       /* Move pointer past the uint16_t. */
+       cs->c_next = next + sizeof(*u);
+       return 0;
+}
+
+/* Unpack a 16-bit signed integer. */
+int
+nd_cpack_int16(netdissect_options *ndo, struct cpack_state *cs, int16_t *u)
+{
+       const uint8_t *next;
+
+       if ((next = nd_cpack_align_and_reserve(cs, sizeof(*u))) == NULL)
+               return -1;
+
+       *u = GET_LE_S_2(next);
+
+       /* Move pointer past the int16_t. */

        cs->c_next = next + sizeof(*u);
        return 0;
 }
 
 /* Unpack an 8-bit unsigned integer. */
 int
        cs->c_next = next + sizeof(*u);
        return 0;
 }
 
 /* Unpack an 8-bit unsigned integer. */
 int

-cpack_uint8(struct cpack_state *cs, u_int8_t *u)
+nd_cpack_uint8(netdissect_options *ndo, struct cpack_state *cs, uint8_t *u)
+{
+       /* No space left? */
+       if ((size_t)(cs->c_next - cs->c_buf) >= cs->c_len)
+               return -1;
+
+       *u = GET_U_1(cs->c_next);
+
+       /* Move pointer past the uint8_t. */
+       cs->c_next++;
+       return 0;
+}
+
+/* Unpack an 8-bit signed integer. */
+int
+nd_cpack_int8(netdissect_options *ndo, struct cpack_state *cs, int8_t *u)

 {
        /* No space left? */
 {
        /* No space left? */

-       if (cs->c_next - cs->c_buf >= cs->c_len)
+       if ((size_t)(cs->c_next - cs->c_buf) >= cs->c_len)

                return -1;
 
                return -1;
 

-       *u = *cs->c_next;
+       *u = GET_S_1(cs->c_next);

 
 

-       /* Move pointer past the u_int8_t. */
+       /* Move pointer past the int8_t. */

        cs->c_next++;
        return 0;
 }
        cs->c_next++;
        return 0;
 }