utils.h: hex dump

src/commands_creator.h

@@ -15,14 +15,22 @@
 #pragma pack(push)
 #pragma pack(1)
 typedef struct connect_r_packet {
-    uint32_t port;
-    uint8_t ip_counts;
-    char type[64];
-    char ips[];
+    uint32_t    port;
+    uint8_t     ip_counts;
+    char        type[64];
+    char        ips[];
 } connect_r_packet_t;
+
+typedef struct connect_packet {
+    uint32_t    port;   ///< Peer port
+    char        *name;  ///< Peer name
+    char        *addr;  ///< Peer IP address
+} connect_packet_t;
+
 #pragma pack(pop)
 
 uint8_t* createCmdConnectRPacketUdp(ksnetEvMgrClass *event_manager, size_t *size_out);
 uint8_t* createCmdConnectRPacketTcp(ksnetEvMgrClass *event_manager, size_t *size_out);
+uint8_t* createCmdConnectPacket(ksnetEvMgrClass *event_manager, size_t *size_out);
 
 #endif

src/ev_mgr.c

@@ -735,11 +735,13 @@ void connect_r_host_cb(ksnetEvMgrClass *ke) {
         // Send data to r-host
         ksnCoreSendto(ke->kc, ke->teo_cfg.r_host_addr, ke->teo_cfg.r_port,
                       CMD_CONNECT_R, data, packet_size);
+
         #ifdef DEBUG_KSNET
         ksn_printf(ke, MODULE, DEBUG_VV, "send CMD_CONNECT_R = %u to r-host peer by address %s:%d.\n",
             CMD_CONNECT_R, ke->teo_cfg.r_host_addr, ke->teo_cfg.r_port);
         #endif
 
+        printHexDump(data, packet_size);
         free(data);
     }
 }

src/utils/utils.c

@@ -766,6 +766,45 @@ int ip_to_array(char* ip, uint8_t *arr) {
     return i;
 }
 
+void printHexDump(void *addr, size_t len)  {
+    unsigned char buf[17];
+    unsigned char *pc = addr;
+    size_t i = 0;
+    for (i = 0; i < len; i++) {
+        if ((i % 16) == 0) {
+            if (i != 0) {
+                printf("  %s\n", buf);
+            }
+
+            // print offset.
+            printf("  %04lx ", i);
+        }
+
+        // Now the hex code for the specific character.
+        printf(" %02x", pc[i]);
+        if ((i % 8) == 0) {
+            printf("  ");
+        }
+
+        // And store a printable ASCII character for later.
+        if ((pc[i] < 0x20) || (pc[i] > 0x7e)) {
+            buf[i % 16] = '.';
+        } else {
+            buf[i % 16] = pc[i];
+        }
+
+        buf[(i % 16) + 1] = '\0';
+    }
+
+
+    while ((i % 16) != 0) {
+        printf("   ");
+        i++;
+    }
+
+    printf("    %s\n", buf);
+}
+
 /**
  * Detect if input IP address is private
  *

src/utils/utils.h

@@ -112,6 +112,8 @@ unsigned char *ksn_base64_decode(const char *data,
 
 void dump_bytes(char *buffer, int buffer_len, uint8_t* data, int data_len);
 
+void printHexDump(void *addr, size_t len);
+
 #ifdef	__cplusplus
 }
 #endif