jeltz/hostap
1
0
Fork 0
Code Issues Pull requests Projects Releases Wiki Activity

P2P: Fix GAS fragmentation to match with IEEE 802.11u

Browse source 
P2P specification v1.15 fixed the description of the GAS fragmentation
to not duplicate NQP Query Response Field header in all fragments. This
change makes the fragmentation match with the description in IEEE
802.11u. The change is not backwards compatible with previous P2P
specification versions as far as fragmented SD responses are concerned.
This commit is contained in:
Jouni Malinen 2010-07-26 18:54:29 -07:00 committed by Jouni Malinen
parent 3dfda83d9c
commit 5ded7d3eb8
2 changed files with 33 additions and 16 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

1
src/p2p/p2p_i.h
View file

@ -322,6 +322,7 @@ struct p2p_data {
u8 sd_frag_id; u8 sd_frag_id;
struct wpabuf *sd_rx_resp; /* Reassembled SD response */ struct wpabuf *sd_rx_resp; /* Reassembled SD response */
u16 sd_rx_update_indic;
/* P2P Invitation data */ /* P2P Invitation data */
enum p2p_invite_role inv_role; enum p2p_invite_role inv_role;

48
src/p2p/p2p_sd.c
View file

@ -210,10 +210,11 @@ static struct wpabuf * p2p_build_gas_comeback_resp(u8 dialog_token,
u16 status_code, u16 status_code,
u16 update_indic, u16 update_indic,
const u8 *data, size_t len, const u8 *data, size_t len,
u8 frag_id, u8 more) u8 frag_id, u8 more,
u16 total_len)
{ {
struct wpabuf *buf; struct wpabuf *buf;
u8 *len_pos, *len_pos2; u8 *len_pos;
buf = wpabuf_alloc(1000 + len); buf = wpabuf_alloc(1000 + len);
if (buf == NULL) if (buf == NULL)
@ -235,17 +236,18 @@ static struct wpabuf * p2p_build_gas_comeback_resp(u8 dialog_token,
/* Query Response */ /* Query Response */
len_pos = wpabuf_put(buf, 2); /* Length (to be filled) */ len_pos = wpabuf_put(buf, 2); /* Length (to be filled) */
/* NQP Query Response Frame */ if (frag_id == 0) {
wpabuf_put_le16(buf, NQP_VENDOR_SPECIFIC); /* Info ID */ /* NQP Query Response Frame */
len_pos2 = wpabuf_put(buf, 2); /* Length (to be filled) */ wpabuf_put_le16(buf, NQP_VENDOR_SPECIFIC); /* Info ID */
wpabuf_put_be24(buf, OUI_WFA); wpabuf_put_le16(buf, 3 + 1 + 2 + total_len);
wpabuf_put_u8(buf, P2P_OUI_TYPE); wpabuf_put_be24(buf, OUI_WFA);
/* Service Update Indicator */ wpabuf_put_u8(buf, P2P_OUI_TYPE);
wpabuf_put_le16(buf, update_indic); /* Service Update Indicator */
wpabuf_put_le16(buf, update_indic);
}
wpabuf_put_data(buf, data, len); wpabuf_put_data(buf, data, len);
WPA_PUT_LE16(len_pos2, (u8 *) wpabuf_put(buf, 0) - len_pos2 - 2);
WPA_PUT_LE16(len_pos, (u8 *) wpabuf_put(buf, 0) - len_pos - 2); WPA_PUT_LE16(len_pos, (u8 *) wpabuf_put(buf, 0) - len_pos - 2);
return buf; return buf;
@ -667,7 +669,8 @@ void p2p_rx_gas_comeback_req(struct p2p_data *p2p, const u8 *sa,
p2p->srv_update_indic, p2p->srv_update_indic,
wpabuf_head_u8(p2p->sd_resp) + wpabuf_head_u8(p2p->sd_resp) +
p2p->sd_resp_pos, frag_len, p2p->sd_resp_pos, frag_len,
p2p->sd_frag_id, more); p2p->sd_frag_id, more,
wpabuf_len(p2p->sd_resp));
if (resp == NULL) if (resp == NULL)
return; return;
wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Send GAS Comeback " wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Send GAS Comeback "
@ -711,7 +714,6 @@ void p2p_rx_gas_comeback_resp(struct p2p_data *p2p, const u8 *sa,
u8 more_frags; u8 more_frags;
u16 comeback_delay; u16 comeback_delay;
u16 slen; u16 slen;
u16 update_indic;
wpa_hexdump(MSG_DEBUG, "P2P: RX GAS Comeback Response", data, len); wpa_hexdump(MSG_DEBUG, "P2P: RX GAS Comeback Response", data, len);
@ -804,6 +806,14 @@ void p2p_rx_gas_comeback_resp(struct p2p_data *p2p, const u8 *sa,
} }
end = pos + slen; end = pos + slen;
if (p2p->sd_rx_resp) {
/*
* NQP header is only included in the first fragment; rest of
* the fragments start with continue TLVs.
*/
goto skip_nqp_header;
}
/* NQP Query Response */ /* NQP Query Response */
if (pos + 4 > end) if (pos + 4 > end)
return; return;
@ -816,11 +826,15 @@ void p2p_rx_gas_comeback_resp(struct p2p_data *p2p, const u8 *sa,
slen = WPA_GET_LE16(pos); slen = WPA_GET_LE16(pos);
pos += 2; pos += 2;
if (pos + slen > end || slen < 3 + 1) { wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: NQP Query Response "
"length: %u", slen);
if (slen < 3 + 1) {
wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
"P2P: Invalid NQP Query Response length"); "P2P: Invalid NQP Query Response length");
return; return;
} }
if (pos + 4 > end)
return;
if (WPA_GET_BE24(pos) != OUI_WFA) { if (WPA_GET_BE24(pos) != OUI_WFA) {
wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
@ -838,11 +852,12 @@ void p2p_rx_gas_comeback_resp(struct p2p_data *p2p, const u8 *sa,
if (pos + 2 > end) if (pos + 2 > end)
return; return;
update_indic = WPA_GET_LE16(pos); p2p->sd_rx_update_indic = WPA_GET_LE16(pos);
wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
"P2P: Service Update Indicator: %u", update_indic); "P2P: Service Update Indicator: %u", p2p->sd_rx_update_indic);
pos += 2; pos += 2;
skip_nqp_header:
if (wpabuf_resize(&p2p->sd_rx_resp, end - pos) < 0) if (wpabuf_resize(&p2p->sd_rx_resp, end - pos) < 0)
return; return;
wpabuf_put_data(p2p->sd_rx_resp, pos, end - pos); wpabuf_put_data(p2p->sd_rx_resp, pos, end - pos);
@ -883,7 +898,8 @@ void p2p_rx_gas_comeback_resp(struct p2p_data *p2p, const u8 *sa,
} }
if (p2p->cfg->sd_response) if (p2p->cfg->sd_response)
p2p->cfg->sd_response(p2p->cfg->cb_ctx, sa, update_indic, p2p->cfg->sd_response(p2p->cfg->cb_ctx, sa,
p2p->sd_rx_update_indic,
wpabuf_head(p2p->sd_rx_resp), wpabuf_head(p2p->sd_rx_resp),
wpabuf_len(p2p->sd_rx_resp)); wpabuf_len(p2p->sd_rx_resp));
wpabuf_free(p2p->sd_rx_resp); wpabuf_free(p2p->sd_rx_resp);