add failed connection message CMDU

src/cmdu_validate.c

@@ -817,3 +817,41 @@ bool validate_ap_autoconfig_response(struct cmdu_buff *cmdu, struct tlv *tv[][16
 
 	return true;
 }
+
+bool validate_failed_connection_msg(struct cmdu_buff *cmdu, struct tlv *tv[][16])
+{
+	int ret;
+	struct tlv_policy c_policy[] = {
+		[0] = {
+			.type = MAP_TLV_STA_MAC_ADDRESS,
+			.present = TLV_PRESENT_ONE,
+			.minlen = 6,
+			.maxlen = 6
+		},
+		[1] = {
+			.type = MAP_TLV_STATUS_CODE,
+			.present = TLV_PRESENT_ONE,
+			.minlen = 2,
+			.maxlen = 2
+		},
+		[2] = {
+			.type = MAP_TLV_REASON_CODE,
+			.present = TLV_PRESENT_MORE,
+			.minlen = 2,
+			.maxlen = 2
+		}
+	};
+
+	ret = cmdu_parse_tlvs(cmdu, tv, c_policy, 3);
+	if (ret) {
+		dbg("%s: parse_tlv failed\n", __func__);
+		return false;
+	}
+
+	if (!tv[0][0] || !tv[1][0]) {
+		dbg("%s: mandatory tlv missing\n", __func__);
+		return false;
+	}
+
+	return true;
+}

src/cmdu_validate.h

@@ -9,5 +9,6 @@ bool validate_topology_response(struct cmdu_buff *cmdu, struct tlv *tv_tsp[][16]
 bool validate_ap_autoconfig_wsc(struct cmdu_buff *cmdu, struct tlv *tv[][16]);
 bool validate_ap_autoconfig_search(struct cmdu_buff *cmdu, struct tlv *tv[][16]);
 bool validate_ap_autoconfig_response(struct cmdu_buff *cmdu, struct tlv *tv[][16]);
+bool validate_failed_connection_msg(struct cmdu_buff *cmdu, struct tlv *tv[][16]);
 
 #endif	// CMDU_VALIDATE

src/cntlr.c

@@ -2249,6 +2249,7 @@ static int controller_subscribe_for_cmdus(struct controller *c)
 			CMDU_AP_CAPABILITY_REPORT,
 			CMDU_CLIENT_CAPABILITY_REPORT,
 			CMDU_HIGHER_LAYER_DATA,
+			CMDU_FAILED_CONNECTION,
 			-1);
 	memcpy(c->cmdu_mask, cmdu_mask, sizeof(c->cmdu_mask));
 

src/cntlr_map_debug.c

@@ -1350,6 +1350,34 @@ int debug_backhaul_sta_caps_report(void *cntlr, struct cmdu_buff *cmdu)
 
 int debug_failed_connection_msg(void *cntlr, struct cmdu_buff *cmdu)
 {
+	struct tlv *tv[3][16];
+
+	if (!validate_failed_connection_msg(cmdu, tv)) {
+		trace("%s: cmdu validation "\
+				"[FAILED_CONNECTION] failed\n", __func__);
+		return -1;
+	}
+
 	trace("%s: --->\n", __func__);
+	trace("parsing failed connection message\n");
+
+	if (tv[0][0]) {
+		struct tlv_sta_mac *t = (struct tlv_sta_mac *)tv[0][0]->data;
+
+		trace("\tmacaddr: " MACFMT "\n", MAC2STR(t->macaddr));
+	}
+
+	if (tv[1][0]) {
+		struct tlv_status_code *t = (struct tlv_status_code *)tv[1][0]->data;
+
+		trace("\tstatus code: %d\n", BUF_GET_BE16(t->code));
+	}
+
+	if (tv[2][0]) {
+		struct tlv_reason_code *t = (struct tlv_reason_code *)tv[2][0]->data;
+
+		trace("\treason code: %d\n", BUF_GET_BE16(t->code));
+	}
+
 	return 0;
 }