]> The Tcpdump Group git mirrors - tcpdump/blobdiff - print-geonet.c
More UNALIGNED_MEM{CPY,CMP} on IP addresses.
[tcpdump] / print-geonet.c
index b9c60ddc3055423b6c950cd2b9337b237976dad9..c268e856f05d3e7b3b4db8a7d3421372a9369dee 100644 (file)
@@ -1,20 +1,18 @@
 /*
- * Copyright (c) 2013
- *     [email protected]  All rights reserved.
+ * Copyright (c) 2013 The TCPDUMP project
  *
  * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that: (1) source code distributions
- * retain the above copyright notice and this paragraph in its entirety, (2)
- * distributions including binary code include the above copyright notice and
- * this paragraph in its entirety in the documentation or other materials
- * provided with the distribution, and (3) all advertising materials mentioning
- * features or use of this software display the following acknowledgement:
- * ``This product includes software developed by Paolo Abeni.'' 
- * The name of author may not be used to endorse or promote products derived 
- * from this software without specific prior written permission.
- * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR IMPLIED
- * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF
- * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
+ * modification, are permitted provided that: (1) source code
+ * distributions retain the above copyright notice and this paragraph
+ * in its entirety, and (2) distributions including binary code include
+ * the above copyright notice and this paragraph in its entirety in
+ * the documentation or other materials provided with the distribution.
+ * THIS SOFTWARE IS PROVIDED ``AS IS'' AND
+ * WITHOUT ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, WITHOUT
+ * LIMITATION, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
+ * FOR A PARTICULAR PURPOSE.
+ *
+ * Original code by Ola Martin Lykkja ([email protected])
  */
 
 #ifdef HAVE_CONFIG_H
    Sub-part 1: Media-Independent Functionality
 */
 
-static const char *
-hex48_to_string(const u_char *bp)
-{
-       int i;
-       static char sz[6*3+2];
-       memset(sz, 0, sizeof(sz));
-       for (i=0; i<6; i++) {
-               if (i) strcat(sz,":");
-               sprintf(sz+strlen(sz), "%02x", bp[i]);
-       }
-       return sz;
-}
+static const struct tok msg_type_values[] = {
+       {   0, "CAM" },
+       {   1, "DENM" },
+       { 101, "TPEGM" },
+       { 102, "TSPDM" },
+       { 103, "VPM" },
+       { 104, "SRM" },
+       { 105, "SLAM" },
+       { 106, "ecoCAM" },
+       { 107, "ITM" },
+       { 150, "SA" },
+       {   0, NULL }
+};
 
 static void
 print_btp_body(const u_char *bp, u_int length)
 {
-       // Assuming ItsDpuHeader
-       int version = bp[0];
-       int msg_type = bp[1];
-       const char *msg_type_str = "Unknown";
+       int version;
+       int msg_type;
+       const char *msg_type_str;
 
-       switch (msg_type) {
-               case   0: msg_type_str = "CAM"; break;
-               case   1: msg_type_str = "DENM"; break;
-               case 101: msg_type_str = "TPEGM"; break;
-               case 102: msg_type_str = "TSPDM"; break;
-               case 103: msg_type_str = "VPM"; break;
-               case 104: msg_type_str = "SRM"; break;
-               case 105: msg_type_str = "SLAM"; break;
-               case 106: msg_type_str = "ecoCAM"; break;
-               case 107: msg_type_str = "ITM"; break;
-               case 150: msg_type_str = "SA"; break;
+       if (length <= 2) {
+               return;
        }
+
+       /* Assuming ItsDpuHeader */
+       version = bp[0];
+       msg_type = bp[1];
+       msg_type_str = tok2str(msg_type_values, "unknown (%u)", msg_type);
+
        printf("; ItsPduHeader v:%d t:%d-%s", version, msg_type, msg_type_str);
 }
 
 static void
-print_btp(const u_char *bp, u_int length)
+print_btp(const u_char *bp)
 {
        u_int16_t dest = EXTRACT_16BITS(bp+0);
        u_int16_t src = EXTRACT_16BITS(bp+2);
@@ -88,7 +83,7 @@ print_btp(const u_char *bp, u_int length)
 }
 
 static void
-print_long_pos_vector(const char *type, const u_char *bp, u_int length)
+print_long_pos_vector(const u_char *bp)
 {
        int i;
        u_int32_t lat, lon;
@@ -114,10 +109,10 @@ print_long_pos_vector(const char *type, const u_char *bp, u_int length)
 void
 geonet_print(netdissect_options *ndo, const u_char *eth, const u_char *bp, u_int length)
 {
-       printf("GeoNet src:%s; ", hex48_to_string(eth+6));
+       printf("GeoNet src:%s; ", etheraddr_string(eth+6));
 
        if (length >= 36) {
-               // Process Common Header
+               /* Process Common Header */
                int version = bp[0] >> 4;
                int next_hdr = bp[0] & 0x0f;
                int hdr_type = bp[1] >> 4;
@@ -168,13 +163,13 @@ geonet_print(netdissect_options *ndo, const u_char *eth, const u_char *bp, u_int
                printf("HT:%d-%d-%s ", hdr_type, hdr_subtype, hdr_type_txt);
                printf("HopLim:%d ", hop_limit);
                printf("Payload:%d ", payload_length);
-               print_long_pos_vector("Sender", bp + 8, 36-8);
+               print_long_pos_vector(bp + 8);
 
-               // Skip Common Header
+               /* Skip Common Header */
                length -= 36;
                bp += 36;
 
-               // Process Extended Headers
+               /* Process Extended Headers */
                switch (hdr_type) {
                        case 0: /* Any */
                                hdr_size = 0;
@@ -220,7 +215,7 @@ geonet_print(netdissect_options *ndo, const u_char *eth, const u_char *bp, u_int
                                break;
                }
 
-               // Skip Extended headers
+               /* Skip Extended headers */
                if (hdr_size >= 0) {
                        length -= hdr_size;
                        bp += hdr_size;
@@ -229,7 +224,7 @@ geonet_print(netdissect_options *ndo, const u_char *eth, const u_char *bp, u_int
                                        break;
                                case 1:
                                case 2: /* BTP A/B */
-                                       print_btp(bp, length);
+                                       print_btp(bp);
                                        length -= 4;
                                        bp += 4;
                                        print_btp_body(bp, length);
@@ -242,7 +237,7 @@ geonet_print(netdissect_options *ndo, const u_char *eth, const u_char *bp, u_int
                printf("Malformed (small) ");
        }
 
-       // Print user data part
+       /* Print user data part */
        if (ndo->ndo_vflag)
                default_print(bp, length);
 }