diff --git a/src/cmdu_validate.c b/src/cmdu_validate.c index e4cb05da82b6f956544264a6a2ae02ca4ea59cd4..5b16b842bb771987ea262df5bf7ce6451e695c6f 100644 --- a/src/cmdu_validate.c +++ b/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; +} diff --git a/src/cmdu_validate.h b/src/cmdu_validate.h index d173b6da23adc01da9ce8db44fabe4cd31cd22f4..9e925588fc51bb44e1bb5df54c88ae124242b291 100644 --- a/src/cmdu_validate.h +++ b/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 diff --git a/src/cntlr.c b/src/cntlr.c index d3f5538dbbbba669f294c17482782cd61f9ce5bf..5c1a1295229a1c0e5bc356444e9f7b1f0cd5ef5c 100644 --- a/src/cntlr.c +++ b/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)); diff --git a/src/cntlr_map_debug.c b/src/cntlr_map_debug.c index 632aca6557b3bdb79089be47b6692929b809547f..01c675c38339e08a4d30653f2d653ef8efd44cca 100644 --- a/src/cntlr_map_debug.c +++ b/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; }