SS7 MTP Layer 2/3 Implementation (partly)

src/libdebug/debug.c

@@ -75,6 +75,8 @@ struct debug_cat {
 	{ "sim layer 2", "\033[0;33m" },
 	{ "sim ICL layer", "\033[0;36m" },
 	{ "sim layer 7", "\033[0;37m" },
+	{ "mtp layer 2", "\033[1;33m" },
+	{ "mtp layer 3", "\033[1;36m" },
 	{ NULL, NULL }
 };
 
@@ -233,3 +235,22 @@ int parse_debug_opt(const char *optarg)
 	return 0;
 }
 
+const char *debug_hex(const uint8_t *data, int len)
+{
+	static char *text = NULL;
+	char *p;
+	int i;
+
+	if (text)
+		free(text);
+	p = text = calloc(1, len * 3 + 1);
+	for (i = 0; i < len; i++) {
+		sprintf(p, "%02x ", *data++);
+		p += 3;
+	}
+	if (text[0])
+		p[-1] = '\0';
+
+	return text;
+}
+

src/libdebug/debug.h

@@ -38,6 +38,8 @@
 #define DSIM2		31
 #define DSIMI		32
 #define DSIM7		33
+#define DMTP2		34
+#define DMTP3		35
 
 void get_win_size(int *w, int *h);
 
@@ -58,3 +60,5 @@ extern void (*print_console_text)(void);
 
 extern int debug_limit_scroll;
 
+const char *debug_hex(const uint8_t *data, int len);
+